1.一种自动驾驶下交叉口通行路径设置方法,其特征在于,该方法包括如下步骤:步骤1:确定交叉口各进口道、出口道车道数并分别对其编号;在交叉口内部建立直角坐标系;输入到达交叉口的自动驾驶车辆的进口道编号,转弯方向;
步骤2:考虑进口车道数量和出口车道数量的差异,确定直行车辆在交叉口内部通行路径的方程;
步骤3:使用椭圆方程确定左转和右转车辆在交叉口内部通行路径的方程;
所述步骤1包括如下步骤:
步骤11:分别以O∈{E,W,S,N}表示东、西、南、北四个进口道,以D∈{E,W,S,N}表示东、西、南、北四个出口道;每个进口道包含iO条车道,其中iO∈{1,2,...,nO},nO表示O方向进口道的最大车道数;每个出口道包含jD条车道,其中jD∈{1,2,...,mD},mD表示D方向出口道的最大车道数,车道宽度为dr;对交叉口进口道、出口道进行编号;并建立直角坐标系,x轴和y轴正负方向的端点坐标值依次为dr·max(nS,mN)、-dr·max(nN,mS)、dr·max(nE,mW)、-dr·max(nW,mE),当相应的进出口车道数不相等时,选取车道数最多的位置确定为坐标轴端点;
所述步骤2中,考虑进口车道数量和出口车道数量的差异,确定直行车辆在交叉口内部通行路径的方程,包括如下步骤:
步骤21:对于直行车辆,当进口道最大车道数小于或等于出口道最大车道数时,直行路径都为直线;否则,车辆的直行路径可能为斜线;具体的,按进口方向进行分类;东进口的车道用iE表示,东进口最大车道数用nE表示;西出口的车道用jW表示,西出口最大车道数用mW表示;东进口道最大车道数nE小于等于西出口道最大车道数mW,即nE≤mW时,东进口道第iE条车道iE∈{1,2,...,nE}上车辆直行路径外边界方程用FEi→Wj表示,内边界方程用fEi→Wj表示,分别由公式(1)、(2)计算:FEi→Wj:
fEi→Wj:
表示O方向进口道第i条车道驶向D方向出口道第j条车道路径外边界方程的Y值,表示O方向进口道第i条车道驶向D方向出口道第j条车道路径外边界方程的X值; 表示0方向进口道第i条车道驶向D方向出口道第j条车道路径内边界方程的y值, 表示O方向进口道第i条车道驶向D方向出口道第j条车道路径内边界方程的x值,其中O∈{E,W,S,N},D∈{E,W,S,N},以 为例说明, 表示东进口道E第1条车道驶向西出口道W第1条车道路径外边界方程的Y值;
当nE>mW时,则E方向进口车道数多于W出口车道数,多出部分的进口道车道数用sE→W表示,由公式(3)计算,进口道多出部分的第zE条车道zE∈{1,2,...,sE→W}上直行车辆路径方程的外边界方程FEi→Wj、内边界方程fEi→Wj由公式(4)、(5)计算:sE→W=nE-mW (3)
FEi→Wj:
fEi→Wj:
步骤22:西进口的车道数用iW表示,西进口最大车道数用nW表示;东出口的车道数用jE表示,东出口最大车道数用mE表示;当西进口车道数nW小于或等于东出口车道数mE即nW≤mE时,西进口道第iW条车道iW∈{1,2,...,nW}上车辆直行路径外边界方程用FWi→Ej表示、内边界用fWi→Ej表示,分别由公式(6)、(7)计算:FWi→Ej:
fWi→Ej:
当nW>mE时,则W方向进口车道数多于E方向出口车道数,多出部分的进口道车道数用sW→E表示,由公式(8)计算,进口道多出部分的第zW条车道zW∈{1,2,...,sW→E}上直行车辆路径外边界FWi→Ej、内边界fWi→Ej的方程分别由公式(9)、(10)计算:nW-mE=sW→E (8)
FWi→Ej:
fWi→Ej:
步骤23:南进口的车道数用iS表示,南进口最大车道数用nS表示;北出口的车道数用jN表示,北出口最大车道数用mN表示;当南进口车道数nS小于等于北出口道车道数mN即nS≤mN时,南进口道第iS条车道iS∈{1,2,...,nS}上车辆直行路径外边界方程用FSi→Nj表示、内边界方程用fSi→Nj表示,由公式(11)、(12)计算:FSi→Nj:
fSi→Nj:
当nS>mN时,则S方向进口车道数多于N出口车道数,多出部分的进口道车道数用sS→N表示,由公式(13)计算,进口道多出部分的第zS条车道zS∈{1,2,...,sS→N}上直行车辆路径外边界FSi→Nj、内边界fSi→Nj的方程由公式(14)、(15)计算:nS-mN=sS→N (13)
FSi→Nj:
fSi→Nj:
步骤24:北进口的车道数用iN表示,北进口最大车道数用nN表示;南出口的车道数用jS表示,南出口最大车道数用mS表示;当北进口车道数nN小于等于北出口道车道数mS即nN≤mS时,北进口第iN条车道iN∈{1,2,...,nN}上车辆直行路径的外边界方程用FNi→Sj表示、内边界方程用fNi→Sj表示,分别由公式(16)、(17)计算:FNi→Sj:
fNi→Sj:
当nN>mS时,则N方向进口车道数多于S出口车道数,多出部分的进口道车道数用sN→S表示,由公式(18)计算,进口道多出部分的第zN条车道zN∈{1,2,...,sN→S}上直行车辆路径外边界FNi→Sj、内边界fNi→Sj的方程由公式(19)、(20)计算:nN-mS=sN→S (18)
FNi→Sj:
fNi→Sj:
2.根据权利要求1所述的一种自动驾驶下交叉口通行路径设置方法,其特征在于,所述步骤3,使用椭圆方程确定左转和右转车辆在交叉口内部行驶路径的方程,包括如下步骤:步骤31:对于左转或右转车辆,通行路径方程与x轴的截距用p表示,与y轴的截距用q表示,(α,β)表示椭圆的圆心,其中(α1,β1)、(α2,β2)、(α3,β3)、(α4,β4)依次表示椭圆圆心在一、二、三、四象限,路径方程如公式(21)所示:步骤32:由东进口E第i条车道到南出口S第j条车道左转的车辆,车辆路径的外边界方程用FEi→Sj表示,内边界方程用fEi→Sj表示,公式中的(α,β)=(α4,β4)=(dr·max(mN,nS),-dr·max(nW,mE)),p和q由公式(22)、(23)计算:FEi→Sj:
fEi→Sj:
步骤33:由西进口W第i条车道到北出口N第j条道的左转车辆,车辆路径的外边界方程用FWi→Nj表示,内边界方程用fWi→Nj表示,公式中的(α,β)=(α2,β2)=(-dr·max(nN,mS),dr·max(mW,nE)),p和q由公式(24)、(25)计算:FWi→Nj:
fWi→Nj:
步骤34:由北进口N第i条车道到东出口E第j条车道的左转车辆,车辆路径的外边界方程用FNi→Ej表示,内边界方程用fNi→Ej表示,公式中的(α,β)=(α1,β1)=(dr·max(mN,nS),dr·max(mW,nE)),p和q由公式(26)、(27)计算:FNi→Ej:
fNi→Ej:
步骤35:由南进口S第i条车道到西出口W第j条车道的左转车辆,车辆路径的外边界方程用FSi→Wj表示,内边界方程用fSi→Wj表示,公式中的(α,β)=(α3,β3)=(-dr·max(mS,nN),-dr·max(nW,mE)),p和q由公式(28)、(29)计算:FSi→Wj:
fSi→Wj:
步骤36:由西进口W第i条车道到南出口S第j条车道的右转车辆,车辆路径的外边界方程用FWi→Sj表示,内边界方程用fWi→Sj表示,公式中的(α,β)=(α3,β3)=(-dr·max(mS,nN),-dr·max(nW,mE)),p和q由公式(30)、(31)计算:FWi→Sj:
fWi→Sj:
步骤37:由南进口S第i条车道到东出口E第j条车道的右转车辆,车辆路径的外边界方程用FSi→Ej表示,内边界方程用fSi→Ej表示,公式中的(α,β)=(α4,β4)=(dr·max(mN,nS),-dr·max(nW,mE)),p和q由公式(32)、(33)计算:FSi→Ej:
fSi→Ej:
步骤38:由东进口E第i条车道到北出口N第j条车道的右转车辆,车辆路径的外边界方程用FEi→Nj表示,内边界方程用fEi→Nj表示,公式中的(α,β)=(α1,β1)=(dr·max(mN,nS),dr·max(mW,nE)),p和q由公式(34)、(35)计算:FEi→Nj:
fEi→Nj:
步骤39:由北进口N第i条车道到西出口W第j条车道的右转车辆,车辆路径的外边界方程用FNi→Wj表示,内边界方程用fNi→Wj表示,公式中的(α,β)=(α2,β2)=(-dr·max(nN,mS),dr·max(mW,nE)),p和q由公式(36)、(37)计算:FNi→Wj:
fNi→Wj: