Cubature rule-based distributed optimal fusion with identification and prediction of kinematic model error for integrated UAV navigation

Abstract Integrated MIMU/GNSS/CNS (micro-electro-mechanical system-based inertial measurement unit/global navigation satellite system/celestial navigation system) is a promising strategy for UAV (unmanned aerial vehicle) navigation. However, given its strong nonlinearity and involvement of kinematic model error, integrated MIMU/GNSS/CNS UAV navigation presents the difficulty in achieving optimal navigation solutions. This paper presents a method of cubature rule-based distributed optimal fusion combined with identification and prediction of kinematic model error to address the above problem in nonlinear integrated MIMU/GNSS/CNS. This method is in a distributed structure to simultaneously process observations from integrated MIMU/GNSS and MIMU/CNS subsystems for the subsequent global fusion. A theory for identification of kinematic model error is established using the concept of Mahalanobis distance. Further, the standard cubature Kalman filter is modified with the model prediction filter to serve as the local filters in integrated MIMU/GNSS and MIMU/CNS subsystems to hinder the disturbance of kinematic model error. Based on the above, an optimal fusion technique is developed to fuse the filtering results of each subsystem for achieving globally optimal state estimation in the sense of mean square error. Simulations and experimental results as well as comparison analysis demonstrate that the proposed distributed optimal fusion method can effectively identify and predict kinematic model error and further achieve globally optimal fusion results, leading to improved performance for integrated MIMU/GNSS/CNS UAV navigation.

[1]  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.

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

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

[4]  Aleksandar Subic,et al.  Matrix weighted multisensor data fusion for INS/GNSS/CNS integration , 2016 .

[5]  Farrokh Janabi-Sharifi,et al.  Unscented Kalman filter state estimation for manipulating unmanned aerial vehicles , 2019, Aerospace Science and Technology.

[6]  Mihai Lungu,et al.  Backstepping and dynamic inversion combined controller for auto-landing of fixed wing UAVs , 2020 .

[7]  Guobin Chang,et al.  Kalman filter with both adaptivity and robustness , 2014 .

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

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

[10]  Yuan Xu,et al.  Maximum correntropy generalized high-degree cubature Kalman filter with application to the attitude determination system of missile , 2019 .

[11]  Giancarmine Fasano,et al.  Attitude estimation for cooperating UAVs based on tight integration of GNSS and vision measurements , 2019, Aerospace Science and Technology.

[12]  Baiqing Hu,et al.  Huber’s M-Estimation-Based Process Uncertainty Robust Filter for Integrated INS/GPS , 2015, IEEE Sensors Journal.

[13]  Jian Xu,et al.  Nonlinear filtering in unknown measurement noise and target tracking system by variational Bayesian inference , 2019, Aerospace Science and Technology.

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

[15]  Jiancheng Fang,et al.  Predictive Iterated Kalman Filter for INS/GPS Integration and Its Application to SAR Motion Compensation , 2010, IEEE Transactions on Instrumentation and Measurement.

[16]  Wei Li,et al.  A Quaternion-Based Method for SINS/SAR Integrated Navigation System , 2012, IEEE Transactions on Aerospace and Electronic Systems.

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

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

[19]  John L. Crassidis,et al.  Predictive Filtering for Nonlinear Systems , 1996 .

[20]  Il Young Song,et al.  Distributed receding horizon filtering for mixed continuous-discrete multisensor linear stochastic systems , 2010 .

[21]  Yong-mei Cheng,et al.  INS/CNS navigation system based on multi-star pseudo measurements , 2019 .

[22]  Yongsun Kim,et al.  Kalman-filter based online system identification of fixed-wing aircraft in upset condition , 2019 .

[23]  Bijan Shirinzadeh,et al.  Multi-sensor optimal data fusion for INS/GPS/SAR integrated navigation system , 2009 .

[24]  Xiyuan Chen,et al.  Performance analysis of improved iterated cubature Kalman filter and its application to GNSS/INS. , 2017, ISA transactions.

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

[26]  Feng Lu,et al.  A novel distributed extended Kalman filter for aircraft engine gas-path health estimation with sensor fusion uncertainty , 2019, Aerospace Science and Technology.

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

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

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

[30]  Ming Xin,et al.  A new class of nonlinear Rauch-Tung-Striebel cubature Kalman smoothers. , 2015, ISA transactions.

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

[32]  Lu Liu,et al.  Adaptive Cubature Kalman Filter Based on the Expectation-Maximization Algorithm , 2019, IEEE Access.

[33]  Yue Meng,et al.  A visual/inertial integrated landing guidance method for UAV landing on the ship , 2019, Aerospace Science and Technology.

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

[35]  Huijuan Hao,et al.  Research on data fusion of multi-sensors based on fuzzy preference relations , 2018, Neural Computing and Applications.