1.一种基于车路协同的混行驾驶车辆编队控制方法,其特征在于,该方法包括如下步骤:(1)基于车路协同的混行驾驶车队长度划分(1.1)如果车辆匀速行驶且前面不存在排队和干扰车辆,则行程时间计算如下:其中,vn表示第n辆车的速度,S表示道路长度;
(1.2)如果车辆不存在排队,则行程时间计算如下:其中,an表示第n辆车的加速度;
(1.3)如果车辆存在排队,则行程时间计算如下:tout,n=tqueue,n+tpass,n其中,tqueue,n表示车辆n的排队时间,tpass,n表示车辆n驶离交叉口的时间;
车辆排队时间计算如下:
其中,dg表示排队车间距,dp表示行驶车间距,N表示最大排队车辆数;
车辆驶离交叉口的时间计算如下:
其中,ln表示车辆自身长度;
(2)确定混行车队行驶条件下通信拓扑结构及车间距策略(2.1)为了避免车队中发生碰撞,计算安全距离:其中,a-max为车辆最大减速度,根据道路条件和车辆动力学模型决定,vn和vn-1分别表示第n辆车和第n-1辆车的速度,且vn≥vn-1;
(2.2)为确保车辆行驶安全性,计算不同类型车辆的行驶距离:其中,hh为人工驾驶车辆理想车头时距,Δth为系统处理数据及传输信息给人工驾驶车辆所消耗的时间,tr为驾驶员收到信息并采取措施的反应时间;hc为网联人工驾驶车辆应该保持的车头时距,Δtc为系统处理数据及传输信息给网联人工驾驶车辆所消耗的时间;ha为网联自动驾驶车辆应该保持的车头时距,Δta为系统处理数据及传输信息给网联自动驾驶车辆所消耗的时间;
(2.3)计算第n辆车与前车的理想车间距:dexp,n=dsafe+drun,n不同类型车辆的理想车间距计算如下:(2.4)计算第n辆车与前车的实际车间距:dtr,n=pn-1-pn
其中,pn和pn-1分别表示第n辆车与第n-1辆车的实际位置;
(3)基于模型预测控制的混行车辆编队控制(3.1)计算相邻两车的车间距偏差:per,n(t)=dtr,n(t)-dexp,n(t)其中,dtr,n(t)表示时间t时,车辆n和车辆n-1之间的实际车间距,dexp,n(t)表示时间t时,车辆n和车辆n-1之间的理想车间距,pn(t)和pn-1(t)分别表示车辆n和车辆n-1在时间t时的位置, 表示车辆n的车头时距,vn(t)表示车辆n在时间t时的速度,dsafe表示安全距离;
(3.2)计算相邻两车间的速度偏差:ver,n(t)=vn(t)-vn-1(t)其中,vn(t)表示车辆n在时间t时的速度,vn-1(t)表示车辆n-1在时间t时的速度;
(3.3)计算不同类型车辆的车头时距:(3.4)对车间距偏差和速度偏差求一阶导:其中,un(t)表示车辆n在时间t时的加速度;
(3.5)以车间距偏差、速度偏差和加速度为输入,建立如下所示的状态空间方程:其中,p(t)表示相同车队中所有车辆在时间t时的车间距偏差组成的矩阵,且p(t)=T[per,1(t),per,2(t),...,per,n(t)] ,v(t)表示相同车队中所有车辆在时间t时的速度偏差组成的矩阵,且v(t)=[ver,1(t),ver,2(t),...,ver,n(t)]T,u(t)表示相同车队中所有车辆在时间t时的加速度组成的矩阵,且u(t)=[u1(t),u2(t),...,un(t)]T。 和 分别是车间距偏差矩阵p(t)和速度偏差矩阵v(t)的一阶导数,0n是n维零矩阵,En是n维单位矩阵,矩阵D表示如下:(3.6)设 以及 将状态空间方程简化为:MPC中输入和输出关系如下:
y(t)=Cx(t)
其中,
(3.7)对状态空间方程进行离散化处理:x(k+1)=(I+AT)x(k)+BTu(k)其中,I是单位矩阵,T是采用时间。设 则离散状态空间方程如下:
(3.8)设Np表示预测时域,Nc表示控制时域,并且Nc≤Np,则在未来预测时域Np中,车辆输入状态方程为:递推可得:
同理可得,未来预测时域Np中,车辆输出状态方程为:因此,离散状态空间方程进一步表示为:X(t)=ψx(k)+Φu(k)Y(t)=ξX(t)
其中,
(3.9)建立多目标函数
min F(x)=(f1(x),f2(x))通过函数f1(x)计算出车队行程时间最短时的最优加速度,函数f2(x)计算出车间距偏差和速度偏差最小时的最优加速度,具体计算如下:其中,
(3.10)混行车辆编队控制模型约束条件:(1)加速度约束:umin≤un(k)≤umax(2)速度约束:0≤vn(k)≤vmax(3)车间距约束:pn(k)-pn+1(k)≥dexp,n(4)通信状态约束:0<Δt<Δtmax+θmaxk其中,Δtmax为最大延时值,θmax为最大丢包数;
(5)车辆行程时间约束:0