一种井下无人驾驶无轨胶轮车的路径规划方法

摘要

本发明公开了一种井下无人驾驶无轨胶轮车的路径规划方法，数据采集装置安装在有人驾驶的无轨胶轮车，然后匀速在井下巷道内行进，通过数据采集装置实时采集行进过程中的道路数据并反馈给NUC电脑，最终遍历整个井下巷道的行驶区域获得原始点云数据包；然后根据原始点云数据包依次通过算法先建立井下巷道三维点云地图，接着对三维点云地图进行分割，获得条带状地面点云，最后对条带状点云进行迭代漂移得到巷道中心点集；接着将得到的巷道线状中心点集拆分成若干段无分叉的点集；最终拼接成具有拓扑关系的井下巷道路网；最终根据该巷道路网进行路径规划。本发明得出的巷道路网能有效还原井下巷道的真实走向，确保无轨胶轮车以最短的时间到达目标点。