[发明专利]一种基于动态窗口和冗余节点过滤的路径优化方法

说明书

本发明公开了一种基于动态窗口和冗余节点过滤的路径优化方法，其包括利用已有的栅格地图数据集，确定运动的起始位置和目标位置的坐标信息，在栅格地图中标注目标节点和障碍物节点；利用A^*算法规划出一条全局路径；利用A^*算法规划处的全局路径进行全局优化，过滤掉冗余节点；结合动态窗口法对优化后的全局路径进行分段局部优化，得到最终的全局路径。本发明使用组合算法减少了移动机器人的单次运动时长，提高了运动路径曲线的平滑性；同时改善了机器人在静态行驶路线过程中的问题，在规划路径段内可以实现灵活的避障功能。

技术领域

本发明涉及移动机器人技术中的运动规划领域，更具体地涉及一种可用于移动机器人的路径规划及优化方法。

背景技术

机器人技术作为一个综合了多个学科的技术，是多年研究的热门。其中，路径规划作为移动机器人技术研发的关键技术，其目的在于参照某一个参数的指标(如代价最低、选择路径最短、运算时间最短等)，在任务区域选择出一条可以从起点运动到终点的最优或次优的避障路径。路径规划按照机器人对工作区域信息的理解层次，可以分为给予完整区域信息理解的全局路径规划和基于部分区域信息理解的局部路径规划，两者各有优缺。现在实际工作中大多情况下都需要融合兼用全局和局部路径规划，前者旨在寻找全局优化路径，后者旨在实时避障。

A^*算法作为最流行的全局路径查找选择方式之一，具有高度灵活性，且可以广泛应用于不同的环境之中。A^*算法的成功秘诀在于它结合了Dijkstra算法使用的信息(对接近起点的位置有利)和贪婪最佳优先搜索使用的信息(对接近目的地的位置有利)。其通过计算路由节点成本，选择成本最低的节点，通过依次扩展具有最小启发函数的节点来寻找最优路径。虽然传统的A*算法能得到一条长度相对比较优秀的路径，但是该路径存在的问题也很明显：有冗余节点、转折点较多，这些对机器人实际的运动都是不利的存在。

动态窗口法因为其符合移动机器人的运动特征，具有灵活性强等优点，成为了动态环境下局部避障的主要算法。动态窗口法的基本思想是结合移动机器人的运动特性，在路径规划过程中，实时预测时间t内移动机器人的速度空间(v_t,w_t)和状态空间(x_t,y_t,yaw_t,v_t,w_t)，模拟移动机器人在预测时间内的运动轨迹，再根据评价函数确定最优的运动轨迹，从而到达目标位置完成路径规划。该方法属于一个局部的路径规划，机器人如果只在这个算法下运动，虽然可以保证一个良好的运动姿态，但是要达到目标点需要遍历太多节点，效率很低。

发明内容

针对现有技术存在的上述问题，本发明的要解决的技术问题是：如何尽可能的优化路线，使机器人的路线更平滑和可靠。

为解决上述第一个技术问题，本发明采用如下技术方案：一种基于动态窗口和冗余节点过滤的路径优化方法，包括以下步骤：

S100：利用已有的栅格地图数据集，确定运动的起始位置和目标位置的坐标信息，在栅格地图中标注目标节点和障碍物节点；

S200：利用A^*算法规划出一条全局路径；

S300：利用A^*算法规划出的全局路径进行全局优化，过滤掉冗余节点；

S400：结合动态窗口法对S300优化后的全局路径进行分段局部优化，得到最终的全局路径。

作为改进，所述S200中利用A^*算法规划出一条全局路径，其包括以下步骤：

S210：构建并且初始化两个空表OpenList和CloseList，将起始位置设置为当前节点并存入OpenList列表；如果当前节点不是目标点，那么调用扩充节点函数选出与当前节点相邻且可扩展的所有节点，并且将扩展的所有节点信息都存入OpenList列表；