微小型无人直升机地磁导航算法研究

以微小型无人直升机为背景,提出了一种基于多传感器融合的地磁导航算法。在分析捷联磁力计输出模型的基础上,提出用基于递推最小二乘的椭球校正法校正捷联磁力计的零位偏差和比例系数误差,取得了比椭圆校正法更好的效果;然后将磁力计和陀螺仪输出进行互补滤波融合以提高航向测量的动态性能并抑制高频磁场干扰;最后对估计地磁场进行倾角补偿获得航向角估计。实验结果表明:利用该算法得到的航向角静态估计误差小于1.5°,在无人直升机的自主悬停、航线飞行和自主降落飞行模态中能很好地实现航向角控制与横纵向速度分解。该地磁导航算法完全可以满足微小型无人直升机自主飞行的要求。