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

Author:

Zhang Hongmei1,Zhang Huaqing1,Xu Guangyan1,Liu Hao1,Liu Xin1

Affiliation:

1. School of Automation, Shenyang Aerospace University, Shenyang, China

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.

Publisher

SAGE Publications

Subject

Applied Mathematics,Control and Optimization,Instrumentation

Cited by 11 articles. 订阅此论文施引文献 订阅此论文施引文献,注册后可以免费订阅5篇论文的施引文献,订阅后可以查看论文全部施引文献

同舟云学术

1.学者识别学者识别

2.学术分析学术分析

3.人才评估人才评估

"同舟云学术"是以全球学者为主线,采集、加工和组织学术论文而形成的新型学术文献查询和分析系统,可以对全球学者进行文献检索和人才价值评估。用户可以通过关注某些学科领域的顶尖人物而持续追踪该领域的学科进展和研究前沿。经过近期的数据扩容,当前同舟云学术共收录了国内外主流学术期刊6万余种,收集的期刊论文及会议论文总量共计约1.5亿篇,并以每天添加12000余篇中外论文的速度递增。我们也可以为用户提供个性化、定制化的学者数据。欢迎来电咨询!咨询电话:010-8811{复制后删除}0370

www.globalauthorid.com

TOP

Copyright © 2019-2024 北京同舟云网络信息技术有限公司
京公网安备11010802033243号  京ICP备18003416号-3