A Robust Adaptive Extended Kalman Filter Based on an Improved Measurement Noise Covariance Matrix for the Monitoring and Isolation of Abnormal Disturbances in GNSS/INS Vehicle Navigation

Abstract

Global Navigation Satellite Systems (GNSS) integrated with Inertial Navigation Systems (INS) have been widely applied in many Intelligent Transport Systems. However, due to the influence of various factors, such as complex urban environments, etc., accurately describing the measurement noise statistics of GNSS receivers and inertial sensors is difficult. An inaccurate definition of the measurement noise covariance matrix will lead to the rapid divergence of the position error of the integrated navigation system. To overcome this problem, this paper proposed a Robust Adaptive Extended Kalman Filter (RAKF) method based on an improved measurement noise covariance matrix. By analyzing and considering the position accuracy factors, measurement factor, and position standard deviation in GNSS measurement results, this paper constructed the optimal measurement noise covariance matrix. Based on the Huber model, this paper constructed a two-stage robust adaptive factor expression and obtained the robust adaptive factors with and without abnormal disturbances. And robust adaptive filtering was carried out. To assess the performance of this method, the author conducted experiments on land vehicles by using a self-developed POS system (GNSS/INS combined navigation system). The classic Extended Kalman Filter algorithm (EKF), Adaptive Kalman Filter (AKF) algorithm, Robust Kalman Filter (RKF) algorithm, and the proposed method were compared through data processing. Experimental results show that compared with the classical EKF, AKF, and RKF, the positioning accuracies of the proposed method were improved by 72.43%, 2.54%, and 47.82%, respectively, in the vehicle land experiment. In order to further evaluate the performance of this method, the vehicle data were subjected to different times and degrees of disturbance experiments. Experimental results show that compared with EKF, AKF, and RKF, the heading angle accuracy had obvious advantages, and its accuracy was improved by 34.65%, 31.53%, and 18.36%, respectively. Therefore, this method can effectively monitor and isolate disturbance and improve the robustness, reliability, accuracy, and stability of GNSS/INS integrated navigation systems in complex urban environments.