一种基于RRT的改进全局路径规划方法技术

本发明专利技术公开了一种基于RRT的改进全局路径规划方法，在采样的路径规划RRT算法中，在预定的最高采样次数k内，通过统计连续采样成功次数和连续失败次数对周边静态环境的复杂度进行预判，并基于预判结果自适应选择激进搜索扩展策略或随机搜索扩展策略，以得到改进的全局路径规划算法。本发明专利技术提供一种基于RRT的改进全局路径规划方法，其在RRT算法的基础上对所处的周边静态环境进行一个预判，降低不必要的时间和空间消耗，并引入激进的搜索扩展策略加快算法的收敛，能够在不同的环境中高效快速完成探索环境的问题，同时也能够快速的实现和实施，是一种高效简单容易实施的规划方式。是一种高效简单容易实施的规划方式。是一种高效简单容易实施的规划方式。

【技术实现步骤摘要】
一种基于RRT的改进全局路径规划方法


[0001]本专利技术涉及无人驾驶路径规划领域，具体涉及一种基于RRT的改进全局路径规划方法。

技术介绍

[0002]随着计算机技术、信息技术高速发展，自动化、智能化成为未来科技发展的趋势，无人驾驶汽车作为智能化的核心板块之一，不仅代表了高新科技水平，还满足了人们对于汽车技术的迫切需求。无人驾驶领域中的路径规划是指在一定环境模型的基础上，给无人车辆规划一条安全稳定的路径，即给定起始点和目标点，规划一条符合车辆约束的安全行进路径。同时为了保证车辆的行驶安全性和乘坐的舒适性，采用优化和平滑算法进行路径的优化，使无人车辆能够沿着规划路径预期连续性行进。
[0003]目前，熟知RRT路径规划算法存在以下优点：(1)算法的探索能力强于图搜索算法；(2)不需要对环境进行预先建模；(3)算法具有完备性并且能够快速提供解决方案。同时RRT路径规划算法存在以下缺点：(1)随机性高，搜索具有无向性，容易造成许多不必要的消耗(时间、内存等)；(2)存在规划路径曲折，超过最大转向角度问题。

技术实现思路

