煤矿巷道清理机器人自主导航与协同控制

Autonomous navigation and collaborative control of coal mine roadway cleaning robot

  • 摘要: 针对煤矿巷道清理机器人在无卫星信号长直巷道中定位易退化、多工序协同困难及属具更换依赖人工等问题,提出一种融合自主导航、多工序协同与属具自动更换的综合控制方法。在自主导航方面,采用角度聚类地面分割与无迹卡尔曼滤波融合定位方法抑制轴向漂移,并设计姿态感知的改进A*全局规划算法消除末端调姿需求。在协同控制方面,构建基于层级有限状态机的分层架构,实现多工序自主调度。在属具更换方面,提出距离触发的粗−精分段异构感知融合策略,通过连续加权融合关节状态反馈与视觉定位信息,完成属具全流程自主更换。在井下开展累计作业160 h、进尺60 m的工业性试验,结果表明:煤矿巷道清理机器人的平均轨迹误差为0.01 m,末端航向偏差3.8°,动态避障成功率达92%;全流程成功率为80%,机械臂末端跟踪误差为0.12 m;属具自动更换成功率达93.3%,单次平均耗时4.8 min;单班作业人数由5人减至2人,减人60%,人均作业效率由1.8 m3/班提升至2.6 m3/班。

     

    Abstract: To address localization degradation of coal mine roadway cleaning robots in long, straight roadways where satellite signals are unavailable, difficulties in multi-process coordination, and reliance on manual intervention for attachment replacement, a comprehensive control method integrating autonomous navigation, multi-tool collaborative control, and automatic attachment replacement of fixture is proposed. For autonomous navigation, a fusion localization method combining angle-clustering-based ground segmentation with the Unscented Kalman Filter (UKF) was employed to suppress axial drift, and an improved pose-aware A* global planning algorithm was designed to eliminate the need for final pose adjustment. For collaborative control, a layered architecture based on a hierarchical finite-state machine was constructed to enable autonomous scheduling of multiple processes. For attachment replacement, a distance-triggered heterogeneous perception fusion strategy with coarse-to-fine staging was proposed; joint-state feedback and visual localization information were continuously weighted and fused to complete the entire attachment replacement process autonomously. An underground industrial test involving a cumulative operating time of 160 h and an advance of 60 m was conducted. Results showed that the coal mine roadway cleaning robot had a mean trajectory error of 0.01 m, a final heading deviation of 3.8°, and a dynamic obstacle avoidance success rate of 92%. The full-process success rate was 80%, and the manipulator end-effector tracking error was 0.12 m. The success rate of automatic attachment replacement was 93.3%, and the mean duration per replacement was 4.8 min. The number of operators per shift was reduced from 5 to 2, a reduction of 60%, while per-capita efficiency increased from 1.8 m3/shift to 2.6 m3/shift.

     

/

返回文章
返回