基于 Mahony-EKF 的无人机姿态解算算法
DOI:
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

V249;TN609

基金项目:

国家自然科学基金(61772090)、教育部地方高校“新工科”综合改革类项目(教高厅函[2018] 17 号)、江苏省高等学校自然科学研究项目(19KJB510017)、江苏省教改研究(2019JSJG243)资助项目


UAV attitude calculation algorithm based on Mahony-EKF
Author:
Affiliation:

Fund Project:

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

    针对微惯性测量单元精度低和传统姿态解算方法误差较大,提出一种 Mahony 和扩展卡尔曼滤波(EKF)融合的姿态解 算算法。 首先通过 Mahony 滤波器融合陀螺仪、加速度计和磁力计数据,解算得到初步姿态四元数。 再以 Mahony 滤波器的姿态 四元数作为 EKF 的量测值,根据非重力加速度的大小,自适应正相关调节量测噪声协方差矩阵;根据陀螺仪测量的角速度信息 建立 EKF 状态方程。 最终经过 EKF 滤波后,获取无人机姿态的估计。 经过仿真实验验证,融合算法解算静态姿态角误差小于 0. 1°,解算动态姿态角误差小于 1°,均优于互补滤波算法和改进 EKF 算法。 融合算法能有效抑制陀螺仪漂移误差,滤除加速度 计测量值混有的高频噪声和抑制非重力加速度的干扰,提高姿态解算精度。

    Abstract:

    A fusion algorithm combining Mahony and extended Kalman filter (EKF) is proposed to solve the problem of low accuracy of micro inertial measurement unit and large error of traditional attitude calculation method. First, the initial attitude quaternion is obtained by fusing gyroscope, accelerometer and magnetometer data with Mahony filter. Then, the attitude quaternion of the Mahony filter is used as the measurement value of EKF. According to the size of the non-gravity acceleration, the measurement noise covariance matrix is automatically adjusted by the positive correlation. The EKF equation of state is established according to the angular velocity information measured by the gyroscope. Finally, the attitude estimation of UAV is obtained after EKF filtering. The simulation results show that the static attitude angle error is less than 0. 1° and the dynamic attitude angle error is less than 1°, both of which are better than the complementary filtering algorithm and the improved EKF algorithm. The fusion algorithm can effectively suppress the gyro drift error, filter out the high frequency noise mixed with the measured value of accelerometer and suppress the interference of non-gravity acceleration, and improve the attitude calculation accuracy.

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

储开斌,赵 爽,冯成涛.基于 Mahony-EKF 的无人机姿态解算算法[J].电子测量与仪器学报,2020,34(12):12-18

复制
分享
文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2023-11-20
  • 出版日期:
文章二维码