A Kalman/Particle Filter-Based Position and Orientation Estimation Method Using a Position Sensor/Inertial Measurement Unit Hybrid System

被引:153
作者
Won, Seong-hoon Peter [1 ]
Melek, Wael William [1 ]
Golnaraghi, Farid [2 ]
机构
[1] Univ Waterloo, Dept Mech Engn, Waterloo, ON N2L 3G1, Canada
[2] Simon Fraser Univ, Burnaby, BC V5A 1S6, Canada
关键词
Accelerometer; expert system; gyro; inertial measurement unit (IMU); Kalman filter (KF); orientation; particle filter (PF); position; VISION;
D O I
10.1109/TIE.2009.2032431
中图分类号
TP [自动化技术、计算机技术];
学科分类号
0812 ;
摘要
This paper presents a novel methodology that estimates position and orientation using one position sensor and one inertial measurement unit. The proposed method estimates orientation using a particle filter and estimates position and velocity using a Kalman filter (KF). In addition, an expert system is used to correct the angular velocity measurement errors. The experimental results show that the orientation errors using the proposed method are significantly reduced compared to the orientation errors obtained from an extended Kalman filter (EKF) approach. The improved orientation estimation using the proposed method leads to better position estimation accuracy. This paper studies the effects of the number of particles of the proposed filter and position sensor noise on the orientation accuracy. Furthermore, the experimental results show that the orientation of the proposed method converges to the correct orientation even when the initial orientation is completely unknown.
引用
收藏
页码:1787 / 1798
页数:12
相关论文
共 31 条
[1]   A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking [J].
Arulampalam, MS ;
Maskell, S ;
Gordon, N ;
Clapp, T .
IEEE TRANSACTIONS ON SIGNAL PROCESSING, 2002, 50 (02) :174-188
[2]   Reproducibility of kinematic motion coupling parameters during manual upper cervical axial rotation mobilization: A 3-dimensional in vitro study of the atlanto-axial joint [J].
Cattrysse, E. ;
Provyn, S. ;
Kool, P. ;
Gagey, O. ;
Clarys, J. P. ;
Van Roy, P. .
JOURNAL OF ELECTROMYOGRAPHY AND KINESIOLOGY, 2009, 19 (01) :93-104
[3]   QUATERNION KINEMATIC AND DYNAMIC DIFFERENTIAL-EQUATIONS [J].
CHOU, JCK .
IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION, 1992, 8 (01) :53-64
[4]   Sigma-point Kalman filtering for integrated GPS and inertial navigation [J].
Crassidis, John L. .
IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS, 2006, 42 (02) :750-756
[5]   VIS-Tracker: A wearable vision-inertial self-tracker [J].
Foxlin, E ;
Naimark, L .
IEEE VIRTUAL REALITY 2003, PROCEEDINGS, 2003, :199-206
[6]   Miniature 6-DOF inertial system for tracking HMDs [J].
Foxlin, E ;
Harrington, M ;
Altshuler, Y .
HELMET- AND HEAD-MOUNTED DISPLAY III, 1998, 3362 :214-228
[7]  
Fung R., 1989, Proceedings of the 5th Conference on Uncertainty in Artificial Intelligence, P209
[8]   Particle filters for positioning, navigation, and tracking [J].
Gustafsson, F ;
Gunnarsson, F ;
Bergman, N ;
Forssell, U ;
Jansson, J ;
Karlsson, R ;
Nordlund, PJ .
IEEE TRANSACTIONS ON SIGNAL PROCESSING, 2002, 50 (02) :425-437
[9]   Intelligent SINS/RDSS Integrated Algorithms for Land Vehicle Navigation [J].
He, Xiaofeng ;
Hu, Xiaoping ;
Wu, Wenqi ;
Wu, Meiping .
IEEE AEROSPACE AND ELECTRONIC SYSTEMS MAGAZINE, 2009, 24 (03) :4-11
[10]  
Hyslop G., 1990, IEEE Aerospace and Electronics Systems Magazine, V5, P29, DOI 10.1109/62.134218