1.一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,包括以下步骤:步骤S1:设定控制区域,建立平面坐标系;
适用场景为公交专用道条件下的港湾式公交停靠站,自动驾驶公交控制区域总长度为LA,包括道路控制区长度LR、港湾式停靠站的减速区长度LD及停车区长度LS,车道宽度为W1,停靠区宽度为W2,站台与减速区夹角为公交车身长度LV、宽度W、高度H、轴距Lz、前悬L`、后悬L\,公交车四个顶点分别为D1、D2、D3、D4,车身与水平面夹角为车身方向角α,建立平面坐标系,横轴起点为公交沿道路行驶方向的控制区起点,纵轴起点为公交站台外缘道边石;
步骤S2:确定公交车基本运行规则;
公交车在进站准备阶段先后经历两种行驶状态,分成两部分,首先,第一部分是,公交车以v1匀速行驶,行驶时间为t1,行驶距离为L1;第二部分是,公交车再以减速度减速行驶,行驶时间为t2,行驶距离L2,此阶段的末速度设为v2;
步骤S3:多目标进站轨迹规划模型,包括确定轨迹规划目标和确定轨迹规划约束条件;
选择准时性P、能耗E、舒适性C的加权值最小作为公交进站轨迹规划的目标,舒适性C表达式如下式:
其中,n表示将车厢划分为n个区域,区域i站立和坐立乘客的数量分别为和舒适性分别为和站立乘客的舒适性Cst[n^计算公式如下:其中,站立乘客t时刻的综合加权加速度ast[n^(t)表达为:其中,和分别表示t时刻,X轴和Y轴方向的加速度;
坐立乘客的舒适性Csit计算公式如下:坐立乘客t时刻的综合加权加速度asit(t)表达为:设舒适基准值C0为公交车以最大加速度am[x减速行驶计算的舒适性值;
确定轨迹规划的约束条件,考虑速度v(t)、加速度a(t)、加加速度j(t)、曲率K、行驶距离、起止位置、行驶避障约束;
步骤S4:通过序列二次优化算法对规划模型进行求解,得出公交车辆最优行驶轨迹;
步骤S5:按照步骤S4输出的轨迹,执行车辆轨迹;
步骤S6:等待下一轮决策触发。
2.根据权利要求1所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S2中还包括以下步骤:步骤S21:公交车到达控制区域起点时刻为t0=0,且此时公交车已行驶在最外侧车道,速度为v1,进站前车身与车道边界安全距离H1,停靠时车身与站台边界安全距离H2,停靠时车辆前端到站台最前端的距离H3,车辆停靠后与站台距离H4,以公交车前轴中心点轨迹作为车辆轨迹,定义t时刻公交车状态Z(t)为:其中x(t),y(t)分别为t时刻公交车横纵坐标,分别为t时刻公交车横纵方向的速度,和表示t时刻的X和Y方向的加速度。
3.根据权利要求2所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S21中还包括以下步骤:步骤S22:在控制区域范围内,设自动驾驶公交行驶距离为L,其中,进站准备阶段行驶距离L12,这两部分的参数表达,如下式:行驶距离L1的表达,如下式:
L1=v1×t1 (7);
行驶距离L2的表达,如下式:
进站准备阶段行驶距离L12的表达,如下式:L12=L1+L2 (9);
第二部分速度的表达,如下式:
第二部分加速度的表达,如下式:
4.根据权利要求3所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S22中还包括以下步骤:步骤S23:公交车变道驶入港湾停靠站的行驶距离L3,行驶时间t3,行驶距离L3,此阶段选择五次多项式轨迹规划模型进行变道轨迹表达,如下式:ai(i=0,1,2,3,4,5),bi(i=0,1,2,3,4,5)为五次多项式系数,对上式分别求一阶导数和二阶导数:公交进站准备阶段结束时的公交状态即为五次多项式轨迹的起点,表示为:公交车进站停靠后的终止状态为:
Z(t1+t2+t3)={LR+LD+LS-H3-Lz-L`,H4+W/2;0,0;0,0} (16);
当公交车换道进站初始时刻t1+t2和结束时刻t1+t2+t3及其状态均已知,求出车辆的轨迹系数,再通过进站轨迹规划模型筛选出最优轨迹。
5.根据权利要求1所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S3中还包括以下步骤:步骤S31:归一化后目标函数表达式如下:其中,ω1、ω2、ω3分别为各目标对应的权重系数,满足ω1+ω2+ω3=1,P0、E0、C0为基准值;
在步骤S31中,准时性P表达式如下式:P=|t1+t2+t3-T_| (18);
其中,T_为公交车期望到站停靠时刻,设准时基准值P0=T_,t3为公交车变道驶入港湾停靠站的行驶时间。
6.根据权利要求5所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S31中还包括以下步骤:在步骤S31中,能耗E表达式如下式:
E=Eu+Er (19);
其中,Eu和Er分别为公交车匀速和减速运行的能耗;
匀速行驶阶段,公交车能耗Eu计算公式为:考虑效率损失,公交车匀速行驶阶段的电机输出功率Pu(t)为:其中,ηt机械传动效率,ηm电机效率,η]电池效率;
公交车匀速行驶功率Ptr(t)为牵引力Ftr(t)和速度v(t)的乘积:Ptr(t)=Ftr(t)v(t) (22)。
7.根据权利要求5所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S31中还包括以下步骤:在匀速行驶阶段,牵引力计算公式如下:
Ftr(t)=F`+Fi+Fw (23);
式中:Ftr(t)为牵引力,F`为滚动阻力,Fi为坡度阻力,Fw为空气阻力,α为车身与水平面夹角,CD为空气阻力系数,A为迎风面积,v(t)为速度,m[为车辆及乘客总质量,g为重力加速度,f为滚动阻力系数;
因此,匀速行驶阶段公交车能耗Eu计算公式为:减速行驶阶段,纯电动公交车有能量回收;根据运动学关系将纯电动公交车在减速时间的制动能量Ek表示为:用于抵消行驶阻力而减少的动能Etr表示为:纯电动公交车在减速过程中回收的能量Er表示为:Er=(1-k)ηtηmηr(Ek-Etr) (28);
式中:k为制动器分配比;
制动能量回收效率系数ηr表示为:
a(t)为加速度;
减速行驶阶段,纯电动公交车的制动能量Ek表示设能耗基准值E0为公交车以初始速度vu行驶距离LZ所消耗的能量。
8.根据权利要求1所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S3中还包括以下步骤:步骤S32:速度约束表达为:
0≤v(t)≤vm[x (31);
加速度约束表达为:
|a(t)|≤am[x (32);
加加速度约束表达为:
|j(t)|≤jm[x (33);
其中,vm[x、am[x、jm[x分别为最大速度、最大加速度、最大加加速度值;
曲率K的计算公式表达为:
x(t),y(t)分别为t时刻公交车横纵坐标;
曲率约束表达为:
K(t)≤1/Rmin (35);
Rmin是公交车辆的最小转弯半径,取值为8m-12m;
公交车在直线行驶阶段,即变道驶入港湾停靠站的结束时刻,不存在车轮转向,即:K(t)=0, 当0≤t≤t1+t2或t=t1+t2+t3 (36)。
9.根据权利要求8所述的一种自动驾驶公交港湾式停靠站多目标进站轨迹规划方法,其特征在于,步骤S32中还包括以下步骤:公交车的四个顶点在t时刻的横纵坐标分别表示为根据阿克曼转向模型得到四个顶点的实时坐标位置;公交车在进站过程中车辆外缘与道路及站台边界有安全距离,避障约束表达为:(1)控制安全,车辆在可控区间范围内行驶;直线匀速行驶距离约束L1≤LR+LD+LS-H3-Lz-L`,直线减速行驶距离约束L2≤LR+LD+LS-H3-Lz-L`;
(2)车尾未进入港湾,车头未进入港湾,即当时,满足(3)车尾未进入港湾,车头处于减速区,即当时,满足其中,θ为公交车的转向角,其表达式如下:其中,为公交车的纵向运行轨迹与时间的关系,为公交车的横向运行轨迹与时间的关系;
(4)车尾未进入港湾,车头处于停靠区,即当时,满足(5)车尾处于减速区,车头处于减速区,当时,满足(6)车尾处于减速区,车头处于停靠区,即当时,满足(7)车尾处于停靠区,车头处于停靠区,即当时,满足H1为进站前车身与车道边界安全距离,H2为停靠时车身与站台边界安全距离,H3为停靠时车辆前端到站台最前端的距离,H4为车辆停靠后与站台距离;
此外,公交起终点处的状态约束表达为:
(1)公交车起始状态为{0,W2+H1+W/2;v1,0;0,0};
(2)公交车终止状态为{LR+LD+LS-H3-Lz-L`,H4+W/2;0,0;0,0}。