Maximum Likelihood-Based Measurement Noise Covariance Estimation Using Sequential Quadratic Programming for Cubature Kalman Filter Applied in INS/BDS Integration

With the completion of the Beidou-3 system (BDS) in China, INS/BDS integration will become a promising navigation and positioning strategy. However, due to the nonlinear propagation characteristic of INS error and inevitable involvement of inaccurate measurement noise statistics, it is difficult to achieve the optimal solution through the INS/BDS integration. This paper proposes a method of cubature Kalman filter (CKF) with the measurement noise covariance estimation by using the maximum likelihood principle to solve the abovementioned problem. It establishes an estimation model for measurement noise covariance according to the maximum likelihood principle, and then, its estimation is calculated by utilizing the sequential quadratic programming. The estimated measurement noise covariance will be fed back to the procedure of CKF to improve its adaptability. Simulation and comparison analysis verify that the proposed method can accurately estimate measurement noise covariance to effectively restrain its influence on navigation solution, leading to improved navigation performance for the INS/BDS integration.

[1]  Vinay A. Bavdekar,et al.  Identification of process and measurement noise covariance for state and parameter estimation using extended Kalman filter , 2011 .

[2]  Seyed Taghi Akhavan Niaki,et al.  Optimization of a multiproduct economic production quantity problem with stochastic constraints using sequential quadratic programming , 2015, Knowl. Based Syst..

[3]  Yongmin Zhong,et al.  Model Predictive Based Unscented Kalman Filter for Hypersonic Vehicle Navigation With INS/GNSS Integration , 2020, IEEE Access.

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

[5]  Lei Zhang,et al.  Robust measure of non-linearity-based cubature Kalman filter , 2017 .

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

[7]  Jie Wu,et al.  Augmented Cubature Kalman filter for nonlinear RTK/MIMU integrated navigation with non-additive noise , 2017 .

[8]  Sirish L. Shah,et al.  Identification of chemical processes with irregular output sampling , 2006 .

[9]  G. Chang.  Robust Kalman filtering based on Mahalanobis distance as outlier judging criterion , 2014, Journal of Geodesy.

[10]  Yongmin Zhong,et al.  Cubature rule-based distributed optimal fusion with identification and prediction of kinematic model error for integrated UAV navigation , 2021 .

[11]  Yongmin Zhong,et al.  A derivative UKF for tightly coupled INS/GPS integrated navigation. , 2015, ISA transactions.

[12]  Shesheng Gao,et al.  Maximum likelihood principle and moving horizon estimation based adaptive unscented Kalman filter , 2018 .

[13]  Ling Yang,et al.  An enhanced MEMS-INS/GNSS integrated system with fault detection and exclusion capability for land vehicle navigation in urban areas , 2013, GPS Solutions.

[14]  Yongmin Zhong,et al.  Robust Unscented Kalman Filtering With Measurement Error Detection for Tightly Coupled INS/GNSS Integration in Hypersonic Vehicle Navigation , 2019, IEEE Access.

[15]  Yang Li,et al.  Robust square-root cubature Kalman filter based on Huber’s M-estimation methodology , 2015 .

[16]  Yang Meng,et al.  Covariance matching based adaptive unscented Kalman filter for direct filtering in INS/GNSS integration , 2016 .

[17]  Shesheng Gao,et al.  Interacting multiple model estimation-based adaptive robust unscented Kalman filter , 2017 .

[18]  Wei Wang,et al.  A new direct filtering approach to INS/GNSS integration , 2018, Aerospace Science and Technology.

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

[20]  Hanxin Zhang,et al.  Modified unscented Kalman filtering and its application in autonomous satellite navigation , 2009 .

[21]  Yonggang Zhang,et al.  A New Process Uncertainty Robust Student’s t Based Kalman Filter for SINS/GPS Integration , 2017, IEEE Access.

[22]  Bingbing Gao,et al.  Unscented kalman filter with process noise covariance estimation for vehicular ins/gps integration system , 2020, Inf. Fusion.

[23]  Jianye Liu,et al.  An adaptive cubature Kalman filter algorithm for inertial and land-based navigation system , 2016 .

[24]  An Li,et al.  Robust derivative-free Kalman filter based on Huber's M-estimation methodology , 2013 .

[25]  Jingnan Liu,et al.  Solar Radiation Pressure Models for BeiDou-3 I2-S Satellite: Comparison and Augmentation , 2018, Remote. Sens..

[26]  Shesheng Gao,et al.  Multi-sensor Optimal Data Fusion for INS/GNSS/CNS Integration Based on Unscented Kalman Filter , 2018 .

[27]  Xi Liu,et al.  Maximum correntropy square-root cubature Kalman filter with application to SINS/GPS integrated systems. , 2018, ISA transactions.

[28]  Qile Zhao,et al.  Precise orbit and clock determination for BeiDou-3 experimental satellites with yaw attitude analysis , 2017, GPS Solutions.