陀螺仪补偿的实时EKF磁场校准

作者：蔡浩原^*; 李文宽; 赵晟霖; 刘春秀

来源：光学精密工程, 2019, 27(12): 2650-2658.

• 陀螺仪
• 磁力计
• 磁场校准
• 扩展卡尔曼滤波

磁场信息对于确定航向角和姿态信息有着至关重要的作用,但其极易受到周围铁磁性物质的干扰,而传统用于磁场校准的椭球拟合算法对磁力计数据的质量要求较高,对于客户的使用并不友好。本文在实现了一种使用更便捷,精度更高的实时磁场校准。首先,根据角速度和磁场物理关系,推导使用陀螺仪数据递推得到磁力计数据的状态转移方程,并把磁力计的测量作为量测方程,结合扩展卡尔曼滤波算法完成陀螺仪补偿的实时EKF磁场校准算法。然后,在手机中实时调取磁力计和陀螺仪数据,对二者进行实时EKF磁场校准运算并输出校准结果,之后与未校准数据和椭球拟合算法校准数据进行比较。在对比实验中:当外部磁场环境改变时,陀螺仪补偿算法不仅能够实现实时校准,并且在2s以内就可以完成对磁力计数据的校准。在校准精度方面,当手机静置时,EKF算法可以实时减少磁场干扰,校准的质量参数Q为0.72;手机绕"8"字运动时,校准的质量参数Q为0.53,优于椭球拟合算法的0.03。模拟手机日常活动的四个情境时,质量参数Q分别为0.73,0.54,0.52和0.48,而这些情况下椭球拟合算法已经失去了校准作用。实验表明,基于扩展卡尔曼滤波的磁场校准方法可实时对磁场干扰进行动态校准,校准速度快,精度高,抗干扰能力强,在消费类电子、车载惯导系统和军事上均具有广泛应用。

• 单位
  传感技术国家重点实验室; 中国科学院大学; 中国科学院电子学研究所