基于LD改进Cartographer建图算法的无人驾驶无轨胶轮车井下SLAM自主导航方法及试验

Unmanned trackless rubber wheeler based on LD improved Cartographer mapping algorithm underground SLAM autonomous navigation method and test

  • 摘要: 无轨胶轮车作为矿井辅助运输系统的重要设备形式之一,无人驾驶是顺应矿山智能化发展的必然方向。然而,目前该领域的研究仍处于初级阶段,特别是缺少针对井下巷道特殊恶劣环境的SLAM自主导航方法。为解决这一问题,需要研究开发高效精确的建图算法,以支持无人驾驶在井下运行的安全和可靠性。首先,基于Cartographer算法构建井下巷道环境的二维栅格地图,引入Lazy Decision(LD)算法对其进行优化,解决Cartographer建图时的重叠、模糊现象,提高了建图精度。其次,选择自适应蒙特卡洛定位(AMCL)算法解决无人驾驶无轨胶轮车的定位问题,实验结果表明:AMCL算法能够快速实现粒子收敛,最快可以在12 s内完成,并且在定位全程中表现出高准确性。再次,在全局路径规划中应用A*算法,并利用二阶贝塞尔曲线来实现路径平滑化处理,以提高路径规划的准确性和效率,解决传统A*算法规划出的路径存在拐点多、曲率大的问题。此外,通过TEB算法进行局部路径规划,实现无人驾驶无轨胶轮车在实时环境中的避障功能,并联合仿真试验测试2种不同的路径规划算法,结果表明:二级贝塞尔曲线优化后的全局路径在拐弯处更加平滑,并且曲率更小,这有助于提高路径规划的稳定性和行驶效率;TEB算法则能够迅速规划出避障路径,让无人车能够顺利避障。最后,在实验室搭建井下巷道模拟场景开展无人驾驶试验,结果表明:AMCL算法能够在短时间内实现粒子的高效收敛,且只需要不到3 m的定位距离即可完成定位任务;使用经过平滑处理的A*和TEB算法能够规划出路径更加平滑、通过性更强的路径,这些路径在拐点处没有明显的转折,并且能够快速避开障碍物,同时完成避障动作以实现导航过程中的安全行驶,满足井下无人驾驶要求。

     

    Abstract: As one of the important forms of equipment for the auxiliary transportation system of mines, the autonomous trackless rubber-tyred vehicles will be an inevitable direction as a result of the intelligent development of mines. However, the current research in this field is still in its infancy, especially the lack of SLAM autonomous navigation method for the special harsh environment of underground roadways. In order to solve this problem, it is necessary to research and develop efficient and accurate mapping algorithms to support the safety and reliability of unmanned underground operation. Firstly, a two-dimensional raster map of the underground roadway environment is constructed based on the Cartographer algorithm, and the Lazy Decision (LD) algorithm is introduced to optimize it, which solves the overlapping and fuzzy phenomena during Cartographer mapping and improves the mapping accuracy. Secondly, the adaptive Monte Carlo positioning (AMCL) algorithm is selected to solve the positioning problem of unmanned trackless rubber wheeler, and the experimental results show that the AMCL algorithm can quickly achieve particle convergence, which can be completed within 12 seconds at the fastest, and shows high accuracy in the whole positioning process. Thirdly, the A* algorithm is applied in the global path planning, and the second-order Bezier curve is used to realize the path smoothing process, so as to improve the accuracy and efficiency of path planning, and solve the problem that the path planned by the traditional A* algorithm has multiple inflection points and large curvature. In addition, the local path planning is carried out by TEB algorithm to realize the obstacle avoidance function in the real-time environment of unmanned trackless rubber wheeler. Through the joint simulation experiment to test two different path planning algorithms, the results show that the global path after the second-level Bezier curve optimization is smoother at the corner and has smaller curvature, which helps to improve the stability and driving efficiency of the path planning, and the TEB algorithm can quickly plan the obstacle avoidance path, so that the unmanned vehicle can avoid obstacles smoothly. Finally, the underground roadway simulation test scene is built in the laboratory to carry out unmanned experiments, and the results show that the AMCL algorithm can achieve efficient convergence of particles in a short time, and only needs a positioning distance of less than 3 meters to complete the positioning task. The smoothed A* and TEB algorithms can be used to plan smoother and more passable paths, which have no obvious turning at the inflection point, and can quickly avoid obstacles, while completing obstacle avoidance actions to achieve safe driving in the process, which can meet the requirements of underground unmanned driving.

     

/

返回文章
返回