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

Research on autonomous navigation and automatic control technology of roadway cleaning robot

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

     

    Abstract: This paper addresses three key challenges faced by coal mine roadway cleaning robots operating in long straight underground roadways without satellite signals: localization degradation, difficulty in multi-process coordination, and labor-intensive attachment replacement. An integrated technical framework combining autonomous navigation, hierarchical collaborative control, and automatic attachment replacement is proposed. For autonomous navigation, an angle-clustering ground segmentation method is combined with a tightly coupled unscented Kalman filter (UKF) for fusion positioning, effectively suppressing axial drift. Furthermore, an attitudeaware improved A* global planning algorithm is developed to eliminate the need for terminal orientation adjustment. For collaborative control, a hierarchical finite state machine based architecture is constructed to enable autonomous multi-process scheduling. For attachment replacement, a distance-triggered coarsetofine segmented heterogeneous perception fusion strategy is introduced. This strategy continuously weights and fuses joint state feedback with visual positioning information, achieving full-process automatic attachment replacement. Underground industrial trials, with a cumulative operation of 160 hours and a total footage of 60 meters, show that the average trajectory error is 0.01 m, the terminal heading deviation is 3.8°, and the dynamic obstacle avoidance success rate is 92%. The overall process success rate reaches 80%, and the manipulator end-effector tracking error is 0.12 m. Fourteen out of fifteen?attachment replacements were successful, with an average cycle time of 4.8 min per replacement, representing a 60% efficiency improvement over manual-assisted methods. The number of operators per shift is reduced from 5 to 2 (a 60% reduction), while per-capita efficiency increases from 1.8 m3/shift to 2.6 m3/shift. The proposed framework effectively resolves the three core challenges-positioning degradation, multi-process coordination, and automatic attachment replacement-for roadway cleaning robots in unstructured confined underground environments, significantly enhancing both operational safety and overall efficiency.

     

/

返回文章
返回