Cubature Kalman filter with closed-loop covariance feedback control for integrated INS/GNSS navigation |
| |
Affiliation: | 1. Research & Development Institute of Northwestern Polytechnical University in Shenzhen, Shenzhen 518057, China;2. School of Automation, Northwestern Polytechnical University, Xi’an 710072, China;3. Aviation Industry Corporation of China (AVIC), Xi’an Aeronautic Computing Technique Research Institute (ACTRI), Xi’an 710068, China;4. School of Engineering, RMIT University, Bundoora, VIC 3083, Australia |
| |
Abstract: | Cubature Kalman Filter (CKF) offers a promising solution to handle the data fusion of integrated nonlinear INS/GNSS (Inertial Navigation System/Global Navigation Satellite System) navigation. However, its accuracy is degraded by inaccurate kinematic noise statistics which originate from disturbances of system dynamics. This paper develops a method of closed-loop feedback covariance control to address the above problem of CKF. In this method, the posterior state and its covariance are fed back to the filtering process to constitute a closed-loop structure for CKF covariance propagation. Subsequently, based on the maximum likelihood principle, a control scheme of the prior state covariance is established by using the feedback state and covariance within an estimation window and further adopting a proportional coefficient to amplify the feedback terms in recent time steps for the full use of new information to reflect actual system characteristics. Since it does not directly use kinematic noise covariance, the proposed method can effectively avoid the adverse impact of inaccurate kinematic noise statistics on filtering solutions. Further, it can also guarantee the prior state covariance to be positive semi-definite without involving extra measures. The efficacy of the proposed method is validated by simulations and experiments for integrated INS/GNSS navigation. |
| |
Keywords: | Covariance control Inertial navigation system Kalman filter Maximum likelihood Proportional coefficient |
本文献已被 ScienceDirect 等数据库收录! |
|