煤炭工程 ›› 2026, Vol. 58 ›› Issue (8): 232-240.doi: 10.11799/ce202608029

• 装备技术 • 上一篇    

基于D-Hybrid A∗和S-TEB算法的矿用梭车轨迹规划研究

李永安,李佳浩,王宏伟,陈 龙,罗 实   

  1. 1. 太原理工大学 机械工程学院,山西 太原 030024

    2. 新疆智能装备研究院,新疆 阿克苏 843000

    3. 山西省煤矿智能装备工程研究中心,山西 太原 030024

    4. 太原理工大学 安全与应急管理工程学院,山西 太原 030024

  • 收稿日期:2025-11-17 修回日期:2026-03-01 出版日期:2026-08-15 发布日期:2026-08-31
  • 通讯作者: 李永安 E-mail:lya1984610@126.com

Research on Trajectory Planning of Mine Shuttle Cars Based on D-Hybrid A* and S-TEB Algorithms

  • Received:2025-11-17 Revised:2026-03-01 Online:2026-08-15 Published:2026-08-31
  • Contact: Li YongAn E-mail:lya1984610@126.com

摘要:

矿用无轨胶轮梭车长期运行于井下工作面附近巷道内未修整的非结构化地面,狭小的巷道通过空间,梭车重载、大几何尺寸的特点, 以及在巷道群内频繁地直角转弯、避障等工况使无人驾驶梭车轨迹规划面临严峻的挑战。针对这一问题,开展基于D-Hybrid A∗和S-TEB算法的矿用梭车轨迹规划研究。首先,推导了其运动学方程,建立了运动学模型;其次,针对传统HybridA∗算法搜索节点多与存在曲率大的路径等问题,采用动态扩展步长、动态使用RS曲线的策略,提出障碍物密度的计算方法并将其引入惩罚函数中,用B样条的方法对路径平滑,将改进前后算法在双巷掘进场景下进行仿真实验,结果发现,改进后的D-Hybrid A∗算法规划时间减少了51.02%,节点扩展数量减少了41.3%,转向次数减少了36.36%,效率大幅提升, 生成的路径更加平滑;最后,针对传统TEB算法易陷局部最优并产生轨迹震荡的问题,对障碍物进行重构,对比改进前后算法的局部轨迹规划仿真结果可知:S-TEB算法可实现安全避障与停障功能,在多种场景下可规划出安全的行驶轨迹,改进后的S-TEB算法平均效率提升22.89%,平均安全性能提高为原来的2.3倍,能够满足矿用梭车的无人驾驶要求。

关键词: 轨迹规划, 混合A?算法, TEB 算法, 矿用梭车, 自动驾驶

Abstract:

Mine shuttle cars have extensive applications in fields such as coal tunnel excavation, recovery of leftover coal, "three?down" coal filling and mining, and salt mine mining. With the continuous development of intelligent coal mines and unmanned vehicle technology, mine shuttle cars are gradually moving towards unmanned operation. However, the working environment of mining shuttle cars is complex, especially in the narrow coal mine roadways, where the shuttle cars are confronted with the challenges of trajectory planning and turning difficulties. In response to these problems, taking the unmanned shuttle car as the research object, through the analysis of its steering structure, simulation experiments were conducted to carry out the research on the trajectory planning of the mine shuttle car underground. Firstly, by analyzing the characteristics of the non-integrity constraints of the shuttle car, the kinematic equation was analyzed and derived, and the Hybrid A* algorithm and the TEB algorithm were determined as the basic algorithms for the trajectory planning of the mining shuttle car. Secondly, in view of the problems such as the large number of search nodes and the existence of paths with large curvature in the traditional Hybrid A* algorithm, the strategies of dynamically expanding the step size and dynamically using the RS curve are adopted. The calculation method of obstacle density is proposed and introduced into the steering penalty function. The reversing penalty is added to the cost function for the driving mode of the shuttle car. The generated paths were smoothed using the B-spline method. Global planning simulation experiments were conducted on the algorithms before and after improvement in the double-tunnel tunneling scenario. The results showed that the planning time of the improved D-Hybrid A* algorithm was reduced by 51.02%, the number of node expansions was reduced by 41.3%, and the number of turns was reduced by 36.36%. The efficiency was significantly improved. The generated path is smoother; Finally, aiming at the problems that the traditional TEB algorithm is prone to getting stuck in local optimum and generating trajectory oscillations, the obstacles were reconstructed, and an isolation layer was added outside the expansion layer to improve it. The simulation results of local trajectory planning of the algorithm before and after the improvement in the double-tunnel excavation environment were compared, indicating that the proposed S-TEB algorithm can achieve the functions of safe obstacle avoidance and stopping. Safe driving trajectories can be planned in various scenarios. The average efficiency of the improved S-TEB algorithm has increased by 22.89%, and the average safety performance has increased by 2.3 times compared to the original, which can meet the unmanned driving requirements of mining shuttle vehicles.

中图分类号: