The function computes the orientation and translation for the transformation between
two corresponding 3D point sets pi and qi so that they are related by qi = R*pi + t.
It is based on Shuster's QUEST algorithm, a popular technique in astronautics for
estimating attitude, described in M.D. Shuster and S.D. Oh: "Three-Axis Attitude Determination from
Vector Observations", Journal of Guidance and Control, Vol. 4, No. 1, January–February 1981, pp. 70–77.
Seehttp://www.malcolmdshuster.com/Pub_1981a_J_TRIAD-QUEST_scan.pdf
See also M. Lourakis and G. Terzakis: "Efficient Absolute Orientation Revisited", in Intl. Conf. on Intelligent Robots and Systems (IROS), 2018.

另外,我有一个代码绝对奥列ntation based on the FOAM algorithm:
//www.tianjin-qmedu.com/matlabcentral/fileexchange/63926