采煤机双IMU位姿解算方法
DOI:
CSTR:
作者:
作者单位:

1.中国矿业大学机电工程学院徐州221116; 2.燕山大学机械工程学院秦皇岛066004

作者简介:

通讯作者:

中图分类号:

TH701TD421

基金项目:

国家自然科学基金项目(52304180)、河北省中央引导地方科技发展资金项目(246Z1911G)资助


Shearer double-IMU position and attitude calculation method
Author:
Affiliation:

1.School of Mechanical and Electrical Engineering, China University of Mining and Technology, Xuzhou 221116, China; 2.School of Mechanical Engineering, Yanshan University, Qinhuangdao 066004, China

Fund Project:

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

    惯性测量单元(IMU)可实现自主全参数导航的优点,具有在井下GPS拒止环境应用的技术优势。基于冗余IMU的采煤机定位是综采装备可行的低成本定位方法,但也面临IMU随时间漂移大的问题。当2个IMU安装在采煤机载体后,其各自输出位置和姿态的差值均应该是常数,即应满足双IMU位姿约束条件。基于位姿约束条件,以信息滤波为基本框架,提出了采煤机双IMU位姿解算方法。以IMU-1和IMU-2的姿态四元数作为状态量,基于四元数更新方程建立信息滤波状态方程。以加速度计原始输出、磁力计原始输出、位置差值和姿态差值作为量测量,推导各量测量与姿态四元数转换的雅克比矩阵,分别构建量测方程。采用移动机器人模拟采煤机截割4刀实验,每刀52 m。对于IMU-1,算法处理后第3、4刀的球概率误差由3.618 0、8.220 2 m分别减小到1.545 2、2.882 8 m,定位精度提升约64.9%。对于IMU2,算法处理后第3、4刀的球概率误差由4.342 0、5.736 8 m分别减小到1.617 8、2.352 3 m,定位精度提升约59.0%。对于移动机器人,对IMU-1和IMU-2算法处理后的姿态求取平均值,采用航位推算法解算位置坐标,得到第3、4刀的球概率误差分别为0.790 7和1.431 7 m。该方法为冗余IMU定位提供了底层解算算法,提高了定位精度。

    Abstract:

    The inertial measurement unit (IMU) can achieve the advantages of autonomous full-parameter navigation and has the technical advantage of being applied in underground GPS-denied environments. The shearer positioning based on redundant IMUs is a feasible and low-cost positioning method for longwall mining equipment. However, it also faces the problem of a large drift of IMUs over time. When two IMUs are installed on the carrier of a coal mining machine, the differences in their respective output positions and attitudes should all be constants. They should meet the dual-IMU pose constraint conditions. Based on the constraints of position and attitude, a method for calculating the shearer double-IMU position and attitude is proposed based on the information filter. Taking the attitude quaternions of IMU-1 and IMU-2 as state quantities, the information filtering state equation is established based on the quaternion update equation. Using the raw output of the accelerometer, the raw output of the magnetometer, the position difference, and the attitude difference as the measurement values, the Jacobian matrices for converting the measurement values into attitude quaternions are derived, and the measurement equations are constructed. In the experiment of four cutting cycles, for IMU-1, the spherical probability errors (SPEs) of the third and fourth cutting cycles after processing by the algorithm are reduced from 3.618 0 m and 8.220 2 m to 3.618 0 m and 8.220 2 m. The positioning accuracy is improved by 64.9%. For IMU-2, the SPEs of the third and fourth cutting cycles after processing are reduced from 4.342 0 m and 5.736 8 m to 1.617 8 m and 2.352 3 m. The positioning accuracy is improved by 59.0%. The average values of the attitude angles processed by the IMU-1 and IMU-2 algorithms are obtained. The position coordinates of the mobile robot are calculated using the position estimation algorithm, and the SPEs of the third and fourth cuts are 0.790 7 m and 1.431 7 m, respectively. This method provides a low-level solution algorithm for redundant IMU positioning and improves positioning accuracy.

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

代卫卫,王世博,王世佳.采煤机双IMU位姿解算方法[J].仪器仪表学报,2025,46(5):277-288

复制
分享
相关视频

文章指标
  • 点击次数:
  • 下载次数:
  • HTML阅读次数:
  • 引用次数:
历史
  • 收稿日期:
  • 最后修改日期:
  • 录用日期:
  • 在线发布日期: 2025-08-12
  • 出版日期:
文章二维码