一种基于A星算法的自动驾驶无人车双向动态路径规划方法

摘要

本发明涉及一种基于A星算法的自动驾驶无人车双向动态路径规划方法，包括如下步骤：初始化，载入栅格地图，设置好起点和目标点位置及无人车的移动步长；创建两个open列表和两个close列表，分别用于从起点向目标点方向使用A星算法搜索和从目标点向起点方向使用A星算法搜索；当两个open列表中出现相同节点时，表示找到了在当前地图环境下的最佳路径，之后再通过移动无人车位置，将新位置设置为新的起点，通过判断新位置是否为目标点位置结束无人车移动。当无人车未到达目标位置时，更新地图信息，重复寻路及移动过程直到无人车到达目标位置。本发明通过对起点和目标点分别使用A星算法，加快寻路速度，还可以适应于变化的环境中。