一种自动驾驶路径规划方法、系统及计算机可读存储介质技术方案

本发明专利技术公开了一种自动驾驶路径规划方法、系统及计算机可读存储介质，采用双向随机树和多棵局部随机树的探索与合并。增加引力分量，使双向随机树朝着各自目标方向生长，减少了算法的随机性。基于障碍物周围均匀生成若干根节点，对根节点增加斥力分量，生成多棵局部随机树，快速寻找可通行的路径，减少扩展过程中对障碍物的检测时间，加快算法的收敛速度，改善了算法的偏差性。了算法的偏差性。了算法的偏差性。

【技术实现步骤摘要】
一种自动驾驶路径规划方法、系统及计算机可读存储介质


[0001]本专利技术属于自动驾驶领域，特别涉及了一种自动驾驶路径规划方法。

技术介绍

[0002]轨迹规划(Trajectories Planning)主要指考虑实际临时或者移动障碍物，考虑速度、动力学约束的情况下，尽量按照规划路径进行轨迹规划。轨迹规划的核心就是要解决车辆该怎么走的问题。轨迹规划的输入包括拓扑地图，障碍物及障碍物的预测轨迹，交通信号灯的状态，还有定位导航、车辆状态等其他信息。而轨迹规划的输出就是一个轨迹，轨迹是一个时间到位置的函数，就是在特定的时刻车辆在特定的位置上。轨迹规划的目标是计算出安全、舒适的轨迹供无人驾驶车辆完成预定的行驶任务。
[0003]快速搜索随机树(RRT
‑
Rapidly
‑
ExploringRandom Trees)，是一种常见的用于路径(运动)规划的方法，它本质上是一种随机生成的数据结构—树，这种思想自从LaValle提出以后已经得到了极大的发展，到现在依然有改进的RRT不断地被提出来。
[0004]经过实际应用，发现现有的RRT技术存在如下问题：
[0005](1)随机的生成路径，路径具有偏差性；
[0006](2)随机树在搜索过程中无导向性；
[0007](3)收敛速度迟缓，搜索效率低。

技术实现思路

