1.一种非结构化道路自动驾驶路径规划方法,其特征在于,包括如下步骤:
A)接收路径规划输入信息,所述路径规划输入信息包括当前位姿以及目标位姿的坐标信息;
B)获取障碍物信息,利用动态步长模块根据所述障碍物信息提取障碍物之间空隙的中心线并对所述中心线进行后处理,以得到离散化路径,并判断所述离散化路径的处理用时是否超出设定许用系统时间;
C)若所述处理用时未超出所述规定许用系统时间,则将所述离散化路径基于动态步长进行非均匀采样路径规划,得到自动驾驶路径;
D)若所述动态步长模块为超时退出,则判断是否存在待行驶路径,且所述待行驶路径的长度是否超过两倍制动所需的路径长度,若不存在所述待行驶路径,或所述待行驶路径的长度不超过两倍制动所需的路径长度,则输出刹车标志位并进行刹车,若存在所述待行驶路径,且所述待行驶路径的长度超过两倍制动所需的路径长度,则执行所述待行驶路径;
若所述动态步长模块为路径规划成功后退出,则执行所述自动驾驶路径。
2.根据权利要求1所述的非结构化道路自动驾驶路径规划方法,其特征在于,步骤A)中的所述坐标信息包括车辆坐标x、y以及车辆航向角θ。
3.根据权利要求2所述的非结构化道路自动驾驶路径规划方法,其特征在于,步骤B)中所述中心线的提取以及离散化的步骤包括:B1)将所述障碍物信息以及所述坐标信息统一坐标系,并判断是否为首次规划自动驾驶路径;
B2)若是首次规划自动驾驶路径,则根据所述障碍物信息对障碍物进行多边形图形提取,以得到所述障碍物的主要边和有限边,将所述主要边和所述有限边中的端点绑定对应的所述车辆航向角θ,对所述端点对应的车辆位姿进行碰撞检测,以删除发生碰撞的边,并根据所述当前位姿获得初始节点,根据所述目标位姿获取目标节点,再基于深度优先法对所述初始节点与所述目标节点相连接的图片进行搜索,获取完整的中心线,并将所述中心线进行离散化以得到离散化路径;
B3)若不是首次规划自动驾驶路径,则调取已有的待行驶路径,对所述待行驶路径按照设定的路径间隔,检测所述待行驶路径是否会与所述障碍物发生碰撞,若会发生碰撞,则删除发生碰撞处所对应的路径点及其后续的所述待行驶路径,并基于剩余的安全路径初始化动态步长搜索树,若不会发生碰撞,则对所述待行驶路径初始化动态步长搜索树,并对所述动态步长搜索树进行离散化。
4.根据权利要求3所述的非结构化道路自动驾驶路径规划方法,其特征在于,所述中心线的提取步骤包括:提取所述障碍物的角点,将临近的所述角点构成所述障碍物的障碍物线段集合,对所述线段集合进行所述多边形图形提取,以筛选出所述主要边和所述有限边,对所述主要边和所述有限边中的端点绑定对应的所述车辆航向角θ:其中,(x1,y1)为所述主要边或所述有限边中的末点坐标,(x0,y0)为所述主要边或所述有限边中的起点坐标;对所述端点对应的所述车辆位姿进行碰撞检测,以删除该端点所对应的发生碰撞的边,并以距离所述当前位姿最近的所述端点作为起始节点,距离所述目标位姿最近的所述端点作为目标节点,以先进先出的深度优先原则对所述起始节点与所述目标节点相连接的图片进行搜索,得到从所述起始节点到所述目标节点的所述中心线。
5.根据权利要求3所述的非结构化道路自动驾驶路径规划方法,其特征在于,所述中心线的提取以及离散化的过程中,所述动态步长模块每经过设定的时间间隔执行一次所述步骤B2)。
6.根据权利要求3至5中任一项所述的非结构化道路自动驾驶路径规划方法,其特征在于,步骤C)中所述自动驾驶路径的获取步骤包括:C1)对所述离散化路径基于设定的偏置采样策略进行非均匀采样,得出采样节点;
C2)筛选出到所述采样节点的路径代价最小的多个节点作为附近节点,计算所述附近节点的代价值,选取代价值最小的所述附近节点接入到动态步长搜索树,并将相应的所述附近节点到目标节点的路径加入动态步长搜索树的路径;
C3)在所述初始节点到所述附近节点的路径上,随机选取任一节点连接到所述采样节点,计算选取的节点到所述采样节点且无碰撞的节点‑采样点全代价值以及选取的节点到所述采样节点再到所述附近节点且无碰撞的节点‑采样点‑附近节点全代价值,并将所述节点‑采样点全代价值以及所述节点‑采样点‑附近节点全代价值与所述附近节点的代价值对比,以在小于所述附近节点的代价值时对应进行重新连接最小代价的路径,并改变相应节点的对应父子关系。
7.根据权利要求6所述的非结构化道路自动驾驶路径规划方法,其特征在于,所述偏置采样策略的步骤包括:从多段所述中心线中均匀概率采样随机选择一条中心线段,在所述中心线段中间均匀采样一个点:xm=(1‑u)x0+x1
ym=(1‑u)y0+y1
其中,u在0到1之间均匀采样,随后对偏置距离和航向角偏置量利用高斯分布采样:
其中σ是方差参数;μ是固定为0的均值参数,所述偏置距离经所述高斯分布采样得出所述采样节点,所述航向角偏置量经所述高斯分布采样得出采样位姿。
8.根据权利要求6所述的非结构化道路自动驾驶路径规划方法,其特征在于,所述代价值的计算函数为:Cost(x,y)=Cost(σx‑>y)=w1Clength+w2Ccusp+w3Ccurv其中,w1、w2、w3是权重系数,Clength为路径长度,Ccusp为路径尖角个数,Ccurv为按照Δ路径长度间隔计算的路径曲率的平方值之和,σx‑>y表示从节点x到节点y的Reeds‑Shepp曲线段路径。
9.一种非结构化道路自动驾驶路径规划系统,其特征在于,包括GPS定位单元、障碍物检测单元、数据处理单元和路径存储单元,所述GPS定位单元用于接收GPS信息,所述障碍物检测单元用于收集障碍物信息,所述路径存储单元中存储有先前规划出的自动驾驶路径,以能够将所述自动驾驶路径作为待行驶路径,所述数据处理单元中预制有权利要求1至8中任一项所述的非结构化道路自动驾驶路径规划方法。
10.一种车辆,其特征在于,包括权利要求9所述的道路自动驾驶路径规划系统。