基于栅格地图的分层式机器人路径规划算法

摘要

采用分层规划的思想,给出一种基于栅格地图的最优路径规划算法.分层路径规划算法的第1层为拓扑层规划,采用Voronoi图起泡生成算法描述全局可行域的拓扑关系；第2层采用广义水平集算法,解决拓扑层的最优路径搜索问题；第3层为栅格层的路径再规划.在栅格层借鉴窄带水平集的思想,通过拓宽拓扑路径,得到一个机器人安全通行的窄带区域,并在此区域实行局部快速匹配算法,改善了拓扑路径,提高了算法的效率,并提高规划的实时性.