CN106840169A - 用于机器人路径规划的改进方法 - Google Patents

Abstract

本发明提供一种用于机器人路径规划的改进方法，包括：步骤一，双向路径规划：分别按照从起始点向目标点和从目标点向起始点的两种方向利用A*算法进行路径规划，保留这两组规划的路径；步骤二，设置并移动关键点：寻找两组规划的路径的交汇点、两组路径上距离障碍物各自最近的点中距离障碍物最远的点，考察该点距离障碍物的距离，若满足大于等于设定距离阈值这个标准，即为关键点；若不满足大于等于设定距离阈值这个标准，则将该点沿规划的路径移动至一个位置点，该位置点距离障碍物的距离刚好等于设定距离阈值，该位置点作为关键点；步骤三，分段规划路径。

Description

用于机器人路径规划的改进方法

技术领域

本发明涉及一种机器人路径规划方法，尤其是一种针对A*算法改进后的路径规划方法。

背景技术

随着机器人技术的发展，机器人的应用越来越多，而移动机器人因其能够更灵活地参与到人类生活和工作的空间，受到广泛关注。

机器人在空间中自由地移动，也就是机器人自主导航，其实现需要机器人能够以其所在空间的地图为基础，根据给定的起始点和目标点，规划出可行且合理的路径。

因此机器人路径规划方法，就成了实现机器人自主导航的重要保障。目前机器人路径规划采用的方法是A*算法，它采用启发式搜索的方式，在栅格化的地图数据基础上由起始点向目标点搜索。

而目前A*算法所规划的路径在某些情况下仍存在问题。在规划路径时，A*算法通常会贴近地图中已有的妨碍机器人行进的障碍物，以达到算法中启发函数的要求，但这样通常会使得机器人在实际行走时偏向于靠近障碍物而行，因此机器人就需要在避障中耗费大量的时间、计算资源和能量。

发明内容

本发明的目的在于克服现有技术中存在的不足，提供一种用于机器人路径规划的改进方法，通过设置和移动关键点达到改善路径走向的目的。本发明的重点是找到合适的关键点。本发明采用的技术方案是：

一种用于机器人路径规划的改进方法，包括：

步骤一，双向路径规划：

分别按照从起始点向目标点和从目标点向起始点的两种方向利用A*算法进行路径规划，保留这两组规划的路径；

步骤二，设置并移动关键点：

寻找两组规划的路径的交汇点、两组路径上距离障碍物各自最近的点中距离障碍物最远的点，考察该点距离障碍物的距离，若满足大于等于设定距离阈值这个标准，即为关键点；若不满足大于等于设定距离阈值这个标准，则将该点沿规划的路径移动至一个位置点，该位置点距离障碍物的距离刚好等于设定距离阈值，该位置点作为关键点；

步骤三，分段规划路径：

从关键点向起始点和目标点分别规划路径，并分别从起始点和目标点向关键点规划路径；对于各分段上的两条路径重复步骤二和步骤三直到关键点不变或者位置变化幅度小于要求值；

经过以上步骤，可以得到分段的优化后的路径，在各分段中选取距离障碍物较远的路径，组合所得分段路径。

进一步地，步骤二中，若需要移动的该点为交汇点，则沿两组规划的路径中任一路径移动。

进一步地，设定距离阈值为1米。

本发明的优点在于：

1）优化了机器人规划的路径。

2）能够在实际应用中更流畅更合理更高效地完成机器人导航任务。

3）间接地节省了机器人运行的能耗。

附图说明

图1为本发明的路径规划示意图。

具体实施方式

下面结合具体附图和实施例对本发明作进一步说明。

本发明的重点是找到并移动合适的关键点到合适的位置，其实现分为三个步骤：第一步进行双向路径规划；第二步设置并移动关键点；第三步分段规划路径；

步骤一，双向路径规划：

分别按照从起始点向目标点和从目标点向起始点的两种方向利用A*算法进行路径规划，保留这两组规划的路径；

两组规划的路径如图1中所示，起始点->点C->目标点（下简称路径一），目标点->点C-起始点（下简称路径二）；点C为两组规划的路径的交汇点；

步骤二，设置并移动关键点：

寻找两组规划的路径的交汇点、两组路径上距离障碍物各自最近的点中距离障碍物最远的点，考察该点距离障碍物的距离，若满足大于等于设定距离阈值这个标准，即为关键点；若不满足大于等于设定距离阈值这个标准，则将该点沿规划的路径移动至一个位置点，该位置点距离障碍物的距离刚好等于设定距离阈值，该位置点作为关键点；（若需要移动的该点为交汇点，则可沿两组规划的路径中任一路径移动）；

图1中，对于交汇点C、路径一上距离障碍物X最近的点为A、路径二上距离障碍物最近的点为B，点C为此三点中距离障碍物X最远的点；考察点C距离障碍物X的距离，若大于等于1米，则直接将点C作为关键点；如果点C距离障碍物X的距离只有0.7米，那么在路径一或路径二上移动点C至一个新的位置点，该位置点距离障碍物的距离为1米，该点C移动后的位置点作为关键点；

步骤三，分段规划路径：

从关键点向起始点和目标点分别规划路径，并分别从起始点和目标点向关键点规划路径；对于各分段上的两条路径重复步骤二和步骤三直到关键点不变或者位置变化幅度小于要求值（比如0.4米）；

经过以上步骤，可以得到分段的优化后的路径，在各分段中选取距离障碍物较远的路径，组合所得分段路径，即可得到本发明所寻求的更合理的路径。

Claims (3)

1.一种用于机器人路径规划的改进方法，其特征在于，包括：

步骤一，双向路径规划：

分别按照从起始点向目标点和从目标点向起始点的两种方向利用A*算法进行路径规划，保留这两组规划的路径；

步骤二，设置并移动关键点：

寻找两组规划的路径的交汇点、两组路径上距离障碍物各自最近的点中距离障碍物最远的点，考察该点距离障碍物的距离，若满足大于等于设定距离阈值这个标准，即为关键点；若不满足大于等于设定距离阈值这个标准，则将该点沿规划的路径移动至一个位置点，该位置点距离障碍物的距离刚好等于设定距离阈值，该位置点作为关键点；

步骤三，分段规划路径：

从关键点向起始点和目标点分别规划路径，并分别从起始点和目标点向关键点规划路径；对于各分段上的两条路径重复步骤二和步骤三直到关键点不变或者位置变化幅度小于要求值；

经过以上步骤，可以得到分段的优化后的路径，在各分段中选取距离障碍物较远的路径，组合所得分段路径。

2.如权利要求1所述的用于机器人路径规划的改进方法，其特征在于，

步骤二中，若需要移动的该点为交汇点，则沿两组规划的路径中任一路径移动。

3.如权利要求1所述的用于机器人路径规划的改进方法，其特征在于，

设定距离阈值为1米。