Robust M-M unscented Kalman filtering for GPS/IMU navigation

In this paper, a robust unscented Kalman filter (UKF) based on the generalized maximum likelihood estimation (M-estimation) is proposed to improve the robustness of the integrated navigation system of Global Navigation Satellite System and Inertial Measurement Unit. The UKF is a variation of Kalman filter by which the Jacobian matrix calculation in a nonlinear system state model is not necessary. The proposed robust M-M unscented Kalman filter (RMUKF) applies the M-estimation principle to both functional model errors and measurement errors. Hence, this robust filter attenuates the influences of disturbances in the dynamic model and of measurement outliers without linearizing the nonlinear state space model. In addition, an equivalent weight matrix, composed of the bi-factor shrink elements, is proposed in order to keep the original correlation coefficients of the predicted state unchanged. Furthermore, a nonlinear error model is used as the dynamic equation to verify the performance of the proposed RMUKF with a simulation and field test. Compared with the conventional UKF, the impacts of measurement outliers and system disturbances on the state estimation are both controlled by RMUKF.