Integrated Navigation Algorithm Based on Multiple Fading Factors Kalman Filter

Abstract

An integrated navigation algorithm based on a multiple fading factors Kalman filter (MFKF) is proposed to solve the problems that the Kalman filtering (KF) algorithm easily brings about diffusion when the model becomes a mismatched or noisy, and the MFKF accuracy is reduced when the fading factor is overused. Based on the innovation covariance theory, the algorithm designs an improved basis for judging filtering anomalies and makes the timing of the introduction of the fading factor more reasonable by switching the filtering state. Different from the traditional basis of filter abnormality judgment, the improved judgment basis adopts a recursive way to continuously update the estimated value of the innovation covariance to improve the estimation accuracy of the innovation covariance, and an empirical reserve factor for the judgment basis is introduced to adapt to practical engineering applications. By establishing an inertial navigation system (INS)/global navigation satellite system (GNSS) integrated navigation model, the results show that the average positioning accuracy of the proposed algorithm is improved by 26.52% and 7.48%, respectively, compared with the KF and MFKF, and shows better robustness and self-adaptability.