基于双级互补滤波的姿态测量算法设计

• 作者: 冯凯强 李杰 李炳臻 许廷金 高宁 高诗尧
• 来源期刊: 传感技术学报
• 学科: 交通运输
• 关键词: 姿态测量 MARG 四元数 磁干扰 互补滤波
• 年，卷（期）: 2019,（12）
• 所属期刊栏目: 传感器信号处理
• 页码范围: 1824-1829
• 页数: 6页
• 分类号: U666.1
• 字数: 3256字
• 语种: 中文
• DOI: 10.3969/j.issn.1004-1699.2019.12.010

摘要

陀螺仪的漂移、载体的线性加速度和磁场的干扰是影响MARG传感器姿态测量精度的主要原因.针对传统姿态测量算法在磁干扰环境下由于航向角误差导致水平角测量精度降低以及载体线性加速度影响水平角精度的问题,提出了一种基于四元数的双级互补滤波姿态融合算法.该算法利用加速度计和磁力计测量数据分别对估计四元数进行补偿修正,避免了磁干扰环境下航向角误差对水平姿态测量的影响.同时引入线性加速度误差和磁干扰误差自适应补偿方案,以降低线性加速度与磁干扰的影响.为了验证算法的有效性,进行了静态与动态实验,实验结果表明该姿态测量算法能显著提高姿态测量精度和抗干扰能力.与传统的Mahony算法相比,俯仰/滚动角的测量精度完全不受磁干扰的影响,性能得到了明显的提升.

作者信息

序号	姓名	单位	发文数	被引次数	H指数	G指数
1	李杰	中北大学电子测试技术重点实验室	142	1013	16.0	26.0
2	冯凯强	中北大学电子测试技术重点实验室	12	33	4.0	5.0
3	高宁	中北大学电子测试技术重点实验室	4	1	1.0	1.0
4	许廷金	中北大学电子测试技术重点实验室	7	19	2.0	4.0
5	高诗尧	中北大学电子测试技术重点实验室	3	1	1.0	1.0
6	李炳臻	中北大学电子测试技术重点实验室	1	0	0.0	0.0