Robust SCKF Filtering Method for MINS/GPS In-Motion Alignment

Abstract

This paper presents a novel multiple strong tracking adaptive square-root cubature Kalman filter (MSTASCKF) based on the frame of the Sage–Husa filter, employing the multi-fading factor which could automatically adjust the Q value according to the rapidly changing noise in the flight process. This filter can estimate the system noise in real-time during the filtering process and adjust the system noise variance matrix Q so that the filtering accuracy is not significantly reduced with the noise. At the same time, the residual error in the filtering process is used as a measure of the filtering effect, and a multiple fading factor is introduced to adjust the posterior error variance matrix in the filtering process, so that the residual error is always orthogonal and the stability of the filtering is maintained. Finally, a vibration test is designed which simulates the random noise of the short-range guided weapon in flight through the shaking table and adds the noise to the present simulation trajectory for semi-physical simulation. The simulation results show that the proposed filter can significantly reduce the attitude estimation error caused by random vibration.