第19卷第12期
2011年12月文章编号
1004-924X(2011)12-3007-09
光学精密工程
Optics and Precision Engineering
Vol, 19No.12
Dec, 2011
基于低成本多传感器的自适应组合滤波
韩辅君1*，徐静，宋世忠3
（1.鲁东大学信息与电气学院，山东烟台264025；
2.济南职业学院机械制造系，山东济南250001；3.济南军区，山东济南250000）
摘要：研究了基于硅微机电系统（MEMS)陀螺、加速度计及磁阻式磁强计组合的微小型飞行器用姿态航向参考系统。针对传统航姿算法无法保证微小型飞行器在长时间、高机动情况下以较高精度保持姿态航向的间题，提出了一种基于低成本多传感器的自适应组合残波算法，该算法首先通过对运动加速度和磁干扰进行建模并将其引人状态方程来保证载体在长时间高机动情况下依然保持较高的姿态航向精度。其次，采用联邦滤波模式降低运动加速度与磁干扰之闻的相互影响，提高算法的精度和可靠性；通过对子滤波器专有状态量的估计方差阵P和量测方差R进行自适应设计，保证不同机动状态切换时算法的稳定性一致。用不同的组合算法进行了半物理仿真试验对比，结果表明，与传统算法相比，该算法在平飞和长时间盘旋飞行条件下均具有较高的精度和鲁棒性。
关键词：微机电系统；磁强计：微航姿参考系统；组合导航；自适应滤波；联邦滤波
中图分类号：V249.32
文献标识码：A
doi:10.3788/OPE.20111912.3007
Adaptiveattitudeestimationfiltering withlow-costmulti-sensorsforMAHRS
HANFu-jun'',XU Jing",SONG Shi-zhong
(1.Schoolof Information and ElectricalEngineering,LudongUniversity,Yantai 264025,China; 2.MachineryManufacturingDepartment，JinanVocationalCollege,Jinan25000l,China;
3.JinanMilitary,ChinesePeople'sLiberationArmy,Jinan250000,China)
Correspondingauthor，E-mailhanfujun@126.com
Abstract: An integrated Micro Attitude Heading Reference System(MAHRS) based on Micro-electro mechanical System(MEMS) gyroscopes, accelerometers, and magnetic-sensors was researched for Mi-cro Aerial Vehicles (MAV). As traditional algorithms could not keep the attitude accuracy of the MAV during a long-time maneuvering, an adaptive attitude estimation filtering algorithm with low-cost multi-sensors was presented for the MAHRS. Firstly, this algorithm was used to establish the models of acceleration and magnetic-disturbance and took them into a state equation. In this way, it could maintain the attitude accuracy of loads during the long-time maneuvering. Then, this algorithm adopted the federated filter mode to reduce the interaction between acceleration and magnetic disturb-ance to improve its precision and reliability. Moreover,the algorithm made the estimation variance (P)
收稿日期：2010-12-01：修订日期：2011-02-15.
基金项目：鲁东大学引进人才项目(No.LY2011014)