Performance evaluation of Cubature Kalman filter in a GPS/IMU tightly-coupled navigation system

In a GPS/IMU tightly-coupled navigation system, the extended Kalman filter (EKF) is widely used to estimate the navigation states, due to its simpler implementation and lower computational load. However, the EKF is a first order approximation to the nonlinear system. When the nonlinearity of the system is high, the negligibility in higher order terms of the nonlinear system will degrade the estimation accuracy. In this paper, a nonlinear filtering method Cubature Kalman filter (CKF) is introduced and analysed through Taylor expansion showing the CKF's capability in capturing higher-order terms of nonlinear system. The analysis indicates that the CKF benefits only when implemented with nonlinear systems. To better show the merits of the CKF, a nonlinear attitude expression is introduced to the integrated navigation system. The performance comparison between the CKF and the EKF is examined based on the observability analysis. When the observability degree is low, the CKF performs better than the EKF in the integrated navigation systems. Otherwise, the CKF has similar performance as the EKF in the tightly-coupled navigation system. The CKF is also superior to the EKF in the GPS outage and large misalignment cases when the nonlinearity of the system is high. HighlightsThe CKF estimation accuracy is analyzed through Taylor expansion.The CKF is a second-order approximation to the nonlinear system.A nonlinear attitude expression is introduced for integrated navigation system.The CKF performs similar as the EKF in observable cases.The CKF is superior in unobservable, large misalignment and GPS outage cases.

[1]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[2]  Jeffrey K. Uhlmann,et al.  Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[3]  Simon Haykin,et al.  Cubature Kalman Filtering for Continuous-Discrete Systems: Theory and Simulations , 2010, IEEE Transactions on Signal Processing.

[4]  Ian Postlethwaite,et al.  A cubature H∞ filter and its square-root version , 2014, Int. J. Control.

[5]  Ienkaran Arasaratnam.  Cubature Kalman Filtering Theory & Applications , 2009 .

[6]  Yudan Yi,et al.  On improving the accuracy and reliability of GPS/INS-based direct sensor georeferencing , 2007 .

[7]  Jan Wendel,et al.  A Performance Comparison of Tightly Coupled GPS/INS Navigation Systems based on Extended and Sigma Point Kalman Filters , 2005 .

[8]  P. Hecker,et al.  Observability of integrated navigation system states under varying dynamic conditions and aiding techniques , 2010, IEEE/ION Position, Location and Navigation Symposium.

[9]  Hugh F. Durrant-Whyte,et al.  Development of a nonlinear psi-angle model for large misalignment errors and its application in INS alignment and calibration , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[10]  Sagi Filin,et al.  Analytical Observability Analysis of INS with Vehicle Constraints , 2015 .

[11]  Yong Li,et al.  Low-cost tightly coupled GPS / INS integration based on a nonlinear Kalman filtering design , 2006 .

[12]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[13]  Qiuzhao Zhang,et al.  Singular Value Decomposition-based Robust Cubature Kalman Filtering for an Integrated GPS/SINS Navigation System , 2015 .

[14]  Kai Chen,et al.  Square-root adaptive cubature Kalman filter with application to spacecraft attitude estimation , 2012, 2012 15th International Conference on Information Fusion.

[15]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[16]  Fredrik Gustafsson,et al.  Some Relations Between Extended and Unscented Kalman Filters , 2012, IEEE Transactions on Signal Processing.

[17]  Dorota A. Grejner-Brzezinska,et al.  Tightly-coupled GPS/INS Integration Using Unscented Kalman Filter and Particle Filter , 2006 .

[18]  Matthew Brandon Rhudy,et al.  Sensitivity and stability analysis of nonlinear Kalman filters with application to aircraft attitude estimation , 2013 .

[19]  Ming Xin,et al.  High-degree cubature Kalman filter , 2013, Autom..

[20]  Jian Wang,et al.  A CKF based GNSS/INS train integrated positioning method , 2010, 2010 IEEE International Conference on Mechatronics and Automation.

[21]  J. Speyer,et al.  Observability of an integrated GPS/INS during maneuvers , 2004 .

[22]  A. Kluga,et al.  The Analysis of the UKF-Based Navigation Algorithm during GPS Outage , 2013 .

[23]  Sinpyo Hong,et al.  Observability of error States in GPS/INS integration , 2005, IEEE Transactions on Vehicular Technology.

[24]  Jay A. Farrell,et al.  Aided Navigation: GPS with High Rate Sensors , 2008 .

[25]  Wanli Li,et al.  A Novel Scheme for DVL-Aided SINS In-Motion Alignment Using UKF Techniques , 2013, Sensors.

[26]  Xiaoji Niu,et al.  Observability Analysis of Non-Holonomic Constraints for Land-Vehicle Navigation Systems , 2012 .

[27]  Yulong Huang,et al.  Moving State Marine SINS Initial Alignment Based on High Degree CKF , 2014 .

[28]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[29]  Chenglin Wen,et al.  Cubature information filters with correlated noises and their applications in decentralized fusion , 2014, Signal Process..

[30]  I. Bar-Itzhack,et al.  Observability analysis of piece-wise constant systems. I. Theory , 1992 .

[31]  Ian Postlethwaite,et al.  Cubature Kalman Filter based Localization and Mapping , 2011 .

[32]  Yong Li,et al.  Observability Analysis of SINS/GPS during In-Motion Alignment Using Singular Value Decomposition , 2012 .

[33]  Sagi Filin,et al.  Analytical Observability Analysis of INS with Vehicle Constraints: Analytical Observ. of INS with Vehicle Constraints , 2014 .

[34]  Deok-Jin Lee.  Nonlinear bayesian filtering with applications to estimation and navigation , 2005 .

[35]  Jan Wendel,et al.  Comparison of Extended and Sigma-Point Kalman Filters for Tightly Coupled GPS/INS Integration , 2005 .

[36]  I. Bar-Itzhack,et al.  Observability analysis of piece-wise constant systems with application to inertial navigation , 1990, 29th IEEE Conference on Decision and Control.

[37]  Jamshaid Ali,et al.  Initial orientation of inertial navigation system realized through nonlinear modeling and filtering , 2011 .

[38]  Aboelmagd Noureldin,et al.  Low-Cost Three-Dimensional Navigation Solution for RISS/GPS Integration Using Mixture Particle Filter , 2010, IEEE Transactions on Vehicular Technology.

[39]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[40]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .

[41]  Marcello R. Napolitano,et al.  Sensitivity Analysis of Extended and Unscented Kalman Filters for Attitude Estimation , 2013, J. Aerosp. Inf. Syst..

[42]  Yonggang Zhang,et al.  Embedded cubature Kalman filter with adaptive setting of free parameter , 2015, Signal Process..

[43]  Yuanxin Wu,et al.  INS/GPS Integration: Global Observability Analysis , 2009, IEEE Trans. Veh. Technol..

[44]  Yingmin Jia,et al.  Location of Mobile Station With Maneuvers Using an IMM-Based Cubature Kalman Filter , 2012, IEEE Transactions on Industrial Electronics.

[45]  John L. Crassidis.  Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2006 .