1.一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,该方法包括如下步骤:步骤1:采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离;
步骤2:根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻;
步骤3:根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻;
步骤4:根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹;
步骤5:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻,以车辆进入交叉口的速度最大和油耗、碳氧化物、氮氧化物、碳氢化物的总排放加权最小为目标,优化每辆车在路段和交叉口的行驶速度,其中目标函数由公式计算:min(1‑ω)·(VM‑vn)+ω·∑AMOEA,n (1)
式中:ω为权重系数,取值范围为0≤ω≤1,A为中间变量,A∈{Fuel,CO,HC,NOX},其中Fuel表示油耗,CO表示碳氧化物,HC表示碳氢化物,NOX表示氮氧化物,MOEFuel,n表示车辆n的油耗,单位为mg,MOECO,n、MOEHC,n、MOENOX,n分别表示车辆n的碳氧化物、碳氢化物、氮氧化物的排放量,单位为ml,VM表示允许行驶的最大速度,vn表示车辆n进入交叉口的速度;
所述步骤4,根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹,包括如下步骤:步骤41:车辆不停车达到停车线的最短时间由tn表示,车辆不停车到达停车线的最长时间由 表示,分别公式计算:式中:Ω表示所有车辆的集合,Ln表示车辆n到停车线的距离,vmin表示在路段上允许行驶的最小速度,aL表示在路段上允许行驶的最大减速度;
当 时,通过调节车辆在路段上的行驶速度,不停车在 时刻后进入交叉口,根据
车辆位置Ln和 调整路段上车辆行驶速度,车辆在Ln处开始优化行驶速度的时刻为0时刻;
an,1·(Tn,2‑Tn,1)=VM‑vn,1 (12)an,2·(Tn,4‑Tn,3)=vn,2‑vn,1 (13)
0≤an,1≤aL,0≤an,2≤aU (14)vmin≤vn,1≤vn,2≤VM (15)
0≤Tn,1≤Tn,2≤Tn,3≤Tn,4≤Tn,5 (16)2
式中:aU表示允许行驶的最大加速度,m/s ,Tn,1表示车辆n以最大速度匀速行驶结束的时刻,Tn,2表示减速至vn,1的时刻,Tn,2‑Tn,1阶段为以an,1减速度匀减速阶段、Tn,3表示以vn,1匀速行驶结束的时刻,Tn,3‑Tn,2为以vn,1匀速行驶的阶段,Tn,4为以an,2匀加速结束的时刻,Tn,4‑Tn,3阶段为以an,2加速度匀加速阶段,Tn,5表示以vn,2匀速结束的时刻,Tn,5‑Tn,4为以vn,2匀速行驶的阶段;an,1表示匀减速的实际减速度,an,2表示匀加速的实际加速度,vn,1表示匀减速结束后的速度,vn,2表示不停车进入交叉口的速度;
步骤42:当车辆可以通过在路段上调节速度不停车进入交叉口时,速度由以下公式计算:wn,1≤xn,1,wn,2≤xn,1+xn,2,wn,3≤xn,2+xn,3,wn,4≤xn,3+xn,4,wn,5≤xn,4+xn,5,wn,6≤xn,5 (19)wn,1+wn,2+wn,3+wn,4+wn,5+wn,6=1 (20)xn,1+xn,2+xn,3+xn,4+xn,5=1 (21)xn,i=0 or 1;i=1,2,3,4,5 (22)wn,i≥0;i=1,2,3,4,5,6 (23)
对于任意的t属于定义域,
t=wn,1·0+wn,2·Tn,1+wn,3·Tn,2+wn,4·Tn,3+wn,5·Tn,4+wn,6·Tn,5 (24)可求得:
vn(t)=wn,1·VM+wn,2·VM+wn,3·vn,1+wn,4·vn,1+wn,5·vn,2+wn,6·vn,2 (25)式中:xn,i,i=1,2,3,4,5;wn,i,i=1,2,3,4,5,6均为中间变量;
步骤43:当车辆可以通过在路段上调节速度不停车进入交叉口时,加速度由以下公式计算:xn,i=0 or 1;i=6,7,8,9,10 (26)
xn,6+xn,7+xn,8+xn,9+xn,10=1 (27)xn,6·0+xn,7·Tn,1+xn,8·Tn,2+xn,9·Tn,3+xn,10·Tn,4≤t≤xn,6·Tn,1+xn,7·Tn,2+yn,8·Tn,3+xn,9·Tn,4+xn,10·Tn,5 (28)an(t)=xn,6·0+xn,7·an,1+xn,8·0+xn,9·an,2+xn,10·0 (29)式中:xn,i,i=6,7,8,9,10均为中间变量;
步骤44:当 时,表示车辆以最小速度不停车行驶到交叉口仍然不能进入,此时车辆必须停车等待; 表示车辆n到同一进口车道第j辆车尾的时间,由公式计算:式中:ΩOi表示O进口方向车道i上的车辆集合,dc表示车辆长度和安全间隔之和,单位为m;
当 时,表示车辆n到同车道第j辆车队尾时,第j辆车未进入交叉口,Tj′表示车辆j实际进入交叉口的时刻,此时车辆n在第j辆车车尾停车等待;对所有j∈ΩOi进行判断,直到 可求得车辆n前排队的车辆数jn;
tn,1表示车辆停车后启动匀加速的时间;tn,2表示车辆停车后启动匀速行驶的时间;
an,3·(Tn,7‑Tn,6)=VM‑vn,3 (34)an,4·(Tn,9‑Tn,8)=vn,3 (35)
0≤an,3≤aL,0≤an,4≤aL (36)
0≤vn,3≤VM (37)2
tn′=VM/aL+[Ln‑jn·dc‑VM/(2·aL)]/VM (40)tn′表示车辆n到达队尾停车的最短行驶时间, 表示车辆n到达队尾停车的最长行驶时间;vmin表示在路段上允许行驶的最小速度;Tn,6表示车辆n以最大速度VM匀速行驶结束的时刻,Tn,7表示减速至vn,3的时刻,Tn,7‑Tn,6阶段为以an,3减速度匀减速阶段;Tn,8表示以vn,3匀速行驶结束的时刻,Tn,8‑Tn,7为以vn,3匀速行驶的阶段,Tn,9为以an,4匀减速结束的时刻,为车辆停止的时刻,Tn,9‑Tn,8阶段为以an,4加速度匀减速阶段;
步骤45:当车辆必须停车等待时,速度vn(t)由以下公式计算:
zn,1≤yn,1,zn,2≤yn,1+yn,2,zn,3≤yn,2+yn,3,zn,4≤yn,3+yn,4,zn,5≤yn,4+yn,5,zn,6≤yn,5+yn,6,zn,7≤yn,6+yn,7,zn,8≤yn,7 (42)zn,1+zn,2+zn,3+zn,4+zn,5+zn,6+zn,7+zn,8=1 (43)yn,1+yn,2+yn,3+yn,4+yn,5+yn,6+yn,7=1 (44)yn,i=0 or 1;i=1,2,3,4,5,6,7 (45)zn,i≥0;i=1,2,3,4,5,6,7,8 (46)
对于任意的t属于定义域,
可求得车辆n在t时刻的速度vn(t):
vn(t)=zn,1·VM+zn,2·VM+zn,3·vn,3+zn,4·vn,3+zn,5·0+zn,6·0+zn,7·tn,1·aU+zn,8·vn,4(48)式中:yn,i, i=1,2,3,4,5,6,7; zn,i, i=1,2,3,4,5,6,7,8均为中间变量,vn(t)表示任一t时刻车辆n的速度;vn,4表示停车后启动进入交叉口的速度;
步骤46:当车辆必须停车等待时,加速度an(t)由以下公式计算:
un,i=0 or 1;i=1,2,3,4,5,6,7 (49)
un,1+un,2+un,3+un,4+un,5+un,6+un,7=1 (50)an(t)=un,1·0+un,2·an,3+un,3·0+un,4·an,4+un,5·0+un,6·aU+un,7·0 (52)式中:un,i,i=1,2,3,4,5,6,7均为中间变量,an(t)表示任一t时刻车辆n的加速度。
2.根据权利要求1所述的一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,所述步骤1中的采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离,包括如下步骤:步骤11:对交叉口各方向的进出口道分别编号,ldi表示交叉口d进口方向第i条车道i∈{1,2,…,nd},d∈O,lkj表示交叉口k出口方向第j条车道j∈{nk+1,…,mk},k∈D,O、D分别表示进口方向和出口方向的集合,O,D={E,W,S,N},nd和mk分别表示d进口方向和k出口方向的车道数,dr表示车道宽度,E,W,S,N分别表示交叉口东、西、南、北四个方向;在交叉口内部建立直角坐标系,计算自动驾驶车辆在交叉口内部的通行路径方程,对于直行路径,路径方程由点斜式公式计算,对于转弯路径方程用椭圆方程计算,路径用r表示,所有路径的集合用R表示;两条路径的交点为冲突点,通过联立两条路径方程,可求得冲突点的坐标,pi表示冲突点i,路径r上冲突点i的坐标用(xr,i,yr,i)表示,Φ表示所有冲突点的集合,pi∈Φ;路径r上冲突点pi和pi+1间的距离用Lr,pi,pi+1表示,用两点间距离公式计算;
所述步骤2中,根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻,包括如下步骤:步骤21:车辆实际进入交叉口的时刻用Tn′表示,进入交叉口的速度用vn表示,Φr表示路径r上冲突点的集合,车辆n经过路径r上冲突点pi的时刻用tn,r,pi表示,速度用vn,r,pi表示,Ω表示所有车辆的集合,经过路径r上第一个冲突点p1的时刻tn,r,p1和速度vn,r,p1分别由公式计算:当 时,tn,r,pi和vn,r,pi分别由公式计算:
2
式中:VM表示允许行驶的最大速度,m/s,aU表示允许行驶的最大加速度,m/s;
当 时,tn,r,pi和vn,r,pi分别由公式计算:
所述步骤3中,根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻,包括如下步骤:步骤31:理论进入交叉口的时刻由 表示,步骤2计算得到前车进入交叉口后经过路径上每个冲突点的时刻,第n辆车进入交叉口,由公式计算式中:Ln表示车辆n到达停车线的距离,m;Ωpi表示经过冲突点pi的车辆集合。
3.根据权利要求1所述的一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,所述步骤5中计算车辆n进入交叉口的速度、确定速度加速度和油耗关系,包括如下步骤:步骤51:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻;
进入交叉口的速度由公式计算:
vn=μn·vn,2+(1‑μn)·vn,4 (53)
式中:vn,2表示不停车进入交叉口的速度,vn,4表示停车后启动进入交叉口的速度,vn表示车辆n进入交叉口的速度,μn为0‑1变量,当 时μn=1,当 时,μn=0;
车辆实际进入交叉口的时刻由公式计算:
式中: 表示理论进入交叉口的时刻,Tn,5表示以vn,2匀速结束的时刻, 表示车辆不停车到达停车线的最长时间;
速度加速度和油耗关系由公式计算:
式中:A为中间变量,A∈{Fuel,CO,HC,NOX},MOEFuel,n表示车辆n的油耗,单位为mg,MOECO,n、MOEHC,n、MOENOX,n分别表示车辆n的碳氧化物、碳氢化物、氮氧化物排放量,单位为ml,表示加速时速度i次方和加速度j次方的回归系数; 表示减速时速度i次方和加速度j次方的回归系数,vn(t)表示任一t时刻车辆n的速度,an(t)表示任一t时刻车辆n的加速度。