Closed-form solution of absolute orientation using orthonormal matrices

Finding the relationship between two coordinate systems by using pairs of measurements of the coordinates of a number of points in both systems is a classic photogrammetric task. The solution has applications in stereophotogrammetry and in robotics. We present here a closed-form solution to the least-squares problem for three or more points. Currently, various empirical, graphical, and numerical iterative methods are in use. Derivation of a closed-form solution can be simplified by using unit quaternions to represent rotation, as was shown in an earlier paper [ J. Opt. Soc. Am. A4, 629 ( 1987)]. Since orthonormal matrices are used more widely to represent rotation, we now present a solution in which 3 × 3 matrices are used. Our method requires the computation of the square root of a symmetric matrix. We compare the new result with that obtained by an alternative method in which orthonormality is not directly enforced. In this other method a best-fit linear transformation is found, and then the nearest orthonormal matrix is chosen for the rotation. We note that the best translational offset is the difference between the centroid of the coordinates in one system and the rotated and scaled centroid of the coordinates in the other system. The best scale is equal to the ratio of the root-mean-square deviations of the coordinates in the two systems from their respective centroids. These exact results are to be preferred to approximate methods based on measurements of a few selected points.

[1]  C. Eckart,et al.  The approximation of one matrix by another of lower rank , 1936 .

[2]  Garrett Birkhoff,et al.  A survey of modern algebra , 1942 .

[3]  P. Halmos.  Finite-Dimensional Vector Spaces , 1960 .

[4]  B. Green.  THE ORTHOGONAL APPROXIMATION OF AN OBLIQUE STRUCTURE IN FACTOR ANALYSIS , 1952 .

[5]  E. H. Thompson.  An exact linear solution of the problem of absolute orientation , 1958 .

[6]  G. Schut.  On exact linear equations for the computation of the rotational elements of absolute orientation , 1960 .

[7]  Granino A. Korn,et al.  Mathematical handbook for scientists and engineers , 1961 .

[8]  Cleve Moler,et al.  Mathematical Handbook for Scientists and Engineers , 1961 .

[9]  W. Gibson,et al.  On the least-squares orthogonalization of an oblique transformation , 1962 .

[10]  R. M. Johnson.  On a theorem stated by eckart and young , 1963 .

[11]  J. Stuelpnagel.  On the Parametrization of the Three-Dimensional Rotation Group , 1964 .

[12]  G. Wahba.  A Least Squares Estimate of Satellite Attitude , 1965 .

[13]  Grace Wahba,et al.  Problem 65-1: A least squares estimate of satellite attitude , 1966 .

[14]  J. Stuelpnagel,et al.  A Least Squares Estimate of Satellite Attitude (Grace Wahba) , 1966 .

[15]  P. Schönemann,et al.  A generalized solution of the orthogonal procrustes problem , 1966 .

[16]  N. Cliff.  Orthogonal rotation to congruence , 1966 .

[17]  P. Schönemann,et al.  Fitting one matrix to another under choice of a central dilation and a rigid motion , 1970 .

[18]  Soren W. Henriksen,et al.  Manual of photogrammetry , 1980 .

[19]  P R Wolf,et al.  Elements of Photogrammetry , 1983 .

[20]  Berthold K. P. Horn.  Robot vision , 1986, MIT electrical engineering and computer science series.

[21]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using unit quaternions , 1987 .

[22]  K. S. Arun,et al.  Least-Squares Fitting of Two 3-D Point Sets , 1987, IEEE Transactions on Pattern Analysis and Machine Intelligence.