http://www.mathworks.com/matlabcentral/fileexchange/22422-absolute-orientation