Robust cubature Kalman filter for GNSS/INS with missing observations and colored measurement noise.

In order to improve the accuracy of GNSS/INS working in GNSS-denied environment, a robust cubature Kalman filter (RCKF) is developed by considering colored measurement noise and missing observations. First, an improved cubature Kalman filter (CKF) is derived by considering colored measurement noise, where the time-differencing approach is applied to yield new observations. Then, after analyzing the disadvantages of existing methods, the measurement augment in processing colored noise is translated into processing the uncertainties of CKF, and new sigma point update framework is utilized to account for the bounded model uncertainties. By reusing the diffused sigma points and approximation residual in the prediction stage of CKF, the RCKF is developed and its error performance is analyzed theoretically. Results of numerical experiment and field test reveal that RCKF is more robust than CKF and extended Kalman filter (EKF), and compared with EKF, the heading error of land vehicle is reduced by about 72.4%.

[1]  An Li,et al.  Transformed Unscented Kalman Filter , 2013, IEEE Transactions on Automatic Control.

[2]  Christophe Boucher,et al.  A Hybrid Particle Approach for GNSS Applications With Partial GPS Outages , 2010, IEEE Transactions on Instrumentation and Measurement.

[3]  Otmar Loffeld,et al.  Low-cost INS/GPS with nonlinear filtering methods , 2010, 2010 13th International Conference on Information Fusion.

[4]  Bo Xu,et al.  Stochastic stability and performance analysis of Cubature Kalman Filter , 2016, Neurocomputing.

[5]  Yong Li,et al.  Novel Hybrid of LS-SVM and Kalman Filter for GPS/INS Integration , 2010 .

[6]  Jun Hu,et al.  Extended Kalman filtering with stochastic nonlinearities and multiple missing measurements , 2012, Autom..

[7]  Feng Ding,et al.  State filtering and parameter estimation for state space systems with scarce measurements , 2014, Signal Process..

[8]  Masayoshi Tomizuka,et al.  Novel hybrid of strong tracking Kalman filter and wavelet neural network for GPS/INS during GPS outages , 2013 .

[9]  Kai-Wei Chiang,et al.  An intelligent navigator for seamless INS/GPS integrated land vehicle navigation applications , 2008, Appl. Soft Comput..

[10]  Stefan Schaal,et al.  Robust Gaussian filtering using a pseudo measurement , 2015, 2016 American Control Conference (ACC).

[11]  G. Lachapelle,et al.  Consideration of time-correlated errors in a Kalman filter applicable to GNSS , 2009 .

[12]  Yang Cheng,et al.  Novel Measurement Update Method for Quadrature-Based Gaussian Filters , 2013 .

[13]  Yuriy S. Shmaliy,et al.  Ultimate iterative UFIR filtering algorithm , 2016 .

[14]  Feng Ding,et al.  A multi-innovation state and parameter estimation algorithm for a state space system with d-step state-delay , 2017, Signal Process..

[15]  Feng Ding,et al.  Parameter estimation with scarce measurements , 2011, Autom..

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

[17]  F. Ding,et al.  Least‐squares parameter estimation for systems with irregularly missing data , 2009 .

[18]  Aboelmagd Noureldin,et al.  GPS/INS integration utilizing dynamic neural networks for vehicular navigation , 2011, Inf. Fusion.

[19]  Feng Ding,et al.  Recursive Parameter Estimation Algorithms and Convergence for a Class of Nonlinear Systems with Colored Noise , 2016, Circuits Syst. Signal Process..

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

[21]  Yuriy S. Shmaliy,et al.  An Iterative Kalman-Like Algorithm Ignoring Noise and Initial Conditions , 2011, IEEE Transactions on Signal Processing.

[22]  Jonathan P. How,et al.  Nonlinearity in Sensor Fusion: Divergence Issues in EKF, modified truncated SOF, and UKF , 2007 .

[23]  Robert Grover Brown,et al.  Introduction to random signals and applied Kalman filtering : with MATLAB exercises and solutions , 1996 .

[24]  Fei Liu,et al.  H∞ Filtering for Discrete-Time Systems With Stochastic Incomplete Measurement and Mixed Delays , 2012, IEEE Trans. Ind. Electron..

[25]  Feng Ding,et al.  Recursive least squares algorithm and gradient algorithm for Hammerstein–Wiener systems using the data filtering , 2016 .

[26]  Ángel F. García-Fernández,et al.  Posterior Linearization Filter: Principles and Implementation Using Sigma Points , 2015, IEEE Transactions on Signal Processing.

[27]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[28]  Xiyuan Chen,et al.  Improved Cubature Kalman Filter for GNSS/INS Based on Transformation of Posterior Sigma-Points Error , 2017, IEEE Transactions on Signal Processing.

[29]  Yingwei Zhao,et al.  Performance evaluation of Cubature Kalman filter in a GPS/IMU tightly-coupled navigation system , 2016, Signal Process..

[30]  Prabir Bhattacharya,et al.  A novel hybrid fusion algorithm to bridge the period of GPS outages using low-cost INS , 2014, Expert Syst. Appl..

[31]  Kazufumi Ito,et al.  Gaussian filters for nonlinear filtering problems , 2000, IEEE Trans. Autom. Control..

[32]  C. Masreliez.  Approximate non-Gaussian filtering with linear state and observation relations , 1975 .

[33]  C. W. Chan,et al.  Performance evaluation of UKF-based nonlinear filtering , 2006, Autom..

[34]  Manuel Davy,et al.  Particle Filtering for Multisensor Data Fusion With Switching Observation Models: Application to Land Vehicle Positioning , 2007, IEEE Transactions on Signal Processing.

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