Simultaneous rotation and translation fitting of two 3-D point sets

A single-stage linear method is devised in this paper to simultaneously fit rotation and translation (pose) parameters given two sets of three-dimensional (3-D) point measurements. The necessary and sufficient conditions for the unique solution of the pose determination problem are stated. The computational complexity of the new algorithm is similar to the existing linear algorithms. However it offers a mechanism to incorporate the reliability of measurements and a procedure to implement the estimation recursively. Applications of the technique include localization of a robot in its environment and real-time estimation of object motion based on computer vision.

[1]  Anthony A. Maciejewski,et al.  A parallel algorithm and architecture for the control of kinematically redundant manipulators , 1994, IEEE Trans. Robotics Autom..

[2]  Kenichi Kanatani,et al.  Unbiased Estimation and Statistical Analysis of 3-D Rigid Motion from Two Views , 1993, IEEE Trans. Pattern Anal. Mach. Intell..

[3]  Zvi S. Roth,et al.  Fundamentals of Manipulator Calibration , 1991 .

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

[5]  J. Suykens,et al.  An absolute stability criterion for the Lur'e problem with sector and slope restricted nonlinearities , 1998 .

[6]  S. Umeyama,et al.  Least-Squares Estimation of Transformation Parameters Between Two Point Patterns , 1991, IEEE Trans. Pattern Anal. Mach. Intell..

[7]  Bahram Ravani,et al.  Kinematic localization for world model calibration in off-line robot programming using Clifford algebra , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[8]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using orthonormal matrices , 1988 .

[9]  K. N. Srinivasa Rao.  The Rotation and Lorentz Groups and Their Representations for Physicists , 1989 .

[10]  C. S. G. Lee,et al.  Robotics: Control, Sensing, Vision, and Intelligence , 1987 .

[11]  Richard A. Brown,et al.  Introduction to random signals and applied kalman filtering (3rd ed , 2012 .

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