一种结合人工势场的概率图谱路径规划方法技术

本发明专利技术公开了一种结合人工势场的概率图谱路径规划方法。该方法利用虚拟势场的方法，用可量化的势场图表示目标环境，从而清晰地表达环境中的障碍物信息。然后提出了一种基于分区的采样策略，在保持采样点均匀分布的同时，提高密集障碍区域中的采样点数量。最后，利用新的八方向检测方法识别并筛选了一些关键点，通过添加关键点有效地提高了路径规划的成功率。本方法可以有效增加狭窄通道内的采样点数量和路径规划的成功率，MATLAB中实验结果证明了该方法的有效性。了该方法的有效性。了该方法的有效性。

【技术实现步骤摘要】
一种结合人工势场的概率图谱路径规划方法


[0001]本专利技术属于路径规划领域，特别涉及适用于含有狭窄通道的静态环境中的路径规划。

技术介绍

[0002]近年来，自主移动机器人在许多领域得到了广泛应用，如货物运输、搜索救援、水下巡航等。路径规划是使机器人能够自主规划从起始位置到目的地的可行无碰撞路径的最关键的技术之一。它能够确保所规划的路径在某些条件下是最优的，例如最小的工作成本、最短的步行路线、最短步行时间等。在过去几十年里，已经有许多种用于机器人路径规划的方法被提出。其中，概率路线图法(Probabilistic Roadmap Methon，PRM)由于其良好的性能得到了广泛的应用。PRM能够将连续复杂环境种的路径规划问题转化为离散空间种的路径规划问题，降低了路径规划的复杂度。同时通过随机采样的方法，能够有效避免空间维度对算法的影响，具有概率完备性。同时，因为其基于随机采样的特性，环境中的每个区域的采样概率相同，所以当任务环境中存在狭窄通道是，通常会出现由于通道内部没有足够的采样点而导致路径规划失败的情况。这也被称为狭窄通道问题。因此如何解决狭窄通道问题，提高通道内的有效采样点的数量，成为了改进概率路线图法的主要方向。
[0003]为了解决PRM面临的狭窄南干道问题，提高通道内的采样点的有效性，本专利技术提出了一种改进的基于势场的概率路线图算法，通过提高采样点的有效性和减少计算时间来克服狭窄通道问题。这项工作的主要贡献有三个方面。首先，利用人工势场的方法，用可量化的势场图表示目标环境，从而清晰地表达障碍物信息。其次，提出了一种基于分区的采样策略，在保持采样点均匀分布的同时，提高密集障碍区域的采样点数量。最后，提出一种新的八方位检测法，识别并筛选出了关键点，通过增加一些关键点，从而有效地提高了路径规划的成功率。

技术实现思路

