一种移动机器人全局路径规划方法技术

本发明专利技术公开了一种利用记忆提高规划效率的移动机器人全局路径规划方法。该方法首先使用传统路径规划方法生成一系列可行路径，随后对完整路径进行分割并提取出骨干路径。以骨干路径的起点和终点作为索引，将骨干路径存储在数据库中。在后续需要路径规划时根据起点和终点从数据库中提取出最近的骨干路径并与局部规划的路径拼接即可快速得到可行的完整路径。该方法利用历史规划结果避免重复计算，提高路径搜索效率和路径质量。径搜索效率和路径质量。径搜索效率和路径质量。

【技术实现步骤摘要】
一种移动机器人全局路径规划方法


[0001]本专利技术属于移动机器人
，具体涉及一种移动机器人全局路径规划方法。

技术介绍

[0002]近年来，随着定位、感知等关键技术的突破，以无人配送车和自动导引车AGV为代表的智能移动机器人在自动驾驶和无人物流等领域得到快速应用，逐渐改善着人们的生产和生活。
[0003]路径规划是实现机器人自主移动能力的关键技术。目前的全局路径规划技术在同时处理机器人自身运动学和环境障碍物等复杂约束时仍然存在搜索速度慢、路径质量低等问题，给移动机器人的大规模应用造成了阻碍。

技术实现思路

