1.一种车辆制动转向协调控制防碰撞系统的控制方法,所述系统包括数据采集模块、综合处理模块和执行模块;
所述数据采集模块中:激光雷达、毫米波雷达、摄像头、ZigBee和自车信息读取单元,分别将采集到的车辆行驶数据和道路信息数据发送至综合处理模块;
所述综合处理模块中,数据处理单元对接收到的车辆行驶数据和道路信息数据进行分析处理获得决策数据并发送至决策单元,经决策单元判断产生决策指令并发送至执行模块;
所述执行模块中,制动器、转向器、蜂鸣器和指示灯分别接收决策单元发送的决策指令,执行转向、制动或预警操作;
所述车辆行驶数据包括:
激光雷达采集到的同车道前车、侧方车道后车和侧方车道前车的车速和加速度,自车与同车道前车之间的车距,自车与侧方车道后车之间的纵向车距,自车与侧方车道前车之间的纵向车距,侧方车道后车与侧方车道前车之间的车距;
毫米波雷达采集到的同车道前车、侧方车道后车和侧方车道前车的车速和加速度;
ZigBee通过数据通信的方式采集到的同车道前车、侧方车道后车和侧方车道前车的车速和加速度,自车所在车道上的不同车型数量,以及自车的侧方车道上的不同车型数量;
自车信息读取单元采集到的自车的车速和自车的加速度;
所述道路信息数据包括:
摄像头采集到的道路宽度、自车所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离,自车所在的行驶中心线与侧方车道之间的车道分界线之间的横向距离,以及自车所在的车道与侧方车道之间的车道分界线的虚实情况;
其特征在于:
所述控制方法具体如下:
S1:采集车辆行驶数据和道路信息数据;
所述步骤S1中:
所述车辆行驶数据包括自车A、同车道前车B、侧方车道后车C以及侧方车道前车D的行驶数据;其中:通过激光雷达采集同车道前车B的车速vB1、同车道前车B的加速度aB1,侧方车道后车C的车速vC1、侧方车道后车C的加速度aC1,侧方车道前车D的车速vD1、侧方车道前车D的加速度aD1,自车A与同车道前车B之间的车距db,自车A与侧方车道后车C之间的纵向车距dc,自车A与侧方车道前车D之间的纵向车距dd,侧方车道后车C与侧方车道前车D之间的车距dcd;
通过毫米波雷达采集同车道前车B的车速vB2、同车道前车B的加速度aB2,侧方车道后车C的车速vC2、侧方车道后车C的加速度aC2,侧方车道前车D的车速vD2、侧方车道前车D的加速度aD2;
通过ZigBee采集同车道前车B的车速vB3、同车道前车B的加速度aB3,侧方车道后车C的车速vC3、侧方车道后车C的加速度aC3,侧方车道前车D的车速vD3、侧方车道前车D的加速度aD3,以及自车A所在车道上的乘用车数量n11、客车数量n12、普通货车数量n13、大型货车数量n14,自车A的侧方车道上的乘用车数量n21、客车数量n22、普通货车数量n23、大型货车数量n24;
通过自车信息读取单元采集自车A的车速vA、自车A的加速度aA、自车A的悬架总角刚度kφ、自车A的簧上质量ms、自车A的簧上质量质心至侧倾轴线的距离h’;
所述道路信息数据包括通过摄像头采集的道路宽度w、自车A所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离h、自车A所在的行驶中心线与侧方车道之间的车道分界线之间的横向距离z,以及自车A所在的车道与侧方车道之间的车道分界线的虚实情况;
S2:数据初步分析处理获得周边车辆行驶数据;
所述步骤S2中:
根据所述步骤S1中获得的车辆行驶数据初步分析处理获得的周边车辆行驶数据包括:同车道前车B的车速vB和加速度aB、侧方车道后车C的车速vC和加速度aC,以及侧方车道前车D的车速vD和加速度aD,计算公式具体如下:S3:数据进一步分析处理获得决策数据,经判断产生并执行转向、制动或预警的决策指令;
本步骤S3中:
根据所述步骤S1和所述步骤S2中获得的数据进一步分析处理获得决策数据,经判断产生并执行决策指令控制执行相应操作的具体过程如下:S31:检测到自车的同车道前方有车辆,并计算纵向预警距离dz1;
所述步骤S31中:
所述纵向预警距离dz1的计算公式如下:上述纵向预警距离dz1的计算公式中:amax为自车A最大制动减速度;
t1为自车A制动反应时间;
t2为自车A制动延迟时间;
t3为自车A制动增长时间;
d0为自车A停车距离;
S32:判断自车A与同车道前车B之间的车距db与纵向预警距离dz1的大小关系,若db≥dz1,则产生并执行正常驾驶指令;若db<dz1,则进入下述步骤S33;
S33:判断侧方变道是否安全,若安全则执行转向操作实现侧方变道,若不安全则执行预警和制动操作;
所述步骤S33中:
判断侧方变道是否安全放入具体步骤如下:S331:判断自车A所在的车道与侧方车道之间的车道分界线是否为虚线,若为虚线,则进入下述步骤S332,若不为虚线,即为实线,则产生并执行预警警告及轻微制动指令;
S332:判断侧方车道后车C与变道后的自车A’之间的安全距离dr与侧方车道后车C与变道后的自车A’之间的实际距离d2之间的大小关系,以及判断侧方车道前车D与变道后的自车A’之间的安全距离df与侧方车道前车D与变道后的自车A’之间的实际距离d3之间的大小关系,若dr<d2且df<d3则进入下述步骤S333,否则产生并执行预警警告及轻微制动指令;
所述侧方车道后车C与变道后的自车A’之间的安全距离dr为预设值;
所述侧方车道前车D与变道后的自车A’之间的安全距离df为预设值;
所述侧方车道后车C与变道后的自车A’之间的实际距离d2的计算公式如下:d2=dc+l‑Sr
上述实际距离d2的计算公式中:
dc为自车A与侧方车道后车C的纵向车距;
l为变道时间内自车A纵向行驶位移;
Sr为变道时间内侧方车道后车C的行驶位移;
t0为db=dz1的时刻;
vA(t0)为t0时刻自车A的车速;
vC(t0)为t0时刻侧方车道后车C的车速;
aC为侧方车道后车C的车加速度;
tb为自车A的换道时间,其中:
上述自车换道时间tb的计算公式中:为轮胎侧向附着系数;
g为重力加速度;
h为自车A所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离;
w为道路宽度;
z为自车A所在的行驶中心线与侧方车道之间的车道分界线之间的横向距离;
最终,获得变道后的自车A’与侧方车道后车C的实际距离d2的计算公式如下:所述侧方车道前车D与变道后的自车A’之间的实际距离d3的计算公式如下:d3=dd+Sf‑l
上述实际距离d3的计算公式中:
dd为自车A与侧方车道前车D纵向车距;
l为变道时间内自车A纵向行驶位移;
Sf为变道时间内侧方车道前车D行驶位移;
t0为db=dz1的时刻;
vA(t0)为t0时刻自车车速;
vD(t0)为t0时刻侧方车道前车D车速;
aD为侧方车道前车D的车加速度;
tb为自车换道时间,其中:
上述自车换道时间tb的计算公式中:为轮胎侧向附着系数;
g为重力加速度;
h为自车A所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离;
w为道路宽度;
z为自车A所在的行驶中心线与侧方车道之间的车道分界线之间的横向距离;
最终,获得变道后的自车A’与侧方车道后车D的实际距离d3的计算公式如下:S333:判断自车A所在车道的同车道道路通畅率γ1与自车A侧方车道的侧方车道道路通畅率γ2的大小关系,若γ2>γ1,则进入下述步骤S334,否则产生并执行预警警告及轻微制动指令;
本步骤S333中:
所述同车道道路通畅率γ1与侧方车道道路通畅率γ2的计算公式如下:上述同车道道路通畅率γ1与侧方车道道路通畅率γ2的计算公式中:n11为自车A所在车道上的乘用车数量;
n12为自车A所在车道上的客车数量;
n13为自车A所在车道上的普通货车数量;
n14为自车A所在车道上的大型货车数量;
n21为自车A的侧方车道上的乘用车数量;
n22为自车A的侧方车道上的客车数量;
n23为自车A的侧方车道上的普通货车数量;
n24为自车A的侧方车道上的大型货车数量;
S334:计算自车A从所在车道变换车道至侧方车道的换道轨迹侧方位移y(t)的计算公式如下:上述换道轨迹侧方位移y(t)的计算公式中:t≤tb;
h为自车A所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离;
t0为db=dz1的时刻;
vA(t0)为t0时刻自车车速;
tb为自车换道时间,其中:
上述自车换道时间tb的计算公式中:为轮胎侧向附着系数;
g为重力加速度;
w为道路宽度;
z为自车A所在的行驶中心线与侧方车道之间的车道分界线之间的横向距离;
S335:判断自车A从所在车道变换车道至侧方车道过程中的质心侧偏角φ与人体舒适性上限的质心侧偏角φlim的大小关系,若φ<φlim,则进入下述步骤S336,否则产生并执行预警警告及轻微制动指令;
所述人体舒适性上限的质心侧偏角φlim为预设值;
所述自车A从所在车道变换车道至侧方车道过程中的质心侧偏角φ的计算公式如下:上述质心侧偏角φ的计算公式中:
为侧向加速度;
h为自车A所在的行驶中心线与侧方车道车辆所在的行驶中心线之间的横向距离;
S336:自车A从所在车道变换车道至侧方车道过程中的转向角θ与操作稳定性转向角的上限值θlim的大小关系,若θ<θlim,则进入下述步骤S337,否则产生并执行预警警告即轻微制动指令;
所述操作稳定性转向角的上限值θlim为预设值;
所述自车A从所在车道变换车道至侧方车道过程中的转向角θ的计算公式如下:上述转向角θ的计算公式中:
vAy为自车换道时侧向速度,
vAx为自车换道时纵向车速,vAx=vA(t0);
即:
S337:判断自车A从所在车道变换车道至侧方车道过程中的侧向加速度 与人体舒适性上限的侧向加速度 之间的大小关系,若 则产生并执行转向操作,控制转向器工作,使自车A遵循自车变道轨迹进行侧方变道,否则产生并执行预警警告及轻微制动指令;
所述人体舒适性上限的侧向加速度 为预设值;
所述自车A从所在车道变换车道至侧方车道过程中的侧向加速度 根据所述换道轨迹侧方位移y(t)求导获得;
所述自车变道轨迹为:
上述自车变道轨迹方程式中:
t≤tb;
y(t)为自车A的换道轨迹侧方位移;
S(t)为自车A的纵向位移。