Pose and motion estimation using dual quaternion-based extended Kalman filtering

A solution to the remote three-dimensional (3-D) measurement problem is presented for a dynamic system given a sequence of two-dimensional (2-D) intensity images of a moving object. The 3-D transformation is modeled as a nonlinear stochastic system with the state estimate providing the six-degree-of-freedom motion and position values as well as structure. The stochastic model uses the iterated extended Kalman filter (IEKF) as a nonlinear estimator and a screw representation of the 3-D transformation based on dual quaternions. Dual quaternions, whose elements are dual numbers, provide a means to represent both rotation and translation in a unified notation. Linear object features, represented as dual vectors, are transformed using the dual quaternion transformation and are then projected to linear features in the image plane. The method has been implemented and tested with both simulated and actual experimental data. Simulation results are provided, along with comparisons to a point-based IEKF method using rotation and translation, to show the relative advantages of this method. Experimental results from testing using a camera mounted on the end effector of a robot arm are also given.

[1]  J.C.K. Chou,et al.  Quaternion kinematic and dynamic differential equations , 1992, IEEE Trans. Robotics Autom..

[2]  Mongi A. Abidi,et al.  A New Efficient and Direct Solution for Pose Estimation Using Quadrangular Targets: Algorithm and Evaluation , 1995, IEEE Trans. Pattern Anal. Mach. Intell..

[3]  William J. Wilson,et al.  Direct dynamic control of a robot using an end-point mounted camera and Kalman filter position estimation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[4]  Sukhan Lee,et al.  A Kalman filter approach for accurate 3-D motion estimation from a sequence of stereo images , 1991, CVGIP Image Underst..

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

[6]  Olivier D. Faugeras,et al.  Building, Registrating, and Fusing Noisy Visual Maps , 1988, Int. J. Robotics Res..

[7]  T. Q. Phong,et al.  Optimal estimation of object pose from a single perspective view , 1993, 1993 (4th) International Conference on Computer Vision.

[8]  Robert C. Bolles,et al.  Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography , 1981, CACM.

[9]  David G. Lowe,et al.  Perceptual Organization and Visual Recognition , 2012 .

[10]  Alex Pentland,et al.  Recursive Estimation of Motion, Structure, and Focal Length , 1995, IEEE Trans. Pattern Anal. Mach. Intell..

[11]  Rakesh Kumar,et al.  Determination of camera location and orientation , 1989 .

[12]  R. Chellappa,et al.  Recursive 3-D motion estimation from a monocular image sequence , 1990 .

[13]  Richard A. Volz,et al.  Estimating 3-D location parameters using dual number quaternions , 1991, CVGIP Image Underst..

[14]  Jiang Wang,et al.  3D relative position and orientation estimation using Kalman filter for robot control , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

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