1.基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,包括以下步骤:
S1、位于加速车道与匝道交界处的路侧检测器判断是否有智能网联自动车辆CAV进入加速车道,若未有CAV进入加速车道,则重复执行路侧检测器判断过程;若有CAV进入加速车道,则进入S2;
S2、开始执行CAV的控制步骤:进入加速车道的CAV为T1,T1在加速车道的前车为T2,后车为T3,T1在主路的前车为T4,后车为T5;T2~T5采取HV跟车模型或CV跟车模型;基于路侧检测器获取加速车道区间内的交通密度及流量;基于车路协同系统与远程交通微波雷达检测器RTMS获取加速车道与主路上的所有车辆T1~T5的实时速度集v1~v5、位置集p1~p5以及加速度集a1~a5,用于作为S3的数据输入和S4的数据输入,并进入S3;
S3、开始进行速度控制:CAV根据S2获取的加速车道上的实时速度集、位置集以及加速度集判断CAV与前后车的速度分布情况、车辆间距情况、加速度分布情况,基于速度控制使得CAV车辆在到达加速车道末端前达到驶入主路的最低速度要求,且始终满足安全行驶条件,并绘制CAV加速车道加速轨迹图,且进入S4;
S4、开始执行轨迹优化:CAV由加速车道安全汇入主路,且进入S5;
S5、基于S3绘制的CAV加速车道加速轨迹图和S4绘制的自加速车道汇入主路轨迹图,绘制CAV汇入全过程的优化轨迹图,同时绘制T2~T5的全程轨迹图,为高速公路合流区的CAV汇入至主路提供可视化轨迹显示。
2.根据权利要求1所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S3中,所述开始进行速度控制,具体包括以下步骤:S31、判断T1执行速度控制的安全条件:判断此时的速度控制行为是否达到满足车辆间的最小安全间距的安全条件,如果是,则进入S32,如果否,CAV按照ΔCC跟车模型行驶,直至满足安全条件后再进入S32;
S32、T1开始执行加速至驶入主路的速度控制:将加速车道路段按路侧检测器的分布位置划分为i个单元,获取T1所处单元的交通量qi(t)、交通密度ρi(t)、以及T1的前后车的实时速度v2,i、v3,i、实时位置p2,i、p3,i、实时加速度a2,i、a3,i,求解T1在所处单元的期望速度,对T1执行速度控制,使T1的实时速度向期望速度实时调整,直至T1的速度达到驶入主路的最低速度要求;
S33、在每一单元内,T1都会执行实时的速度判定,若T1达到了汇入主路的最低速度要求且具备汇入的速度差要求、加速度差要求、间距要求,则绘制CAV加速车道加速轨迹图,并进入S4;若T1未达到汇入主路的最低速度要求,则在下一单元重复S32进行速度调整,直至达到进入S4的要求,进入S4。
3.根据权利要求2所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S31中,所述安全条件的函数如下式所示:式中,facc·safety为安全条件函数;a为对数系数;T′为T1与T2的最小安全距离;T为T1与T3的最小安全距离,Δp12为T1与T2的间距,Δp13分别为T1与T3的间距。
4.根据权利要求2所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S32中,所述T1在所处单元的期望速度如下式所示:式中,v1,i(t+1)表示t+1时刻路段上第i单元T1的期望速度,v1,i(t)为t时刻路段上第i单元T1的实时速度,T″为控制时间步长,τ为因前方交通流密度变化导致的滞后时间,v2,i(t)为t时刻路段上第i单元T2的实时速度,v3,i(t)为t时刻路段上第i单元T3的实时速度,L为路段上各单元的长度,η为模型参数,ρi+1(t)为t时刻路段上第i+1单元的交通密度,ρi(t)为t时刻驶出路段上第i单元的交通密度,κ为模型参数。
5.根据权利要求4所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,T1所处单元的交通量qi(t)的计算如下式所示:式中, 表示t时刻驶出路段上第i单元的平均速度,λ表示车道数,ρi(t)表示t时刻驶出路段上第i单元的交通密度;
t+1时刻路段上第i单元的交通密度的计算如下式所示:式中,ρi(t+1)为t+1时刻路段上第i单元的交通密度,ρi(t)为t时刻驶出路段上第i单元的交通密度,T″为控制时间步长,L为路段上各单元的长度;λ表示车道数;qi‑1(t)为t时刻驶出路段上第i‑1单元的交通量;qi(t)为t时刻驶出路段上第i单元的交通量。
6.根据权利要求4所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,当T2为HV,T3为CV时,T2的跟车模型采用优化速度模型,T3的跟车模型采用智能驾驶模型;
所述T2的实时速度v2,i(t)方程如下式所示:式中,v2,i(t)为t时刻路段上第i单元T2的实时速度,V(Δx)是车头间距的函数,a2,i(t)分别为t时刻路段上第i单元T2的实时加速度,ρi(t)为t时刻路段上第i单元的交通密度,ρcr表示路段的临界密度;
所述T3的实时速度v3,i(t)方程如下式所示:式中,v3,i(t)为t时刻路段上第i单元T3的实时速度,a3,i(t)为t时刻路段上第i单元T3的实时加速度。
7.根据权利要求2所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S33中,所述T1达到了汇入主路的最低速度要求且具备汇入的速度差要求、加速度差要求、间距要求,具体为:
所述汇入主路的最低速度要求函数如下式所示:vmain,min≤v1,i(t)<vacc,max;
式中,vmain,min为主路最低行驶速度要求,vacc,max为加速车道最高行驶速度要求;
所述速度差要求、加速度差要求、间距要求函数如下式所示:fcondition(Δv,Δa,Δp)=fsafety(Δv12,Δv14,Δv15)∩fsafety(Δa12,Δa14,Δa15)∩fsafety(Δp12,Δp14,Δp15)式中,fcondition(Δv,Δa,Δp)为速度差、加速度差、间距要求函数;fsafety(Δv12,Δv14,Δv15)为速度差安全函数;Δv12为T1与T2的速度差,Δv14为T1与T4的速度差,Δv15为T1与T5的速度差;fsafety(Δa12,Δa14,Δa15)为加速度差安全函数;Δa12为T1与T2的加速度差,Δa14为T1与T4的加速度差,Δa15为T1与T5的加速度差;fsafety(Δp12,Δp14,Δp15)为间距安全函数;
Δp12为T1与T2的间距,Δp14为T1与T4的间距,Δp15为T1与T5的间距;
其中,速度差安全函数fsafety(Δv12,Δv14,Δv15)如下式所示:其中,加速度差安全函数fsafety(Δa12,Δa14,Δa15)如下式所示:其中,间距安全函数fsafety(Δp12,Δp14,Δp15)如下式所示:式中,T′为T1与T2、T5的相对安全车头间距;T为T1与T4的相对安全车头间距。
8.根据权利要求1所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S4中,所述开始执行轨迹优化,具体包括以下步骤:S41、建立CAV轨迹优化模型:T1由加速车道汇入主路的初始时刻为t0,经过Δt后,T1与Ti的车头间距由Δp1i变为Δp′1i,i=2、4、5,T1与车辆行驶方向所成的夹角θ作为T1的汇入转向角,在汇入过程中,T1以恒定纵向加速度与横向加速度和转向角θ进行汇入;
S42、CAV轨迹优化模型中,以T1与T2的最小安全间距、T1与T4的最小安全间距、T1与T5的最小安全间距为安全汇入指标,当T1与T2的斜向距离、T1与T4的斜向距离、T1与T5的斜向距离均大于等于T1与T2的最小安全间距、T1与T4的最小安全间距、T1与T5的最小安全间距时,T1开始执行汇入主路操作,并绘制CAV自加速车道汇入主路轨迹图,且进入S5。
9.根据权利要求8所述的基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法,其特征在于,S42中,所述T1与T2的斜向距离d12的函数表达式如下式所示:d12≥T′
式中,d12为T1与T2的斜向距离;T′为T1与T2的最小安全距离;θ为转向角;Δp′12为Δt时间后T1与T2的车头间距;L为车长;W为车宽;S1y为T1的纵向行驶距离;
其中SIy的表达公式,如下式所示:
式中,v1y为T1的纵向速度,a1y为T1的纵向加速度;
基于上述两式得到T1与T2的最小安全间距T′;
T1与T4的斜向距离d14的函数表达式如下所示:d14≥T
d14=(Δp′14‑L)cosθ+(3‑S1y)sinθ;
式中,d14为T1与T4的斜向距离;T为T1与T4的最小安全距离;θ为转向角;Δp′14为Δt时间后T1与T4的车头间距;L为车长;S1y为T1的纵向行驶距离;
T1与T5的斜向距离d15的函数表达式如下所示:d15≥T′
式中,d15为T1与T5的斜向距离;T′为T1与T5的最小安全距离;θ为转向角;Δp′15为Δt时间后T1与T5的车头间距;L为车长;w为车宽。