CN114577217A - 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质 - Google Patents

基于冯洛诺伊图的路径规划方法、装置、设备及存储介质 Download PDF

Info

Publication number
CN114577217A
CN114577217A CN202210480551.7A CN202210480551A CN114577217A CN 114577217 A CN114577217 A CN 114577217A CN 202210480551 A CN202210480551 A CN 202210480551A CN 114577217 A CN114577217 A CN 114577217A
Authority
CN
China
Prior art keywords
node
path
position information
vonoroi
end point
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
Application number
CN202210480551.7A
Other languages
English (en)
Other versions
CN114577217B (zh
Inventor
邹雪丰
张洊闻
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Individual filed Critical Individual
Priority to CN202210480551.7A priority Critical patent/CN114577217B/zh
Publication of CN114577217A publication Critical patent/CN114577217A/zh
Application granted granted Critical
Publication of CN114577217B publication Critical patent/CN114577217B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804Creation or updating of map data
    • G01C21/3807Creation or updating of map data characterised by the type of data
    • G01C21/3811Point data, e.g. Point of Interest [POI]
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06QINFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
    • G06Q10/00Administration; Management
    • G06Q10/04Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
    • G06Q10/047Optimisation of routes or paths, e.g. travelling salesman problem

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Business, Economics & Management (AREA)
  • Human Resources & Organizations (AREA)
  • General Physics & Mathematics (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Economics (AREA)
  • Strategic Management (AREA)
  • Quality & Reliability (AREA)
  • Tourism & Hospitality (AREA)
  • Operations Research (AREA)
  • General Business, Economics & Management (AREA)
  • Marketing (AREA)
  • Theoretical Computer Science (AREA)
  • Entrepreneurship & Innovation (AREA)
  • Game Theory and Decision Science (AREA)
  • Development Economics (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本申请涉及机器人路径规划技术领域,提供了一种基于冯洛诺伊图的路径规划方法、装置、设备及存储介质,方法包括以下步骤:获取环境地图信息;将所述环境地图信息转换为Vonoroi图,所述Vonoroi图包含障碍物图像;获取起点的第一位置信息和终点的第二位置信息;根据所述第一位置信息和所述第二位置信息,在所述Vonoroi图中搜索从所述起点到所述终点的初始移动路径;所述初始移动路径包含多个路径节点;所述路径节点包含所述起点、所述终点和至少一个Vonoroi图节点;根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径;本发明具有路径规划速度快、搜索效率高的有益效果。

Description

基于冯洛诺伊图的路径规划方法、装置、设备及存储介质
技术领域
本申请涉及机器人路径规划技术领域,具体而言,涉及一种基于冯洛诺伊图的路径规划方法、装置、设备及存储介质。
背景技术
随着近年来机器人产业的飞速发展,机器人在人们的日常生活中扮演着重要的角色。机器人的简易、方便、智能等优点受到了人们的喜爱。机器人可以满足人们的各种需求,如货物搬运、地形侦查等繁重、危险的工作。为了让移动机器人能够自主寻找移动路径,对其路径规划的研究尤为必要。
然而现有的路径规划方法在为移动机器人进行路径规划时仍然存在一些缺点,例如传统的基于采样的路径规划方法,规划路径速度较慢、路径不稳定、无法保证规划路径的最优以及在一些狭小空间处,机器人的路径搜索效率大幅下降等问题。
基于上述问题,目前尚未有有效的解决方法。
发明内容
本申请的目的在于提供一种基于冯洛诺伊图的路径规划方法、装置、设备及存储介质,路径规划速度快,能够提高路径搜索效率。
第一方面,本申请提供了一种基于冯洛诺伊图的路径规划方法,包括以下步骤:
S1.获取环境地图信息;
S2.将所述环境地图信息转换为Vonoroi图,所述Vonoroi图包含障碍物图像;
S3.获取起点的第一位置信息和终点的第二位置信息;
S4.根据所述第一位置信息和所述第二位置信息,在所述Vonoroi图中搜索从所述起点到所述终点的初始移动路径;所述初始移动路径包含多个路径节点;所述路径节点包含所述起点、所述终点和至少一个Vonoroi图节点;
S5.根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径。
本申请通过利用冯洛诺伊图搜索移动路径,相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
可选地,步骤S5包括:
S501.获取所述初始移动路径的三个相邻的所述路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断所述第一节点和所述第三节点之间的连线是否穿过所述障碍物图像;
S503.若穿过,则利用路径规划算法搜索从所述第一节点到所述第三节点的避障路径段,以替代所述初始移动路径中的从所述第一节点到所述第三节点的初始路径段。
当第一节点到第三节点之间的连线穿过障碍物图像时,利用路径规划算法重新选取第一节点到第三节点的避障路径段来替代第一节点到第三节点的初始路径段,而采用路径规划算法算出的避障路径段的长度比初始路径段的长度短,通过这种替换路径段的方式,可以有效减少机器人的移动距离,减少机器人的移动时间。
可选地,步骤S502之后,还包括:
S504.若所述第一节点和所述第三节点之间的连线不穿过所述障碍物图像,则判断所述第三节点是否为所述终点;
S505.若所述第三节点是所述终点,则停止路径优化;
S506.若所述第三节点不是所述终点,则重新把所述第三节点及其后一个路径节点分别标记为新的第二节点和新的第三节点,并以所述新的第二节点和新的第三节点分别代替原先的第二节点和原先的第三节点,并执行步骤S502-S506。
可选地,步骤S503包括:
利用RRT*算法在以所述第一节点、所述第二节点和所述第三节点为三个角点的三角形区域内,搜索所述避障路径段。
在实际应用中,RRT*算法具有渐进最优性,同时,由于有初始移动路径作为基础,利用RRT*算法在提升算法效率的同时,也保证了用RRT*算法规划得到的避障路径段长度下限,其避障路径段长度必然会小于等于初始路径段,且由于限制了搜索区域(以第一节点、第二节点和第三节点为三个角点的三角形区域),能够使RRT*算法以较快的运算速度收敛得到接近最短或者最短的避障路径段。
可选地,步骤S503还包括:
S5031.判断所述第三节点是否为所述终点;
S5032.若所述第三节点为所述终点,则停止路径优化;
S5033.若所述第三节点不是所述终点,则重新将所述第三节点及其后的第一个路径节点、第二个路径点分别标记为新的第一节点、新的第二节点和新的第三节点,并以所述新的第一节点、新的第二节点和新的第三节点分别代替原先的第一节点、原先的第二节点和原先的第三节点,并执行步骤S502-S506。
可选地,步骤S4包括:
S401.利用A*算法,根据所述第一位置信息和所述第二位置信息在所述Vonoroi图中搜索所述初始移动路径。
本申请提供的基于冯洛诺伊图的路径规划方法,通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
第二方面,本申请提供一种基于冯洛诺伊图的路径规划装置,用于机器人规划路径,所述装置包括:
包括以下模块:
第一获取模块:用于获取环境地图信息;
转化模块:用于将所述环境地图信息转换为Vonoroi图,所述Vonoroi图包含障碍物图像;
第二获取模块:用于获取起点的第一位置信息和终点的第二位置信息;
搜索模块:用于根据所述第一位置信息和所述第二位置信息,在所述Vonoroi图中搜索从所述起点到所述终点的初始移动路径;所述初始移动路径包含多个路径节点;所述路径节点包含所述起点、所述终点和至少一个Vonoroi图节点;
优化模块:用于根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径。
可选地,所述优化模块在根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径的时候,执行以下步骤:
S501.获取所述初始移动路径的三个相邻的所述路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断所述第一节点和所述第三节点之间的连线是否穿过所述障碍物图像;
S503.若穿过,则利用路径规划算法搜索从所述第一节点到所述第三节点的避障路径段,以替代所述初始移动路径中的从所述第一节点到所述第三节点的初始路径段。
本申请提供的基于冯洛诺伊图的路径规划装置,通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
第三方面,本申请提供一种电子设备,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如上述第一方面提供的所述方法中的步骤。
第四方面,本申请提供一种存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时运行如上述第一方面提供的所述方法中的步骤。
本申请的有益效果:路径节点少,路径规划速度快,路径搜索效率高,节省算法的运算时间。
附图说明
图1为本申请提供的基于冯洛诺伊图的路径规划方法的一种流程图。
图2为本申请提供的基于冯洛诺伊图的路径规划装置的一种结构示意图。
图3为本申请提供的电子设备的结构示意图。
图4为本申请提供的以第一节点、第二节点和第三节点为角点的三角形区域示意图。
图5为本申请提供的经过RRT*算法搜寻后的路径节点示意图。
图6为本申请提供的开始遍历初始移动路径的路径节点示意图。
图7为本申请提供的把第三节点及其后一个路径节点分别标记为新的第二节点和新的第三节点的路径节点示意图。
标号说明:
201、第一获取模块;202、转化模块;203、第二获取模块;204、搜索模块;205、优化模块;301、处理器;302、存储器;303、通信总线;400、障碍物。
具体实施方式
下面将结合本申请实施方式中附图,对本申请实施方式中的技术方案进行清楚、完整地描述,显然,所描述的实施方式仅仅是本申请一部分实施方式,而不是全部的实施方式。通常在此处附图中描述和示出的本申请实施方式的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本申请的实施方式的详细描述并非旨在限制要求保护的本申请的范围,而是仅仅表示本申请的选定实施方式。基于本申请的实施方式,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施方式,都属于本申请保护的范围。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步定义和解释。同时,在本申请的描述中,术语“第一”、“第二”等仅用于区分描述,而不能理解为指示或暗示相对重要性。
在实际应用中,机器人广泛应用于货仓、商场和车间内,机器人可以替代人类从事繁琐的搬运工作,而这些工作场所一般都不是空旷的场地,工作场所内会设置有大小不一且不可移动的障碍物,例如货架、加工台等,机器人需要对移动路径进行合理规划,绕开障碍物的同时保证机器人的移动路径要最短,尽量节省移动时间,最终到达目标地点。
请参照图1,图1是本申请一些实施方式中的基于冯洛诺伊图的路径规划方法的流程图,用于机器人规划路径,包括以下步骤:
S1.获取环境地图信息;
S2.将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;
S3.获取起点的第一位置信息和终点的第二位置信息;
S4.根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;
S5.根据路径节点之间的连线和障碍物图像优化初始移动路径。
其中,环境地图信息的获取为现有技术,在此不再赘述。
其中,将环境地图信息转换为Vonoroi图的方法很多,常见的有分治法、扫描线算法和三角剖分算法。Vonoroi图又叫泰森多边形或冯洛诺伊图(其中,Vonoroi图节点包括Vonoroi图的控制点和/或这些多边形的角点),Vonoroi图相比其他地图类型具有路径节点少的特点,因此将环境地图信息转换为Vonoroi图,可以在保证整体路径节点完备性的基础上,使路径规划算法减少对路径节点的搜索,从而减少路径规划算法的算力消耗。
其中,获取起点的第一位置信息和终点的第二位置信息为现有技术,在此不再赘述。其中,起点的第一位置信息即起点的位置信息,终点的第二位置信息即终点的位置信息,为了便于区分两个位置信息,本文中把起点的位置信息称为第一位置信息,把终点的位置信息称为第二位置信息。
其中,搜索初始移动路径的方法可以采用现有的路径规划算法,例如组合规划算法、基于采样的规划算法或者RRT(快速扩展随机树)算法。
其中,根据路径节点之间的连线(直线连线)和障碍物图像优化初始移动路径,可以是指根据任意两个路径节点之间的连线是否穿过障碍物为依据,选择是否优化初始移动路径,优化的方法也可采用上述的路径规划算法。
本申请的基于冯洛诺伊图的路径规划方法,通过获取环境地图信息;将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;获取起点的第一位置信息和终点的第二位置信息;根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;根据路径节点之间的连线和障碍物图像优化初始移动路径。通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
在一些实施方式中,步骤S5包括:
S501.获取初始移动路径的三个相邻的路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断第一节点和第三节点之间的连线是否穿过障碍物图像;
S503.若穿过,则利用路径规划算法搜索从第一节点到第三节点的避障路径段,以替代初始移动路径中的从第一节点到第三节点的初始路径段。
在一些实施方式中,获取初始移动路径的三个相邻的路径节点可以是从起点开始选取,然后按起点到终点的顺序选取三个,即上述的从前到后顺序是按照从起点到终点的顺序;也可以是从终点开始选取,然后按终点到起点的顺序选取三个,此时上述的从前到后顺序是从终点到起点的顺序;还可以是从靠近障碍物图像的路径段中按顺序选取三个路径节点,此时上述的从前到后则是根据实际情况,来确定是从起点到终点的顺序或者从终点到起点的顺序。
为了方便解释说明,以下的实施方式均是从起点开始选取,即上述的从前到后顺序是按照从起点到终点的顺序。
在一些优选的实施方式中,获取初始移动路径的三个相邻的路径节点采用的是从起点开始选取的方式,通过这种选取方式,可以遍历到初始移动路径上所有路径节点,对每个以三个相邻的路径节点所组成的初始路径段重新调整,最终能有效缩短第一节点到第三节点的初始路径段。
其中,步骤S503中,路径规划算法可以采用上述现有的路径规划算法。
查阅图4,其中,第一节点为s,第二节点为m,第三节点为e。
当第一节点到第三节点之间的连线穿过障碍物图像时,利用路径规划算法重新选取第一节点到第三节点的避障路径段来替代第一节点到第三节点的初始路径段,而采用路径规划算法算出的避障路径段的长度比初始路径段的长度短,通过这种替换路径段的方式,可以有效减少机器人的移动距离,减少机器人的移动时间。
在一些优选的实施方式中,步骤S503包括:
利用RRT*算法在以第一节点、第二节点和第三节点为三个角点的三角形区域内,搜索避障路径段。
其中,RRT*算法具有渐进最优性,同时,由于有初始移动路径作为基础,利用RRT*算法在提升算法效率的同时,也保证了用RRT*算法规划得到的避障路径段长度下限,其避障路径段长度必然会小于等于初始路径段,且由于限制了搜索区域(以第一节点、第二节点和第三节点为三个角点的三角形区域),能够使RRT*算法以较快的运算速度收敛得到接近最短或者最短的避障路径段。
在进一步的实施方式中,步骤S503还包括:
S5031.判断第三节点是否为终点;
S5032.若第三节点为终点,则停止路径优化;
S5033.若第三节点不是终点,则重新将第三节点及其后的第一个路径节点、第二个路径点分别标记为新的第一节点、新的第二节点和新的第三节点,并以所述新的第一节点、新的第二节点和新的第三节点分别代替原先的第一节点、原先的第二节点和原先的第三节点,并执行步骤S502-S506。
参阅图5,原先的第一节点为a,原先的第二节点为b,新的第一节点(原先的第三节点)为s,新的第二节点为m,新的第三节点为e,可以看出此时的第一节点s为原先的第三节点,第二节点m为原先的第三节点后的第一个路径节点,第三节点e为原先的第三节点后的第二个路径节点,原先的第一节点a到第一节点(原先的第三节点)s之间的避障路径段(实线部分,经过RRT*算法搜索得到)已经比原先的第一节点a到原先的第二节点为b,再到第一节点(原先的第三节点)s的初始路径段(虚线部分)短。
在进一步的实施方式中,步骤S502之后,还包括:
S504.若第一节点和第三节点之间的连线不穿过障碍物图像,则判断第三节点是否为终点;
S505.若第三节点是终点,则停止路径优化;
S506.若第三节点不是终点,则重新把第三节点及其后一个路径节点分别标记为新的第二节点和新的第三节点,并以所述新的第二节点和新的第三节点分别代替原先的第二节点和原先的第三节点,并执行步骤S502-S506。
参阅图6,其中,第一节点为s,第二节点为m,第三节点为e。由于第一节点s到第三节点e之间的连线没穿过障碍物400,且第三节点e不是终点,所以要重新把第三节点标记为第二节点,把第三节点的后一个路径节点标记为第三节点,即演化至图7,可以看出,图7的第一节点为s,第二节点(原图6的第三节点)为m,第三节点(原图6的第三节点的后一个路径节点)为e。
通过这种依次巡检的方式,可以遍历到初始移动路径上的所有路径节点,对每个以三个相邻的路径节点所组成的初始路径段进行检查,从而判断是否需要使用路径规划算法重新规划或者剔除多余的路径节点,能进一步减少初始路径段的长度。
在一些优选的实施方式中,步骤S4包括:
S401.利用A*算法,根据第一位置信息和第二位置信息在Vonoroi图中搜索初始移动路径。
一方面,通过利用A*算法作为一个启发式的搜索算法,在Vonoroi图中搜索初始移动路径,搜索效率相比传统的深度优先算法和广度优先算法要高。另一方面,通过利用A*算法在在Vonoroi图中搜索初始移动路径,将初始移动路径作为引导,使得后续利用RRT*算法在以第一节点、第二节点和第三节点为三个角点的三角形区域内进行搜索时,在面对狭小空间处的路径规划问题上,不会因为采集到的路径节点频繁落入障碍物,导致RRT*算法效率大幅降低。
由上可知,本申请的基于冯洛诺伊图的路径规划方法,通过获取环境地图信息;将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;获取起点的第一位置信息和终点的第二位置信息;根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;根据路径节点之间的连线和障碍物图像优化初始移动路径。通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
请参照图2,图2是本申请一些实施方式中的基于冯洛诺伊图的路径规划装置,用于机器人规划路径,包括以下模块:
第一获取模块201:用于获取环境地图信息;
转化模块202:用于将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;
第二获取模块203:用于获取起点的第一位置信息和终点的第二位置信息;
搜索模块204:用于根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;
优化模块205:用于根据路径节点之间的连线和障碍物图像优化初始移动路径。
其中,第一获取模块201获取环境地图信息的方式为现有技术,在此不再赘述。
其中,转化模块202将环境地图信息转换为Vonoroi图的方法很多,常见的有分治法、扫描线算法和三角剖分算法。Vonoroi图又叫泰森多边形或冯洛诺伊图(其中,Vonoroi图节点包括Vonoroi图的控制点和/或这些多边形的角点),Vonoroi图相比其他地图类型具有路径节点少的特点,因此将环境地图信息转换为Vonoroi图,可以在保证整体路径节点完备性的基础上,使路径规划算法减少对路径节点的搜索,从而减少路径规划算法的算力消耗。
其中,第二获取模块203获取起点的第一位置信息和终点的第二位置信息为现有技术,在此不再赘述。其中,起点的第一位置信息即起点的位置信息,终点的第二位置信息即终点的位置信息,为了便于区分两个位置信息,本文中把起点的位置信息称为第一位置信息,把终点的位置信息称为第二位置信息。
其中,搜索模块204搜索初始移动路径的方法可以采用现有的路径规划算法,例如组合规划算法、基于采样的规划算法或者RRT(快速扩展随机树)算法。
其中,根据路径节点之间的连线(直线连线)和障碍物图像优化初始移动路径,可以是指根据任意两个路径节点之间的连线是否穿过障碍物为依据,选择是否优化初始移动路径,优化的方法也可采用上述的路径规划算法。
本申请的基于冯洛诺伊图的路径规划装置,通过第一获取模块201获取环境地图信息;转化模块202将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;第二获取模块203获取起点的第一位置信息和终点的第二位置信息;搜索模块204根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;优化模块205根据路径节点之间的连线和障碍物图像优化初始移动路径。通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
在一些实施方式中,优化模块205在根据路径节点之间的连线和障碍物图像优化初始移动路径的时候,执行以下步骤:
S501.获取初始移动路径的三个相邻的路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断第一节点和第三节点之间的连线是否穿过障碍物图像;
S503.若穿过,则利用路径规划算法搜索从第一节点到第三节点的避障路径段,以替代初始移动路径中的从第一节点到第三节点的初始路径段。
在一些实施方式中,获取初始移动路径的三个相邻的路径节点可以是从起点开始选取,然后按起点到终点的顺序选取三个,即上述的从前到后顺序是按照从起点到终点的顺序;也可以是从终点开始选取,然后按终点到起点的顺序选取三个,此时上述的从前到后顺序是从终点到起点的顺序;还可以是从靠近障碍物图像的路径段中按顺序选取三个路径节点,此时上述的从前到后则是根据实际情况,来确定是从起点到终点的顺序或者从终点到起点的顺序。
为了方便解释说明,以下的实施方式均是从起点开始选取,即上述的从前到后顺序是按照从起点到终点的顺序。
在一些优选的实施方式中,获取初始移动路径的三个相邻的路径节点采用的是从起点开始选取的方式,通过这种选取方式,可以遍历到初始移动路径上所有路径节点,对每个以三个相邻的路径节点所组成的初始路径段重新调整,最终能有效缩短第一节点到第三节点的初始路径段。
其中,步骤S503中,路径规划算法可以采用上述现有的路径规划算法。
查阅图4,其中,第一节点为s,第二节点为m,第三节点为e。
当第一节点到第三节点之间的连线穿过障碍物图像时,利用路径规划算法重新选取第一节点到第三节点的避障路径段来替代第一节点到第三节点的初始路径段,而采用路径规划算法算出的避障路径段的长度比初始路径段的长度短,通过这种替换路径段的方式,可以有效减少机器人的移动距离,减少机器人的移动时间。
在一些优选的实施方式中,步骤S503包括:
利用RRT*算法在以第一节点、第二节点和第三节点为三个角点的三角形区域内,搜索避障路径段。
其中,RRT*算法具有渐进最优性,同时,由于有初始移动路径作为基础,利用RRT*算法在提升算法效率的同时,也保证了用RRT*算法规划得到的避障路径段长度下限,其避障路径段长度必然会小于等于初始路径段,且由于限制了搜索区域(以第一节点、第二节点和第三节点为三个角点的三角形区域),能够使RRT*算法以较快的运算速度收敛得到接近最短或者最短的避障路径段。
在进一步的实施方式中,步骤S503还包括:
S5031.判断第三节点是否为终点;
S5032.若第三节点为终点,则停止路径优化;
S5033.若第三节点不是终点,则重新将第三节点及其后的第一个路径节点、第二个路径点分别标记为新的第一节点、新的第二节点和新的第三节点,并以所述新的第一节点、新的第二节点和新的第三节点分别代替原先的第一节点、原先的第二节点和原先的第三节点,并执行步骤S502-S506。
参阅图5,原先的第一节点为a,原先的第二节点为b,新的第一节点(原先的第三节点)为s,新的第二节点为m,新的第三节点为e,可以看出此时的第一节点s为原先的第三节点,第二节点m为原先的第三节点后的第一个路径节点,第三节点e为原先的第三节点后的第二个路径节点,原先的第一节点a到第一节点(原先的第三节点)s之间的避障路径段(实线部分,经过RRT*算法搜索得到)已经比原先的第一节点a到原先的第二节点为b,再到第一节点(原先的第三节点)s的初始路径段(虚线部分)短。
在进一步的实施方式中,步骤S502之后,还包括:
S504.若第一节点和第三节点之间的连线不穿过障碍物图像,则判断第三节点是否为终点;
S505.若第三节点是终点,则停止路径优化;
S506.若第三节点不是终点,则重新把第三节点及其后一个路径节点分别标记为新的第二节点和新的第三节点,并以所述新的第二节点和新的第三节点分别代替原先的第二节点和原先的第三节点,并执行步骤S502-S506。
参阅图6,其中,第一节点为s,第二节点为m,第三节点为e。由于第一节点s到第三节点e之间的连线没穿过障碍物400,且第三节点e不是终点,所以要重新把第三节点标记为第二节点,把第三节点的后一个路径节点标记为第三节点,即演化至图7,可以看出,图7的第一节点为s,第二节点(原图6的第三节点)为m,第三节点(原图6的第三节点的后一个路径节点)为e。
通过这种依次巡检的方式,可以遍历到初始移动路径上的所有路径节点,对每个以三个相邻的路径节点所组成的初始路径段进行检查,从而判断是否需要使用路径规划算法重新规划或者剔除多余的路径节点,能进一步减少初始路径段的长度。
在一些优选的实施方式中,搜索模块204在根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径时,执行以下步骤:
S401.利用A*算法,根据第一位置信息和第二位置信息在Vonoroi图中搜索初始移动路径。
一方面,通过利用A*算法作为一个启发式的搜索算法,在Vonoroi图中搜索初始移动路径,搜索效率相比传统的深度优先算法和广度优先算法要高。另一方面,通过利用A*算法在在Vonoroi图中搜索初始移动路径,将初始移动路径作为引导,使得后续利用RRT*算法在以第一节点、第二节点和第三节点为三个角点的三角形区域内进行搜索时,在面对狭小空间处的路径规划问题上,不会因为采集到的路径节点频繁落入障碍物,导致RRT*算法效率大幅降低。
由上可知,本申请的基于冯洛诺伊图的路径规划装置,通过第一获取模块201获取环境地图信息;转化模块202将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;第二获取模块203获取起点的第一位置信息和终点的第二位置信息;搜索模块204根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;优化模块205根据路径节点之间的连线和障碍物图像优化初始移动路径。通过利用冯洛诺伊图搜索移动路径相比使用其他地图类型进行路径规划具有路径节点少的优势,解决了传统路径规划算法需要对大量路径节点进行规划的问题,节省了运算时间,提高了机器人的对路径的搜索和规划效率。
请参照图3,图3为本申请实施方式提供的一种电子设备的结构示意图,本申请提供一种电子设备,包括:处理器301和存储器302,处理器301和存储器302通过通信总线303和/或其他形式的连接机构(未标出)互连并相互通讯,存储器302存储有处理器301可执行的计算机程序,当计算设备运行时,处理器301执行该计算机程序,以在执行时执行上述实施方式的任一可选的实现方式中的方法,以实现以下功能:获取环境地图信息;将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;获取起点的第一位置信息和终点的第二位置信息;根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;根据路径节点之间的连线和障碍物图像优化初始移动路径。
本申请实施方式提供一种存储介质,其上存储有计算机程序,计算机程序被处理器执行时,执行上述实施方式的任一可选的实现方式中的方法,以实现以下功能:获取环境地图信息;将环境地图信息转换为Vonoroi图,Vonoroi图包含障碍物图像;获取起点的第一位置信息和终点的第二位置信息;根据第一位置信息和第二位置信息,在Vonoroi图中搜索从起点到终点的初始移动路径;初始移动路径包含多个路径节点;路径节点包含起点、终点和至少一个Vonoroi图节点;根据路径节点之间的连线和障碍物图像优化初始移动路径。其中,存储介质可以由任何类型的易失性或非易失性存储设备或者它们的组合实现,如静态随机存取存储器(Static Random Access Memory, 简称SRAM),电可擦除可编程只读存储器(Electrically Erasable Programmable Read-Only Memory, 简称EEPROM),可擦除可编程只读存储器(Erasable Programmable Read Only Memory, 简称EPROM),可编程只读存储器(Programmable Red-Only Memory, 简称PROM),只读存储器(Read-Only Memory,简称ROM),磁存储器,快闪存储器,磁盘或光盘。
在本申请所提供的实施方式中,应该理解到,所揭露系统和方法,可以通过其它的方式实现。以上所描述的系统实施方式仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,又例如,多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口,系统或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
另外,作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施方式方案的目的。
再者,在本申请各个实施方式中的各功能模块可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或两个以上模块集成形成一个独立的部分。
在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。
以上所述仅为本申请的实施方式而已,并不用于限制本申请的保护范围,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。

Claims (10)

1.一种基于冯洛诺伊图的路径规划方法,用于机器人规划路径,其特征在于,包括以下步骤:
S1.获取环境地图信息;
S2.将所述环境地图信息转换为Vonoroi图,所述Vonoroi图包含障碍物图像;
S3.获取起点的第一位置信息和终点的第二位置信息;
S4.根据所述第一位置信息和所述第二位置信息,在所述Vonoroi图中搜索从所述起点到所述终点的初始移动路径;所述初始移动路径包含多个路径节点;所述路径节点包含所述起点、所述终点和至少一个Vonoroi图节点;
S5.根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径。
2.根据权利要求1所述的基于冯洛诺伊图的路径规划方法,其特征在于,步骤S5包括:
S501.获取所述初始移动路径的三个相邻的所述路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断所述第一节点和所述第三节点之间的连线是否穿过所述障碍物图像;
S503.若穿过,则利用路径规划算法搜索从所述第一节点到所述第三节点的避障路径段,以替代所述初始移动路径中的从所述第一节点到所述第三节点的初始路径段。
3.根据权利要求2所述的基于冯洛诺伊图的路径规划方法,其特征在于,步骤S502之后,还包括:
S504.若所述第一节点和所述第三节点之间的连线不穿过所述障碍物图像,则判断所述第三节点是否为所述终点;
S505.若所述第三节点是所述终点,则停止路径优化;
S506.若所述第三节点不是所述终点,则重新把所述第三节点及其后一个路径节点分别标记为新的第二节点和新的第三节点,并以所述新的第二节点和新的第三节点分别代替原先的第二节点和原先的第三节点,并执行步骤S502-S506。
4.根据权利要求2所述的基于冯洛诺伊图的路径规划方法,其特征在于,步骤S503包括:
利用RRT*算法在以所述第一节点、所述第二节点和所述第三节点为三个角点的三角形区域内,搜索所述避障路径段。
5.根据权利要求2所述的基于冯洛诺伊图的路径规划方法,其特征在于,步骤S503还包括:
S5031.判断所述第三节点是否为所述终点;
S5032.若所述第三节点为所述终点,则停止路径优化;
S5033.若所述第三节点不是所述终点,则重新将所述第三节点及其后的第一个路径节点、第二个路径点分别标记为新的第一节点、新的第二节点和新的第三节点,并以所述新的第一节点、新的第二节点和新的第三节点分别代替原先的第一节点、原先的第二节点和原先的第三节点,并执行步骤S502-S506。
6.根据权利要求1所述的基于冯洛诺伊图的路径规划方法,其特征在于,步骤S4包括:
S401.利用A*算法,根据所述第一位置信息和所述第二位置信息在所述Vonoroi图中搜索所述初始移动路径。
7.一种基于冯洛诺伊图的路径规划装置,用于机器人规划路径,其特征在于,包括以下模块:
第一获取模块:用于获取环境地图信息;
转化模块:用于将所述环境地图信息转换为Vonoroi图,所述Vonoroi图包含障碍物图像;
第二获取模块:用于获取起点的第一位置信息和终点的第二位置信息;
搜索模块:用于根据所述第一位置信息和所述第二位置信息,在所述Vonoroi图中搜索从所述起点到所述终点的初始移动路径;所述初始移动路径包含多个路径节点;所述路径节点包含所述起点、所述终点和至少一个Vonoroi图节点;
优化模块:用于根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径。
8.根据权利要求7所述的基于冯洛诺伊图的路径规划装置,其特征在于,所述优化模块在根据所述路径节点之间的连线和所述障碍物图像优化所述初始移动路径的时候,执行以下步骤:
S501.获取所述初始移动路径的三个相邻的所述路径节点,从前到后依次记为第一节点、第二节点和第三节点;
S502.判断所述第一节点和所述第三节点之间的连线是否穿过所述障碍物图像;
S503.若穿过,则利用路径规划算法搜索从所述第一节点到所述第三节点的避障路径段,以替代所述初始移动路径中的从所述第一节点到所述第三节点的初始路径段。
9.一种电子设备,其特征在于,包括处理器以及存储器,所述存储器存储有计算机可读取指令,当所述计算机可读取指令由所述处理器执行时,运行如权利要求1-6任一项所述基于冯洛诺伊图的路径规划方法中的步骤。
10.一种存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时运行如权利要求1-6任一项所述基于冯洛诺伊图的路径规划方法中的步骤。
CN202210480551.7A 2022-05-05 2022-05-05 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质 Active CN114577217B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210480551.7A CN114577217B (zh) 2022-05-05 2022-05-05 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210480551.7A CN114577217B (zh) 2022-05-05 2022-05-05 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质

Publications (2)

Publication Number Publication Date
CN114577217A true CN114577217A (zh) 2022-06-03
CN114577217B CN114577217B (zh) 2022-07-29

Family

ID=81785278

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210480551.7A Active CN114577217B (zh) 2022-05-05 2022-05-05 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质

Country Status (1)

Country Link
CN (1) CN114577217B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115950439A (zh) * 2023-03-15 2023-04-11 季华实验室 双向rrt路径规划方法、装置、电子设备及存储介质

Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103542852A (zh) * 2013-10-23 2014-01-29 上海大学 一种基于分割法的无人机路径规划方法
CN107085437A (zh) * 2017-03-20 2017-08-22 浙江工业大学 一种基于eb‑rrt的无人机航迹规划方法
CN108549388A (zh) * 2018-05-24 2018-09-18 苏州智伟达机器人科技有限公司 一种基于改进a星策略的移动机器人路径规划方法
CN109668561A (zh) * 2017-10-13 2019-04-23 中兴通讯股份有限公司 一种室内路径规划方法、终端及可读存储介质
CN109947100A (zh) * 2019-03-12 2019-06-28 深圳优地科技有限公司 路径规划方法、系统及终端设备
CN110081889A (zh) * 2019-06-11 2019-08-02 广东工业大学 一种基于随机采样和强化学习的机器人路径规划方法
CN110673634A (zh) * 2019-11-12 2020-01-10 合肥工业大学 一种电力巡检无人机路径规划方法和输电线巡检方法
CN111750869A (zh) * 2020-08-14 2020-10-09 中国电子科技集团公司第五十四研究所 一种实时重构Voronoi图的无人机路径规划方法
CN111860880A (zh) * 2020-06-01 2020-10-30 北京骑胜科技有限公司 一种路径确定方法、装置、电子设备和存储介质
US20210041243A1 (en) * 2019-08-06 2021-02-11 Boston Dynamics, Inc. Intermediate Waypoint Generator
CN112393728A (zh) * 2020-10-23 2021-02-23 浙江工业大学 一种基于a*算法和rrt*算法的移动机器人路径规划方法
CN112783169A (zh) * 2020-12-31 2021-05-11 科大讯飞(苏州)科技有限公司 一种路径规划方法、设备及计算机可读存储介质
CN112799393A (zh) * 2020-12-04 2021-05-14 湖南大学 一种面向泊车场景的地图简化系统
CN113286985A (zh) * 2020-09-17 2021-08-20 华为技术有限公司 一种路径规划方法和路径规划装置
CN113485379A (zh) * 2021-08-18 2021-10-08 山东建筑大学 一种改进A-Star算法的移动机器人路径规划方法
CN113934206A (zh) * 2021-07-22 2022-01-14 浙江科技学院 移动机器人路径规划方法、装置、计算机设备和存储介质
CN114115271A (zh) * 2021-11-25 2022-03-01 江苏科技大学 一种改进rrt的机器人路径规划方法和系统
CN114353814A (zh) * 2021-12-06 2022-04-15 重庆邮电大学 基于Angle-Propagation Theta*算法改进的JPS路径优化方法

Patent Citations (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103542852A (zh) * 2013-10-23 2014-01-29 上海大学 一种基于分割法的无人机路径规划方法
CN107085437A (zh) * 2017-03-20 2017-08-22 浙江工业大学 一种基于eb‑rrt的无人机航迹规划方法
CN109668561A (zh) * 2017-10-13 2019-04-23 中兴通讯股份有限公司 一种室内路径规划方法、终端及可读存储介质
CN108549388A (zh) * 2018-05-24 2018-09-18 苏州智伟达机器人科技有限公司 一种基于改进a星策略的移动机器人路径规划方法
CN109947100A (zh) * 2019-03-12 2019-06-28 深圳优地科技有限公司 路径规划方法、系统及终端设备
CN110081889A (zh) * 2019-06-11 2019-08-02 广东工业大学 一种基于随机采样和强化学习的机器人路径规划方法
US20210041243A1 (en) * 2019-08-06 2021-02-11 Boston Dynamics, Inc. Intermediate Waypoint Generator
CN110673634A (zh) * 2019-11-12 2020-01-10 合肥工业大学 一种电力巡检无人机路径规划方法和输电线巡检方法
CN111860880A (zh) * 2020-06-01 2020-10-30 北京骑胜科技有限公司 一种路径确定方法、装置、电子设备和存储介质
CN111750869A (zh) * 2020-08-14 2020-10-09 中国电子科技集团公司第五十四研究所 一种实时重构Voronoi图的无人机路径规划方法
CN113286985A (zh) * 2020-09-17 2021-08-20 华为技术有限公司 一种路径规划方法和路径规划装置
CN112393728A (zh) * 2020-10-23 2021-02-23 浙江工业大学 一种基于a*算法和rrt*算法的移动机器人路径规划方法
CN112799393A (zh) * 2020-12-04 2021-05-14 湖南大学 一种面向泊车场景的地图简化系统
CN112783169A (zh) * 2020-12-31 2021-05-11 科大讯飞(苏州)科技有限公司 一种路径规划方法、设备及计算机可读存储介质
CN113934206A (zh) * 2021-07-22 2022-01-14 浙江科技学院 移动机器人路径规划方法、装置、计算机设备和存储介质
CN113485379A (zh) * 2021-08-18 2021-10-08 山东建筑大学 一种改进A-Star算法的移动机器人路径规划方法
CN114115271A (zh) * 2021-11-25 2022-03-01 江苏科技大学 一种改进rrt的机器人路径规划方法和系统
CN114353814A (zh) * 2021-12-06 2022-04-15 重庆邮电大学 基于Angle-Propagation Theta*算法改进的JPS路径优化方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
WENZHENG CHI: ""A Generalized Voronoi Diagram-Based Efficient Heuristic Path Planning Method for RRTs in Mobile Robots"", 《IEEE TRANSACTIONS ON INDUSTRIAL ELECTRONICS 》 *

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115950439A (zh) * 2023-03-15 2023-04-11 季华实验室 双向rrt路径规划方法、装置、电子设备及存储介质
CN115950439B (zh) * 2023-03-15 2023-06-02 季华实验室 双向rrt路径规划方法、装置、电子设备及存储介质

Also Published As

Publication number Publication date
CN114577217B (zh) 2022-07-29

Similar Documents

Publication Publication Date Title
CN109115226B (zh) 基于跳点搜索的多机器人冲突避免的路径规划方法
Jin et al. Solving the container relocation problem by an improved greedy look-ahead heuristic
US20220018669A1 (en) A method for searching the shortest path of must-pass nodes
US20130339352A1 (en) Shortest path computation in large networks
CN110006429A (zh) 一种基于深度优化的无人船航迹规划方法
CN110967015B (zh) 一种路径规划方法及系统
CN114577217B (zh) 基于冯洛诺伊图的路径规划方法、装置、设备及存储介质
CN111104471B (zh) 基于跳点路径搜索的模式数据库信息压缩方法及系统
CN107544502A (zh) 一种已知环境下的移动机器人规划方法
CN108151744A (zh) 基于a-star算法的室内导航系统
CN110781311A (zh) 一种企业一致行动人运算系统及方法
Xu et al. An efficient algorithm for environmental coverage with multiple robots
Shen et al. Euclidean pathfinding with compressed path databases
CN110975288B (zh) 基于跳点路径搜索的几何容器数据压缩方法及系统
CN111427341A (zh) 一种基于概率地图的机器人最短预期时间目标搜索方法
Banerjee et al. A framework of voronoi diagram for planning multiple paths in free space
CN102819581A (zh) 一种地理信息系统拓扑集中的多边形链生成方法
Stelzer et al. Trail-Map: A scalable landmark data structure for biologically inspired range-free navigation
CN115143980A (zh) 基于剪枝Voronoi图的增量式拓扑地图构建方法
Yan et al. Path planning based on constrained delaunay triangulation
Gugan et al. Towards the development of a robust path planner for autonomous drones
Wang et al. SRM: An efficient framework for autonomous robotic exploration in indoor environments
Nutanong et al. Local network voronoi diagrams
CN113311843A (zh) 基于安全距离约束和los视线判断的无人船路径规划方法
Ran et al. Summary of research on path planning based on A* algorithm

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