摘要：应用一种以单位四元数为状态向量的自适应卡尔曼滤波算法融合三轴陀螺、三轴加速度计及三轴磁传感器测量信号,实现了车辆航向估计。该算法根据磁干扰强度调整磁传感器量测在航向估计中的权重,从而减小磁干扰造成的估计误差,但这种做法也使航向预测值失去了有效约束,为此研究了一种基于车辆状态的量测方程。首先,依据单位四元数与航向角的关系推导了量测方程式;然后,利用不同传感器信号间的相关关系判断车辆状态并据此实现量测权重系数的自适应调整;最后,将该量测方程引入航向估计融合算法。在实验中分别应用引入新量测方程前后的融合算法对传感器数据进行处理,实验结果表明,新量测方程可以在发生磁干扰时继续发挥约束航向预测值的作用,从而有效提高了航向估计算法抗磁干扰能力。

关键词：航向估计 陀螺 加速度计 磁传感器 卡尔曼滤波器 

单位：北京科技大学自动化学院; 北京100083; 中国石油大学(华东)信息与控制工程学院; 青岛266580; 中国石油大学胜利学院; 东营257061; 北京市工业波谱成像工程技术研究中心; 北京100083; 北京科技大学高等工程师学院; 北京100083