基于 Mahony-EKF 算法的手臂运动姿态测量系统
DOI:
CSTR:
作者:
作者单位:

作者简介:

通讯作者:

中图分类号:

TN2

基金项目:


Mahony-EKF algorithm-basing on arm motion attitude measurement system
Author:
Affiliation:

Fund Project:

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

    针对传统姿态解算方法效率迟缓、精度低下及稳定性差等问题,提出一种基于 Mahony 和扩展卡尔曼(EKF) 相融合的 算法,并开发出一种新型人体手臂姿态测量系统。首先,通过 STM32 微处理器采集 MEMS传感器测得的数据,借助 Mahony 滤波器解算加速度计、磁力计和陀螺仪的数据,以此得到初步姿态四元数。其次,将初步姿态四元数作为EKF 量测值,依据非 重力加速度调节量测噪声协方差矩阵。然后,根据陀螺仪测得的角速度信息建立 EKF 状态方程,通过EKF 滤波更新状态,获 取解算融合后的手臂姿态数据。最后,将数据发送到上位机,通过上位机软件实时监测姿态角数据,再构建三维模型实时还 原手臂的运动状态。经实验验证,应用EKF 算法矫正Mahony滤波解算出的姿态数据,不仅可以使误差减小到0.5°、消除超 调量和降低噪声干扰,还能有效克服传统姿态解算方法中需要大量数据集和计算时间长问题,从而抑制了随机波动,提高姿 态解算精度。

    Abstract:

    To address the issues of slow efficiency,low accuracy,and poor robustness associated with traditional posture estimation techniques,we propose an algorithm based on Mahony-EKF fusion and develop a new human arm posture estimation technique.First,collect the data measured by MEMS sensors using an STM32 microprocessor,and solve the accelerometer,magnetometer and gyroscope data using the Mahony filter to obtain the preliminary quaternion of body attitude.Next,based on the non-gravitational acceleration,the preliminary quaternion is used as the EKF measurement and adjust the measurement matrix of noise.Then the EKF state equation is established based on the angular velocity information measured by the gyroscope,and the state is updated by EKF filtering to obtain the solved and fused attitude data of the arm.Finally,the data are sent to the host computer,the angle data of attitude are monitored in real time by the software itself and the motion state of the arm is restored in real-time by constructing the 3D model.After the experimental verification,utilize the EKF algorithm to correct the attitude data solved by Mahony filtering which can not only reduce the error to 0.5°,eliminate the overshoot and reduce the noise interference but also effectively overcome the problem of requiring a large number of data sets and long computation time in the traditional methods,to suppress the random fluctuation and improve the accuracies.

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

王怡苗,夏振华.基于 Mahony-EKF 算法的手臂运动姿态测量系统[J].国外电子测量技术,2024,43(2):123-130

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