CN111428919B - 路径规划方法、装置、电子设备及存储介质 - Google Patents
路径规划方法、装置、电子设备及存储介质 Download PDFInfo
- Publication number
- CN111428919B CN111428919B CN202010185234.3A CN202010185234A CN111428919B CN 111428919 B CN111428919 B CN 111428919B CN 202010185234 A CN202010185234 A CN 202010185234A CN 111428919 B CN111428919 B CN 111428919B
- Authority
- CN
- China
- Prior art keywords
- path
- point
- optimized
- arc
- effective
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION 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/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/10—Computer-aided planning, simulation or modelling of surgical operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION 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/00—Administration; Management
- G06Q10/06—Resources, workflows, human or project management; Enterprise or organisation planning; Enterprise or organisation modelling
- G06Q10/063—Operations research, analysis or management
- G06Q10/0639—Performance analysis of employees; Performance analysis of enterprise or organisation operations
- G06Q10/06393—Score-carding, benchmarking or key performance indicator [KPI] analysis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/10—Computer-aided planning, simulation or modelling of surgical operations
- A61B2034/107—Visualisation of planned trajectories or target regions
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/10—Computer-aided planning, simulation or modelling of surgical operations
- A61B2034/108—Computer aided selection or customisation of medical implants or cutting guides
Landscapes
- Business, Economics & Management (AREA)
- Engineering & Computer Science (AREA)
- Human Resources & Organizations (AREA)
- Strategic Management (AREA)
- Economics (AREA)
- Health & Medical Sciences (AREA)
- Entrepreneurship & Innovation (AREA)
- Development Economics (AREA)
- Quality & Reliability (AREA)
- Game Theory and Decision Science (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- General Business, Economics & Management (AREA)
- Physics & Mathematics (AREA)
- Tourism & Hospitality (AREA)
- Operations Research (AREA)
- Marketing (AREA)
- Educational Administration (AREA)
- Life Sciences & Earth Sciences (AREA)
- Surgery (AREA)
- Medical Informatics (AREA)
- Robotics (AREA)
- Biomedical Technology (AREA)
- Heart & Thoracic Surgery (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- Molecular Biology (AREA)
- Veterinary Medicine (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Supply And Distribution Of Alternating Current (AREA)
- Navigation (AREA)
Abstract
本申请适用于计算机技术领域,提供了路径规划方法、装置、电子设备及存储介质,路径规划方法包括:获取起始点、目标点以及障碍物信息;根据起始点、目标点以及障碍物信息确定至少一个有效路径点,对至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,优化路径为连接起始点和目标点的路径;根据预设的路径评估函数计算每个优化路径对应的路径评分;若存在路径评分达到预设值的优化路径,将路径评分达到预设值的优化路径作为规划路径。本申请实施例提供的路径规划方法根据有效路径点进行路径规划,得到优化路径,扩大路径选择范围,再从多个方面对优化路径进行约束,以得到更优的规划路径。
Description
技术领域
本申请属于计算机技术领域,尤其涉及路径规划方法、装置、电子设备及存储介质。
背景技术
现有的路径规划方法,一般采用单一的规划算法,不能解决复杂的路径规划问题,避障效果不佳,若将现有的路径规划方法应用于实际的器官穿刺中,不能保证穿刺过程的精度和安全性。
发明内容
本申请实施例提供了路径规划方法、装置、电子设备及存储介质,可以规划出更准确的路径,实现更好的避障效果。
第一方面,本申请实施例提供了一种路径规划方法,包括:
获取起始点、目标点以及障碍物信息;
根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间;
对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径;
根据预设的路径评估函数计算每个优化路径对应的路径评分;
若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
在一种可能的实现方式中,所述障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件;所述根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,包括:
根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向;
根据所述障碍物的距离约束条件以及所述每个初始路径点的方向,从所述初始路径点中筛选出至少一个有效路径点。
在一种可能的实现方式中,所述对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,包括:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个优化路径;其中,所述优化路径由至少两个弧段依次连接所得到,相邻的两个弧段相切;所述路径约束条件为:若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧。
在一种可能的实现方式中,所述圆弧计算公式为:
其中,li表示第i个有效路径点到对应圆弧的圆心的距离,n表示有效路径点的数量,m表示第i个有效路径点与目标点之间的有效路径点的数量,r1和r2分别表示形成所述弧段的双圆弧中每个圆弧的半径,当f取最小值时,所对应的半径为所述最优双圆弧中每个圆弧的半径。
在一种可能的实现方式中,所述根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,包括:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个初始路径;
根据最大曲率约束条件从所述初始路径中筛选出至少一个优化路径。
在一种可能的实现方式中,所述路径评估函数包括路径长度评估函数、障碍物距离评估函数和/或弧段数量评估函数。
在一种可能的实现方式中,所述根据预设的路径评估函数计算每个优化路径对应的路径评分之后,所述方法还包括:
若不存在路径评分达到预设值的优化路径,获取新的起始点和新的目标点,重新进行路径规划。
第二方面,本申请实施例提供了一种路径规划装置,包括:
获取模块,用于获取起始点、目标点以及障碍物信息;
确定模块,用于根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间;
规划模块,用于对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径;
计算模块,用于根据预设的路径评估函数计算每个优化路径对应的路径评分;
判断模块,用于若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
在一种可能的实现方式中,所述障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件;所述确定模块具体用于:
根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向;
根据所述障碍物的距离约束条件以及所述每个初始路径点的方向,从所述初始路径点中筛选出至少一个有效路径点。
在一种可能的实现方式中,所述规划模块具体用于:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个优化路径;其中,所述优化路径由至少两个弧段依次连接所得到,相邻的两个弧段相切;所述路径约束条件为:若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧。
在一种可能的实现方式中,所述圆弧计算公式为:
其中,li表示第i个有效路径点到对应圆弧的圆心的距离,n表示有效路径点的数量,m表示第i个有效路径点与目标点之间的有效路径点的数量,r1和r2分别表示形成所述弧段的双圆弧中每个圆弧的半径,当f取最小值时,所对应的半径为所述最优双圆弧中每个圆弧的半径。
在一种可能的实现方式中,所述规划模块具体还用于:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个初始路径;
根据最大曲率约束条件从所述初始路径中筛选出至少一个优化路径。
在一种可能的实现方式中,所述路径评估函数包括路径长度评估函数、障碍物距离评估函数和/或弧段数量评估函数。
在一种可能的实现方式中,所述判断模块还用于:
若不存在路径评分达到预设值的优化路径,获取新的起始点和新的目标点,重新进行路径规划。
第三方面,本申请实施例提供了一种电子设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上述第一方面所述的路径规划方法。
第四方面,本申请实施例提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现如上述第一方面所述的路径规划方法。
第五方面,本申请实施例提供了一种计算机程序产品,当计算机程序产品在电子设备上运行时,使得电子设备执行如上述第一方面所述的路径规划方法。
本申请实施例与现有技术相比存在的有益效果是:通过获取起始点、目标点以及障碍物信息,根据起始点、目标点以及障碍物信息确定至少一个有效路径点,其中,有效路径点位于起始点和所述目标点之间;对至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,优化路径为连接起始点和目标点的路径;根据预设的路径评估函数计算每个优化路径对应的路径评分;若存在路径评分达到预设值的优化路径,将路径评分达到预设值的优化路径作为规划路径。由于有效路径点是根据障碍物信息确定的,因此能够保证有效路径点具有较好的避障效果,此外,再根据有效路径点规划出优化路径,扩大路径选择范围,最后根据路径评估函数对优化路径进行评分,从而从多个方面对路径进行约束,以得到更优的规划路径。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍。
图1是本申请实施例提供的路径规划方法的流程示意图;
图2是本申请实施例提供的路径规划区域的示意图;
图3是本申请实施例提供的路径规划方法的子步骤的流程示意图;
图4是本申请实施例提供的一种筛选有效路径点的方法示意图;
图5是本申请实施例提供的另一种筛选有效路径点的方法示意图;
图6是本申请实施例提供的等曲率双圆弧示意图;
图7是本申请实施例提供的最优双圆弧示意图;
图8是本申请实施例提供的优化路径的示意图;
图9是本申请实施例提供的规划路径的示意图;
图10是本申请实施例提供的路径规划装置示意图;
图11是本申请实施例提供的电子设备的示意图。
具体实施方式
以下描述中,为了说明而不是为了限定,提出了诸如特定系统结构、技术之类的具体细节,以便透彻理解本申请实施例。然而,本领域的技术人员应当清楚,在没有这些具体细节的其它实施例中也可以实现本申请。在其它情况中,省略对众所周知的系统、装置、电路以及方法的详细说明,以免不必要的细节妨碍本申请的描述。
应当理解,当在本申请说明书和所附权利要求书中使用时,术语“包括”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
还应当理解,在本申请说明书和所附权利要求书中使用的术语“和/或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
如在本申请说明书和所附权利要求书中所使用的那样,术语“如果”可以依据上下文被解释为“当...时”或“一旦”或“响应于确定”或“响应于检测到”。类似地,短语“如果确定”或“如果检测到[所描述条件或事件]”可以依据上下文被解释为意指“一旦确定”或“响应于确定”或“一旦检测到[所描述条件或事件]”或“响应于检测到[所描述条件或事件]”。
在本申请说明书中描述的参考“一个实施例”或“一些实施例”等意味着在本申请的一个或多个实施例中包括结合该实施例描述的特定特征、结构或特点。由此,在本说明书中的不同之处出现的语句“在一个实施例中”、“在一些实施例中”、“在其他一些实施例中”、“在另外一些实施例中”等不是必然都参考相同的实施例,而是意味着“一个或多个但不是所有的实施例”,除非是以其他方式另外特别强调。术语“包括”、“包含”、“具有”及它们的变形都意味着“包括但不限于”,除非是以其他方式另外特别强调。
本申请实施例提供的路径规划方法应用于电子设备,电子设备可以是电脑、医疗器械、可穿戴设备等,本申请实施例对电子设备的具体类型不作任何限制。
图1为本申请一实施例提供的路径规划方法的流程示意图,如图1所示,本申请一实施例提供的路径规划方法包括:
S101:获取起始点、目标点以及障碍物信息。
其中,起始点和目标点分别为需要进行路径规划的区域的两个坐标点,障碍物位于起始点和目标点之间。例如,在柔性针进行器官穿刺之前,需要对柔性针的穿刺路径进行路径规划。如图2所示,通过医疗图像获取待穿刺区域各个器官的图像和尺寸,起始点A为柔性针的入针点,目标点B为穿刺路径的终点,障碍物C为起始点和目标点之间的各个组织和器官。障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件。其中,障碍物的影响范围是根据障碍物的大小、障碍物距离起始点的距离以及障碍物距离目标点的距离而设定的,障碍物的距离约束条件为路径与障碍物之间的最小距离。
S102:根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间。
具体的,在起始点和目标点之间选定至少一个有效路径点,该有效路径点满足障碍物的距离约束条件。
在一种可能的实现方式中,如图3所示,S102包括S201和S202。
S201:根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向。
其中,人工势能场算法是将目标点以及障碍物对路径点的影响设计成力的形式的算法。对于当前路径点,受到目标点的吸引力,受到障碍物的排斥力。吸引力的大小根据当前路径点距离目标点的距离而设定,吸引力的方向根据当前路径点与目标点的相对位置而设定,排斥力的大小根据当前路径点距离障碍物的距离而设定,排斥力的方向根据当前路径点与障碍物的相对位置而设定。
如图2所示,根据当前路径点受到的吸引力和排斥力,可以计算出当前路径点受到的合力,将合力的方向作为当前路径点的方向,根据当前路径点的方向和预设的步距,可以计算出下一个路径点的位置,再根据下一个路径点受到的合力计算下一个路径点的方向,依次类推,得到一系列路径点及其对应的方向,即初始路径点以及与每个初始路径点对应的方向。
S202:根据所述障碍物的距离约束条件以及所述每个初始路径点的方向,从所述初始路径点中筛选出至少一个有效路径点。
具体地,计算每个初始路径点与障碍物的距离,如图4所示,若初始路径点与障碍物的距离不满足距离约束条件,即初始路径点与障碍物的距离小于路径与障碍物的最小距离,则删除该初始路径点,即删除圆圈内的初始路径点,从而避免在路径规划过程中对障碍物造成的影响。如图5所示,根据每个初始路径点的方向计算每相邻两个初始路径点之间的夹角,若相邻两个初始路径点之间的夹角大于或者等于90°,删除该初始路径点,从而避免在路径规划过程中出现局部震荡。删除不满足条件的初始路径点后,得到有效路径点。
S103:对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径。
具体地,依次连接两个相邻的有效路径点或者非相邻的有效路径点,得到优化路径。
在一种可能的实现方式中,优化路径是由至少两个弧段依次连接所得到,相邻的两个弧段相切,以得到平滑的规划路径,提高实际穿刺过程中的穿刺精度。在弧段生成过程中,设定路径约束条件,根据路径约束条件和有效路径点进行路径规划。其中,路径约束条件为:若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧。
例如,如图6所示,为两个相邻的有效路径点,弧段为双圆弧,即该弧段是由圆弧P和圆弧Q连接而成的,圆弧P和圆弧Q的曲率相等,即半径相等,得到的弧段即为等曲率双圆弧。
如图7所示,为两个非相邻的有效路径点,弧段为双圆弧,即该弧段是由圆弧S和圆弧T连接而成的,圆弧S和圆弧T的半径由预设圆弧公式计算出,得到最优双圆弧。在一种可能的实现方式中,圆弧计算公式为:
其中,li表示第i个有效路径点到对应圆弧的圆心的距离,n表示有效路径点的数量,m表示第i个有效路径点与目标点之间的有效路径点的数量,r1和r2分别表示形成所述弧段的双圆弧中每个圆弧的半径,当f取最小值时,所对应的半径为所述最优双圆弧中每个圆弧的半径,即圆弧S和圆弧T的半径。
如图8所示,将每个有效路径点分别按照等曲率双圆弧和最优双圆弧的连接方式进行连接,任意组合后形成多条初始路径,从而增大规划路径的选择范围。再结合实际穿刺过程,设定最大曲率约束条件,将不满足最大曲率约束条件的弧段删除,从而得到至少一个优化路径。
S104:根据预设的路径评估函数计算每个优化路径对应的路径评分。
在一种可能的实现方式中,路径评估函数包括路径长度评估函数、障碍物距离评估函数和/或弧段数量评估函数。示例性地,路径评估函数为
F=ω1Fl+ω2Fd+ω3Fn,
其中,Fl表示长度评估函数,Fd表示障碍物评估函数,Fn表示弧段数量评估函数,ω1、ω2、ω3分别表示长度评估函数、障碍物距离评估函数和弧段数量评估函数的系数,ω1、ω2、ω3的和可以为1,根据路径规划的实际需要分别设置各个系数,得到路径评估函数,计算出每个优化路径对应的路径评分,从而可以在路径规划过程中综合考虑路径长度、障碍物距离和弧段数量,规划出更优的路径。
例如,在根据规划路径进行器官穿刺中,路径长度越长,对组织和器官的伤害越大,障碍物距离越近,穿刺危险性越高,弧段数越多,穿刺精度越低,根据实际的穿刺部位调整各个系数,得到路径评估函数,计算出每个优化路径对应的路径评分。
S105:若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
具体的,如图9所示,取路径评分最高的优化路径,若该路径评分大于或者等于预设值,则将该优化路径作为最终的规划路径。
S106:若不存在路径评分达到预设值的优化路径,获取新的起始点和新的目标点,重新进行路径规划。
具体地,若不存在路径评分达到预设值的优化路径,重新设定起始点和目标点,按照S101-S105的方法重新进行路径规划。
在一种可能的实现方式中,在需要进行路径规划的区域,对可以设为起始点的区域进行离散化处理,得到离散化后的多个起始点,对每个起始点均按照S101-S104的方法进行路径规划,将路径评分最高的优化路径作为最终的规划路径。
上述实施例中,通过获取起始点、目标点以及障碍物信息,根据起始点、目标点以及障碍物信息确定至少一个有效路径点,其中,有效路径点位于起始点和所述目标点之间;对至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,优化路径为连接起始点和目标点的路径;根据预设的路径评估函数计算每个优化路径对应的路径评分;若存在路径评分达到预设值的优化路径,将路径评分达到预设值的优化路径作为规划路径。由于有效路径点是根据障碍物信息确定的,因此能够保证有效路径点具有较好的避障效果,此外,再根据有效路径点规划出优化路径,扩大路径选择范围,最后根据路径评估函数对优化路径进行评分,从而从多个方面对路径进行约束,以得到更优的规划路径。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本申请实施例的实施过程构成任何限定。
对应于上文实施例所述的路径规划方法,图10示出了本申请实施例提供的路径规划装置的结构框图,为了便于说明,仅示出了与本申请实施例相关的部分。
参照图10,该路径规划装置包括,
获取模块10,用于获取起始点、目标点以及障碍物信息;
确定模块20,用于根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间;
规划模块30,用于对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径;
计算模块40,用于根据预设的路径评估函数计算每个优化路径对应的路径评分;
判断模块50,用于若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
在一种可能的实现方式中,所述障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件;所述确定模块20具体用于:
根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向;
根据所述障碍物的距离约束条件以及所述每个初始路径点的方向,从所述初始路径点中筛选出至少一个有效路径点。
在一种可能的实现方式中,所述规划模块30具体用于:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个优化路径;其中,所述优化路径由至少两个弧段依次连接所得到,相邻的两个弧段相切;所述路径约束条件为:若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧。
在一种可能的实现方式中,所述圆弧计算公式为:
其中,li表示第i个有效路径点到对应圆弧的圆心的距离,n表示有效路径点的数量,m表示第i个有效路径点与目标点之间的有效路径点的数量,r1和r2分别表示形成所述弧段的双圆弧中每个圆弧的半径,当f取最小值时,所对应的半径为所述最优双圆弧中每个圆弧的半径。
在一种可能的实现方式中,所述规划模块30具体还用于:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个初始路径;
根据最大曲率约束条件从所述初始路径中筛选出至少一个优化路径。
在一种可能的实现方式中,所述路径评估函数包括路径长度评估函数、障碍物距离评估函数和/或弧段数量评估函数。
在一种可能的实现方式中,所述判断模块50还用于:
若不存在路径评分达到预设值的优化路径,获取新的起始点和新的目标点,重新进行路径规划。
需要说明的是,上述装置/单元之间的信息交互、执行过程等内容,由于与本申请方法实施例基于同一构思,其具体功能及带来的技术效果,具体可参见方法实施例部分,此处不再赘述。
图11是本申请实施例提供的电子设备的示意图。如图11所示,该实施例的电子设备包括:处理器11、存储器12以及存储在所述存储器12中并可在所述处理器11上运行的计算机程序13。所述处理器11执行所述计算机程序13时实现上述路径规划方法实施例中的步骤,例如图1所示的步骤S101至S106。或者,所述处理器11执行所述计算机程序13时实现上述各装置实施例中各模块/单元的功能,例如图10所示模块10至50的功能。
示例性的,所述计算机程序13可以被分割成一个或多个模块/单元,所述一个或者多个模块/单元被存储在所述存储器12中,并由所述处理器11执行,以完成本申请。所述一个或多个模块/单元可以是能够完成特定功能的一系列计算机程序指令段,该指令段用于描述所述计算机程序13在所述电子设备中的执行过程。
本领域技术人员可以理解,图10仅仅是电子设备的示例,并不构成对电子设备的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件,例如所述电子设备还可以包括输入输出设备、网络接入设备、总线等。
所述处理器11可以是中央处理单元(Central Processing Unit,CPU),还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific Integrated Circuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
所述存储器12可以是所述电子设备的内部存储单元,例如电子设备的硬盘或内存。所述存储器12也可以是所述电子设备的外部存储设备,例如所述电子设备上配备的插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。进一步地,所述存储器12还可以既包括所述电子设备的内部存储单元也包括外部存储设备。所述存储器12用于存储所述计算机程序以及所述电子设备所需的其他程序和数据。所述存储器12还可以用于暂时地存储已经输出或者将要输出的数据。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。实施例中的各功能单元、模块可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中,上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。另外,各功能单元、模块的具体名称也只是为了便于相互区分,并不用于限制本申请的保护范围。上述系统中单元、模块的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述或记载的部分,可以参见其它实施例的相关描述。
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的范围。
在本申请所提供的实施例中,应该理解到,所揭露的装置/电子设备和方法,可以通过其它的方式实现。例如,以上所描述的装置/电子设备实施例仅仅是示意性的,例如,所述模块或单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通讯连接可以是通过一些接口,装置或单元的间接耦合或通讯连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
集成的模块/单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请实现上述实施例方法中的全部或部分流程,也可以通过计算机程序来指令相关的硬件来完成,所述的计算机程序可存储于一计算机可读存储介质中,该计算机程序在被处理器执行时,可实现上述各个方法实施例的步骤。其中,所述计算机程序包括计算机程序代码,所述计算机程序代码可以为源代码形式、对象代码形式、可执行文件或某些中间形式等。所述计算机可读介质可以包括:能够携带所述计算机程序代码的任何实体或装置、记录介质、U盘、移动硬盘、磁碟、光盘、计算机存储器、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,RandomAccess Memory)、电载波信号、电信信号以及软件分发介质等。
以上所述实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围,均应包含在本申请的保护范围之内。
Claims (8)
1.一种路径规划方法,其特征在于,包括:
获取起始点、目标点以及障碍物信息;
根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间;所述障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件;所述根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,包括:
根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向;
删除不满足条件的初始路径点,得到至少一个有效路径点,所述不满足条件的初始路径点包括与障碍物的距离不满足距离约束条件的初始路径点,以及与相邻初始路径点之间的夹角大于或等于90°的初始路径点;
对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径;所述对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,包括:连接两个相邻的有效路径点或者非相邻的有效路径点,得到一个弧段;所述优化路径由至少两个弧段依次连接所得到,相邻的两个弧段相切;若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧;
根据预设的路径评估函数计算每个优化路径对应的路径评分;
若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
3.如权利要求1所述的路径规划方法,其特征在于,所述对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,还包括:
根据路径约束条件对所述至少一个有效路径点进行路径规划,得到至少一个初始路径;
根据最大曲率约束条件从所述初始路径中筛选出至少一个优化路径。
4.如权利要求1所述的路径规划方法,其特征在于,所述路径评估函数包括路径长度评估函数、障碍物距离评估函数和/或弧段数量评估函数。
5.如权利要求1所述的路径规划方法,其特征在于,所述根据预设的路径评估函数计算每个优化路径对应的路径评分之后,所述方法还包括:
若不存在路径评分达到预设值的优化路径,获取新的起始点和新的目标点,重新进行路径规划。
6.一种路径规划装置,其特征在于,包括:
获取模块,用于获取起始点、目标点以及障碍物信息;
确定模块,用于根据所述起始点、所述目标点以及所述障碍物信息确定至少一个有效路径点,其中,所述有效路径点位于所述起始点和所述目标点之间;所述障碍物信息包括障碍物的影响范围以及障碍物的距离约束条件;所述确定模块具体用于:根据人工势能场算法、所述起始点、所述目标点、所述障碍物的影响范围以及预设的步距,确定至少一个初始路径点以及每个初始路径点的方向;
删除不满足条件的初始路径点,得到至少一个有效路径点,所述不满足条件的初始路径点包括与障碍物的距离不满足距离约束条件的初始路径点,以及与相邻初始路径点之间的夹角大于或等于90°的初始路径点;
规划模块,用于对所述至少一个有效路径点进行路径规划,得到至少一个优化路径,其中,所述优化路径为连接所述起始点和所述目标点的路径;所述规划模块具体用于:连接两个相邻的有效路径点或者非相邻的有效路径点,得到一个弧段;所述优化路径由至少两个弧段依次连接所得到,相邻的两个弧段相切;若所述弧段是由相邻的两个有效路径点连接形成的,所述弧段为等曲率双圆弧;若所述弧段是由非相邻的两个有效路径点连接形成的,所述弧段为根据预设的圆弧计算公式得到的最优双圆弧;
计算模块,用于根据预设的路径评估函数计算每个优化路径对应的路径评分;
判断模块,用于若存在路径评分达到预设值的优化路径,将所述路径评分达到预设值的优化路径作为规划路径。
7.一种电子设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至5任一项所述的方法。
8.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至5任一项所述的方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010185234.3A CN111428919B (zh) | 2020-03-17 | 2020-03-17 | 路径规划方法、装置、电子设备及存储介质 |
PCT/CN2020/129198 WO2021184793A1 (zh) | 2020-03-17 | 2020-11-16 | 路径规划方法、装置、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010185234.3A CN111428919B (zh) | 2020-03-17 | 2020-03-17 | 路径规划方法、装置、电子设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111428919A CN111428919A (zh) | 2020-07-17 |
CN111428919B true CN111428919B (zh) | 2022-07-19 |
Family
ID=71547974
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010185234.3A Active CN111428919B (zh) | 2020-03-17 | 2020-03-17 | 路径规划方法、装置、电子设备及存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN111428919B (zh) |
WO (1) | WO2021184793A1 (zh) |
Families Citing this family (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111428919B (zh) * | 2020-03-17 | 2022-07-19 | 深圳先进技术研究院 | 路径规划方法、装置、电子设备及存储介质 |
CN112033426B (zh) * | 2020-08-05 | 2022-06-28 | 东软睿驰汽车技术(沈阳)有限公司 | 行驶路径规划方法、装置及电子设备 |
CN111982143B (zh) * | 2020-08-11 | 2024-01-19 | 北京汽车研究总院有限公司 | 车辆及车辆路径规划方法、装置 |
CN114442674A (zh) * | 2020-11-04 | 2022-05-06 | 北京猎户星空科技有限公司 | 目标跟踪方法、装置、电子设备和计算机可读存储介质 |
CN113124891B (zh) * | 2021-04-20 | 2023-05-16 | 东软睿驰汽车技术(沈阳)有限公司 | 一种行驶路径规划方法及相关装置 |
CN113111146A (zh) * | 2021-04-20 | 2021-07-13 | 杭州壹悟科技有限公司 | Agv路线优化方法、系统及装置 |
CN113534818B (zh) * | 2021-08-24 | 2023-09-26 | 珠海格力电器股份有限公司 | 路径导航规划方法、装置、存储介质及电子设备 |
CN113759905A (zh) * | 2021-08-30 | 2021-12-07 | 北京盈迪曼德科技有限公司 | 机器人路径规划方法、装置及机器人 |
CN113873610B (zh) * | 2021-09-08 | 2023-07-14 | 广州杰赛科技股份有限公司 | 一种无线信息传输的路径规划方法、装置、设备及介质 |
CN114010310B (zh) * | 2021-09-15 | 2023-10-13 | 苏州中科华影健康科技有限公司 | 一种路径规划方法、装置、电子设备及存储介质 |
CN113570174B (zh) * | 2021-09-26 | 2022-01-18 | 南京信息工程大学 | 一种气象灾害避灾路线规划方法 |
CN114047757B (zh) * | 2021-11-05 | 2023-05-19 | 季华实验室 | 一种多agv路径评估规划方法 |
CN113985892B (zh) * | 2021-11-17 | 2023-09-22 | 江苏科技大学 | 一种基于改进a*算法的智能船舶路径规划方法 |
CN114117574B (zh) * | 2021-11-25 | 2023-06-20 | 北京力控元通科技有限公司 | 基于图纸的路线生成方法、装置、电子设备及存储介质 |
CN114500900A (zh) * | 2022-02-24 | 2022-05-13 | 北京云迹科技股份有限公司 | 丢失对象的寻找方法及装置 |
CN115302357B (zh) * | 2022-08-05 | 2023-05-16 | 中国人民解放军空军工程大学航空机务士官学校 | 一种基于评价函数的螺旋抛光路径规划方法 |
CN116485100B (zh) * | 2023-03-03 | 2023-12-29 | 深圳市城市规划设计研究院股份有限公司 | 智能杆规划方法、智能杆规划系统、设备及存储介质 |
CN116151036B (zh) * | 2023-04-17 | 2023-07-07 | 中铁九局集团有限公司 | 一种钢筋自动绑扎的路径规划方法及装置 |
CN116807611A (zh) * | 2023-05-24 | 2023-09-29 | 安徽医科大学 | 一种基于差分进化算法的柔性穿刺针路径规划方法 |
CN116560297B (zh) * | 2023-06-13 | 2023-11-10 | 苏州翰泽精密机械有限公司 | 一种金属制品的切削走刀路径规划系统及方法 |
CN117084790B (zh) * | 2023-10-19 | 2024-01-02 | 苏州恒瑞宏远医疗科技有限公司 | 一种穿刺方位控制方法、装置、计算机设备、存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08153085A (ja) * | 1994-11-28 | 1996-06-11 | Ricoh Co Ltd | 配送計画問題の最適解探索方法及びその装置 |
CN103761589A (zh) * | 2014-02-18 | 2014-04-30 | 东南大学 | 一种城市轨道交通清分方法 |
CN106021935A (zh) * | 2016-05-24 | 2016-10-12 | 深圳先进技术研究院 | 一种柔性针穿刺路径评估方法及系统 |
CN106650298A (zh) * | 2017-01-11 | 2017-05-10 | 湘潭大学 | 基于环境特征和随机方法的柔性针路径规划方法 |
CN107228668A (zh) * | 2017-05-17 | 2017-10-03 | 桂林电子科技大学 | 一种基于规则网格dem数据的路径规划新方法 |
CN109828564A (zh) * | 2019-01-28 | 2019-05-31 | 广州杰赛科技股份有限公司 | 一种无人驾驶汽车路径规划的优化方法、装置及终端设备 |
CN110471441A (zh) * | 2019-08-12 | 2019-11-19 | 南京理工大学 | 一种基于激光探测的四旋翼无人机避障方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8663130B2 (en) * | 2008-05-28 | 2014-03-04 | Technion Researh & Development Foundation Ltd. | Ultrasound guided robot for flexible needle steering |
DE102008063377A1 (de) * | 2008-12-30 | 2010-07-01 | Deutsche Post Ag | Verfahren zur Planung der Fahrtroute eines Transportfahrzeugs, Transportfahrzeug |
CN109976148B (zh) * | 2017-12-28 | 2022-02-22 | 深圳市优必选科技有限公司 | 机器人运动路径规划方法、装置、存储介质及终端设备 |
CN111428919B (zh) * | 2020-03-17 | 2022-07-19 | 深圳先进技术研究院 | 路径规划方法、装置、电子设备及存储介质 |
-
2020
- 2020-03-17 CN CN202010185234.3A patent/CN111428919B/zh active Active
- 2020-11-16 WO PCT/CN2020/129198 patent/WO2021184793A1/zh active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08153085A (ja) * | 1994-11-28 | 1996-06-11 | Ricoh Co Ltd | 配送計画問題の最適解探索方法及びその装置 |
CN103761589A (zh) * | 2014-02-18 | 2014-04-30 | 东南大学 | 一种城市轨道交通清分方法 |
CN106021935A (zh) * | 2016-05-24 | 2016-10-12 | 深圳先进技术研究院 | 一种柔性针穿刺路径评估方法及系统 |
CN106650298A (zh) * | 2017-01-11 | 2017-05-10 | 湘潭大学 | 基于环境特征和随机方法的柔性针路径规划方法 |
CN107228668A (zh) * | 2017-05-17 | 2017-10-03 | 桂林电子科技大学 | 一种基于规则网格dem数据的路径规划新方法 |
CN109828564A (zh) * | 2019-01-28 | 2019-05-31 | 广州杰赛科技股份有限公司 | 一种无人驾驶汽车路径规划的优化方法、装置及终端设备 |
CN110471441A (zh) * | 2019-08-12 | 2019-11-19 | 南京理工大学 | 一种基于激光探测的四旋翼无人机避障方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111428919A (zh) | 2020-07-17 |
WO2021184793A1 (zh) | 2021-09-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111428919B (zh) | 路径规划方法、装置、电子设备及存储介质 | |
CN108645411B (zh) | 基于粒子群算法的机器人路径规划方法、装置及终端设备 | |
CN110471409B (zh) | 机器人巡检方法、装置、计算机可读存储介质及机器人 | |
JP5034941B2 (ja) | コンピュータ読み出し可能媒体、システム及び方法 | |
EP2120169A1 (en) | Route curve generation system. method and program | |
CN110598714B (zh) | 一种软骨图像分割方法、装置、可读存储介质及终端设备 | |
CN112936301B (zh) | 一种机器人手眼标定方法、装置、可读存储介质及机器人 | |
CN111857037B (zh) | 一种过渡轨迹的生成方法、机器人及计算机可读存储介质 | |
CN112382359B (zh) | 患者注册方法、装置、电子设备及计算机可读介质 | |
CN109543909A (zh) | 车辆案件数量的预测方法、装置和计算机设备 | |
CN110967019A (zh) | 一种规划机器人局部路径的方法及机器人 | |
Delillo et al. | Numerical computation of the Schwarz–Christoffel transformation for multiply connected domains | |
CN113110423A (zh) | 步态轨迹规划方法、装置、计算机可读存储介质及机器人 | |
CN113033343B (zh) | 数据处理方法、装置、电子设备及计算机可读存储介质 | |
CN111272182B (zh) | 采用区块链数据库的地图绘制系统 | |
CN113459088A (zh) | 地图调整方法、电子设备及存储介质 | |
CN113119114B (zh) | 一种机械臂运动规划方法、装置、可读存储介质及机械臂 | |
CN113262048B (zh) | 空间配准方法、装置、终端设备及术中导航系统 | |
CN111368860A (zh) | 重定位方法及终端设备 | |
US20220015844A1 (en) | Kinematics of wristed laparoscopic instruments | |
EP3309660A1 (en) | Method for detecting input device, and detection device | |
CN108629219A (zh) | 一种识别一维码的方法及装置 | |
CN110070479B (zh) | 图像变形拖拽点定位方法和装置 | |
CN108572939B (zh) | Vi-slam的优化方法、装置、设备及计算机可读介质 | |
CN113805578A (zh) | 无人车路径优化方法及相关设备 |
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 |