The performance comparison and algorithm analysis of first order EKF, second order EKF and smoother for GPS/DR navigation

Several algorithms based on the global positioning system (GPS) and the dead reckoning (DR) are proposed. For comparison purpose, the performance of the GPS/DR integrated navigation system is analyzed with first extended Kalman filter (FEKF), second extended Kalman filter (SEKF) and the Rauch Tung Striebel-smoother (RTS). In this paper, the state models and measurement models of GPS /DR are set up. Furthermore, the GPS/DR integrated navigation system based on the three algorithms is simulated, and the algorithm performance is compared by the simulation results. The numerical emulation demonstrates that the EKF-RTS gives clearly better estimates than the EKF, and the SEKF is superior to the FEKF.

[1]  Weifeng Tian,et al.  Application of fixed interval smoothing to GPS/DR integrated navigation system , 2003, Proceedings of the 2003 IEEE International Conference on Intelligent Transportation Systems.

[2]  G. Welch,et al.  Model-Based 3D Object Tracking Using an Extended-Extended Kalman Filter and Graphics Rendered Measurements , 2005, Computer Vision for Interactive and Intelligent Environment (CVIIE'05).

[3]  Mohinder S. Grewal,et al.  Kalman Filtering: Theory and Practice Using MATLAB , 2001 .

[4]  Gao Zhongyu,et al.  An adaptive information fusion method to vehicle integrated navigation , 2002, 2002 IEEE Position Location and Navigation Symposium (IEEE Cat. No.02CH37284).

[5]  Santong Zhang,et al.  The Application Reserch of Unscented Particle Filter Algorithm to GPS/DR , 2006, 2006 6th World Congress on Intelligent Control and Automation.

[6]  Li-Guo Zhang,et al.  Square-Root Unscented Kalman Filter for Vehicle Integrated Navigation , 2007, 2007 International Conference on Machine Learning and Cybernetics.