[0008]为了解决上述
技术介绍
提到的技术问题，本专利技术提出了一种自动驾驶路径规划方法、系统及计算机可读存储介质，将人工势场法中的目标引力思想和障碍物斥力思想入到RRT算法中，改善基于RRT算法路径规划的性能。
[0009]为了实现上述技术目的，本专利技术的技术方案为：
[0010]一种自动驾驶路径规划方法，包括以下步骤：
[0011]确定车辆周围的障碍物位置，在障碍物周围均匀生成若干根节点xp(i)，i＝1,2,
…
，以xp(i)为根节点构建局部随机树Ti；
[0012]在障碍物斥力影响范围内，增加障碍物的斥力分量，引导局部随机树Ti朝着无障碍物的方向扩展；
[0013]分别以起点和终点为根节点，建立双向随机树Ta和Tb；增加终点产生的引力分量，引导随机树Ta朝着终点方向生长；增加起点产生的引力分量，引导随机树Tb朝着起点方向生长；
[0014]随机树Ta或Tb在扩展过程中，若随机树Ta或Tb的新节点与其他随机树的节点距离小于设定的阈值，则合并两棵树，若起点与终点在同一棵树上，结束搜索，返回搜索路径，否则继续搜索。
[0015]进一步地，所述增加引力分量的具体过程如下：
[0016]对双向随机树中的每个节点n都增加一个目标引力函数G(n)，此处的节点n表示由
起点xinit或终点xgoal向外扩展的第n个新节点xnew，表示为：
[0017]F(n)＝R(n)+G(n)
[0018]其中，F(n)表示从节点n到终点xgoal的生长指导函数，R(n)表示从起点到节点n的随机生长函数；所述目标引力函数G(n)：
[0019]G(n)＝ρ
·
k
p
·
(xgoal
‑
xnear)/(‖xgoal
‑
xnear‖)
[0020]其中，ρ为步长，k
p
为引力场系数，xnear为距离随机点xrand最接近的节点，‖*‖表示几何距离；
[0021]根据R(n)＝ρ
·
(xrand
‑
xnear)/(‖xrand
‑
xnear‖)，得：
[0022]F(n)＝ρ
·
(xrand
‑
xnear)/(‖xrand
‑
xnear‖)+ρ
·
k
p
·
(xgoal
‑
xnear)/(‖xgoal
‑
xnear‖)进而得到增加引力分量后新节点xnew的生成式：
[0023]xnew＝xnear+ρ
·
((xrand
‑
xnear)/(‖xrand
‑
xnear‖)+k
p
·
(xgoal
‑
xnear)/(‖xgoal
‑
xnear‖))
[0024]双向随机树的各节点的生长指导函数均为F(n)，使双向随机树在引力分量的作用下在自由空间内朝目标方向搜索生长。
[0025]进一步地，所述增加斥力分量的具体过程如下：
[0026]在对障碍物周围局部随机树中的每个节点n都引入一个障碍物斥力函数T(n)，此处的节点n表示由起点xinit向外扩展的第n个新节点xnew，表示为：
[0027]F(n)＝R(n)+T(n)
[0028]其中，F(n)表示从节点n到终点的生长指导函数，R(n)为从起点到节点n的随机生长函数，所述障碍物斥力函数T(n)：
[0029][0030]其中，ρ为步长，k
rep
为斥力场系数，p(x)表示节点到障碍物的最短距离，p0表示障碍物对节点的影响距离，x
obstacle
表示障碍物位置，xnear为距离随机点xrand最接近的节点；
[0031]根据得：
[0032][0033]其中，‖*‖表示几何距离；
[0034]进而得到增加斥力分量后新节点xnew的生成式：
[0035][0036]以障碍物周围若干节点为根节点的随机树的各节点的生长指导函数均为F(n)，使多向随机树在斥力分量的作用下在自由空间内向远离障碍物的方向搜索生长。
[0037]进一步地，设定搜索循环次数，如果在循环次数内搜索树无法达到终点或目标区域，则路径搜索失败。
[0038]一种自动驾驶路径规划系统，包括处理器和存储器，所述存储器存储有所述处理器的执行指令，所述处理器配置为执行所述执行指令来实现上述自动驾驶路径规划方法。
[0039]一种计算机可读存储介质，用于存储程序，执行所述程序以实现上述自动驾驶路径规划方法。
[0040]采用上述技术方案带来的有益效果：
[0041](1)本专利技术采用双向随机树和多棵局部随机树的探索与合并，增加引力分量，使双向随机树朝着各自目标方向生长，减少了现有RRT技术的随机性；
[0042](2)本专利技术在障碍物周围均匀生成若干根节点，对根节点增加斥力分量，生成多棵局部随机树，快速寻找可通行的路径，减少扩展过程中对障碍物的检测时间，加快RRT算法的收敛速度，改善了RRT算法的偏差性；
[0043](3)本专利技术通过在障碍物周围均匀生成若干个随机树根节点，以这若干个根节点，向障碍物外搜索扩展建立多棵局部随机树，从而减少了对障碍物的检测时间，减少了迭代次数。
附图说明
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动驾驶路径规划方法，其特征在于，包括以下步骤：确定车辆周围的障碍物位置，在障碍物周围均匀生成若干根节点xp(i)，i＝1,2,
…
，以xp(i)为根节点构建随机树Ti；在障碍物斥力影响范围内，增加障碍物的斥力分量，引导随机树Ti朝着无障碍物的方向扩展；分别以起点和终点为根节点，建立双向随机树Ta和Tb；增加终点产生的引力分量，引导随机树Ta朝着终点方向生长；增加起点产生的引力分量，引导随机树Tb朝着起点方向生长；随机树Ta或Tb在扩展过程中，若随机树Ta或Tb的新节点与其他随机树的节点距离小于设定的阈值，则合并两棵树，若起点与终点在同一棵树上，结束搜索，返回搜索路径，否则继续搜索。2.根据权利要求1所述自动驾驶路径规划方法，其特征在于，所述增加引力分量的具体过程如下：对双向随机树中的每个节点n都增加一个目标引力函数G(n)，此处的节点n表示由起点xinit或终点xgoal向外扩展的第n个新节点xnew，表示为：F(n)＝R(n)+G(n)其中，F(n)表示从节点n到终点xgoal的生长指导函数，R(n)表示从起点到节点n的随机生长函数；所述目标引力函数G(n)：G(n)＝ρ
·
k
p
·
(xgoal
‑
xnear)/(‖xgoal
‑
xnear‖)其中，ρ为步长，k
p
为引力场系数，xnear为距离随机点xrand最接近的节点，‖*‖表示几何距离；根据R(n)＝ρ
·
(xrand
‑
xnear)/(‖xrand
‑
xnear‖)，得：F(n)＝ρ
·
(xrand
‑
xnear)/(‖xrand
‑
xnear‖)+ρ
·
k
p
·
(xgoal
‑
xnear)/(‖xgoal
‑
xnear‖...

【专利技术属性】
技术研发人员：吴月路，
申请(专利权)人：的卢技术有限公司，
类型：发明
国别省市：