A Novel Robust Kalman Filter Algorithm With Unknown Noise Statistics for SINS/GPS Integrated Navigation

Xin Lai,Fu-Xin Yang

2023-01-01

Journal of the chinese society of mechanical engineers

Abstract:The estimation of process noise is often inaccurate due to factors such as ambient noise and maneuvering during carrier motion in practical applications. The higher precision and stability of integrated navigation system are pivotal for systems such as vehicles and aircraft. To solve the problem of uncertainty of unknown parameter estimation in the integrated navigation system, a novel robust expectation-maximization based Kalman filter (EMKF) algorithm is proposed in the paper. The prediction error covariance matrix and measurement noise covariance matrix are estimated adaptively using the online expectation -maximization (EM) method. The remarkable advantages of the EM-KF algorithm in this paper include the following. The online EM is employed to calculate maximum likelihood (ML) estimation of parameters, which converges in each iteration with successive likelihood increments, ensuring local convergence of the iterations; Adaptive estimation of the prediction error covariance matrix and measurement noise covariance matrix can reduce the reliance on prior information and the influence of noise on measurement estimates; The proposed EM-KF has remarkable navigation and robustness in complex environment. Simulations and the field test results illustrate that the proposed EM-KF algorithm has strong robustness and accuracy, and enables high accuracy navigation of moving vehicles for a long time.