1.一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,包括以下步骤:判断自动驾驶车辆的决策任务是否需要绕中心岛行驶;
若自动驾驶车辆的决策任务不需要绕中心岛行驶,生成路径的过程为:S2.1、针对车道两侧存在车道线引导的驶入路段和驶出路段,均采用拟合的方法生成拟合五次Bezier参考路径L1和L3;
S2.2、针对车道两侧不存在车道线引导的环岛区域,则基于连续性条件和S2.1生成的拟合五次Bezier参考路径L1和L3,采用插值的方法生成插值五次Bezier参考路径L2;
S2.3、将S2.1和S2.2生成的拟合五次Bezier参考路径L1和L3与插值五次Bezier参考路径L2按照行驶顺序依次连接,构成该决策任务对应的自动驾驶参考路径;
若自动驾驶车辆的决策任务需要绕中心岛行驶,生成路径的过程为:S3.1、针对车道两侧存在车道线引导的驶入路段,采用拟合的方法生成拟合五次Bezier参考路径L1;
S3.2、以沿中心岛绕行的起点为合流点;设合流点在目标循环车道的道路中心线上,且优化迭代方向与交通流方向相同;沿着目标循环中心线优化迭代出理想的合流点;
S3.3、基于合流点,针对车道两侧存在车道线引导的中心岛绕行段,采用拟合的方法生成拟合五次Bezier参考路径L3;
S3.4、基于S2.1中驶入路段的拟合五次Bezier参考路径L1和L3与连续性条件,采用插值的方法生成驶入路段和中心岛绕行段之间的插值五次Bezier参考路径L2;
S3.5、按照行驶顺序依次连接S3.1‑S3.4中的参考路径L1、L2和L3,得到驶入环形交叉口的参考路径;
S3.6、驶出环形交叉口是驶入环形交叉口的镜像行为,参考S3.1‑S3.5得到驶出环形交叉口的参考路径,构成该决策任务对应的自动驾驶参考路径。
2.根据权利要求1所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,包括以下步骤:采用拟合生成参考路径的方法是:根据两侧车道线计算道路中心点,采用最小二乘法对离散的道路中心点进行拟合,反算出五次Bezier曲线的控制点,再根据控制点正算出拟合五次Bezier参考路径。
3.根据权利要求1所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,采用插值生成参考路径的方法是:基于已经确定的拟合五次Bezier参考路径,由于插值五次Bezier参考路径两端控制点与其两端已经确定的拟合五次Bezier参考路径的端点重合且满足连续性条件,由此构建插值五次Bezier参考路径的控制点,获得插值五次Bezier参考路径。
4.根据权利要求3所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特
0 1 2
征在于,所述连续性条件是指满足G、G、G连续性。
5.根据权利要求1所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,优化迭代出理想的合流点或分流点的方法为:以环形交叉口的中心为原点,建立环形交叉口全局坐标系;
以驶入路段的拟合五次Bezier参考路径L1上最后一个控制点P1,5点处的切线与目标循* *环车道中心线的交叉点P 2,5为迭代的起点;P 2,5是车辆保持其当前航向通过驶入线并行驶到目标循环车道中心线的地点;
*
P1,5到P2,5的线段为最小成本路径;
*
P2,5与坐标系原点的连线与x轴之间的夹角为迭代初始角θ;
*
以P2,5为迭代起点,沿着目标循环中心线优化迭代出理想的偏转角度Δ,Δ∈[0,π/2]。
6.根据权利要求5所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,将合流点、分流点、高阶连续性的比例系数的优化过程中的多个约束条件概括多目标优化问题,表示如下:min(h)=(Lrelative,Kpeak,K′peak,K″peak)其中,Lrelative为相对路径长度,Kpeak是路径曲率峰值绝对值的总和;K'peak是路径曲率一阶导数峰值绝对值的总和;K”peak是路径曲率二阶导数峰值绝对值的总和;α1,2,α2,3均为高阶连续性的比例系数;Δ为偏转角度;k是路径的曲率,k'是路径的曲率的变化率;kmax为最小转弯半径的倒数;σmax为最大曲率。
7.根据权利要求6所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,Lrelative、Kpeak、K'peak、K”peak是参考路径生成的四个评价指标,分别表示如下:其中,相对路径长度Lrelative为真实路径lreal与最小成本路径lminiCost之间的差值;Kpeak是路径曲率峰值绝对值kpeak的总和;K'peak是路径曲率一阶导数峰值k'peak绝对值的总和;
K”peak是路径曲率二阶导数峰值k”peak绝对值的总和。
8.根据权利要求6所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,采用NSGA对多个约束条件形成的多目标优化问题进行求解。
9.根据权利要求1‑8中任意一项所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,五次Bezier曲线的数学表达式为:其中,Pa(u)表示决策任务涉及的行驶区域a的Bezier曲线;Pa,i是区域a中Bezier曲线的第i个控制点,i=0,1,2,...,5;函数的输入u∈[0,1]决定Bezier曲线从起点到终点的位置比例;Bi,5(u)是5次Bezier曲线上第i个控制点的伯恩斯坦多项式。
10.根据权利要求9所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,五次Bezier曲线上的一个伯恩斯坦多项式表示如下:其中,5!为5的阶乘,i!为i的阶乘,i为控制点的序号。