基于改进方向评价函数DWA算法的局部路径规划方法

摘要

本发明公开了一种基于改进方向评价函数DWA算法的局部路径规划方法，包括以下步骤：无人车SLAM功能对环境进行同步定位与建图，生成栅格地图和代价地图，发布二维导航目标；DWA算法生成采样轨迹，用改进的方向评价函数做采样轨迹代价计算；判断最小代价路径是否可达，若选取位置半径长度内出现了占用概率高于阈值的点，判定此点不可达，缩短半径到可达点的位置，作为下一路径点方向；判断无人车对路径点和目标点的夹角，大于阈值则重新发布二维导航目标，处于阈值范围内则驶向二维导航目标。该方法避免了传统DWA算法可能陷入局部最优的状况，解决了目标点始终被占据或始终有障碍物在侧边的情况。