直线型植保无人机航姿UKF两级估计算法

摘要：

针对直线型植保无人机航姿测量受磁场干扰严重、磁力计校准动态性能差、航姿估计精度低等问题,提出了一种基于磁力计实时校准的无人机航姿两级解算方法.依据地磁场矢量变化小的特点,利用列文伯格-马夸特(Levenberg-Marquardt,LM)算法和磁力计误差模型,建立磁力计实时校准模型,实时计算磁力计误差参数.考虑运动加速度、电机磁场以及环境磁场干扰,采用无迹卡尔曼滤波器(Unscented Kalman filter,UKF)融合陀螺仪和加速度计实现一级航姿估计,通过四元数精准解析出横滚角和俯仰角姿态信息;然后融合磁力计实时校准数据和陀螺仪修正航向角完成二级航姿估计,最终实现无人机姿态和航向的精准估计.试验结果表明,在外部磁场干扰高达30.97 μT时,实时校准算法仍可快速计算出磁力计校准参数,模长均方根误差为0.59 μT,减小了航向观测信息噪声.本文的航姿测量系统姿态角均方根误差不大于0.75°,航向角均方根误差为1.40°,较互补滤波算法,姿态角精度提高约0.6％,航向角估计精度提高1.38°;动态飞行试验中,姿态估计算法大幅减弱了磁干扰影响,航姿跟踪准确,航向角快速收敛,稳态精度更高.

关键词：直线型植保无人机、航姿估计、分级融合、磁力计实时校准、无迹卡尔曼滤波

所属期刊栏目：53

分类号：S251;S494(农业航空)

资助基金：江苏省重点研发计划项目;江苏省自然科学基金;镇江市重点研发计划项目

在线出版日期：2022-10-20（万方平台首次上网日期，不代表论文的发表时间）

页数：共9页

页码：151-159