A Novel Lie Group Framework-based Student’s T Robust Filter and Its Application to INS/DVL Tightly Integrated Navigation

Siyuan Du,Fengchi Zhu,Zhao Wang,Yulong Huang,Yonggang Zhang
DOI: https://doi.org/10.1109/tim.2024.3379400
IF: 5.6
2024-01-01
IEEE Transactions on Instrumentation and Measurement
Abstract:The inertial navigation system (INS) and Doppler velocity log (DVL) tightly integrated navigation system is widely used in autonomous underwater vehicles. However, due to the changeable and complex marine environment, the DVL measurement noise may contain a significant amount of outlier interferences, and the system noise also exhibits inherent uncertainty. Although the existing variational-Bayesian-based robust Student's t Kalman filter (VB-RSTKF) can mitigate the impact of the outliers to a certain extent, the establishment of its state-space model is based on traditional error variable, which makes the estimation consistency poor. In addition, its estimation accuracy is affected by the inaccurate prior prediction error covariance matrix and state noise covariance matrix (SNCM). In this article, in order to improve the estimation consistency, a novel unified Lie group navigation framework is proposed, and the invariant error-based state and the measurement equation are established, respectively. Then, the expectation-maximization (EM)-VB-based RSTKF (EMVB-RSTKF) is proposed to improve the algorithm estimation accuracy within the inaccurate prior SNCM, where the prediction error scale matrix is estimated by using the EM method and the SNCM is indirectly estimated online based on the estimate of prediction error covariance matrix. Finally, the results of simulations and semiphysical filed experiments show that the proposed algorithm has significant advantages in convergence speed and estimation accuracy.
What problem does this paper attempt to address?