[0004]本专利技术的目的是针对传统概率路线图方法，结合人工势场的思想，提出了一种能够识别狭窄通道内部关键采样点，通过采样关键点，增加狭窄通道的有效采样点的数量，提高路径规划成功率的方法。为了实现该目的，本专利技术所采用的步骤是：
[0005]步骤1：建立势力场地图。根据已知的环境信息、设定的斥力场系数η和斥力作用范围D0，结合人工势场法中的斥力场公式，计算得到环境中每一处空间配置点处的斥力场值，得到一张环境的斥力场地图；
[0006]步骤2：筛选关键点。基于已经的得到的斥力场地图，首先设定一个最大检测距离门限r
max
，根据斥力场公式计算得到在距离障碍物r
max
处的斥力场门限值rep
threshold
，对环境中的空间配置点进行筛选初步得到待筛选关键点集合p
cri
；针对p
cri
中的每一个点，根据检测半径r
d
对其进行八方位检测法进一步检测筛选，得到狭窄通道内部的三个关键点集，即通道内的关键点集q
passage
，通道口的关键点集q
door.
，通道拐角处的关键点集q
corner.
；
[0007]步骤3：学习阶段。将环境势力场地图在x和y方向上等分为n
x
和n
y
份，计算每个区域的总势场值P
tot
(i，j)；定义P
m
为P
tot
(i，j)的中值，将所有网格分为高电位场值和低电位场值两类；根据所需的采样点总数，确定每个区域所需的采样点数量Nodenum(i，j)；针对被障碍物完全覆盖的区域进行采样点补偿；分别对划分的每个区域进行采样点采样，同时在环境中添加关键点；最后连接所有的采样点，形成一张连通图，也称路线图。
[0008]步骤4：查询阶段。根据获得的路线图，尝试将起点和目标点添加到路线图中。首先添加起点，计算环境中所有节点到起点的距离。邻域距离D内到起点的距离试图通过局部规划器与起点连接的这些点。如果满足条件的所有点都不能与起点连接，则表示起点和目标点之间没有可行路径。目标点的添加同上。如果成功地将起点和目标点添加到路线图中，则使用A*算法计算路线图上的最佳路径。
[0009]本专利技术提出的改进型概率路线图方法已经通过MATLAB中实现的具体案列得到了验证。仿真实验中设置的采样点总数为80和100，每种情况下进行100次重复试验，每个试验指标取平均值。附图1给出了本专利技术提出的方法流程图。附图2给出了本专利技术对于不同通道情况关键点的示意图。依据本专利技术提出的方法，可以识别并区分这些关键点。附图3本专利技术的实验环境模型，其中圆点为起点，菱形点为终点。附图4为本专利技术实现的成功率对比结果。附图5为本专利技术实现的平均路径长度对比结果。附图6为本专利技术实现的平均算法时间对比结果。
附图说明
[0010]图1是本专利技术的实验流程图；
[0011]图2是本专利技术的不同通道情况关键点示意图；
[0012]图3是本专利技术实验的环境模型；
[0013]图4是本专利技术与其他路径规划方法的成功率对比结果；
[0014]图5是本专利技术与其他路径规划方法的平均路径长度对比结果；
[0015]图6是本专利技术与其他路径规划方法的平均算法时间对比结果。
具体实施方式
[0016]下面结合附图和实施例对本专利技术作进一步详细描述。
[0017]在后面的叙述中，本说明书将本专利技术提出的改进的基于人工势场的概率路线图的路径规划方法简记为PCPRM(An improved Probabilistic Roadmap Method combined with Potential field and Critical point for path planning)。PCPRM首先设定了以下场景参数：
[0018]1、采样点总数：N。在工作区域内，设定的用于路径规划的环境采样点q的数量。
[0019]2、领域长度：D。在进行路线图构造的时候，相邻两个邻居节点之间能够构成联通路径的最大长度。
[0020]3、斥力场系数：η。也称斥力增益，为一个常量。
[0021]4、斥力作用范围：D0。障碍物产生的斥力场的影响范围。只有当物体距离障碍物小于D0时，才会受到障碍物产生的斥力场的影响。
[0022]5、狭窄通道内关键点集与分类：q
passage
表示通道内的关键点集，q
door.
表示通道口
的关键点集，q
corner.
表示通道拐角处的关键点集。
[0023]以上述条件为基础，本专利技术提出的PCPRM已在MATLAB中实现具体的案列，实现结果证明了该方法的有效性。PCPRM的具体实施步骤为：
[0024]步骤1：构建环境势力场地图。
[0025]因为在后续的采样阶段只需要用到环境信息就可以合理的分布采样点，因此只需要在环境中构建斥力场地图。其中斥力场公式为
[0026][0027]在公本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种结合人工势场的概率图谱路径规划方法，所采用的步骤是：步骤1：建立势力场地图。根据已知的环境信息、设定的斥力场系数η和斥力作用范围D0，结合人工势场法中的斥力场公式，计算得到环境中每一处空间配置点处的斥力场值，得到一张环境的斥力场地图；步骤2：筛选关键点。基于已经的得到的斥力场地图，首先设定一个最大检测距离门限r
max
，根据斥力场公式计算得到在距离障碍物r
max
处的斥力场门限值rep
threshold
，对环境中的空间配置点进行筛选初步得到待筛选关键点集合p
cri
；针对p
cri
中的每一个点，根据检测半径r
d
对其进行八方位检测法进一步检测筛选，得到狭窄通道内部的三个关键点集，即通道内的关键点集q
passage
，通道口的关键点集q
door.
，通道拐角处的关键点集q
corner.
；步骤3：学习阶段。将环境势力场地图在x和y方向上等分为n
x
和n
y
份，计算每个区域的总势场值P
tot
(i，j)；定义P
m
为P
tot
(i，j)的中值，将所有网格分为高电位场值和低电位场值两类；根据所需的采样点总数，确定每个区域所需的采样点数量Nodenum(i，j)；针对被障碍物完全覆盖的区域进行采样点补偿；分别对划分的每个区域进行采样点采样，同时在环境中添加关键点；最后连接所有的采样点，形成一张连通图，也称路线图。步骤4：查询阶段。根据获得的路线图，尝试将起点和目标点添加到路线图中。首先添加起点，计算环境中所有节点到起点的距离。邻域距离D内到起点的距离试图通过局部规划器与起点连接的这些点。如果满足条件的所有点都不能与起点连接，则表示起点和目标点之间没有可行路径。目标点的添加同上。如果成功地将起点和目标点添加到路线图中，则使用A*算法计算路线图上的最佳路径。2.根据权利要求1所述的一种结合人工势场的概率图谱路径规划方法，其特征在于结合人工势场法，利用环境中的障碍物信息，将复杂抽象的环境信息量化成具体的势场值信息的具体方法为：因为在后续的采样阶段只需要用到环境信息就可以合理的分布采样点，因此只需要在环境中构建斥力场地图。其中斥力场公式为在公式中，η表示斥力场系数，也称斥力增益，为一个常量；D(q)表示空间配置点q处距离其附近障碍物的最近距离；D0表示障碍物产生的斥力的作用范围，只有当空间配置点q与障碍物之间的距离小于D0时，障碍物在位置q处才会产生一个斥力场，而当空间配置点q在障碍物作用范围之外时，也就是当D(q)大于D0，时，障碍物在其位置处产生的斥力场大小为0。3.根据权利要求1所述的一种结合人工势场的概率图谱路径规划方法，其特征在于采用八方位检测法筛选得到狭窄通道关键点集的具体方法为：(1)初步筛选环境中的关键点首先，设定一个最大距离r
max
作为检测门限距离，根据公式(1)，计算得到在距离障碍物r
max
处的斥力场门限值rep
threshold
。因为在斥力场地图中，障碍物处的斥力场值为最大值，即
所以，狭窄通道内的关键点处的斥力场大小rep
cri
满足对于满足这部分条件的关键点集合记为p
cri
。(2)通过八方位检测法进一步筛选关键点按照附图2所示的不同狭窄通道情况下关键点的示意图可知，当前筛选出的关键点为灰色区域内的点，所以需要进一步筛选得到关键点。设定八方位检测法的检测半径为r
d
。对于p
cri
中的每一个点q，分别对其进行上、下、左、右、左上、左下、右上、右下八个方位进行检测。对于待检测点q，通过对点q每个方向上分别进行检测，判断是否在距离点q的R_d长范围内，是否检测到障碍物，如果检测到了，则将...

【专利技术属性】
技术研发人员：张莉涓，张永豪，雷磊，吕博，蔡圣所，李志林，沈高青，朱晓浪，牛凯华，李慧，
申请(专利权)人：南京航空航天大学，
类型：发明
国别省市：