1.一种车辆分段式实时换道轨迹规划方法,其特征在于,用于对车辆A从车道I经车道线L换道至车道II的轨迹进行规划,包括:对车辆A从车道I到车道线L的第一段换道轨迹进行规划:根据车辆A及其在车道I上的前方障碍车辆B1的状态,计算车辆A在车道线L上中转位置的状态范围;再基于车辆A在换道起点的状态和中转位置的状态范围,将第一段换道过程的多个指标建模为最优控制问题,优化计算第一段换道过程的轨迹;车辆的状态包括横纵向的位置和速度;
其中,计算车辆A在车道线L上中转位置的状态范围,具体为:
首先,确定车辆A与车辆B1之间不发生横向碰撞的条件:
d1+xB1>xA1 (1)
式中,d1为车辆A与车辆B1之间在换道开始时刻的距离,xB1为车辆B1在车辆A的第一段换道过程中的最小横向位移,xA1为车辆A在第一段换道过程中的最大横向位移,且有:式中,tc为车辆A第一段换道过程的实际时间,aA、vx0分别为车辆A在整个换道过程的横向加速度和横向初始速度,aB1、vB1分为车辆B1在车辆A第一段换道过程中的加速度和速度;其中,车辆B1在横向车道I不换道行驶;
然后,求解不等式(1)得到车辆A在第一段换道过程的最大换道时间t1;
将最大换道时间t1代入到式(2)得到车辆在车道线L上中转位置的状态范围,包括横向位置区间、纵向位置区间、横向速度区间和纵向速度区间:syc=D车,vxc∈[vx0,vx0+aAt1],vyc∈[0,vymax]其中,D车为所有车辆的宽度,vymax为车辆换道的最大纵向速度;
当车辆到达中转位置时,对车辆A从车道线L到车道II的第二段换道轨迹进行规划:根据车道II目标位置的前方障碍车辆B2和后方障碍车辆B3的状态,计算车辆A在车道II的终点状态范围;再利用五次多项式生成多条轨迹,考虑多个指标从中选择最优轨迹作为第二段换道过程的轨迹;
其中,计算车辆A在车道II的终点状态范围,具体为:
首先,确定车辆A与车辆B2之间不发生横向碰撞的条件:
d2+xB2>xA2 (8)
式中,d2为车辆A与车辆B2之间在第二段换道开始时刻的距离,xB2为车辆B2在车辆A的第二段换道过程中的最小横向位移,xA2为车辆A在第二段换道过程中的最大横向位移,且有:式中,te为车辆A第二段换道过程的实际时间,aA、vxc分别为车辆A在整个换道过程的横向加速度和在第一段换道过程结束时的横向速度,aB2、vB2分为车辆B2在车辆A第二段换道过程中的加速度和速度;其中,车辆B2在横向车道II不换道行驶;
然后,还确定车辆A与车辆B3之间不发生横向碰撞的条件:
d3+xA3>xB3 (11)
式中,d3为车辆A与车辆B3之间在第二段换道开始时刻的距离,xB3为车辆B3在车辆A的第二段换道过程中的最大横向位移,xA3为车辆A在第二段换道过程中的最小横向位移,且有:式中,aB3、vB3分为车辆B3在车辆A第二段换道过程中的加速度和速度;其中,车辆B3在横向车道II不换道行驶;
然后再求解不等式(8)得到车辆A在第二段换道过程的最大换道时间t2,以及求解不等式(11)得到车辆A在第二段换道过程的最小换道时间t3,得到车辆A在第二段换道过程的换道时间范围te∈[t3,t2];
最终,将第二段换道过程的最大换道时间t2代入到式(9),将第二段换道过程的最小换道时间t3代入式(12),得到车辆在车道II换道结束位置的状态范围,包括横向位置区间、纵向位置区间、横向速度区间和纵向速度区间:vxe∈[vxc+aAt3,vxc+aAt2],vye=0
其中,D车道为车道的宽度,aA为车辆A在整个换道过程的横向加速度。
2.根据权利要求1所述的车辆分段式实时换道轨迹规划方法,其特征在于,在建模最优控制问题以优化计算第一段轨迹时,和/或,利用五次多项式选择第二段换道轨迹时,均考虑车辆的能耗指标;能耗指标的计算采用VT-CPEM能耗模型。
3.根据权利要求1所述的车辆分段式实时换道轨迹规划方法,其特征在于,距离d1的计算考虑第一段换道轨迹规划的算法求解时间,计算式为:d1=d0-(vx0-vB1)×tcom (4)
式中,d0为车辆A与车辆B1之间在开始换道轨迹规划时的距离,tcom为第一段换道轨迹规划的算法求解时间。
4.根据权利要求1所述的车辆分段式实时换道轨迹规划方法,其特征在于,将第一段换道过程的多个指标建模为最优控制问题,代价函数为:式中,J表示代价函数,为车辆A在时间t的纵向加速度,aymax为车辆A的纵向最大加速度,v(t),a(t)分别为车辆A在时间t的速度和加速度,E(v(t),a(t))为车辆A的能耗代价,Emax表示最大能耗,β1,β2,β3分别代表舒适性、效率、能耗经济性的加权系数,且β1+β2+β3=1;其中,式中,vx(t),ax(t)分别为车辆A在时间t的横向速度和横向加速度,vy(t),ay(t)分别为车辆A在时间t的纵向速度和纵向加速度,ERecoverable(v(t),a(t))为车辆A在时间t的消耗能量,EConsume(v(t),a(t))为车辆A在时间t的制动回收能量;
通过求解上述代价函数,得到第一段换道过程的实际时间tc以及每一时刻的加速度a(t),进而通过积分得到每一时刻的速度v(t)和位移s(t)。
5.根据权利要求4所述的车辆分段式实时换道轨迹规划方法,其特征在于,最优控制问题的约束条件包括:
6.根据权利要求5所述的车辆分段式实时换道轨迹规划方法,其特征在于,采用与第一段换道轨迹最优控制问题相同的代价函数和约束条件,从生成的多条轨迹中选择最优轨迹。
7.根据权利要求1所述的车辆分段式实时换道轨迹规划方法,其特征在于,利用五次多项式生成多条轨迹的方法为:将车辆A在第二段换道过程的换道时间范围te∈[t3,t2],均匀离散为N个时间te1,te2,…,teN;将横向位置区间均匀离散为M个横向位置sxe1,sxe2,…,sxeM;
将车辆A的位置表示为横向和纵向的关于时间t的函数,得到以下表达式:
式中,m、n分别表示离散时间点和离散横向位置的编号,且m=1,2,…,M;n=1,2,…,N;sx(t)、sy(t)分别表示车辆A在时间t的横向位置和纵向位置;a0m×n、a1m×n、a2m×n、a3m×n、a4m×n、a5m×n表示横向位置有关于时间t的五次多项式的系数,b0m×n、b1m×n、b2m×n、b3m×n、b4m×n、b5m×n表示纵向位置有关于时间t的五次多项式的系数;
基于位移、速度、加速度之间的运动学约束关系,得到车辆A的速度和加速度在横向和纵向关于时间t的函数表达式为:式中,vx(t)、vy(t)分别表示车辆A在时间t的横向速度和纵向速度;ax(t)、ay(t)分别表示车辆A在时间t的横向加速度和纵向加速度;
将车辆A在第二段换道过程起点的状态Xc=[sxc,D车,vxc,vyc,axc,ayc]和终点的状态Xe=[sxe,D车道,vxe,vye,axe,aye],且vye=0,axe=0,aye=0,代入到式(14)得到:其中,设第二段换道过程起点的时间t=0;
求解式(17)(18)得到式(14)中的系数a0m×n、a1m×n、a2m×n、a3m×n、a4m×n、a5m×n和系数b0m×n、b1m×n、b2m×n、b3m×n、b4m×n、b5m×n,进而得到车辆A在第二段换道过程的位置、速度以及加速度的函数表达式;
最终基于离散时间点和离散横向位置的编号m、n的不同取值,相应得到多条轨迹。