[0004]本专利技术的一个目的是解决至少上述问题和/或缺陷，并提供至少后面将说明的优点。
[0005]为了实现本专利技术的这些目的和其它优点，提供了一种基于RRT的改进全局路径规划方法，在采样的路径规划RRT算法中，在预定的最高采样次数k内，通过统计连续采样成功次数和连续失败次数对周边静态环境的复杂度进行预判，并基于预判结果自适应选择激进搜索扩展策略或随机搜索扩展策略，以得到改进的全局路径规划算法。
[0006]优选的是，所述预判的方法被配置为包括：
[0007]步骤一：设定起始点和目标点，利用激进扩展方式对起始点、目标点进行连接，如连接成功则直接获得初步的规划路径，否则进入步骤二对环境的复杂度进行判断，以对扩展方式进行二次选择；
[0008]步骤二：当采样次数不大于k时，随机生成一个(0,1)之间的数(Random(0,1))，与初始设定的偏置概率p
ss
进行比较，当(Random(0,1))小于p
ss
时选择激进扩展策略，反之则为随机扩展策略；
[0009]步骤三：如果选择的是激进扩展策略，且在激进扩展策略中能找到起始点到目标点的路径，则初步的规划路径结束，否则将部分无碰撞的路径添加到树中，返回步骤二；
[0010]如果选择的是随机扩展策略，则返回步骤二；
[0011]其中，在随机扩展策略、激进扩展策略中，在每一次返回步骤二时，都根据当前采样对p
ss
进行修正，直到采样次数超过k的值或返回成功。
[0012]优选的是，在步骤三中，将p
ss
的初始值设定为0.2，对p
ss
进行修正的是通过公式一
得到对应的修正值p
ss
(j+1)：
[0013][0014]其中，n
succ
表示连续扩展成功的次数，n
fail
表示连续扩展失败的次数，且n
succ
和n
fail
两者为互斥量，在可扩展和不可扩展的情况下，一个被累积，另一个被清零；
[0015]l
step
表示当前扩展的路径长度，l
max
表示树中最长可扩展的路径长度，L
step
＝max{l
step
，l
max
}表示当前扩展的路径长度l
step
和树中最长可扩展的路径长度l
max
。
[0016]优选的是，还包括步骤四，在初始路径规划后，通过三次B样条曲线优化当前路径做平滑处理，以得到最终路径。
[0017]优选的是，三次B样条曲线拟合公式二为：
[0018][0019]其中，公式二中的x
i
为初始规划路径中每个点位，而公式二中的基函数公式为：
[0020][0021]基于公式二和公式三得拟合曲线点公式四：
[0022][0023]其中，在公式四中t∈[0,1],其中X(t)为四个控制点根据三次B样条曲线拟合得到的点集。
[0024]优选的是，在步骤三的激进扩展策略中，若起始点或中途探索点与终点能直接连接，则进入步骤四，若起始点或中途探索点与终点中间有障碍物，则将从起点或中途探索点出发部分到障碍物之间所在的路径进行保留，而障碍物与终点之间的路径进行删除，并返回至步骤二中。
[0025]本专利技术至少包括以下有益效果：本专利技术通过在RRT算法的基础上对所处的周边静态环境进行一个预判，降低不必要的时间和空间消耗，并引入激进的搜索扩展策略加快算法的收敛，其能够在不同的环境中高效快速完成探索环境的问题，同时也能够快速的实现和实施，是一种高效简单容易实施的规划方式。
[0026]本专利技术的其它优点、目标和特征将部分通过下面的说明体现，部分还将通过对本专利技术的研究和实践而为本领域的技术人员所理解。
附图说明
[0027]图1为本专利技术基于RRT的改进全局路径规划的流程示意图；
[0028]图2为本专利技术在实际规范时的运行效果示意图；图3为在激进扩展方式中，起点或中途探索点与终点直接连接的示意图；
图4为在激进扩展方式中，起点或中途探索点与终点之间具有障碍物的处理示意图。
具体实施方式
[0029]下面结合附图对本专利技术做进一步的详细说明，以令本领域技术人员参照说明书文字能够据以实施。
[0030]本专利技术的目的是为了解决在利用RRT算法进行全局路径规划过程中，规划出的路径曲折，超过最大转向角度并且需要提高规划的整体效率而提出的解决方案。
[0031]本专利技术基于RRT的改进全局路径规划方法的整体设计思路是：该专利技术在主流的基于采样的路径规划RRT算法的基础上进行改进，传统RRT规划算法由于随机性过强、路径过于曲折等问题，在实际的应用情况当中，对于时间的消耗较高，对于探索情况的记录占用内存资源大，不利于后续的控制跟踪模块直接进行参考使用。本专利技术能够解决传统规划算法耗费计算资源和耗时以及不易实施等问题，同时本专利技术能够稳定的规划一条路径，解决了当前算法曲折、终端不精确的问题。针对基本场景下的静态环境进行分类处理，灵活变动搜索扩展策略，根据不同的搜索策略，该算法可以在宽阔场地亦或是较为复杂的环境中都能提供较快的解决方案，即可快速规划一条满足条件的安全路径。
[0032]本专利技术采用一种检测可行驶区域(即本专利技术方案中描述的通过多次采样检测可行驶区域，理论上多次采样中连续成功的次数越多，说明环境就约开阔，反之则相反)和激进扩展的方式，通过统计连续采样成功次数和连续失败次数可以判断当前环境是处于宽阔敞亮地带或者是狭窄闭塞的街道，进而灵活的调整自身的扩展策略。最后将所获得的路径点，采用B样条曲线进行路径平滑优化。
[0033]具体来说，如图1，本专利技术基于RRT的改进全局路径本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于RRT的改进全局路径规划方法，其特征在于，在采样的路径规划RRT算法中，在预定的最高采样次数k内，通过统计连续采样成功次数和连续失败次数对周边静态环境的复杂度进行预判，并基于预判结果自适应选择激进搜索扩展策略或随机搜索扩展策略，以得到改进的全局路径规划算法。2.如权利要求1所述的基于RRT的改进全局路径规划方法，其特征在于，所述预判的方法被配置为包括：步骤一：设定起始点和目标点，利用激进扩展方式对起始点、目标点进行连接，如连接成功则直接获得初步的规划路径，否则进入步骤二对环境的复杂度进行判断，以对扩展方式进行二次选择；步骤二：当采样次数不大于k时，随机生成一个(0,1)之间的数(Random(0,1))，与初始设定的偏置概率p
ss
进行比较，当(Random(0,1))小于p
ss
时选择激进扩展策略，反之则为随机扩展策略；步骤三：如果选择的是激进扩展策略，且在激进扩展策略中能找到起始点到目标点的路径，则初步的规划路径结束，否则将部分无碰撞的路径添加到树中，返回步骤二；如果选择的是随机扩展策略，则返回步骤二；其中，在随机扩展策略、激进扩展策略中，在每一次返回步骤二时，都根据当前采样对p
ss
进行修正，直到采样次数超过k的值或返回成功。3.如权利要求2所述的基于RRT的改进全局路径规划方法，其特征在于，在步骤三中，将p
ss
的初始值设定为0.2，对p
ss
进行修正的是通过公式一得到对应的修正值p
ss
(j+1)：其中，n
succ

【专利技术属性】
技术研发人员：蒋涛，雷婷，谭学敏，陈谢天，宁梓豪，刘明文，张林帅，
申请(专利权)人：成都信息工程大学，
类型：发明
国别省市：