摘要

针对微型无人机航向姿态参考系统低成本、小型化的工程实现需求,基于三轴陀螺仪、加速度计和磁力计,提出了一种在线实时姿态估计算法。该算法采用四元数描述系统模型,采用改进的梯度下降法预处理加速度计和磁力计的姿态信息,然后采用互补滤波融合陀螺仪的姿态信息,实现高精度实时姿态估计。最后通过在线性能测试,来验证算法的有效性。结果表明,该算法测量误差小、运算量小、实时性高,具有较高的工程应用价值。

全文