[0004]本专利技术针对现有移动机器人全局路径规划方法效率低下的问题，提出一种移动机器人全局路径规划方法，通过重复利用记忆路径，能够减少重复计算，从而大幅提高规划效率。
[0005]本专利技术实施例可以应用于包括自动驾驶车辆、自动导引车AGV和服务机器人的智能移动机器人。
[0006]本专利技术提出的技术方案包含以下步骤：
[0007]一种移动机器人全局路径规划方法，所述规划方法包括以下步骤：
[0008]步骤1，根据起始点和目标点，以及障碍物分布，规划出移动机器人的完整可行路径；
[0009]步骤2，从所述可行路径中，去除与起始点和目标点之间距离小于设定长度d0的点，形成一段包含新的起点和新的终点的骨干路径，以所述骨干路径的起点和终点作为索引存储在数据库中；
[0010]步骤3，再次规划时根据新任务的起始点和目标点检索数据库，提取对应的骨干路径；
[0011]步骤4，使用局部路径规划方法将新的起始点和目标点连接到骨干路径，得到最终的可行路径。
[0012]进一步的，所述设定长度d0根据移动机器人的最小转向半径确定具体为2R
min
<d0<4R
min
，R
min
是最小转向半径。
[0013]进一步的，所述步骤1中，采用混合A*算法规划出移动机器人的完整可行路径。
[0014]进一步的，所述骨干路径根据以下方式得到：
[0015]所述新任务起始点与骨干路径起点之间距离，与新任务目标点与骨干路径终点之间距离之和最小，该骨干路径为所述新任务对应的骨干路径。
[0016]作为本申请的一种优选实施方案，所述步骤3中，如果移动机器人为类车机器人，采用Reeds
‑
Shepp曲线长度作为距离度量；
[0017]如果机器人为全向移动机器人，采用欧式距离度量。
[0018]作为本申请的一种优选实施方案，利用混合A*算法连接新任务的起始点和骨干路径的起点；利用混合A*算法连接骨干路径的终点和新任务的目标点；再将三段路径拼接为一段完整路径，作为满足避障和移动机器人运动约束的全局路径。
[0019]与现有技术相比，本专利技术的技术方案具有以下优点：
[0020]骨干路径是满足避障和运动约束的可行路径片段。利用记忆的骨干路径，机器人的搜索空间将显著缩小，AGV的全局路径规划转化为机器人附近范围内的局部路径规划，通过重复利用记忆路径，能够减少重复计算，从而大幅提高规划效率。而且，环境面积越大，骨干路径的长度越长，效率提升越明显。在机器人作业点覆盖环境一定区域后，骨干路径将形成骨干路径网络，利用该网络能进一步减少重复规划计算量。因此该专利技术具有更大的改进空间。
附图说明
[0021]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0022]图1是移动机器人全局路径规划的一种工作场景示意图；
[0023]图2是从可行路径上提取得到的骨干路径示意图；
[0024]图3是采用本申请提供的移动机器人全局路径规划方法示意图。
具体实施方式
[0025]为使本专利技术的目的、技术方案和优点更加清楚，下面将以室内叉车机器人自动搬运任务为例对本专利技术的技术方案进行详细的描述。显然，所描述的实施例仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式，都属于本专利技术所保护的范围。
[0026]机器人技术与仿生技术结合是机器人未来的发展趋势之一，经过千万年的进化，动物能够在复杂的自然环境中快速生成高质量的运动路径，通过借鉴动物高效的运动规划机理并与现有方法融合，能够显著提高机器人的路径规划效率。
[0027]根据对哺乳动物导航的神经基础——海马体的研究发现，动物在进行路径规划时能够将路径存储到记忆中，后续搜索路径时则会回忆其历史路径，即路径规划并非完全从零开始。受此思想启发，本专利技术提出一种基于记忆的机器人全局路径规划方法。
[0028]采用类车机器人模型对室内无人叉车进行运动学建模，类车机器人属于非完整约束系统，具有最小转向半径R
min
。
[0029]环境地图采用多边形几何表示，使用多边形表示叉车机器人最小包围盒的平面投影，如图1至图3所示，本申请中采用长方形作为包围盒的外部形态，机器人与环境的碰撞检测采用AABB Axially Aligned Bounding Box包围盒交叉检测算法。
[0030]图1为本专利技术实施例提供的一种工作场景，其中直线为障碍物，长方形为机器人包围盒，包围盒与障碍物不相交则表示无碰撞；在图示开始位姿和目标位姿之间，使用混合A*
算法规划得到了一条可行路径，即包围盒移动的中轴曲线。在路径上还画出了离散路径点上的机器人包围盒，即方形框。由于机器人具有运动学约束，采用混合A*路径规划算法作为骨干路径的构造算法。根据给定的起点和终点位姿坐标，调用混合A*算法生成避免与障碍物交叉，同时满足机器人运动约束的可行路径。
[0031]从可行路径上提取骨干路径。将距离起点d0距离内的可行路径点剔除，同样将距离终点d0距离内的可行路径点剔除。将剩余部分的可行路径点记为骨干路径path
m
，新的骨干路径具有新的起点和终点。距离阈值d0的选择取决于机器人的最小转向半径R
min
，本实施例选择d0＝2R
min
，将骨干路径上距离原始起点最近的点作为新的起点p1，将距离原始终点最近的点作为新的终点p2，参见图2。每个路径点是一个三维向量，包括机器人的xy位置和偏航角θ。
[0032]构造新的起点和终点对记为索引index＝(p1,p2)，将索引与骨干路径关联存储到数据库中，{index,path
m
}。如果有新的搬运任务，从图3中的开始位姿3，记为p3，到终止位姿4，记为p4，则根据距离检索骨干路径的索引，查找距离最小的索引。新任务起始点与骨干路径起点之间距离加上新本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种移动机器人全局路径规划方法，其特征在于，所述规划方法包括以下步骤：步骤1，根据起始点和目标点，以及障碍物分布，规划出移动机器人的完整可行路径；步骤2，从所述可行路径中，去除与起始点和目标点之间距离小于设定长度d0的点，形成一段包含新的起点和新的终点的骨干路径，以所述骨干路径的起点和终点作为索引存储在数据库中；步骤3，再次规划时根据新任务的起始点和目标点检索数据库，提取对应的最近骨干路径；步骤4，使用局部路径规划方法将新的起始点和目标点连接到骨干路径，得到最终的可行路径。2.根据权利要求1所述的一种移动机器人全局路径规划方法，其特征在于，所述设定长度d0根据移动机器人的最小转向半径R
min
确定，具体为2R
min
< d0<4R
min
。3.根据权利要求1所述的一种移动机器人全局路径规划方法，其特...

【专利技术属性】
技术研发人员：胡亚南，明瑞浩，韩国庆，杨佳，陆飞宇，于洋，
申请(专利权)人：江苏金陵智造研究院有限公司，
类型：发明
国别省市：