基于多传感器融合的掘进机组合定位方法

Combined Positioning Method for Roadheader Based on Multi-sensor Fusion

  • 摘要: 针对煤矿井下掘进机工作时易打滑、横移和大角度偏转的复杂工况,传统单一传感器定位方法难以同时满足高可靠性与抗干扰能力要求的问题,提出一种融合激光雷达、光纤惯性导航与UWB技术的掘进机组合定位方法。首先建立巷道坐标系、掘进机坐标系、激光雷达坐标系与导航坐标系,推导多坐标系间的姿态变换与位置变换矩阵。利用单线激光雷达采集巷道顶板导轨标靶的点云数据,经滤波预处理后采用DBSCAN密度聚类算法分离导轨、顶板与噪声点云,通过拟合导轨中线计算掘进机相对于巷道中心线的横向偏移与高度。融合UWB前后基站的测距信息、惯导测量的航向角以及激光雷达获得的横向偏移,构建机身-巷道几何关系模型,实现对掘进机进尺的实时解算。在此基础上,以EBZ220S型掘进机为对象,分别开展了静态定位试验以及井下掘进机自主截割试验。结果表明:静态条件下横向偏差测量平均误差为1.26 cm;高度测量平均误差为1.72 cm;进尺测量平均误差为1.73 cm。组合定位方法能有效消除掘进机机身旋转带来的进尺测量误差,最大抑制量达9.83 cm。掘进机自主截割试验中,掘进机可稳定完成自主行走、自主纠偏和全断面截割,成型断面尺寸平均误差为5.7 cm,满足煤矿智能掘进成型精度要求。本文提出的多传感器融合定位方法显著提升了掘进机在井下实际截割工况下的定位精度、稳定性与工程适应性,可为掘进机的自主行走、全断面自主截割及远程无人化作业提供可靠的技术支撑。

     

    Abstract: In view of the complex working conditions of coal mine underground heading machines, which are prone to slipping, lateral shifting, and large-angle deflection during operation, traditional single-sensor positioning methods struggle to simultaneously meet the requirements of high reliability and anti-interference capability. A combined positioning method for heading machines, integrating LiDAR, fiber-optic inertial navigation, and UWB technology, is proposed. Firstly, the tunnel coordinate system, heading machine coordinate system, LiDAR coordinate system, and navigation coordinate system are established, and the attitude transformation and position transformation matrices between multiple coordinate systems are derived. Single-line LiDAR is used to collect point cloud data of the tunnel roof guide rail targets. After filtering and preprocessing, the DBSCAN density clustering algorithm is employed to separate the guide rail, roof, and noise point clouds. The lateral offset and height of the heading machine relative to the tunnel centerline are calculated by fitting the guide rail centerline. By integrating the ranging information from front and rear UWB base stations, the heading angle measured by inertial navigation, and the lateral offset obtained from LiDAR, a body-tunnel geometric relationship model is constructed to achieve real-time calculation of the heading machine's footage. Based on this, static positioning tests and underground heading machine autonomous cutting tests were conducted using the EBZ220S heading machine as the object. The results show that under static conditions, the average error in lateral deviation measurement is 1.26 cm; the average error in height measurement is 1.72 cm; and the average error in footage measurement is 1.73 cm. The combined positioning method can effectively eliminate the footage measurement error caused by the rotation of the heading machine body, with a maximum suppression of 9.83 cm. In the autonomous cutting test of the heading machine, the machine can stably complete autonomous walking, autonomous correction, and full-section cutting. The average error in the size of the formed section is 5.7 cm, meeting the accuracy requirements for intelligent heading and forming in coal mines. The multi-sensor fusion positioning method proposed in this paper significantly improves the positioning accuracy, stability, and engineering adaptability of the heading machine under actual underground cutting conditions, providing reliable technical support for autonomous walking, full-section autonomous cutting, and remote unmanned operations of the heading machine.

     

/

返回文章
返回