基于三子样更新的EKF低成本MEMS姿态估计算法

• 作者: 李杰 杜思远 杨雁宇 郑涛
• 来源期刊: 中国测试
• 关键词: 惯性测量 低成本MEMS惯性器件 三子样算法 扩展卡尔曼滤波 姿态四元数
• 年，卷（期）: 2018,（3）
• 所属期刊栏目: 物理测试
• 页码范围: 38-43
• 页数: 6页
• 字数: 3388字
• 语种: 中文
• DOI: 10.11857/j.issn.1674-5124.2018.03.008

摘要

针对低成本MEMS惯性器件精度较低、噪声较大、存在误差随时间积累而无法满足长时间载体姿态测量的问题,提出一种基于三子样姿态更新的扩展卡尔曼姿态估计算法.该算法结合三子样构造姿态更新四元数作为扩展卡尔曼滤波的状态量,利用当地导航系下重力场、磁场中相关数据通过比例积分控制器完成对角速率误差的一次补偿,同时作为扩展卡尔曼观测信息,完成对姿态四元数的实时校正,以此降低误差随时间积累的影响.为验证算法精度,设计转台静态及车载动态试验,试验结果表明在测试约为400 s的时间内,航向角误差约为5°,俯仰角及滚转角误差低于2°,且无发散问题,满足长时姿态测量要求.

作者信息

序号	姓名	单位	发文数	被引次数	H指数	G指数
1	李杰	中北大学仪器科学与动态测试教育部重点实验室	142	1013	16.0	26.0
2	杜思远	中北大学仪器科学与动态测试教育部重点实验室	7	34	3.0	5.0
3	杨雁宇	中北大学仪器科学与动态测试教育部重点实验室	7	25	4.0	5.0
4	郑涛	中北大学仪器科学与动态测试教育部重点实验室	9	20	2.0	4.0