直线型植保无人机航姿UKF两级估计算法
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

基金项目:

江苏省重点研发计划项目(BE2018372)、江苏省自然科学基金项目(BK20181443)和镇江市重点研发计划项目(NY2018001)


UKF Two-stage Estimation Algorithm for Heading and Attitude of Linear Plant Protection UAV
Author:
Affiliation:

Fund Project:

  • 摘要
  • |
  • 图/表
  • |
  • 访问统计
  • |
  • 参考文献
  • |
  • 相似文献
  • |
  • 引证文献
  • |
  • 资源附件
  • |
  • 文章评论
    摘要:

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

    Abstract:

    Aiming at the problems of serious magnetic field interference, poor dynamic performance of magnetometer calibration and low accuracy of UAV attitude estimation, a two-stage heading and attitude estimation method based on real-time magnetometer calibration was proposed. According to the characteristics of small variation of geomagnetic field vector, the real-time calibration model of magnetometer was established by using Levenberg-Marquardt (LM) algorithm and magnetometer error model, and the error parameters of magnetometer were calculated in real time. Considering the disturbance of motion acceleration, motor magnetic field and environmental magnetic field, the unscented Kalman filter (UKF) was used to fuse gyroscope and accelerometer to realize the first-stage attitude estimation, and the attitude information of roll angle and pitch angle was accurately analyzed through quaternion. The second-stage attitude estimation combined the realtime calibration data of the magnetometer and the gyroscope to correct the heading angle, and finally realized the accurate estimation of the UAV attitude and heading. The test results showed that when the external magnetic field interference was up to 30.97μT, the real-time calibration algorithm can still quickly calculate the calibration parameters of the magnetometer, and the mode length root mean square error was 0.59μT, which reduced the noise of heading observation information. The root mean square error of the attitude angle of the attitude measurement system was no more than 0.75°, and the root mean square error of the heading angle was 1.40°. Compared with that of complementary filtering algorithm, the attitude angle accuracy was increased by 0.6°, and the heading angle estimation accuracy was improved by 1.38°. In the dynamic flight test, the attitude estimation algorithm greatly reduced the influence of magnetic interference, the attitude tracking was accurate, the heading angle converged quickly, and the steady-state accuracy was higher.

    参考文献
    相似文献
    引证文献
引用本文

沈跃,孙志伟,沈亚运,张大海,钱鹏,刘慧.直线型植保无人机航姿UKF两级估计算法[J].农业机械学报,2022,53(9):151-159. SHEN Yue, SUN Zhiwei, SHEN Yayun, ZHANG Dahai, QIAN Peng, LIU Hui. UKF Two-stage Estimation Algorithm for Heading and Attitude of Linear Plant Protection UAV[J]. Transactions of the Chinese Society for Agricultural Machinery,2022,53(9):151-159.

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:2021-10-29
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2022-09-10
  • 出版日期: