煤炭工程 ›› 2021, Vol. 53 ›› Issue (11): 140-145.doi: 10.11799/ce202111027

• 研究探讨 • 上一篇    下一篇

基于捷联惯导和推移油缸信息融合的智能掘进机器人位姿测量方法#br#

华洪涛,马宏伟,毛清华,石金龙,张羽飞   

  1. 1. 西安科技大学 电气与控制工程学院, 陕西 西安 710054
    2. 西安科技大学 机械工程学院, 陕西 西安 710054
    3. 陕西省矿山机电装备智能监测重点实验室, 陕西 西安 710054
  • 收稿日期:2020-12-15 修回日期:2021-01-19 出版日期:2021-11-20 发布日期:2022-01-05
  • 通讯作者: 华洪涛 E-mail:1558746016@qq.com

Research on the Pose Measurement Method of Roadheader Based on Strapdown Inertial Navigation and Oil Cylinder Movement

#br#   

  • Received:2020-12-15 Revised:2021-01-19 Online:2021-11-20 Published:2022-01-05
  • Contact: hongtao 无hua E-mail:1558746016@qq.com

摘要:

针对煤矿智能掘进机器人系统位姿实时精确测量问题, 基于两级护盾结构相互推移油缸实现机器人行驶原理, 提出了一种基于捷联惯导和推移油缸信息融合的智能掘进机器人位姿测量方法。利用捷联惯导实时测量智能掘进机器人的姿态信息, 再结合推移油缸位移数据, 进行航位推算。采用标准卡尔曼滤波算法将捷联惯导数据和油缸数据进行融合, 抑制惯导测量误差, 提高位姿测量精度。井下实验结果表明: 在智能掘进机器人系统静止1h 左右, 惯导和油缸组合测量的俯仰角、横滚角和航向角的漂移量分别为0.018596°、0.004635°和0.011898°; 在智能掘进机器人前进21m(截距为1m) 的过程中, 组合测量系统解算得到的位置误差在X 轴和Y轴方向分别小于3.5cm和2cm。

关键词: 捷联惯导, 油缸, 掘进机位姿, 航位推算, 卡尔曼滤波

Abstract:

In order to realize the intelligent mining of the fully mechanized excavation face, in response to the need for real-time accurate measurement of the roadheader's position and attitude at work, a combined measurement method for the roadheader's position and attitude based on strapdown inertial navigation and cylinder displacement is proposed. The method uses strapdown inertial navigation to measure the attitude information of the roadheader in real time, combines the displacement data of the cylinder moving the roadheader forward with the attitude information of the roadheader to calculate dead-reckoning, and uses the standard Kalman filter algorithm to combine the strapdown inertial navigation data and the cylinder data Perform fusion to suppress the divergence of inertial navigation measurement results and improve the accuracy of pose measurement. The results of downhole experiments show that the pitch angle, roll angle and heading angle measured by the combination of inertial navigation and the cylinder are0.018596 deg ,0.004635 deg,0.011898 deg and when the intelligent tunneling robot is stationary for 1 hour; In the process, the position error calculated by the combined measurement system is less than 3.5cm and 2cm in the x-axis and y-axis directions, respectively, which overcomes the problem of cumulative errors caused by the pure inertial navigation solution.

中图分类号: