CN111906765B - 应用于路径规划的空间采样方法、装置、设备及介质 - Google Patents

应用于路径规划的空间采样方法、装置、设备及介质 Download PDF

Info

Publication number
CN111906765B
CN111906765B CN202010763143.3A CN202010763143A CN111906765B CN 111906765 B CN111906765 B CN 111906765B CN 202010763143 A CN202010763143 A CN 202010763143A CN 111906765 B CN111906765 B CN 111906765B
Authority
CN
China
Prior art keywords
sampling
point set
strategy
state space
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.)
Active
Application number
CN202010763143.3A
Other languages
English (en)
Other versions
CN111906765A (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.)
Ping An Technology Shenzhen Co Ltd
Original Assignee
Ping An Technology Shenzhen Co Ltd
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 Ping An Technology Shenzhen Co Ltd filed Critical Ping An Technology Shenzhen Co Ltd
Priority to CN202010763143.3A priority Critical patent/CN111906765B/zh
Priority to PCT/CN2020/120756 priority patent/WO2021164277A1/zh
Publication of CN111906765A publication Critical patent/CN111906765A/zh
Application granted granted Critical
Publication of CN111906765B publication Critical patent/CN111906765B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/08Programme-controlled manipulators characterised by modular constructions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10Complex mathematical operations
    • G06F17/18Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Data Mining & Analysis (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • General Physics & Mathematics (AREA)
  • Mathematical Optimization (AREA)
  • Theoretical Computer Science (AREA)
  • Computational Mathematics (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Physics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Probability & Statistics with Applications (AREA)
  • Operations Research (AREA)
  • Algebra (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Evolutionary Biology (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Complex Calculations (AREA)

Abstract

本发明涉及人工智能领域,公开了一种应用于路径规划的空间采样方法、装置、设备及介质,其方法包括:通过预采样方法确定状态空间S的有效点集SG,有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略。本发明在多状态空间、多约束条件的情况下,可以提高路径规划的处理效率,减少采样耗时。本发明可适用于智慧交通领域,从而推动智慧城市的建设。

Description

应用于路径规划的空间采样方法、装置、设备及介质
技术领域
本发明涉及人工智能领域,尤其涉及一种应用于路径规划的空间采样方法、装置、设备及介质。
背景技术
近年来,路径规划方法的研究日益渐增。路径规划算法广泛应用于各个运动控制领域,如机械臂、智能驾驶、无人机等。其中,基于随机采样的路径规划方法是其中的研究热点。基于随机采样的路径规划方法指的是对状态空间(解空间)进行采样从而建立路标或路径分支的方法。该方法具有概率完备性,即,如果在起点和终点之间存在解,只要采样点数量足够多,就一定可以生成可行路径。
目前,依据采样点生成路径的算法较多,诸如RRT(快速扩展随机树算法)、PRM(概率路线图算法)、KPIECE(一种基于决策树采样的运动规划算法)等。这些算法侧重于路径规划,并未涉及采样策略的改进。对于一些环境复杂的状态空间(如多状态空间、多约束条件等),生成采样点耗时长,甚至难以生成采样点,影响路径规划的耗时。
发明内容
基于此,有必要针对上述技术问题,提供一种应用于路径规划的空间采样方法、装置、设备及介质,以解决在环境复杂的状态空间下,路径规划采样困难,耗时长的问题。
一种应用于路径规划的空间采样方法,包括:
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
按照所述执行策略进行采样。
一种应用于路径规划的空间采样装置,包括:
预采样模块,用于通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;
随机选取策略模块,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
采样模块,用于按照所述执行策略进行采样。
一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,所述处理器执行所述计算机可读指令时实现上述应用于路径规划的空间采样方法。
一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可读指令,所述计算机可读指令被处理器执行时实现上述应用于路径规划的空间采样方法。
上述应用于路径规划的空间采样方法、装置、计算机设备及存储介质,通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内,以划分出路径规划的可行点集。根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样,以提供不同的采样策略,提高采样的灵活性。按照所述执行策略进行采样,以完成采集任务。本发明使用预采样和实时采样(即采用执行策略进行采样),可以提高采样成功率,减少反复采样,解决了路径规划在多状态空间、多约束条件的情况下求解效率低或无解的问题,大大提高了路径规划的处理效率,减少采样耗时。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例的描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一实施例中应用于路径规划的空间采样方法的一应用环境示意图;
图2是本发明一实施例中应用于路径规划的空间采样方法的一流程示意图;
图3是一示例中6关节机械臂可行末端空间路径与轴空间路径进行变换的示意图;
图4是本发明一实施例中应用于路径规划的空间采样方法的一流程示意图;
图5是一示例中状态空间S中的点集SLP映射到状态空间Q时的示意图;
图6是本发明一实施例中应用于路径规划的空间采样方法的一流程示意图;
图7是一示例中状态空间Q中的点集QLT映射到状态空间S时的示意图;
图8是本发明一实施例中应用于路径规划的空间采样方法的一流程示意图;
图9是本发明一实施例中应用于路径规划的空间采样装置的一结构示意图;
图10是本发明一实施例中计算机设备的一示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本方案属于智慧交通领域,通过本方案能够推动智慧城市的建设。本实施例提供的应用于路径规划的空间采样方法,可应用在如图1的应用环境中,其中,客户端与服务端进行通信。其中,客户端包括但不限于各种个人计算机、笔记本电脑、智能手机、平板电脑和便携式可穿戴设备。服务端可以用独立的服务器或者是多个服务器组成的服务器集群来实现。
在一实施例中,如图2所示,提供一种应用于路径规划的空间采样方法,以该方法应用在图1中的服务端为例进行说明,包括如下步骤:
S10、通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内。
本实施例中,状态空间S与状态空间Q为不同的状态空间。在一示例中,机械臂的路径通常在末端空间S∈SE(3)或者轴空间Q∈Rn(n为关节数)中规划。在此处,状态空间S为末端空间,状态空间Q为轴空间。状态空间S中的点均可以在状态空间Q中找到对应的点,即状态空间S中的点与状态空间Q中对应的点存在映射关系。具体的,从S映射到Q的映射关系为第一映射关系,可表示为:
Figure GDA0003653871450000052
从Q映射到S的映射关系为第二映射关系,可表示为:
Figure GDA0003653871450000051
在本示例中,第一映射关系也可称为逆向运动学变换关系,第二映射关系也可称为正向运动学变换关系。如图3所示,图3为一示例中6关节机械臂可行末端空间路径与轴空间路径进行变换的示意图。6关节机械臂的末端位置由六个关节(即轴)的转动角度决定。其中,第一关节的角度(即图3左侧的1staxis的转动角度)可以映射到右图上方的q1坐标。以此类推。每个第一关节的角度可以映射到对应的轴空间坐标上。
在此处,虽然状态空间S中的点均可以在状态空间Q中找到对应的点,但不同空间的可行区域并不完全重叠。也就是说,状态空间S中可行区域SLP内的点映射到状态空间Q的点并不一定落在状态空间Q的可行区域QL内。预采样方法用于确定映射前和映射后均落在可行区域的点的集合。也就是说,有效点集
Figure GDA0003653871450000061
Figure GDA0003653871450000062
QG为有效点集SG映射到状态空间Q上的点集。有效点集SG即为已验证的空间有效取点,可以在路径规划时确保取样点的有效性,但对空间的随机探索性相对较低。
S20、根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样。
本实施例中,第一采样策略具有最强的随机探索性但对有效性的保障最低。第二采样策略具有最强的有效性,但对空间的随机探索性相对较低.而第三采样策略的性能介于第一采样策略和第二采样策略之间。在一些情况下,指定个数可以是大于3,也即是存在第四采样策略、第五采样策略等。具体的,可以根据实际需要制定相应的第四采样策略、第五采样策略等,在此不再赘述。
预设随机选取规则可以根据实际需要进行制定。在一些情况下,当需要多次采样时,可以只选取其中的一种采样策略作为执行策略。在此处,提供了多种不同的采样策略,大大提高了采样的灵活性。
S30、按照所述执行策略进行采样。
本实施例中,在确定执行策略之后,可以按照执行策略进行采样,完成点的采集。在一次路径规划中,若需要采集的点多于一个,则需要采用相应的执行策略进行采样。这些执行策略可以是相同,也可以是不同。
步骤S10-S30中,通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内,以划分出路径规划的可行点集。根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样,以提供不同的采样策略,提高采样的灵活性。按照所述执行策略进行采样,以完成采集任务。
可选的,请参考图4和5,步骤S10,即所述通过预采样方法确定状态空间S的有效点集SG,包括:
S101、在状态空间S的可行区域SL均匀取样,得到点集SLP
S102、根据所述第一映射关系将所述点集SLP映射到状态空间Q,获得点集QLP
S103、从所述点集QLP中选取处于所述可行区域QL内的点,获得点集QA
S104、在所述点集SLP中选取与所述点集QA对应的点,生成点集SA,所述有效点集SG包括所述点集SA
本实施例中,已知状态空间S,S中的可行区域SL(图5中左侧圆柱部分)以及状态空间Q,Q中的可行区域QL(图5中右侧长方体)。首先,在SL内均匀采样得到点集SLP(如图5中左上侧圆柱的点)。然后通过函数iK把SLP映射到状态空间Q中,得到点集QLP(图5中长方体内的白点和长方体外的黑点)。最后在QLP中筛选出符合QL的点(长方体内的白点),并在SLP找到与其对应的采样点(如图5中左下侧圆柱内颜色较深的点),从而得到状态空间S有效采样的点集SA,则:
SA={p|p∈SLP∧iK(p)∈QL}。
在此处,点集SA为有效点集SG的子集。
可选的,请参考图6和7,步骤S10,即所述通过预采样方法确定状态空间S的有效点集SG,包括:
S105、在状态空间Q的可行区域QL均匀取样,得到点集QLT
S106、根据第二映射关系将所述点集QLT映射到状态空间S,获得点集SLT
S107、从所述点集SLT中选取处于所述可行区域SL内的点,获得点集SQA,所述有效点集SG包括所述点集SQA
本实施例中,首先在QL均匀采样得到点集QLT(如图7长方体内的点)。然后通过函数fK把QLT映射到状态空间S中,得到点集SLT(图7左侧最上方圆柱内的灰点和圆柱外的黑点)。最后在SLT中筛选出符合SL的点(图7左侧最上方圆柱内的灰点),得到点集SQA。即:
SQA={p|p∈QLT∧fK(p)∈SL}。
在此处,点集SQA为有效点集SG的子集。SGQA∪SA。SG即为图7左侧最下方圆柱内的点的集合。
可选的,如图8所示,步骤S20,即所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:
S201、随机生成随机数r,随机数r的取值区间为W;
S202、若随机数r处于第一区间X,则选取第一采样策略作为执行策略;
S203、若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;
S204、若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;
其中,
Figure GDA0003653871450000091
X∪Y∪Z=W。
本实施例中,可以通过随机数生成函数生成随机数r,且r的取值区间为W,即:r=rand(),r∈W。
在一些情况下,若X、Y、Z均为连续区间,由于X∪Y∪Z=W,则在W存在分割点ra、rb,将W分割为区间X、Y、Z。
因而,步骤S20可表示为:
r=rand(),r∈[0,1]
if(r≤ra):
第一采样策略
elseif(ra<r≤rb):
第二采样策略
else:
第三采样策略。
在此处,随机选取采样策略为实时采样阶段。本实施例提供的三种不同采样策略具有不同的特点。第一采样策略具有最强的随机探索性但对有效性的保障最低。第二采样策略具有最强的有效性,但对空间的随机探索性相对较低.而第三采样策略的性能介于第一采样策略和第二采样策略之间。使用时可依据实际情况调整执行比例,使路径规划采样算法在效率和探索性能之间取得平衡。
可选的,W=[0,1],所述第一区间X为[0,ra),所述第二区间Y为[ra,rb),所述第三区间Z为[rb,1],ra、rb为超参数,且0<ra<rb<1。
本实施例中,随机数r可以选取[0,1]中的任意一个数。ra、rb为超参数,可以根据实际需要设置这两个超参数的值,以调整不同采样策略被选取的概率。
应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
在一实施例中,提供一种应用于路径规划的空间采样装置,该应用于路径规划的空间采样装置与上述实施例中应用于路径规划的空间采样方法一一对应。如图9所示,该应用于路径规划的空间采样装置包括预采样模块10、随机选取策略模块20和采样模块30。各功能模块详细说明如下:
预采样模块10,用于通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;
随机选取策略模块20,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
采样模块30,用于按照所述执行策略进行采样。
可选的,预采样模块10包括:
第一取样单元,用于在状态空间S的可行区域SL均匀取样,得到点集SLP
第一映射单元,用于根据所述第一映射关系将所述点集SLP映射到状态空间Q,获得点集QLP
第一选取单元,用于从所述点集QLP中选取处于所述可行区域QL内的点,获得点集QA
第一生成点集单元,用于在所述点集SLP中选取与所述点集QA对应的点,生成点集SA,所述有效点集SG包括所述点集SA
可选的,预采样模块10包括:
第二取样单元,用于在状态空间Q的可行区域QL均匀取样,得到点集QLT
第二映射单元,用于根据第二映射关系将所述点集QLT映射到状态空间S,获得点集SLT
第二选取单元,用于从所述点集SLT中选取处于所述可行区域SL内的点,获得点集SQA,所述有效点集SG包括所述点集SQA
可选的,随机选取策略模块20包括:
生成随机数单元,用于随机生成随机数r,随机数r的取值区间为W;
第一选取策略单元,用于若随机数r处于第一区间X,则选取第一采样策略作为执行策略;
第二选取策略单元,用于若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;
第三选取策略单元,用于若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;
其中,
Figure GDA0003653871450000111
X∪Y∪Z=W。
可选的,W=[0,1],所述第一区间X为[0,ra),所述第二区间Y为[ra,rb),所述第三区间Z为[rb,1],ra、rb为超参数,且0<ra<rb<1。
关于应用于路径规划的空间采样装置的具体限定可以参见上文中对于应用于路径规划的空间采样方法的限定,在此不再赘述。上述应用于路径规划的空间采样装置中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中,也可以以软件形式存储于计算机设备中的存储器中,以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中,提供了一种计算机设备,该计算机设备可以是服务器,其内部结构图可以如图10所示。该计算机设备包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统、计算机可读指令和数据库。该内存储器为非易失性存储介质中的操作系统和计算机可读指令的运行提供环境。该计算机设备的数据库用于存储上述应用于路径规划的空间采样方法所涉及的数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机可读指令被处理器执行时以实现一种应用于路径规划的空间采样方法。
在一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机可读指令,处理器执行计算机可读指令时实现以下步骤:
通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
按照所述执行策略进行采样。
在一个实施例中,提供了一个或多个存储有计算机可读指令的计算机可读存储介质,本实施例所提供的可读存储介质包括非易失性可读存储介质和易失性可读存储介质。可读存储介质上存储有计算机可读指令,计算机可读指令被一个或多个处理器执行时实现以下步骤:
通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
按照所述执行策略进行采样。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机可读指令来指令相关的硬件来完成,所述的计算机可读指令可存储于一非易失性计算机可读取存储介质中,该计算机可读指令在执行时,可包括如上述各方法的实施例的流程。其中,本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(ROM)、可编程ROM(PROM)、电可编程ROM(EPROM)、电可擦除可编程ROM(EEPROM)或闪存。易失性存储器可包括随机存取存储器(RAM)或者外部高速缓冲存储器。作为说明而非局限,RAM以多种形式可得,诸如静态RAM(SRAM)、动态RAM(DRAM)、同步DRAM(SDRAM)、双数据率SDRAM(DDRSDRAM)、增强型SDRAM(ESDRAM)、同步链路(Synchlink)DRAM(SLDRAM)、存储器总线(Rambus)直接RAM(RDRAM)、直接存储器总线动态RAM(DRDRAM)、以及存储器总线动态RAM(RDRAM)等。
所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。
以上所述实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围,均应包含在本发明的保护范围之内。

Claims (6)

1.一种应用于路径规划的空间采样方法,其特征在于,包括:
通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;所述状态空间S为末端空间,所述状态空间Q为轴空间;所述第一映射关系为逆向运动学变换关系;
根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
按照所述执行策略进行采样;
所述有效点集SG包括点集SA和点集SQA
其中,所述通过预采样方法确定状态空间S的有效点集SG,包括:
在状态空间S的可行区域SL均匀取样,得到点集SLP
根据所述第一映射关系将所述点集SLP映射到状态空间Q,获得点集QLP
从所述点集QLP中选取处于所述可行区域QL内的点,获得点集QA
在所述点集SLP中选取与所述点集QA对应的点,生成所述点集SA
所述通过预采样方法确定状态空间S的有效点集SG,还包括:
在状态空间Q的可行区域QL均匀取样,得到点集QLT
根据第二映射关系将所述点集QLT映射到状态空间S,获得点集SLT;所述第二映射关系为正向运动学变换关系;
从所述点集SLT中选取处于所述可行区域SL内的点,获得所述点集SQA
2.如权利要求1所述的应用于路径规划的空间采样方法,其特征在于,所述根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,包括:
随机生成随机数r,随机数r的取值区间为W;
若随机数r处于第一区间X,则选取第一采样策略作为执行策略;
若随机数r处于第二区间Y,则选取第二采样策略作为执行策略;
若随机数r处于第三区间Z,则选取第三采样策略作为执行策略;
其中,
Figure FDA0003665192690000021
X∪Y∪Z=W。
3.如权利要求2所述的应用于路径规划的空间采样方法,其特征在于,W=[0,1],所述第一区间X为[0,ra),所述第二区间Y为[ra,rb),所述第三区间Z为[rb,1],ra、rb为超参数,且0<ra<rb<1。
4.一种应用于路径规划的空间采样装置,其特征在于,包括:
预采样模块,用于通过预采样方法确定状态空间S的有效点集SG,所述有效点集SG中的任意一点,经第一映射关系映射在状态空间Q的可行区域QL内;所述状态空间S为末端空间,所述状态空间Q为轴空间;所述第一映射关系为逆向运动学变换关系;
随机选取策略模块,用于根据预设随机选取规则在指定个数的采样策略中选取一种采样策略作为执行策略,所述指定个数的采样策略至少包括第一采样策略、第二采样策略和第三采样策略,所述第一采样策略是指在状态空间S的可行区域SL进行采样;第二采样策略是指在所述有效点集SG进行采样;第三采样策略是指先在有效点集SG随机选取点B,再在点B的指定范围内选取属于所述有效点集SG的点C,在点B与点C之间任意一点进行采样;
采样模块,用于按照所述执行策略进行采样;
所述有效点集SG包括点集SA和点集SQA
其中,所述预采样模块包括:
第一取样单元,用于在状态空间S的可行区域SL均匀取样,得到点集SLP
第一映射单元,用于根据所述第一映射关系将所述点集SLP映射到状态空间Q,获得点集QLP
第一选取单元,用于从所述点集QLP中选取处于所述可行区域QL内的点,获得点集QA
第一生成点集单元,用于在所述点集SLP中选取与所述点集QA对应的点,生成点集SA
第二取样单元,用于在状态空间Q的可行区域QL均匀取样,得到点集QLT
第二映射单元,用于根据第二映射关系将所述点集QLT映射到状态空间S,获得点集SLT;所述第二映射关系为正向运动学变换关系;
第二选取单元,用于从所述点集SLT中选取处于所述可行区域SL内的点,获得点集SQA
5.一种计算机设备,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,其特征在于,所述处理器执行所述计算机可读指令时实现如权利要求1至3中任一项所述应用于路径规划的空间采样方法。
6.一个或多个存储有计算机可读指令的可读存储介质,所述计算机可读指令被一个或多个处理器执行时,使得所述一个或多个处理器执行如权利要求1至3中任一项所述应用于路径规划的空间采样方法。
CN202010763143.3A 2020-07-31 2020-07-31 应用于路径规划的空间采样方法、装置、设备及介质 Active CN111906765B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202010763143.3A CN111906765B (zh) 2020-07-31 2020-07-31 应用于路径规划的空间采样方法、装置、设备及介质
PCT/CN2020/120756 WO2021164277A1 (zh) 2020-07-31 2020-10-14 应用于路径规划的空间采样方法、装置、设备及介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010763143.3A CN111906765B (zh) 2020-07-31 2020-07-31 应用于路径规划的空间采样方法、装置、设备及介质

Publications (2)

Publication Number Publication Date
CN111906765A CN111906765A (zh) 2020-11-10
CN111906765B true CN111906765B (zh) 2022-07-12

Family

ID=73287586

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010763143.3A Active CN111906765B (zh) 2020-07-31 2020-07-31 应用于路径规划的空间采样方法、装置、设备及介质

Country Status (2)

Country Link
CN (1) CN111906765B (zh)
WO (1) WO2021164277A1 (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115990875B (zh) * 2022-11-10 2024-05-07 华南理工大学 一种基于隐空间插值的柔性线缆状态预测与控制系统
CN117553820B (zh) * 2024-01-12 2024-04-05 北京理工大学 一种越野环境中路径规划方法、系统及设备

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101144835A (zh) * 2007-10-17 2008-03-19 电子科技大学 一种等效采样装置
CN104155974A (zh) * 2013-07-29 2014-11-19 深圳信息职业技术学院 一种用于机器人快速避碰的路径规划方法及设备
CN105246121A (zh) * 2015-09-30 2016-01-13 西北大学 一种移动sink信息收集路径的可变维粒子群构建方法
CN107677285A (zh) * 2017-04-11 2018-02-09 平安科技(深圳)有限公司 机器人的路径规划系统及方法
CN108582073A (zh) * 2018-05-02 2018-09-28 北京邮电大学 一种基于改进的随机路标地图法的机械臂快速避障方法
CN109521774A (zh) * 2018-12-27 2019-03-26 南京芊玥机器人科技有限公司 一种基于强化学习的喷涂机器人轨迹优化方法
CN110653805A (zh) * 2019-10-10 2020-01-07 西安科技大学 笛卡尔空间下的七自由度冗余机械臂任务约束路径规划方法
CN111340875A (zh) * 2020-02-17 2020-06-26 南京航空航天大学 一种基于三维激光雷达的空间移动目标检测方法

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100941418B1 (ko) * 2007-03-20 2010-02-11 삼성전자주식회사 이동 로봇의 위치 인식 방법
JP2015147256A (ja) * 2014-02-04 2015-08-20 セイコーエプソン株式会社 ロボット、ロボットシステム、制御装置、及び制御方法
CN106569496B (zh) * 2016-11-14 2021-07-23 中国船舶工业集团公司第七0八研究所 一种运动路径的规划方法
US10012988B2 (en) * 2016-11-29 2018-07-03 Mitsubishi Electric Research Laboratories, Inc. Methods and systems for path planning using a network of safe-sets
CN106695802A (zh) * 2017-03-19 2017-05-24 北京工业大学 基于多自由度机械臂的改进式rrt*的避障运动规划方法
CN109887012B (zh) * 2019-01-09 2023-03-31 天津大学 一种结合自适应搜索点集的点云配准方法
CN109807886B (zh) * 2019-01-15 2022-07-26 西北工业大学 一种基于预测的空间非合作目标抓捕策略
CN110986953B (zh) * 2019-12-13 2022-12-06 达闼机器人股份有限公司 路径规划方法、机器人及计算机可读存储介质
CN111251306B (zh) * 2020-03-18 2022-11-29 广东省智能机器人研究院 一种带有底盘误差的机械臂路径规划方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101144835A (zh) * 2007-10-17 2008-03-19 电子科技大学 一种等效采样装置
CN104155974A (zh) * 2013-07-29 2014-11-19 深圳信息职业技术学院 一种用于机器人快速避碰的路径规划方法及设备
CN105246121A (zh) * 2015-09-30 2016-01-13 西北大学 一种移动sink信息收集路径的可变维粒子群构建方法
CN107677285A (zh) * 2017-04-11 2018-02-09 平安科技(深圳)有限公司 机器人的路径规划系统及方法
CN108582073A (zh) * 2018-05-02 2018-09-28 北京邮电大学 一种基于改进的随机路标地图法的机械臂快速避障方法
CN109521774A (zh) * 2018-12-27 2019-03-26 南京芊玥机器人科技有限公司 一种基于强化学习的喷涂机器人轨迹优化方法
CN110653805A (zh) * 2019-10-10 2020-01-07 西安科技大学 笛卡尔空间下的七自由度冗余机械臂任务约束路径规划方法
CN111340875A (zh) * 2020-02-17 2020-06-26 南京航空航天大学 一种基于三维激光雷达的空间移动目标检测方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Ning Chen.An Improved Sampling-Based Approach for Spacecraft Proximity Operation Path Planning in Near-Circular Orbit.《An Improved Sampling-Based Approach for Spacecraft Proximity Operation Path Planning in Near-Circular Orbit》.IEEE,2020, *
王坤.基于改进渐进最优的双向快速扩展随机树的移动机器人路径规划算法.《基于改进渐进最优的双向快速扩展随机树的移动机器人路径规划算法》.计算机应用,2019,第39卷(第5期),第1312-1317页. *
谭建豪.基于改进RRT*FN算法的机器人路径规划.《基于改进RRT*FN算法的机器人路径规划》.控制与决策,2020,第36卷(第8期), *

Also Published As

Publication number Publication date
WO2021164277A1 (zh) 2021-08-26
CN111906765A (zh) 2020-11-10

Similar Documents

Publication Publication Date Title
CN111906765B (zh) 应用于路径规划的空间采样方法、装置、设备及介质
CN113609786B (zh) 一种移动机器人导航方法、装置、计算机设备和存储介质
US20180024966A1 (en) Autonomous memory architecture
WO2023116314A1 (zh) 一种神经网络加速装置、方法、设备和计算机存储介质
US9015440B2 (en) Autonomous memory subsystem architecture
CN111598213B (zh) 网络训练方法、数据识别方法、装置、设备和介质
CN110648279A (zh) 点云数据处理方法、装置、计算机设备和存储介质
CN109931943B (zh) 无人船舶全局路径规划方法及电子设备
CN114092336B (zh) 基于双线性插值算法的图像缩放方法、装置、设备及介质
CN112975954A (zh) 机械臂的控制方法、计算机设备和存储介质
CN110322477B (zh) 特征点观察窗口设置方法、跟踪方法、装置、设备和介质
WO2023019873A1 (zh) 清扫路径的规划
CN113901746B (zh) 一种用于向量代数的硬件加速器的设计方法
CN108009214B (zh) 基于ArcGIS的矢量数据并行处理方法及系统
CN114707641A (zh) 双视角图神经网络模型的训练方法、装置、设备及介质
CN111831356B (zh) 权重精度配置方法、装置、设备及存储介质
CN113934206A (zh) 移动机器人路径规划方法、装置、计算机设备和存储介质
Tuba et al. Water cycle algorithm for robot path planning
CN114463429B (zh) 机器人、地图创建方法、定位方法及介质
CN112393739B (zh) 大面积环境中的改进型快速搜索随机树路径规划方法
CN115437372A (zh) 机器人路径规划方法、装置、电子设备及存储介质
Sun et al. An SOM-based algorithm with locking mechanism for task assignment
CN112683273A (zh) 一种自适应增量建图方法、系统、计算机设备及存储介质
CN113239171A (zh) 对话管理系统更新方法、装置、计算机设备及存储介质
CN111191982A (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