An improved GNSS/INS navigation method based on cubature Kalman filter for occluded environment

Abstract

Global navigation satellite systems and inertial navigation systems (GNSSs/INSs) based on the cubature Kalman filter (CKF) can provide an effective land vehicle navigation and positioning solution. The accuracy of CKF depends mainly on the prior probability density function (PDF), which is inaccurate when the GNSS signal is temporarily blocked in an urban environment. Although the improved CKF (ICKF) can reduce cubature point errors by using the historical information obtained iteratively, the generation of cubature points is still related to measurement noise. To obtain a more accurate PDF, adjustment off the sensor measurement noise is necessary. In this paper, an adaptive ICKF for GNSS/INS system based on the Mahalanobis distance called MD-ICKF is proposed, which expands the usability of the micro-electronic mechanical system based integrated navigation system in an urban environment. Two lower triangular matrices obtained by Cholesky decomposition are used to adjust the cubature point errors during each iteration. Furthermore, the measurement noise will be inflated to obtain a more accurate PDF when it exceeds the threshold calculated by the MD and chi-square test. The field experiment results show that the proposed method has better positioning accuracy and performance than CKF and ICKF in an occluded environment