A Tight Coupling Algorithm for Strapdown Inertial Navigation System (SINS)/Global Positioning System (GPS) Adaptive Integrated Navigation Based on Variational Bayesian

Abstract

Multi-source nonlinear noise exists in the process of multi-source navigation information fusion in long-endurance positioning systems in complex environments. In such engineering applications, the classical Kalman filter (KF) and the extended Kalman filter (EKF) have the phenomena of noise instability and parameter drift, which lead to the divergence of filtering results and reductions in accuracy over long periods of time. Aiming at the above problems, this paper proposes a fusion algorithm of the variational Bayesian (VB) and the cubature Kalman filter (CKF). Firstly, the system is modeled through nonlinear filtering, and the CKF error equation is established by taking the position difference and velocity difference between SINS and GPS as observation variables. Then, to address the problem of poor self-adaptation of the CKF algorithm, the variational Bayesian adaptive estimation method is introduced into the CKF algorithm, and a measurement noise variance estimation model is introduced to the process of time and measurement updates of the CKF algorithm to finally obtain the adaptive VB–CKF algorithm. The simulation results from the experimental platform show that the proposed fusion algorithm improves the combined SINS/GPS system by about 30% in terms of attitude angle accuracy and reduces speed and position estimation errors (RMSE) by about 45%. At the same time, comprehensive experiments on multiple types of sites show that compared with the CKF algorithm, the VB–CKF algorithm improves the positioning accuracy by 10% when the GPS signal is stable and improves the accuracy by about 38% when the GPS measurement noise changes dramatically in complex terrain, which effectively suppresses the accuracy divergence of the CKF algorithm and has high value for engineering applications.