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所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,所述连续性条件是指满足G
5.根据权利要求1所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,优化迭代出理想的合流点或分流点的方法为:以环形交叉口的中心为原点,建立环形交叉口全局坐标系;
以驶入路段的拟合五次Bezier参考路径L1上最后一个控制点PP
P
以P
6.根据权利要求5所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,将合流点、分流点、高阶连续性的比例系数的优化过程中的多个约束条件概括多目标优化问题,表示如下:min(h)=(L
其中,L
7.根据权利要求6所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,L其中,相对路径长度L
8.根据权利要求6所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,采用NSGA对多个约束条件形成的多目标优化问题进行求解。
9.根据权利要求1-8中任意一项所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,五次Bezier曲线的数学表达式为:其中,P
10.根据权利要求9所述的一种适用于环形交叉口场景的自动驾驶路径规划方法,其特征在于,五次Bezier曲线上的一个伯恩斯坦多项式表示如下:其中,5!为5的阶乘,i!为i的阶乘,i为控制点的序号。