Please wait a minute...
Journal of Zhejiang University-SCIENCE A (Applied Physics & Engineering)  2007, Vol. 8 Issue (10): 1604-1613    DOI: 10.1631/jzus.2007.A1604
Electrical & Electronic Engineering     
Gaussian particle filter based pose and motion estimation
WU Xue-dong, SONG Zhi-huan
State Key Lab. of Industrial Control Technology, Institute of Industrial Process Control, Zhejiang University, Hangzhou 310027, China; Department of Electronic Information and Electrical Engineering, Fujian University of Technology, Fuzhou 350014, China
Download:     PDF (0 KB)     
Export: BibTeX | EndNote (RIS)      

Abstract  Determination of relative three-dimensional (3D) position, orientation, and relative motion between two reference frames is an important problem in robotic guidance, manipulation, and assembly as well as in other fields such as photogrammetry. A solution to pose and motion estimation problem that uses two-dimensional (2D) intensity images from a single camera is desirable for real-time applications. The difficulty in performing this measurement is that the process of projecting 3D object features to 2D images is a nonlinear transformation. In this paper, the 3D transformation is modeled as a nonlinear stochastic system with the state estimation providing six degrees-of-freedom motion and position values, using line features in image plane as measuring inputs and dual quaternion to represent both rotation and translation in a unified notation. A filtering method called the Gaussian particle filter (GPF) based on the particle filtering concept is presented for 3D pose and motion estimation of a moving target from monocular image sequences. The method has been implemented with simulated data, and simulation results are provided along with comparisons to the extended Kalman filter (EKF) and the unscented Kalman filter (UKF) to show the relative advantages of the GPF. Simulation results showed that GPF is a superior alternative to EKF and UKF.

Key wordsGaussian particle filter (GPF)      Pose and motion estimation      Line features      Monocular vision      Extended Kalman filter (EKF)      Unscented Kalman filter (UKF)      Dual quaternion     
Received: 14 January 2007     
CLC:  TP391  
Cite this article:

WU Xue-dong, SONG Zhi-huan. Gaussian particle filter based pose and motion estimation. Journal of Zhejiang University-SCIENCE A (Applied Physics & Engineering), 2007, 8(10): 1604-1613.

URL:

http://www.zjujournals.com/xueshu/zjus-a/10.1631/jzus.2007.A1604     OR     http://www.zjujournals.com/xueshu/zjus-a/Y2007/V8/I10/1604

[1] Xi-ming Cheng, Li-guang Yao, Michael Pecht. Lithium-ion battery state-of-charge estimation based on deconstructed equivalent circuit at different open-circuit voltage relaxation times[J]. Journal of Zhejiang University-SCIENCE A (Applied Physics & Engineering), 2017, 18(4): 256-267.
[2] Ye-hu SHEN, Ji-lin LIU, Xin DU. Environment map building and localization for robot navigation based on image sequences[J]. Journal of Zhejiang University-SCIENCE A (Applied Physics & Engineering), 2008, 9(4): 489-499.
[3] LI Mao-hai, HONG Bing-rong, LUO Rong-hua, WEI Zhen-hua. A novel method for mobile robot simultaneous localization and mapping[J]. Journal of Zhejiang University-SCIENCE A (Applied Physics & Engineering), 2006, 7(6): 937-944.