露天矿场无人驾驶自卸车路径规划方法研究

针对矿用自卸车在露天矿场环境下的路径左行要求以及长距离运输路径的平滑效率问题,提出了基于Clothoid曲线拓展的左行混合A*算法和离散点对角向量模最小化平滑算法相结合的路径规划方法。首先,在混合A*算法节点拓展搜索过程中,采用Clothoid曲线代替传统圆弧进行拓展,以保证混合A*搜索路径的曲率连续性和曲率变化率限制要求。然后,利用左行规则改进混合A*算法累加代价和启发代价,在累加代价中加入左转代价和碰撞吸引代价保证路径向左和沿地图边界左侧进行规划,在启发代价中根据拓展方向与地图边界最近点的左右位置关系调整拓展代价得到利于左行的启发代价图,以生成左行全局粗略路径。最后,结合二次规划技术,以离散点对角向量模最小化为目标函数,坐标轴方向移动量为约束,构建平滑优化模型,对全局路径进行平滑,同时为防止平滑过程中曲率超限超出车辆转向响应能力,利用大曲率点可行域隧道缩减技术,限制大曲率点平滑可移动量。试验结果表明:所提方法可以生成适应矿区左行规则的沿地图左侧边界行驶的全局路径;启发代价的改进有效地减少了混合A*算法拓展的节点数量,有利于更好实现左行;离散点路径平滑方法有效提高了全局路径的平滑度,利于车辆控制跟踪;Clothoid曲线拓展与可行域隧道缩减技术可有效应对装载、卸载等大曲率路径,不存在曲率超限情况;对比不同长度路径规划耗时数据,路径平滑算法有效降低了路径规划的总耗时,4 km路径平滑耗时只需76 ms;左行规划的实现和总耗时的减少提高了路径对于矿区场景的适应性。