The Motor Extended Kalman Filter: A Geometric Approach for Rigid Motion Estimation

In this paper the motor algebra for linearizing the 3D Euclidean motion of lines is used as the oretical basis for the development of a novel extended Kalman filter called the motor extended Kalman filter (MEKF). Due to its nature the MEKF can be used as online approach as opposed to batch SVD methods. The MEKF does not encounter singularities when computing the Kalman gain and it can estimate simultaneously the translation and rotation transformations. Many algorithms in the literature compute the translation and rotation transformations separately. The experimental part demonstrates that the motor extended Kalman filter is an useful approach for estimation of dynamic motion problems. We compare the MEKF with an analytical method using simulated data. We present also an application using real images of a visual guided robot manipulator; the aim of this experiment is to demonstrate how we can use the online MEKF algorithm. After the system has been calibrated, the MEKF estimates accurately the relative position of the end-effector and a 3D reference line. We believe that future vision systems being reliably calibrated will certainly make great use of the MEKF algorithm.

[1]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[2]  Olivier Faugeras,et al.  Three D-Dynamic Scene Analysis: A Stereo Based Approach , 1992 .

[3]  Alex Pentland,et al.  Recursive estimation of structure and motion using relative orientation constraints , 1993, Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[4]  Clifford,et al.  Applications of Grassmann's Extensive Algebra , 1878 .

[5]  Eduardo Bayro-Corrochano,et al.  The dual quaternion approach to hand-eye calibration , 1996, Proceedings of 13th International Conference on Pattern Recognition.

[6]  Clifford,et al.  Preliminary Sketch of Biquaternions , 1871 .

[7]  E. J. Lefferts,et al.  Kalman Filtering for Spacecraft Attitude Estimation , 1982 .

[8]  H. W. Sorenson,et al.  Kalman Filtering Techniques , 1966 .

[9]  Eduardo Bayro-Corrochano,et al.  Motor Algebra for 3D Kinematics: The Case of the Hand-Eye Calibration , 2000, Journal of Mathematical Imaging and Vision.

[10]  David Hestenes.  New Foundations for Classical Mechanics , 1986 .

[11]  Eduardo Bayro-Corrochano.  The geometry and algebra of kinematics , 2001 .

[12]  Michel Dhome,et al.  Hand-eye calibration , 1997, Proceedings of the 1997 IEEE/RSJ International Conference on Intelligent Robot and Systems. Innovative Robotics for Real-World Applications. IROS '97.

[13]  Olivier Faugeras,et al.  3D Dynamic Scene Analysis , 1992 .

[14]  H. Grassmann.  Der Ort der Hamilton'schen Quaternionen in der Ausdehnungslehre , 1877 .

[15]  Eduardo Bayro-Corrochano,et al.  Selforganizing Clifford neural network , 1996, Proceedings of International Conference on Neural Networks (ICNN'96).

[16]  D. Hestenes,et al.  Clifford Algebra to Geometric Calculus: A Unified Language for Mathematics and Physics , 1984 .

[17]  Jake K. Aggarwal,et al.  Estimation of motion from a pair of range images: A review , 1991, CVGIP Image Underst..

[18]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

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

[20]  Eduardo Bayro-Corrochano,et al.  Analysis and Computation of Projective Invariants from Multiple Views in the Geometric Algebra Framework , 1999, Int. J. Pattern Recognit. Artif. Intell..

[21]  I. Bar-Itzhack,et al.  Attitude Determination from Vector Observations: Quaternion Estimation , 1985, IEEE Transactions on Aerospace and Electronic Systems.

[22]  David Hestenes,et al.  Space-time algebra , 1966 .