The Measurement Correction of MEMS Gyroscope Based Interlaced Kalman Filtering

Abstract

To correct the angular rate measurement error of MEMS gyroscopes for tactical missile, this paper proposes use of dynamics correspondence between the rudder control torque and the missile body attitude to build the state equation of system, which is more realistic and precise than the description for the actual missile attitude change with low-pass filter. In order to avoid errors in the linearization for nonlinear equations and reduce the filtering computation complexity, the Interlaced Kalman Filtering is applied to achieve the pseudo-linear state equation with coupling terms, which effectively reduce the computation complexity. Finally, the semi-physical simulation with the three-axis MEMS IMU and Electro-Servo verified that the algorithm significantly improved the angular rate measurement accuracy of the low-precision MEMS gyroscope.