Attitude anti-interference federal filtering algorithm for MEMS-SINS/GPS/magnetometer/SV integrated navigation system

Abstract

The attitude measurement systems composed of magnetic, angular rate and gravity sensors in the navigation system of an unmanned aerial vehicle are vulnerable to disturbed magnetic field observations. In this paper, an anti-interference integrated navigation federal Kalman filter is designed with fusing the information of microelectromechanical-system-based strapdown inertial navigation system, gravity field, geomagnetic field and solar vector (direction of sun). The filter works in the mode of fusion reset or no reset according to environmental conditions or manual setting. In addition, the characteristic is discovered that disturbed magnetic field observations can interfere with the state estimation covariance matrixes of quaternions, which in turn affect the fusion update of estimated quaternions in no reset mode of the federal filter. In order to eliminate the effect of magnetic field observations on the attitude information of pitch and roll angles, a method of correction update for a yaw angle component in quaternions using the magnetometer is designed, and an Euler angle information fusion method is developed by constructing a pseudo-covariance matrix of Euler angels in fusion update of the filter. Thus, when there exist disturbed magnetic field observations and the filter is in no reset mode, the estimated pitch and roll angles of the main filter after fusion update are not affected, and the yaw angle estimation errors of the main filter decrease relative to the estimation errors of the sub-filter which is corrected by a magnetometer. The effectiveness of the algorithm is illustrated by a numerical simulation and a semi-physical simulation.