Real-time pose estimation and tracking of rigid objects in 3D space using extended Kalman filter

Estimation of the orientation and location of a rigid object in 3D space using its 2D projection is considered in the current paper. In this case, a state-space model is proposed and applied to an Extended Kalman Filter (EKF) which estimates and tracks the parameters of 6 degree of freedom (DOF) movement (rotation and translation) of the object in 3D space. At the first stage, a matrix which projects the feature points in 3D space to 2D space is introduced based on the rotation-translation equations. Secondly, using the arrays of this matrix, the coordinates of the feature points in the image space are modeled by a state-space model. Finally, the 6DOF parameters are estimated using an EKF. The proposed algorithm is then evaluated by simulating the human head movements and the simulation results reveal that it can estimate the Euler angles with the estimation error less than 0.2 degree.

[1]  Maurizio Ficocelli,et al.  Adaptive filtering for pose estimation in visual servoing , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[2]  Ioannis Pitas,et al.  Facial feature extraction and pose determination , 2000, Pattern Recognit..

[3]  Vincenzo Lippiello,et al.  Adaptive extended Kalman filtering for visual motion estimation of 3D objects , 2007 .

[4]  Manolis I. A. Lourakis,et al.  Model-Based Pose Estimation for Rigid Objects , 2013, ICVS.

[5]  Anthony A. Maciejewski,et al.  Designing eigenspace manifolds: With application to object identification and pose estimation , 2009, 2009 IEEE International Conference on Systems, Man and Cybernetics.

[6]  Monish D. Tandale,et al.  Vision-Based Sensor and Navigation System for Autonomous Air Refueling , 2005 .

[7]  Qiang Ji,et al.  3D Face pose estimation and tracking from a monocular camera , 2002, Image Vis. Comput..

[8]  Helge J. Ritter,et al.  Recognition of human head orientation based on artificial neural networks , 1998, IEEE Trans. Neural Networks.

[9]  S. F. Atashzar,et al.  Robust solution to three-dimensional pose estimation using composite extended Kalman observer and Kalman filter , 2012 .

[10]  Mohan M. Trivedi,et al.  Head Pose Estimation in Computer Vision: A Survey , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.