CN115930969A - 移动机器人的路径规划方法、装置、电子设备及存储介质 - Google Patents
移动机器人的路径规划方法、装置、电子设备及存储介质 Download PDFInfo
- Publication number
- CN115930969A CN115930969A CN202310029725.2A CN202310029725A CN115930969A CN 115930969 A CN115930969 A CN 115930969A CN 202310029725 A CN202310029725 A CN 202310029725A CN 115930969 A CN115930969 A CN 115930969A
- Authority
- CN
- China
- Prior art keywords
- information
- path
- generating
- obstacle
- mobile robot
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及机器人导航技术领域,具体公开了一种移动机器人的路径规划方法、装置、电子设备及存储介质,其中,方法包括以下步骤:获取栅格地图,栅格地图包含起点信息、终点信息及至少一个障碍物信息;根据栅格地图生成关于障碍物信息的维诺图,维诺图具有多个围绕障碍物信息的泰森多边形;根据每个泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;根据所述奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索泰森多边形的边生成导航路径;该方法充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
Description
技术领域
本申请涉及机器人导航技术领域,具体而言,涉及一种移动机器人的路径规划方法、装置、电子设备及存储介质。
背景技术
近些年来,随着自动驾驶、机器人等行业的加速发展。对于移动机器人而言,其核心问题之一是如何保证机器人安全、可靠、快速、稳定地导航,这需要稳定、高效的路径规划算法来实现。
现有的机器人的路径规划算法一般为:先进行全局的路径搜索,然后在局部进行细致的运动规划。现有的全局的路径搜索经常使用的规划算法都只能从完备性的角度找到可达路径,即寻找路径最短的导航路径,其对障碍物也只能进行简单规避,无法对狭窄和宽阔的两条不同路径进行区分,更加安全的路径生成需要局部规划器进行处理,无法兼顾路径长度和避障功能取得最优解。
针对上述问题,目前尚未有有效的技术解决方案。
发明内容
本申请的目的在于提供一种移动机器人的路径规划方法、装置、电子设备及存储介质,以兼顾路径长度和避障功能进行路径规划。
第一方面,本申请提供了一种移动机器人的路径规划方法,用于生成移动机器人的移动路径,所述方法包括以下步骤:
获取栅格地图,所述栅格地图包含起点信息、终点信息及至少一个障碍物信息;
根据所述栅格地图生成关于所述障碍物信息的维诺图,所述维诺图具有多个围绕所述障碍物信息的泰森多边形;
根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
以所述根据所述奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索所述泰森多边形的边生成导航路径。
本申请的移动机器人的路径规划方法利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径。
所述的移动机器人的路径规划方法,其中,所述利用A*搜索所述泰森多边形的边生成导航路径的步骤以所述泰森多边形的顶点作为搜索对象,并以顶点与起点信息之间的路径距离作为实际代价值。
该示例的方法在维诺图中进行路径搜索时,能根据边与障碍物信息之间的距离信息动态设置碰撞代价值,从而使得A*搜索算法能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径。
所述的移动机器人的路径规划方法,其中,所述根据所述栅格地图生成关于所述障碍物信息的维诺图的步骤包括:
根据所述障碍物信息在所述栅格地图中生成德洛内三角网;
根据所述德洛内三角网在所述栅格地图中生成所述泰森多边形以获取所述维诺图。
所述的移动机器人的路径规划方法,其中,所述根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息的步骤包括:
根据所述距离信息生成每个所述泰森多边形的每个边的碰撞风险信息,所述碰撞风险信息与所述距离信息负相关;
根据所述碰撞风险信息生成每个所述泰森多边形的每个边的奖励信息,所述碰撞风险信息与所述奖励信息负相关。
所述的移动机器人的路径规划方法,其中,所述根据所述距离信息生成每个所述泰森多边形的每个边的碰撞风险信息的步骤包括:
沿边的延伸方向积分获取每个所述泰森多边形的每个边的距离信息的积分值,并根据所述积分值生成对应边的碰撞风险信息。
所述的移动机器人的路径规划方法,其中,所述方法还包括步骤:
对所述导航路径进行平滑化处理。
所述的移动机器人的路径规划方法,其中,所述对所述导航路径进行平滑化处理的步骤包括:
根据碰撞惩罚、平滑惩罚、长度惩罚设定关于所述导航路径平滑化处理的损失函数;
根据梯度下降法更新所述损失函数至收敛以平滑化处理所述导航路径。
第二方面,本申请还提供了一种移动机器人的路径规划装置,用于生成移动机器人的移动路径,所述装置包括:
地图获取模块,用于获取栅格地图,所述栅格地图包含起点信息、终点信息及至少一个障碍物信息;
维诺图生成模块,用于根据所述栅格地图生成关于所述障碍物信息的维诺图,所述维诺图具有多个围绕所述障碍物信息的泰森多边形;
奖励模块,用于根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
路径生成模块,用于根据所述奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索所述泰森多边形的边生成导航路径。
本申请的移动机器人的路径规划装置利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
第三方面,本申请还提供了一种电子设备,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如上述第一方面提供的所述方法中的步骤。
第四方面,本申请还提供了一种存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时运行如上述第一方面提供的所述方法中的步骤。
由上可知,本申请提供了一种移动机器人的路径规划方法、装置、电子设备及存储介质,尤其适用于全局路径规划,其中,方法利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了具有避障特性的导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
附图说明
图1为本申请实施例提供的移动机器人的路径规划方法的流程图。
图2为一些实施例中的包含障碍物信息的栅格地图。
图3为一些实施例中的包含障碍物信息的维诺图。
图4为基于本申请实施例提供的移动机器人的路径规划方法在栅格地图生成的导航路径的示意图。
图5为本申请实施例提供的移动机器人的路径规划装置的结构示意图。
图6为本申请实施例提供的电子设备的结构示意图。
附图标记:201、地图获取模块;202、维诺图生成模块;203、奖励模块;204、路径生成模块;205、平滑化处理模块;301、处理器;302、存储器;303、通信总线。
具体实施方式
下面将结合本申请实施例中附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施例。基于本申请的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本申请的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
第一方面,请参照图1-图4,本申请一些实施例提供了一种移动机器人的路径规划方法,用于生成移动机器人的移动路径,方法包括以下步骤:
S1、获取栅格地图,栅格地图包含起点信息、终点信息及至少一个障碍物信息;
S2、根据栅格地图生成关于障碍物信息的维诺图,维诺图具有多个围绕障碍物信息的泰森多边形;
S3、根据每个泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
S4、根据奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索泰森多边形的边生成导航路径。
具体地,起点信息为移动机器人在栅格地图上的位置,终点信息为移动机器人在栅格地图上的移动目的地;障碍物信息为结合环境地图和实际环境检测获取的障碍物分布、体积在栅格地图上显示的障碍物数据,可基于搭载在移动机器人上的传感器扫描环境获取,也可以基于固定设置在场景中的传感器扫描环境获取,还可以基于搭载在其他移动设备上的传感器扫描环境获取;如图2所示,栅格地图为黑白二值地图,地图边界和障碍物信息显示为黑色区域,移动机器人可通行的区域显示为白色区域,本申请实施例的移动机器人的路径规划方法规划导航路径的过程为在白色区域中寻找连接起点信息和终点信息的路径的搜索过程。
更具体地,栅格地图可以采用现有的建图工具或建图算法根据预设的地图数据和/或基于传感器采集的感知数据进行生成,该生成过程属于现有技术,在此不再赘述。
更具体地,维诺图(Voronoi图)又称冯洛诺伊图,是基于泰森多边形对空间平面进行剖分的手段,泰森多边形是一组由连接两邻点的线段的垂直平分线组成的连续多边形;一个泰森多边形内的任一点到构成该多边形的Voronoi点的距离小于到其他多边形Voronoi点的距离。
更具体地,步骤S2生成的维诺图关联于障碍物信息,即该维诺图为以障碍物信息作为Voronoi点集而生成,其生成过程可以是提取障碍物信息的关键节点作为Voronoi点集,也可以是将障碍物信息坍缩生成的节点作为Voronoi点集,还可以是将障碍物信息拆分为多个组成部分后并提取不同组成部分的质心作为Voronoi点集;因此,在本申请实施例中,维诺图为根据栅格地图的地图边界及栅格地图中的障碍物信息生成,相应地,基于障碍物信息获取的Voronoi点集中的点位于对应的泰森多边形的中心,表征障碍物信息位于对应的泰森多边形的中心,以使泰森多边形围绕对应的障碍物信息。
更具体地,如图3所示,维诺图由有限个的泰森多边形构成,除了地图边界外,每个完整的泰森多边形的中心均有障碍物信息,在起点信息和终点信息之间存在可行路径的情况下,该维诺图中必然存在基于泰森多边形顶点连接而成的从起点信息指向终点信息的有效路径,其中,若起点信息和终点信息分别在某一泰森多边形的边或顶点上,必然有由泰森多边形边构成的至少一条不触碰障碍物(即不与栅格地图中的障碍物信息重叠)的有效路径,而若起点信息和终点信息均不在泰森多边形的边或顶点上,起点信息和终点信息对应邻近的泰森多边形的顶点与其他泰森多边形边也能构成对应的有效路径,故本申请实施例中的维诺图能作为生成导航路径的路线基础,即泰森多边形的边构成了导航路径的路径段。
更具体地,距离信息表征了泰森多边形的边与其中心的障碍物信息之间的距离关系,由于栅格地图中的泰森多边形的边没有体积数据,故根据维诺图获取的导航路径也不能根据移动机器人的体积来实际反馈障碍物信息与移动机器人的碰撞概率,因此,在生成导航路径的过程中,本申请实施例的方法基于距离信息生成的奖励信息能反映移动机器人沿该泰森多边形的边进行移动时与对应的障碍物碰撞的可能性。
更具体地,在本申请实施例中,奖励信息相当于附加在泰森多边形的边上的权值,附带奖励信息的维诺图相当于转化为基于奖励信息加权的无向图,使得步骤S4能根据该无向图进行导航路径的搜索。
更具体地,A*搜索算法,又称A星算法,是一种启发式搜索算法,即属于静态路网中求解最短路径最有效的搜索方法;其中,A*搜索算法在搜索每个路径点的过程需要考虑实际代价值和启发式代价值,其中,实际代价值为从起点到对应路径点(本申请实施例中的泰森多边形的顶点)的路径长度,启发式代价值为该路径点到终点的路径长度,在本申请实施例中,在启发式代价值的基础上增加了以奖励信息计算生成的碰撞代价值,在本申请实施例中,碰撞代价值根据维诺图最大边长与对应边的奖励信息之比计算获取,即本申请实施例中的A*搜索算法的启发式代价值为路径点到终点的路径长度及对应路径所在边的碰撞代价值之和,从而使得奖励信息能引导A*搜索算法的搜索方向,即本申请实施例的方法在搜索生成导航路径的过程中以泰森多边形的边上的权值作为引导进行搜索,使得搜索过程中获取的路径更倾向于距离信息更大的路径,从而使得获取的导航路径能尽可能地避开障碍物。
本申请实施例的移动机器人的路径规划方法尤其适用于全局路径规划,其利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
更具体地,本申请实施例的方法还适用于局部路径的规划过程,即将原本的移动过程分为多个局部移动过程,从而产生多个阶段性的终点信息,采用本方法相当于基于当前起点信息和对应阶段性的终点信息在栅格地图中生成局部维诺图,并基于局部维诺图生成对应阶段性终点信息的导航路径,从而指导移动机器人逐步移动。
在一些优选的实施方式中,利用A*搜索泰森多边形的边生成导航路径的步骤以泰森多边形的顶点作为搜索对象,并以顶点与起点信息之间的路径距离作为实际代价值。
具体地,基于前述内容可知,实际代价值为从起点到对应路径点的路径长度,由于本申请实施例的方法是基于泰森多边形的边进行路径搜索的,因此,在该A*搜索过程中,需以连接泰森多边形的边的顶点作为搜索对象,并根据已搜索的部分的路径距离(即以对应已选取的泰森多边形的边的长度之和)作为实际代价值。
更具体地,A*搜索一般基于f(n)=g(n)+h(n)进行,其中,n为路径点,f(n)为通往该路径点n的总代价,g(n)为起点到路径点n的实际代价值,h(n)为路径点n到终点的启发式代价值;在本申请实施例中,将启发式代价值中的碰撞代价值定义为h2(n),启发式代价值中的其余代价值定义为h1(n),h2(n)可以是额外增加的代价,还可以是与h1(n) 按设定权重进行叠加的代价,在本申请实施例中优选为后者,故有:
f(n)=g(n)+λ1h1(n)+λ2h2(n) (1)
其中,λ1和λ2为设定权重,满足λ1+λ2=1,且均为非负常量,h2(n)为路径点n到终点的碰撞代价值,即路径点n到终点的泰森多边形的边的奖励信息计算的碰撞代价值之和,本申请实施例的方法在维诺图中进行路径搜索时,能根据边与障碍物信息之间的距离信息动态设置碰撞代价值,从而使得A*搜索算法利用f(n)进行导航路径搜索时能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径;其中,λ1越大则导航路径搜索效率越快、导航路径越短。
更具体地,根据实际需要设定λ1和λ2的大小能调节导航路径的性能的倾向性,λ2设定越大,对应的导航路径的避障效果越好,λ1设定越大,对应的导航路径的移动效率越高。
在一些优选的实施方式中,当A*搜索算法在维诺图中进行搜索时,将λ1和λ2设定为0.5,使得导航路径能有效兼顾路径长度和避障功能;当A*搜索算法在维诺图外进行搜索时,A*搜索脱离泰森多边形的边进行路径搜索,为避免碰撞代价值扰乱A*搜索的搜索能力,将此时的λ1和λ2分别设定为1和0。
在一些优选的实施方式中,根据栅格地图生成关于障碍物信息的维诺图的步骤包括:
S21、根据障碍物信息在栅格地图中生成德洛内三角网;
S22、根据德洛内三角网在栅格地图中生成泰森多边形以获取维诺图。
具体地,基于前述内容可知,障碍物信息作为Voronoi点集使用,故步骤S21能基于这些Voronoi点集生成德洛内三角网,在本申请实施例中,德洛内三角网(Delaunay三角网,Delaunay triangulation)是一系列相连的但不重叠的以Voronoi点作为角点的三角形的集合, 而且这些三角形的外接圆不包含这个面域的其他Voronoi点。
应当理解的是,获取维诺图的过程为以栅格地图的边界作为图形边界来生成泰森多边形的过程,或以局部维诺图的边界作为图形边界来生成泰森多边形的过程。
在一些优选的实施方式中,步骤S21包括:
S211、将障碍物信息划分为局部障碍物信息,以局部障碍物信息的中点作为Voronoi点构成Voronoi点集;
S212、基于该Voronoi点集在栅格地图中生成德洛内三角网。
具体地,为避免体积过大或者具有中部空腔的障碍物信息影响泰森多边形的生成,本申请实施例的方法将具有上述特点的障碍物信息划分为多个局部障碍物信息,再获取对应的Voronoi点来生成德洛内三角网,以使得泰森多边形关于障碍物信息的生成位置、分布、数量更合理,从而使得A*搜索获取的导航路径能更充分地考虑图上障碍物信息的形态、分布特点。
更具体地,根据维诺图的定义,维诺图中任意泰森多边形在空间剖分上都是等分的,因此,每个局部障碍物信息均位于对应泰森多边形的中心(对应于Voronoi点)。
在一些优选的实施方式中,根据每个泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息的步骤包括:
S31、根据距离信息生成每个泰森多边形的每个边的碰撞风险信息,碰撞风险信息与距离信息负相关;
S32、根据碰撞风险信息生成每个泰森多边形的每个边的奖励信息,碰撞风险信息与奖励信息负相关。
具体地,在移动机器人沿导航路径移动时,移动机器人距离障碍物越近越容易发生碰撞意外,故距离信息能反映泰森多边形的边所在的路径段的碰撞风险(collisionrisk),因此,在本申请实施例中,能根据边的距离信息设定与之负相关的碰撞风险信息;在更进一步的实施方式中,步骤S31可以是根据距离信息的倒数生成每个泰森多边形的每个边的碰撞风险信息,碰撞风险信息与距离信息的倒数正相关。
更具体地,移动机器人的导航路径应当具备适当的避障功能和相对优秀的移动效率,本申请实施例的方法生成的维诺图为在栅格地图上根据障碍物信息生成的,其对应的泰森多边形为围绕障碍物信息生成的,因此,A*搜索根据维诺图必然能获取高效移动、高效避障的导航路径,为了进一步优化避障效果,本申请实施例的方法引用了基于距离信息设定的奖励信息,该奖励信息与碰撞风险信息负相关,即与距离信息正相关,使得A*搜索在搜索泰森多边形顶点的过程中能更倾向于远离障碍物信息的顶点,以尽可能避免移动机器人沿导航路径移动过程中出现碰撞意外。
应当理解的是,虽然维诺图的生成过程是基于障碍物信息获取的Voronoi点集进行的,但为了避免出现碰撞意外,该距离信息为基于泰森多边形的边与栅格地图中实际标记的障碍物信息的距离进行计算的。
在一些优选的实施方式中,根据距离信息生成每个泰森多边形的每个边的碰撞风险信息的步骤包括:
S311、沿边的延伸方向积分获取每个泰森多边形的每个边的距离信息的积分值,并根据积分值生成对应边的碰撞风险信息。
具体地,距离信息可以为最小距离,也可以为上述边的延伸方向积分产生的积分值;若单纯采用最小距离生成奖励信息,则奖励信息只能反映边与障碍物信息之间的最小距离关系,但导航路径应当考虑整个路径段的碰撞风险,即需要根据比较不同路径段各个位置与障碍物之间的位置关系来判断碰撞风险,从而使得搜索到的路径段更可靠,使得移动机器人在整个移动过程中均能有效避障,因此,在本申请实施例中,步骤S31优选为采用步骤S311生成碰撞风险信息。
更具体地,在栅格地图中,沿边的延伸方向积分获取每个泰森多边形的每个边的距离信息的积分值相当于获取该边的各个位置与障碍物信息之间的最小距离之和。
更具体地,本申请实施例的方法基于该奖励信息能计算获取启发式代价值中的碰撞代价值,故A*搜索过程中的h2(n)相当于根据沿路径点n到终点的泰森多边形的边的距离信息的积分值总和设定的奖励值所计算获取的碰撞代价值,故能反映该搜索过程中余下路径整体的碰撞风险,若对于不同的余下路径具有相同或相近的h1(n),则对于路径点n的搜索行为相当于最小化碰撞代价值(最大化该奖励值),即获取整体碰撞风险最低的余下路径,相对地,对于整个搜索过程而言,获取导航路径的目标等价于在维诺图中寻找一条从起点信息到终点信息的泰森多边形与障碍物信息之间的距离信息的积分值最大的路径。
在一些优选的实施方式中,方法还包括步骤:
S5、对导航路径进行平滑化处理。
具体地,步骤S1-步骤S4获取的导航路径基于泰森多边形生成,使得路径较为粗略,尤其是在对应于泰森多边形的顶点处明显存在转角路径,存在平滑性不足的问题,不利于移动机器人移动,因此,本申请实施例的方法针对基于步骤S1-步骤S4获取的导航路径进行平滑化处理,以优化整个导航路径,使其更适用于移动机器人使用。
更具体地,由于步骤S1-步骤S4获取的导航路径具有优异的避障功能,故该平滑化处理过程可采用现有技术中的平滑处理手段进行优化,而不会导致优化后的导航路径引起碰撞意外。
在一些优选的实施方式中,对导航路径进行平滑化处理的步骤包括:
S51、根据碰撞惩罚、平滑惩罚、长度惩罚设定关于导航路径平滑化处理的损失函数;
S52、根据梯度下降法更新损失函数至收敛以平滑化处理导航路径。
具体地,为确保平滑化处理过程具有通用性,能适用于不同形态的导航路径,并保证平滑化处理后的导航路径依然符合移动机器人使用,本申请实施例的平滑化处理设置碰撞惩罚、平滑惩罚、长度惩罚作为约束手段以引导平滑化处理过程;其中,碰撞惩罚为关于与障碍物距离的惩罚,其与障碍物距离越远对应产生的惩罚值越小;平滑惩罚为关于导航路径平滑度的惩罚,其平滑度越平滑对应产生的惩罚值越小;长度惩罚为关于导航路径整体长度的惩罚,其长度越大对应产生的惩罚值越大。
更具体地,在本申请实施例中,损失函数可以是基于等权值的碰撞惩罚、平滑惩罚、长度惩罚叠加设定构建,也可以根据使用需求针对不同惩罚设定不同的权值的碰撞惩罚、平滑惩罚、长度惩罚叠加设定构建。
更具体地,该平滑化处理优选为针对导航路径中的路径点(泰森多边形的顶点)进行处理。
更具体地,在本申请实施例中,该平滑化处理的损失函数loss优选为:
(2)
其中,为碰撞惩罚,为平滑惩罚,为长度惩罚;其中,、、分别为碰撞惩罚权值、平滑惩罚权值和长度惩罚权值,、、分别为碰撞惩罚函数、平滑惩罚函数和长度惩罚函数,
o、
s、
l分别为碰撞惩罚、平滑惩罚和长度惩罚的下标,
N为路径点的总数,
i为路径点的编号,为第
i个路径点的位置,为第
i+1个路径点与第
i个路径点的位置偏差,有,故为第
i+2个路径点与第
i+1个路径点的位置偏差,为最近的障碍物的位置,为障碍物距离阈值,其中,和均为栅格地图中的坐标数据。
更具体地,该损失函数用于指导约束平滑化处理过程,最小化该损失函数至收敛能获取最优平滑化处理的导航路径,使得平滑处理化后的导航路径兼顾碰撞风险低、平滑度高及路线长度短的特点。
更具体地,平滑化处理过程相当于最小化损失函数的过程,本申请实施例的方法优选采用梯度下降法同时更新、、以提高平滑化处理效率、效果。
在本申请实施例中,碰撞惩罚函数、平滑惩罚函数、长度惩罚函数优选采用平方损失函数,故对应的惩罚函数分别基于下面各个梯度进行优化:
(3)
(4)
(5)
更具体地,为了进一步提高平滑化处理的处理效果,本申请实施例的平滑化处理的优化过程设定迭代次数为50次,避免损失函数难以收敛时花费过多时间进行导航路径的平滑化处理;根据经验数据可知,式(2)一般利用式(3)(4)(5)进行30次左右的迭代优化便能收敛。
在一些优选的实施方式中, 、、分别优选设置为0.2、0.6和0.2。
具体地,根据经验数据可知,碰撞惩罚权值设定过大容易导致导航路径在狭窄区域处的路径点变得稀疏,更多的路径点被推向狭窄区域外部,也不利于损失函数收敛,因此在本申请实施例中,将碰撞惩罚权值设置为0.2,确保平滑化处理后的导航路径上的路径点分布较为均匀。
第二方面,请参照图5,本申请一些实施例还提供了一种移动机器人的路径规划装置,用于生成移动机器人的移动路径,装置包括:
地图获取模块201,用于获取栅格地图,栅格地图包含起点信息、终点信息及至少一个障碍物信息;
维诺图生成模块202,用于根据栅格地图生成关于障碍物信息的维诺图,维诺图具有多个围绕障碍物信息的泰森多边形;
奖励模块203,用于根据每个泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
路径生成模块204,用于根据奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索泰森多边形的边生成导航路径。
本申请实施例的移动机器人的路径规划装置尤其适用于全局路径规划,其利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
在一些优选的实施方式中,该装置还包括:
平滑化处理模块205,用于对导航路径进行平滑化处理。
在一些优选的实施方式中,本申请实施例的移动机器人的路径规划装置用于执行上述第一方面提供的移动机器人的路径规划方法。
第三方面,请参照图6,本申请提供一种电子设备,包括:处理器301和存储器302,处理器301和存储器302通过通信总线303和/或其他形式的连接机构(未标出)互连并相互通讯,存储器302存储有处理器301可执行的计算机可读取指令,当电子设备运行时,处理器301执行该计算机可读取指令,以执行时执行上述实施例的任一可选的实现方式中的方法。
第四方面,本申请实施例提供一种存储介质,其上存储有计算机程序,该计算机程序被处理器执行时,执行上述实施例的任一可选的实现方式中的方法。其中,存储介质可以由任何类型的易失性或非易失性存储设备或者它们的组合实现,如静态随机存取存储器(Static Random Access Memory, 简称SRAM),电可擦除可编程只读存储器(ElectricallyErasable Programmable Read-Only Memory, 简称EEPROM),可擦除可编程只读存储器(Erasable Programmable Read Only Memory, 简称EPROM),可编程只读存储器(Programmable Red-Only Memory, 简称PROM),只读存储器(Read-Only Memory, 简称ROM),磁存储器,快闪存储器,磁盘或光盘。
综上,本申请实施例提供了一种移动机器人的路径规划方法、装置、电子设备及存储介质,尤其适用于全局路径规划,其中,方法利用维诺图中的泰森多边形的顶点和边形成路径搜索可用的路径点和路径段,构成了具有避障特性的导航路径的生成基础,并基于边与障碍物信息之间的距离关系设定奖励信息以获取启发式代价值中的碰撞代价值,使得A*搜索过程能充分考虑路径与障碍物信息之间的位置关系而生成避障效果好的导航路径,使得导航路径能兼顾路径长度和避障功能。
在本申请所提供的实施例中,应该理解到,所揭露装置和方法,可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,又例如,多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
另外,作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
再者,在本申请各个实施例中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。
在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
以上所述仅为本申请的实施例而已,并不用于限制本申请的保护范围,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。
Claims (10)
1.一种移动机器人的路径规划方法,用于生成移动机器人的移动路径,其特征在于,所述方法包括以下步骤:
获取栅格地图,所述栅格地图包含起点信息、终点信息及至少一个障碍物信息;
根据所述栅格地图生成关于所述障碍物信息的维诺图,所述维诺图具有多个围绕所述障碍物信息的泰森多边形;
根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
根据所述奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索所述泰森多边形的边生成导航路径。
2.根据权利要求1所述的移动机器人的路径规划方法,其特征在于,所述利用A*搜索所述泰森多边形的边生成导航路径的步骤以所述泰森多边形的顶点作为搜索对象,并以顶点与起点信息之间的路径距离作为实际代价值。
3.根据权利要求1所述的移动机器人的路径规划方法,其特征在于,所述根据所述栅格地图生成关于所述障碍物信息的维诺图的步骤包括:
根据所述障碍物信息在所述栅格地图中生成德洛内三角网;
根据所述德洛内三角网在所述栅格地图中生成所述泰森多边形以获取所述维诺图。
4.根据权利要求1所述的移动机器人的路径规划方法,其特征在于,所述根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息的步骤包括:
根据所述距离信息生成每个所述泰森多边形的每个边的碰撞风险信息,所述碰撞风险信息与所述距离信息负相关;
根据所述碰撞风险信息生成每个所述泰森多边形的每个边的奖励信息,所述碰撞风险信息与所述奖励信息负相关。
5.根据权利要求4所述的移动机器人的路径规划方法,其特征在于,所述根据所述距离信息生成每个所述泰森多边形的每个边的碰撞风险信息的步骤包括:
沿边的延伸方向积分获取每个所述泰森多边形的每个边的距离信息的积分值,并根据所述积分值生成对应边的碰撞风险信息。
6.根据权利要求1所述的移动机器人的路径规划方法,其特征在于,所述方法还包括步骤:
对所述导航路径进行平滑化处理。
7.根据权利要求6所述的移动机器人的路径规划方法,其特征在于,所述对所述导航路径进行平滑化处理的步骤包括:
根据碰撞惩罚、平滑惩罚、长度惩罚设定关于所述导航路径平滑化处理的损失函数;
根据梯度下降法更新所述损失函数至收敛以平滑化处理所述导航路径。
8.一种移动机器人的路径规划装置,用于生成移动机器人的移动路径,其特征在于,所述装置包括:
地图获取模块,用于获取栅格地图,所述栅格地图包含起点信息、终点信息及至少一个障碍物信息;
维诺图生成模块,用于根据所述栅格地图生成关于所述障碍物信息的维诺图,所述维诺图具有多个围绕所述障碍物信息的泰森多边形;
奖励模块,用于根据每个所述泰森多边形的每个边与该泰森多边形所围绕的障碍物信息之间的距离信息生成每个边的奖励信息;
路径生成模块,用于根据所述奖励信息获取启发式代价值中的碰撞代价值,并利用A*搜索所述泰森多边形的边生成导航路径。
9.一种电子设备,其特征在于,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如权利要求1-7任一项所述方法中的步骤。
10.一种存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时运行如权利要求1-7任一项所述方法中的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310029725.2A CN115930969B (zh) | 2023-01-09 | 2023-01-09 | 移动机器人的路径规划方法、装置、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310029725.2A CN115930969B (zh) | 2023-01-09 | 2023-01-09 | 移动机器人的路径规划方法、装置、电子设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115930969A true CN115930969A (zh) | 2023-04-07 |
CN115930969B CN115930969B (zh) | 2023-06-02 |
Family
ID=85820240
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310029725.2A Active CN115930969B (zh) | 2023-01-09 | 2023-01-09 | 移动机器人的路径规划方法、装置、电子设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115930969B (zh) |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106682787A (zh) * | 2017-01-09 | 2017-05-17 | 北京航空航天大学 | 一种基于wavefront算法的快速生成广义维诺图的方法 |
CN108549388A (zh) * | 2018-05-24 | 2018-09-18 | 苏州智伟达机器人科技有限公司 | 一种基于改进a星策略的移动机器人路径规划方法 |
CN108664022A (zh) * | 2018-04-27 | 2018-10-16 | 湘潭大学 | 一种基于拓扑地图的机器人路径规划方法及系统 |
CN111750869A (zh) * | 2020-08-14 | 2020-10-09 | 中国电子科技集团公司第五十四研究所 | 一种实时重构Voronoi图的无人机路径规划方法 |
CN112344941A (zh) * | 2020-11-06 | 2021-02-09 | 杭州国辰机器人科技有限公司 | 路径规划方法、系统、机器人及存储介质 |
CN112783169A (zh) * | 2020-12-31 | 2021-05-11 | 科大讯飞(苏州)科技有限公司 | 一种路径规划方法、设备及计算机可读存储介质 |
CN113358129A (zh) * | 2021-05-25 | 2021-09-07 | 南京邮电大学 | 基于Voronoi图的避障最短路径规划方法 |
EP4016504A1 (en) * | 2020-12-15 | 2022-06-22 | OKAPI:Orbits GmbH | Method, computer program and hardware for determining a collision probability |
CN114815791A (zh) * | 2021-01-18 | 2022-07-29 | 阿里巴巴集团控股有限公司 | 可行驶空间规划方法及设备 |
CN115060281A (zh) * | 2022-08-16 | 2022-09-16 | 浙江光珀智能科技有限公司 | 一种基于voronoi图的全局路径引导点生成规划方法 |
CN115167399A (zh) * | 2022-06-22 | 2022-10-11 | 武汉市肺科医院 | 考虑多目标优化的消毒机器人路径规划方法 |
CN115218916A (zh) * | 2022-07-14 | 2022-10-21 | 清华大学 | 一种安全性路径规划方法、装置 |
CN115291597A (zh) * | 2022-05-30 | 2022-11-04 | 上海仙途智能科技有限公司 | 基于双向混合a*算法的路径规划方法及装置、终端 |
CN115373399A (zh) * | 2022-09-13 | 2022-11-22 | 中国安全生产科学研究院 | 一种基于空地协同的地面机器人路径规划方法 |
-
2023
- 2023-01-09 CN CN202310029725.2A patent/CN115930969B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106682787A (zh) * | 2017-01-09 | 2017-05-17 | 北京航空航天大学 | 一种基于wavefront算法的快速生成广义维诺图的方法 |
CN108664022A (zh) * | 2018-04-27 | 2018-10-16 | 湘潭大学 | 一种基于拓扑地图的机器人路径规划方法及系统 |
CN108549388A (zh) * | 2018-05-24 | 2018-09-18 | 苏州智伟达机器人科技有限公司 | 一种基于改进a星策略的移动机器人路径规划方法 |
CN111750869A (zh) * | 2020-08-14 | 2020-10-09 | 中国电子科技集团公司第五十四研究所 | 一种实时重构Voronoi图的无人机路径规划方法 |
CN112344941A (zh) * | 2020-11-06 | 2021-02-09 | 杭州国辰机器人科技有限公司 | 路径规划方法、系统、机器人及存储介质 |
EP4016504A1 (en) * | 2020-12-15 | 2022-06-22 | OKAPI:Orbits GmbH | Method, computer program and hardware for determining a collision probability |
CN112783169A (zh) * | 2020-12-31 | 2021-05-11 | 科大讯飞(苏州)科技有限公司 | 一种路径规划方法、设备及计算机可读存储介质 |
CN114815791A (zh) * | 2021-01-18 | 2022-07-29 | 阿里巴巴集团控股有限公司 | 可行驶空间规划方法及设备 |
CN113358129A (zh) * | 2021-05-25 | 2021-09-07 | 南京邮电大学 | 基于Voronoi图的避障最短路径规划方法 |
CN115291597A (zh) * | 2022-05-30 | 2022-11-04 | 上海仙途智能科技有限公司 | 基于双向混合a*算法的路径规划方法及装置、终端 |
CN115167399A (zh) * | 2022-06-22 | 2022-10-11 | 武汉市肺科医院 | 考虑多目标优化的消毒机器人路径规划方法 |
CN115218916A (zh) * | 2022-07-14 | 2022-10-21 | 清华大学 | 一种安全性路径规划方法、装置 |
CN115060281A (zh) * | 2022-08-16 | 2022-09-16 | 浙江光珀智能科技有限公司 | 一种基于voronoi图的全局路径引导点生成规划方法 |
CN115373399A (zh) * | 2022-09-13 | 2022-11-22 | 中国安全生产科学研究院 | 一种基于空地协同的地面机器人路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN115930969B (zh) | 2023-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111504325B (zh) | 一种基于扩大搜索邻域的加权a*算法的全局路径规划方法 | |
CN108705532B (zh) | 一种机械臂避障路径规划方法、设备及存储设备 | |
CN109509210B (zh) | 障碍物跟踪方法和装置 | |
Demyen et al. | Efficient triangulation-based pathfinding | |
US20170219353A1 (en) | Method and system for determining a path of an object for moving from a starting state to an end state set avoiding one or more obstacles | |
CN111880561B (zh) | 城市环境下基于改进鲸鱼算法的无人机三维路径规划方法 | |
CN110232741B (zh) | 多层包围盒确定方法、碰撞检测及运动控制方法与设备 | |
CN114510056A (zh) | 室内移动机器人的平稳移动全局路径规划方法 | |
Song et al. | Online coverage and inspection planning for 3D modeling | |
CN112731941B (zh) | 双足机器人路径规划方法、装置和双足机器人 | |
CN112033413A (zh) | 一种结合环境信息的改进a*算法 | |
CN110744543A (zh) | 基于ur3机械臂的改进式prm避障运动规划方法 | |
JP2020004421A (ja) | 1個以上の障害物を回避して始状態から終状態集合まで移動する物体の経路を決定する方法およびシステム | |
CN115167474A (zh) | 一种移动机器人路径规划优化方法 | |
CN116880497A (zh) | 一种自动化农业机械的全覆盖路径规划方法、装置和设备 | |
CN112084853A (zh) | 一种脚印预测方法、脚印预测装置及人形机器人 | |
CN115195706A (zh) | 一种泊车路径规划方法、装置 | |
CN111427341A (zh) | 一种基于概率地图的机器人最短预期时间目标搜索方法 | |
Makarov et al. | Smoothing Voronoi-Based Path with Minimized Length and Visibility Using Composite Bezier Curves. | |
Plaku et al. | Clearance-driven motion planning for mobile robots with differential constraints | |
Eraghi et al. | Path length comparison in grid maps of planning algorithms: HCTNav, A* and Dijkstra | |
CN115930969A (zh) | 移动机器人的路径规划方法、装置、电子设备及存储介质 | |
CN116764225A (zh) | 一种高效寻路的处理方法、装置、设备及介质 | |
CN114577217A (zh) | 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质 | |
Yan et al. | Path planning based on constrained delaunay triangulation |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |