CN114312765B - A longitudinal active collision avoidance control system and method - Google Patents

A longitudinal active collision avoidance control system and method Download PDF

Info

Publication number
CN114312765B
CN114312765B CN202111666415.9A CN202111666415A CN114312765B CN 114312765 B CN114312765 B CN 114312765B CN 202111666415 A CN202111666415 A CN 202111666415A CN 114312765 B CN114312765 B CN 114312765B
Authority
CN
China
Prior art keywords
vehicle
longitudinal
wheel
collision
wire
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202111666415.9A
Other languages
Chinese (zh)
Other versions
CN114312765A (en
Inventor
郭中阳
吴竟启
宋娟娟
束琦
王剑波
束磊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Chaoli Electric Appliance Co.,Ltd.
Original Assignee
Jiangsu Chaoli Electric Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Jiangsu Chaoli Electric Inc filed Critical Jiangsu Chaoli Electric Inc
Priority to CN202111666415.9A priority Critical patent/CN114312765B/en
Publication of CN114312765A publication Critical patent/CN114312765A/en
Application granted granted Critical
Publication of CN114312765B publication Critical patent/CN114312765B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Regulating Braking Force (AREA)

Abstract

The invention discloses a longitudinal active anti-collision control system and a method, and the longitudinal active anti-collision control system comprises an environment and obstacle detection system, a chassis anti-collision control system, a wheel independent drive-by-wire system and a wheel independent drive-by-wire brake system, wherein the chassis anti-collision control system comprises a front-end collision protection system and a rear-end collision protection system; the wheel independent brake-by-wire system comprises a vehicle body stabilizing module and a brake delay compensation module, wherein the vehicle body stabilizing module is used for ensuring the stability of a vehicle, and the brake delay compensation module is used for compensating brake delay caused by brake execution action delay and communication delay. The system completes independent braking and independent driving operation commands of the independent wheels by using corresponding control strategies according to the external environment and the obstacle information, and guarantees the stability and safety of the vehicle in the running process.

Description

一种纵向主动防撞控制系统及方法A longitudinal active collision avoidance control system and method

技术领域technical field

本发明涉及一种纵向主动防撞控制系统及方法。The invention relates to a longitudinal active anti-collision control system and method.

背景技术Background technique

随着科技的飞速发展,物流运输行业也向着智能化、网联化方向发展,在汽车产业智能化浪潮下,整车线控底盘的改进和发展呈现较快增长趋势。随着汽车年产量的日渐增长,其造成的社会问题也日趋严重,主要涉及能源消耗量大、交通拥堵、车辆交通事故伤亡率高以及环境污染等问题,其中交通事故的发生对人们的生命和财产安全产生了巨大的损害,线控底盘是目前车辆各种智能化转变和智能化操纵的基础,在政策和市场的共同作用下,对线控底盘的改进和进一步研究已经成为大势所趋。With the rapid development of science and technology, the logistics and transportation industry is also developing in the direction of intelligence and networking. Under the wave of intelligence in the automotive industry, the improvement and development of the vehicle's wire-controlled chassis shows a rapid growth trend. With the increasing annual production of automobiles, the social problems caused by them are also becoming more and more serious, mainly involving problems such as large energy consumption, traffic congestion, high casualty rate of vehicle traffic accidents, and environmental pollution. Property safety has caused huge damage. The drive-by-wire chassis is the basis for various intelligent transformation and intelligent manipulation of vehicles. Under the combined effect of policies and the market, the improvement and further research on the drive-by-wire chassis has become the general trend.

车辆追尾碰撞是车辆交通事故产生的主要原因,与传统底盘相比,线控底盘消除部分执行器的误差,为无人驾驶提供了可能。线控底盘控制执行主要基于车辆底盘的线控制动、线控转向和线控驱动,大部分追尾碰撞事故是在纵向行驶发生的,针对纵向车辆行驶时的追尾碰撞设计主动防撞控制线控底盘变得很有必要。Vehicle rear-end collision is the main cause of vehicle traffic accidents. Compared with the traditional chassis, the wire-controlled chassis eliminates the error of some actuators and provides the possibility for unmanned driving. The control execution of the drive-by-wire chassis is mainly based on the brake-by-wire, steering-by-wire and drive-by-wire drive of the vehicle chassis. Most rear-end collision accidents occur in longitudinal driving, and the active anti-collision control-by-wire chassis is designed for the rear-end collision when the longitudinal vehicle is driving. becomes necessary.

发明内容SUMMARY OF THE INVENTION

针对上述问题,本发明提供一种纵向主动防撞控制系统及方法,系统根据外界环境和障碍物信息,利用相应的控制策略,完成独立车轮的独立制动和独立驱动操作指令,保障车辆行驶过程中的稳定性和安全性。In view of the above problems, the present invention provides a longitudinal active anti-collision control system and method. The system uses corresponding control strategies according to the external environment and obstacle information to complete the independent braking and independent driving operation instructions of independent wheels to ensure the driving process of the vehicle. stability and security.

为实现上述技术目的,达到上述技术效果,本发明通过以下技术方案实现:In order to realize the above-mentioned technical purpose and achieve the above-mentioned technical effect, the present invention is realized through the following technical solutions:

一种纵向主动防撞控制系统,包括环境和障碍物检测系统,所述环境和障碍物检测系统用于检测并采集环境信息和车辆前后左右各方障碍物位置与运动状态信息,还包括底盘防撞控制系统、车轮独立线控驱动系统和车轮独立线控制动系统,所述底盘防撞控制系统包括防护前端碰撞系统和防护后端碰撞系统,所述车轮独立线控驱动系统用于对车辆的各个车轮施加独立的驱动力,所述车轮独立线控制动系统用于对车辆的各个车轮施加独立的制动力,所述底盘防撞控制系统根据环境和障碍物检测系统采集的信息控制各个车轮的制动力和驱动力使得车辆实现防护前端碰撞和防护后端碰撞;所述车轮独立线控制动系统包括车身稳定模块和制动延迟补偿模块,所述车身稳定模块用于保证车辆稳定,所述制动延迟补偿模块用于补偿制动器执行动作延迟与通讯延时导致的制动延迟。A longitudinal active anti-collision control system, including an environment and obstacle detection system, the environment and obstacle detection system is used to detect and collect environmental information and information on the position and motion status of obstacles on the front, rear, left, and right sides of the vehicle, and also includes chassis anti-collision system. A crash control system, a wheel independent drive-by-wire system and a wheel-independent brake-by-wire system, the chassis anti-collision control system includes a front-end collision protection system and a rear-end collision protection system, and the wheel-independent drive-by-wire system is used for driving the vehicle. Each wheel applies an independent driving force, and the wheel-independent brake-by-wire system is used to apply an independent braking force to each wheel of the vehicle. The braking force and driving force enable the vehicle to achieve front-end collision protection and rear-end collision protection; the wheel-independent brake-by-wire system includes a body stability module and a braking delay compensation module, the body stability module is used to ensure vehicle stability, and the braking The motion delay compensation module is used to compensate the brake delay caused by the brake execution delay and communication delay.

优选,还包括车车通讯系统和云端通讯系统:所述车车通讯系统用于线控底盘车型车辆之间的信息交互,以及线控底盘车型车辆与其他车型车辆的信息交互;所述云端通讯系统用于记录线控底盘车型车辆的环境和障碍物检测系统采集的环境信息数据,并将其传递给非线控底盘车型车辆,同时将非线控底盘车型车辆的信息记录反馈给线控底盘车型车辆,完成道路车辆全部参与信息交互;所述云端通讯系统还包括信息整合单元A,所述信息整合单元A将云端通讯系统接收的信息、环境和障碍物检测系统检测到的障碍物信息以及车车通讯系统的交互信息进行信息整合。Preferably, it also includes a vehicle-to-vehicle communication system and a cloud communication system: the vehicle-to-vehicle communication system is used for information interaction between the wire-controlled chassis model vehicles, and the information interaction between the wire-controlled chassis type vehicles and other types of vehicles; the cloud communication system The system is used to record the environment of vehicles with chassis-by-wire vehicles and the environmental information data collected by the obstacle detection system, and transmit it to vehicles with non-wire-controlled chassis models. The cloud communication system also includes an information integration unit A, which integrates the information received by the cloud communication system, the obstacle information detected by the environment and the obstacle detection system, and the The interactive information of the vehicle-to-vehicle communication system is integrated.

优选,所述环境和障碍物检测系统包括智能环视传感器系统、轮心相对高度测量仪、信息整合单元B和平整度信息修正单元:Preferably, the environment and obstacle detection system includes an intelligent surround view sensor system, a wheel center relative height measuring instrument, an information integration unit B and a flatness information correction unit:

所述智能环视传感器系统包括车头顶部机械式激光雷达,车头前部的固态激光雷达,车头顶部与前部相交处的双目摄像头以及车辆尾部的单目摄像头;The intelligent surround view sensor system includes a mechanical lidar on the top of the vehicle, a solid-state lidar on the front of the vehicle, a binocular camera at the intersection of the top of the vehicle and the front, and a monocular camera at the rear of the vehicle;

所述信息整合单元B将机械式激光雷达、双目摄像头采集到的信息与车车通讯系统、云端通信系统采集的车辆交互信息进行整合,精确障碍物和周边车辆状态;The information integration unit B integrates the information collected by the mechanical laser radar and the binocular camera with the vehicle interaction information collected by the vehicle-to-vehicle communication system and the cloud communication system to accurately determine the status of obstacles and surrounding vehicles;

平整度信息修正单元将固态激光雷达与轮心相对高度测量仪采集的车辆行驶的周围道路平整度信息进行修正。The flatness information correction unit corrects the flatness information of the surrounding road where the vehicle is traveling, which is collected by the solid-state lidar and the wheel center relative height measuring instrument.

优选,所述底盘防撞控制系统用于控制三轴六轮车辆,所述车轮独立线控驱动系统为六轮独立线控驱动系统,六个车轮均为驱动轮,每个驱动轮包括驱动模式、随动模式与放空模式三种工作模式;Preferably, the chassis anti-collision control system is used to control a three-axle six-wheel vehicle, the wheel independent wire-controlled drive system is a six-wheel independent wire-controlled drive system, the six wheels are all driving wheels, and each driving wheel includes a driving mode, a Three working modes: dynamic mode and empty mode;

所述车轮独立线控制动系统为六轮独立线控制动系统,所述车身稳定模块和制动延迟补偿模块用于保证制动工作时的车辆自身稳定性和无延迟制动。The wheel independent brake-by-wire system is a six-wheel independent brake-by-wire system, and the vehicle body stability module and the brake delay compensation module are used to ensure the vehicle's own stability and non-delay braking during braking.

优选,车辆前端的第一轴和车辆尾端的第三轴的驱动轮采用轮边驱动模式,车辆中间的第二轴的驱动轮采用轮毂电机驱动模式,车辆前端的第一轴和车辆尾端的第三轴采用电液耦合制动,车辆中间的第二轴采用电子机械制动。Preferably, the driving wheels of the first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopt the wheel-side drive mode, the driving wheel of the second axle in the middle of the vehicle adopts the in-wheel motor drive mode, and the first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopt the in-wheel motor drive mode. The three-axle adopts electro-hydraulic coupling braking, and the second axis in the middle of the vehicle adopts electro-mechanical braking.

优选,当第二轴处于放空模式时、仅第一轴和第三轴车轮制动工作时,第一轴和第三轴的四个车轮制动的轮缸压力值分别为:Preferably, when the second axle is in the emptying mode and only the wheel brakes of the first axle and the third axle are working, the wheel cylinder pressure values of the four wheel brakes of the first axle and the third axle are respectively:

Figure GDA0003767225330000031
Figure GDA0003767225330000031

Figure GDA0003767225330000032
Figure GDA0003767225330000032

Figure GDA0003767225330000033
Figure GDA0003767225330000033

Figure GDA0003767225330000034
Figure GDA0003767225330000034

式中,p1、p2、p5、p6分别为第一轴左右侧车轮与第三轴左右侧车轮的制动压力,单位为MPa;FZ1、FZ2、FZ5、FZ6分别为第一轴左右侧车轮与第三轴左右侧车轮的地面垂向作用力,单位为N;Rw1、Rw3分别为第一轴和第三轴上车轮的半径,单位为米;Kb为制动压力系数,其大小为车轮制动力矩与轮缸压力的比值;ΔMZ为车辆期望横摆力矩,单位为Nm;B1为第一轴左右侧车轮中心到轴心的距离,B3为第三轴左右侧车轮中心到轴心的距离,单位为米;δ1、δ2、δ5、δ6分别为第一轴左右侧车轮与第三轴左右侧车轮转角,单位为rad。In the formula, p 1 , p 2 , p 5 , and p 6 are the braking pressures of the left and right wheels of the first axis and the left and right wheels of the third axis, respectively, in MPa; F Z1 , F Z2 , F Z5 , and F Z6 respectively is the ground vertical force of the left and right wheels of the first axis and the left and right wheels of the third axis, in N; R w1 and R w3 are the radii of the wheels on the first and third axes, respectively, in meters; K b is the braking pressure coefficient, which is the ratio of the wheel braking torque to the wheel cylinder pressure; ΔM Z is the expected yaw moment of the vehicle, in Nm; B 1 is the distance from the center of the left and right wheels of the first axis to the axle center, B 3 is the distance from the center of the left and right wheels of the third axis to the axle center, the unit is meters; δ 1 , δ 2 , δ 5 , δ 6 are the rotation angles of the left and right wheels of the first axis and the left and right wheels of the third axis, the unit is rad .

优选,制动延迟补偿模块的补偿轮缸压力值为:Preferably, the compensation wheel cylinder pressure value of the brake delay compensation module is:

Figure GDA0003767225330000041
Figure GDA0003767225330000041

式中,pcom为补偿轮缸压力值,t1为通讯延迟时间,t2’为制动器间隙减小所用时间,t2”为制动器逐渐压紧至稳定所用时间,从制动器起作用开始后的t1+t2’+t2”/2时间段内,ppro取值为最大轮缸压力值的30%-80%,单位为MPa,ppro的值取决于底盘防撞控制系统中的制动减速度值,p(t)为t时刻制动轮缸压力值,单位为MPa。In the formula, p com is the compensation wheel cylinder pressure value, t 1 is the communication delay time, t 2 ' is the time taken for the brake clearance to decrease, t 2 '' is the time taken for the brake to be gradually pressed to a stable state, and the time after the brake starts to work. During the time period of t 1 +t 2 '+t 2 ”/2, the value of p pro is 30%-80% of the maximum wheel cylinder pressure value, the unit is MPa, and the value of p pro depends on the chassis collision avoidance control system. Brake deceleration value, p(t) is the pressure value of the brake wheel cylinder at time t, the unit is MPa.

优选,所述平整度信息修正单元的修正公式为:Preferably, the correction formula of the flatness information correction unit is:

Figure GDA0003767225330000042
Figure GDA0003767225330000042

式中,hn,i为修正后的车辆周围第i个不平路面低矮障碍相对高度;h’n,i和h”n,i分别为固态激光雷达检测和轮心相对高度测量仪测量的车辆周围第i个不平路面低矮障碍相对高度,单位为米;vx为车辆的纵向车速,单位为m/s;kvx为纵向车速影响因子,单位为m/s。In the formula, h n,i is the corrected relative height of the i-th low obstacle on the uneven road around the vehicle; h' n,i and h'n ,i are measured by solid-state lidar detection and wheel center relative height measuring instrument, respectively. The relative height of the low obstacle on the ith uneven road around the vehicle, in meters; vx is the longitudinal speed of the vehicle, in m/s; k vx is the longitudinal speed influence factor, in m/s.

优选,所述信息整合单元B经过信息整合后的障碍物信息为:Preferably, the obstacle information after information integration by the information integration unit B is:

Figure GDA0003767225330000043
Figure GDA0003767225330000043

Figure GDA0003767225330000044
Figure GDA0003767225330000044

Figure GDA0003767225330000045
Figure GDA0003767225330000045

Figure GDA0003767225330000046
Figure GDA0003767225330000046

式中,xcj、ycj、vcj、acj分别为双目摄像头所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xdj、ydj、vdj、adj分别为机械式激光雷达所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xwi、ywi、vwi、awi分别为车车通讯系统检测到的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xi、yi、vi、ai分别为整合后的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xn-i、yn-i、vn-i、an-i为整合后的非线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度,其中n为机械式激光雷达所检测到的动态障碍物的数量,j=1…n;kw为交互信息准确性系数;kd为雷达信息准确性系数;kc为摄像头信息准确性系数,kw、kd和kc的取值均为小于1的正数;xd,n-i、yd,n-i、vd,n-i、ad,n-i分别为机械式激光雷达所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xc,n-i、yc,n-i、vc,n-i、ac,n-i分别为双目摄像头所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度。In the formula, x cj , y cj , v cj , and a cj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by the binocular camera; x dj , y dj , v dj , and a dj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by mechanical lidar, respectively; x wi , y wi , v wi , and a wi are respectively are the longitudinal instantaneous position, lateral instantaneous position , instantaneous speed , and instantaneous acceleration of the i - th vehicle-by-wire chassis vehicle detected by the vehicle-to-vehicle communication system; Longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the vehicle by wire-controlled chassis; x ni , y ni , v ni , and a ni are the longitudinal and lateral instantaneous positions of the integrated non-wire-controlled chassis vehicle. Instantaneous speed, instantaneous acceleration, where n is the number of dynamic obstacles detected by mechanical lidar, j=1...n; k w is the accuracy coefficient of interactive information; k d is the accuracy coefficient of radar information; k c is The camera information accuracy coefficient, k w , k d and k c are all positive numbers less than 1; x d, ni , y d, ni , v d, ni , a d, ni are mechanical lidars, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle collected; x c,ni , y c,ni , v c,ni , a c,ni are the binocular cameras, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle are collected.

对应的,一种纵向主动防撞控制方法,底盘防撞控制系统包括具有通讯功能的防撞模式和不具有通讯功能的防撞模式:Correspondingly, a longitudinal active anti-collision control method, the chassis anti-collision control system includes an anti-collision mode with a communication function and an anti-collision mode without a communication function:

具有通讯功能的防撞模式:根据环境和障碍物检测系统、车车通讯系统以及云端通讯系统整合后的障碍物信息数据,判定自车的碰撞风险,利用障碍物数据和相应控制策略决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞;Anti-collision mode with communication function: According to the obstacle information data integrated by the environment and obstacle detection system, the vehicle-to-vehicle communication system and the cloud communication system, determine the collision risk of the own vehicle, and use the obstacle data and the corresponding control strategy to decide the out-of-line control The execution of the various systems of the chassis avoids collision with dynamic and static obstacles;

不具有通讯功能的防撞模式,仅根据环境和障碍物检测系统采集的动静态障碍物信息,判断自车的碰撞风险,利用障碍物数据和相应控制策略决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞,具体算法如下:The anti-collision mode without communication function only judges the collision risk of the vehicle based on the dynamic and static obstacle information collected by the environment and obstacle detection system, and uses the obstacle data and the corresponding control strategy to decide the execution actions of each system of the drive-by-wire chassis. To avoid collision with dynamic and static obstacles, the specific algorithm is as follows:

A)设t时刻相邻两车之间的纵向间距d(t)为:A) Let the longitudinal distance d(t) between two adjacent cars at time t be:

d(t)=xf(t)-x(t)或d(t)=x(t)-xr(t)d(t)= xf (t)-x(t) or d(t)=x(t) -xr (t)

式中,xf(t)为t时刻线控底盘车型前车的纵向位置,x(t)为t时刻线控底盘车型的纵向位置,xr(t)为t时刻线控底盘车型后车的纵向位置,单位为米;In the formula, x f (t) is the longitudinal position of the car in front of the chassis model by wire at time t, x(t) is the longitudinal position of the chassis model by wire at time t, and x r (t) is the rear car of the chassis model by wire at time t The longitudinal position of , in meters;

B)t时刻底盘防撞控制系统控制的纵向驱动力或纵向制动力的计算公式为:B) The calculation formula of the longitudinal driving force or longitudinal braking force controlled by the chassis anti-collision control system at time t is:

Figure GDA0003767225330000061
Figure GDA0003767225330000061

Figure GDA0003767225330000062
Figure GDA0003767225330000062

式中,F(t)为t时刻车辆纵向驱动力或制动力,单位为N;m为自车的整车质量;q和k为积分滑模系数;λ1为改进车头时距系数;Fa(t)、Fr(t)分别为t时刻空气阻力和滚动阻力,单位为N;

Figure GDA0003767225330000063
为t时刻相邻辆车的纵向位置误差值的一阶导数;
Figure GDA0003767225330000064
为t时刻相邻辆车的纵向位置误差值的二阶导数;ades(t)为t时刻滑模控制策略所得到的自车的期望加速度;v1和v2分别为相邻两车中前车的纵向车速和后车的纵向车速,单位为m/s;In the formula, F(t) is the longitudinal driving force or braking force of the vehicle at time t, the unit is N; m is the vehicle mass of the vehicle; q and k are the integral sliding mode coefficients; λ 1 is the improved headway coefficient; F a (t) and F r (t) are the air resistance and rolling resistance at time t, respectively, and the unit is N;
Figure GDA0003767225330000063
is the first derivative of the longitudinal position error value of adjacent vehicles at time t;
Figure GDA0003767225330000064
is the second derivative of the longitudinal position error value of the adjacent vehicle at time t; a des (t) is the expected acceleration of the vehicle obtained by the sliding mode control strategy at time t; v 1 and v 2 are the two adjacent vehicles, respectively The longitudinal speed of the preceding vehicle and the longitudinal speed of the rear vehicle, in m/s;

Figure GDA0003767225330000065
Figure GDA0003767225330000065

Figure GDA0003767225330000066
Figure GDA0003767225330000066

式中,λ为积分滑模系数,无量纲,e(t)为t时刻相邻两车的纵向位置误差值,单位为m;si为滑模面,G为正常数;In the formula, λ is the integral sliding mode coefficient, dimensionless, e(t) is the longitudinal position error value of two adjacent vehicles at time t, the unit is m; s i is the sliding mode surface, and G is a constant;

C)防护前端碰撞系统判断自车的车头与前车发生碰撞的风险,当自车前方距离最近的车辆的纵向位置与自车纵向位置之差小于期望间距时,启动防护前端碰撞系统,其中自车与前车的纵向期望间距计算公式为:C) The front-end collision protection system judges the risk of collision between the front of the vehicle and the vehicle in front. When the difference between the longitudinal position of the vehicle with the closest distance in front of the vehicle and the longitudinal position of the vehicle is less than the desired distance, the front-end collision protection system is activated, in which the self-service front-end collision protection system is activated. The formula for calculating the expected longitudinal distance between the vehicle and the vehicle in front is:

Figure GDA0003767225330000067
Figure GDA0003767225330000067

式中,dx,des为自车与前车的期望间距;vx为自车纵向车速;vx,f为前车的纵向车速;ax为自车纵向加速度;ax,f为前车的纵向加速度;λ1为改进车头时距系数;λ2为速度比例系数;λ3为加速度差值系数;d为车辆最小行驶间距,单位为m;In the formula, d x, des is the expected distance between the ego vehicle and the preceding vehicle; v x is the longitudinal speed of the ego vehicle; v x, f is the longitudinal speed of the preceding vehicle; a x is the longitudinal acceleration of the ego vehicle; a x, f is the front Longitudinal acceleration of the vehicle; λ 1 is the time distance coefficient of the improved vehicle head; λ 2 is the speed proportional coefficient; λ 3 is the acceleration difference coefficient; d is the minimum driving distance of the vehicle, the unit is m;

启动防护前端碰撞系统,制动力分配公式为:The front-end collision protection system is activated, and the braking force distribution formula is:

F1,bra=0.4Fbra F 1,bra = 0.4F bra

Figure GDA0003767225330000071
Figure GDA0003767225330000071

Figure GDA0003767225330000072
Figure GDA0003767225330000072

式中,F1,bra、F2,bra、F3,bra分别为第一轴、第二轴、第三轴车轮分配的制动力;abra为制动减速度;Fbra为制动力;In the formula, F 1,bra , F 2,bra , F 3,bra are the braking forces distributed by the wheels of the first, second and third axles respectively; a bra is the braking deceleration; F bra is the braking force;

D)防护后端碰撞系统判断自车的车尾与后车发生碰撞的风险,当自车与后车的纵向间距小于期望间距时且前方无车辆、障碍物或前方车辆障碍物无威胁时,启动防护后端碰撞系统,自车将处于加速状态,自车与后车纵向期望间距计算公式为:D) The rear-end collision protection system judges the risk of collision between the rear of the vehicle and the vehicle behind. When the longitudinal distance between the vehicle and the vehicle behind is less than the expected distance and there is no vehicle, obstacle or obstacle in front of the vehicle ahead, there is no threat. When the rear-end collision protection system is activated, the ego vehicle will be in an accelerating state. The formula for calculating the desired longitudinal distance between the ego car and the rear car is:

Figure GDA0003767225330000073
Figure GDA0003767225330000073

式中,dx,des’为自车与前车的期望间距;vx为自车纵向车速;vx,r为后车的纵向车速;ax为自车纵向加速度;ax,r为后车的纵向加速度;λ1为改进车头时距系数,λ2为速度比例系数,λ3为加速度差值系数,d为车辆最小行驶间距,单位为m;In the formula, d x, des' is the desired distance between the ego vehicle and the preceding car; v x is the longitudinal speed of the ego vehicle; v x, r is the longitudinal speed of the rear car; a x is the longitudinal acceleration of the ego vehicle; a x, r is the longitudinal acceleration of the ego vehicle; The longitudinal acceleration of the rear vehicle; λ 1 is the time distance coefficient of the improved headway, λ 2 is the speed proportional coefficient, λ 3 is the acceleration difference coefficient, d is the minimum driving distance of the vehicle, and the unit is m;

启动防护后端碰撞系统,驱动力分配公式为:The rear-end collision protection system is activated, and the driving force distribution formula is:

Facc,1=0.3Facc F acc,1 = 0.3F acc

Figure GDA0003767225330000074
Figure GDA0003767225330000074

Figure GDA0003767225330000075
Figure GDA0003767225330000075

式中,Facc,1、Facc,2、Facc,3分别为第一轴、第二轴、第三轴车轮分配的驱动力;aacc为加速度;Facc为驱动力;In the formula, F acc,1 , F acc,2 and F acc,3 are the driving forces distributed by the wheels of the first, second and third axles respectively; a acc is the acceleration; F acc is the driving force;

E)当相邻两辆车均为线控底盘车型车辆时,若两车之间实际纵向距离小于两车之间的期望纵向间距时,前车的防护后端碰撞系统与后车的防护前端碰撞系统同时工作,前车处于加速状态,后车处于减速度状态,前后车同时启动防护碰撞系统。E) When the two adjacent vehicles are both drive-by-wire chassis type vehicles, if the actual longitudinal distance between the two vehicles is less than the expected longitudinal distance between the two vehicles, the rear-end collision protection system of the front vehicle and the front-end protection of the rear vehicle The collision system works at the same time, the front car is in the acceleration state, the rear car is in the deceleration state, and the front and rear cars simultaneously activate the collision protection system.

本发明的有益效果是:The beneficial effects of the present invention are:

1.本系统中的六轮独立线控驱动系统和六轮独立线控制动系统,能够使线控底盘更加精细化、准确化的分配每一个车轮的制动力和驱动力,使得车辆在遇到路面附着条件不同的路面时,可以独立控制各个车轮的驱动力和制动力,使得线控底盘车辆在复杂路面也能实现稳定、安全可靠的行驶。1. The six-wheel independent wire-controlled drive system and the six-wheel independent wire-controlled brake system in this system can make the wire-controlled chassis more refined and accurate to distribute the braking force and driving force of each wheel, so that the vehicle will adhere to the road surface. When the road conditions are different, the driving force and braking force of each wheel can be independently controlled, so that the drive-by-wire chassis vehicle can also achieve stable, safe and reliable driving on complex road surfaces.

2.本系统的线控底盘防撞控制系统与智能环视传感器系统和通讯系统的信息传递密切,可以准确得到外界驾驶环境信息与周围障碍物信息,使得线控底盘防撞控制系统控制操作迅速、及时有效。2. The wire-controlled chassis anti-collision control system of this system is closely related to the information transmission of the intelligent surround view sensor system and communication system, and can accurately obtain the information of the external driving environment and surrounding obstacles, making the control operation of the wire-controlled chassis anti-collision control system fast and efficient. Timely and effective.

3.本系统的主动防撞控制分为两种,一种是防护前端碰撞,通过后车进行制动操作完成主动防撞;另一种是防护后端碰撞,通过前车进行加速操作完成主动防撞。同时,当前后车均搭载线控底盘防撞控制系统时,其前后车可以同时启动防护前端碰撞和防护后端碰撞,使得主动防撞操作更加迅速,实现更短时间内避撞操作。3. There are two types of active anti-collision control in this system, one is to protect the front-end collision, and the rear vehicle performs the braking operation to complete the active anti-collision; the other is to protect the rear-end collision, and the front vehicle accelerates to complete the active collision prevention Anti-collision. At the same time, when the front and rear cars are equipped with a wire-controlled chassis anti-collision control system, the front and rear cars can simultaneously activate the front-end collision protection and the rear-end collision protection, making the active anti-collision operation faster and realizing the collision avoidance operation in a shorter time.

4.本系统对制动系统中的制动延迟进行补偿,使得制动延迟现象对外不展现,最终得到的制动效果为不存在制动延迟。4. The system compensates for the braking delay in the braking system, so that the braking delay phenomenon does not appear to the outside world, and the final braking effect is that there is no braking delay.

附图说明Description of drawings

图1是本发明一种纵向主动防撞控制系统的结构示意图;1 is a schematic structural diagram of a longitudinal active anti-collision control system of the present invention;

图2是本发明一种纵向主动防撞控制方法的流程示意图。FIG. 2 is a schematic flowchart of a longitudinal active collision avoidance control method according to the present invention.

具体实施方式Detailed ways

下面结合附图和具体的实施例对本发明技术方案作进一步的详细描述,以使本领域的技术人员可以更好的理解本发明并能予以实施,但所举实施例不作为对本发明的限定。The technical solutions of the present invention will be described in further detail below in conjunction with the accompanying drawings and specific embodiments, so that those skilled in the art can better understand the present invention and implement it, but the embodiments are not intended to limit the present invention.

如图1-2所示,一种纵向主动防撞控制系统,包括环境和障碍物检测系统,所述环境和障碍物检测系统用于检测并采集环境信息和车辆前后左右各方障碍物位置与运动状态信息。纵向主动防撞控制系统还包括底盘防撞控制系统、车轮独立线控驱动系统和车轮独立线控制动系统,所述底盘防撞控制系统包括防护前端碰撞系统和防护后端碰撞系统,所述车轮独立线控驱动系统用于对车辆的各个车轮施加独立的驱动力,所述车轮独立线控制动系统用于对车辆的各个车轮施加独立的制动力。As shown in Figure 1-2, a longitudinal active collision avoidance control system includes an environment and obstacle detection system. The environment and obstacle detection system is used to detect and collect environmental information and the position and relationship of obstacles on the front, rear, left, and right sides of the vehicle. Movement status information. The longitudinal active anti-collision control system further includes a chassis anti-collision control system, a wheel-independent drive-by-wire system, and a wheel-independent brake-by-wire system. The chassis anti-collision control system includes a front-end collision protection system and a rear-end collision protection system. The independent drive-by-wire system is used to apply an independent driving force to each wheel of the vehicle, and the wheel independent drive-by-wire system is used to apply an independent braking force to each wheel of the vehicle.

底盘防撞控制系统分为防护前端碰撞系统和防护后端碰撞系统,通过协同线控驱动、线控制动、转向、和悬架以及防撞控制策略的共同作用,实现线控底盘车型车辆纵向防撞,针对两车与多车碰撞风险场景,其防撞系统包含具有通讯功能的防撞模式与不具有通讯功能的普通防撞模式两种,同时当纵向车道存在连续两辆及两辆以上的线控底盘车型车辆时,线控底盘车型车辆可同时启动防护前端碰撞系统和防护后端碰撞系统。The chassis anti-collision control system is divided into a front-end collision protection system and a rear-end collision protection system. Through the joint action of the drive-by-wire, brake-by-wire, steering, and suspension, as well as the anti-collision control strategy, the longitudinal anti-collision of the chassis-by-wire vehicle is realized. Collision, for two-vehicle and multi-vehicle collision risk scenarios, its anti-collision system includes two types of anti-collision mode with communication function and ordinary anti-collision mode without communication function. In the case of a vehicle with a drive-by-wire chassis, the vehicle with a drive-by-wire chassis can activate the front-end collision protection system and the rear-end collision protection system at the same time.

所述底盘防撞控制系统根据环境和障碍物检测系统采集的信息控制各个车轮的制动力和驱动力使得车辆实现防护前端碰撞和防护后端碰撞;所述车轮独立线控制动系统包括车身稳定模块和制动延迟补偿模块,所述车身稳定模块用于保证车辆稳定,所述制动延迟补偿模块用于补偿制动器执行动作延迟与通讯延时导致的制动延迟。The chassis anti-collision control system controls the braking force and driving force of each wheel according to the information collected by the environment and the obstacle detection system, so that the vehicle can achieve front-end collision protection and rear-end collision protection; the wheel independent brake-by-wire system includes a body stability module and a braking delay compensation module, the vehicle body stability module is used to ensure the stability of the vehicle, and the braking delay compensation module is used to compensate for the braking delay caused by the delay in the execution of the brake and the delay in the communication.

为了提高整个道路的行车安全性和防撞的可靠性、智能性,优选,纵向主动防撞控制系统还包括车车通讯系统和云端通讯系统:所述车车通讯系统用于线控底盘车型车辆之间的信息交互,以及线控底盘车型车辆与其他车型车辆的信息交互;所述云端通讯系统用于记录线控底盘车型车辆的环境和障碍物检测系统采集的环境信息数据,并将其传递给非线控底盘车型车辆,同时将非线控底盘车型车辆的信息记录反馈给线控底盘车型车辆,完成道路车辆全部参与信息交互;所述云端通讯系统还包括信息整合单元A,所述信息整合单元A将云端通讯系统接收的信息、环境和障碍物检测系统检测到的障碍物信息以及车车通讯系统的交互信息进行信息整合。In order to improve the driving safety of the entire road and the reliability and intelligence of anti-collision, preferably, the longitudinal active anti-collision control system further includes a vehicle-to-vehicle communication system and a cloud communication system: the vehicle-to-vehicle communication system is used for a wire-controlled chassis model vehicle The information exchange between the vehicle and other types of vehicles; the cloud communication system is used to record the environment information data collected by the environment and obstacle detection system of the vehicle by wire, and transmit it. For the non-wire-controlled chassis model vehicles, the information records of the non-wire-controlled chassis type vehicles are fed back to the wire-controlled chassis type vehicles, so that all road vehicles participate in information exchange; the cloud communication system also includes an information integration unit A, the information The integration unit A integrates the information received by the cloud communication system, the obstacle information detected by the environment and the obstacle detection system, and the interactive information of the vehicle-to-vehicle communication system.

一般的,环境和障碍物检测系统包括智能环视传感器系统、轮心相对高度测量仪、信息整合单元B和平整度信息修正单元:Generally, the environment and obstacle detection system includes an intelligent surround view sensor system, a wheel center relative height measuring instrument, an information integration unit B and a flatness information correction unit:

所述智能环视传感器系统包括车头顶部机械式激光雷达,车头前部较低处的固态激光雷达,车头顶部与前部相交处的双目摄像头以及车辆尾部的单目摄像头。The intelligent surround-view sensor system includes a mechanical lidar on the top of the vehicle, a solid-state lidar at the lower part of the front of the vehicle, a binocular camera at the intersection of the top of the vehicle and the front, and a monocular camera at the rear of the vehicle.

环境和障碍物检测系统包含两个种类不同的激光雷达,在车辆不同位置搭载不同种类雷达,比如,可以在车头前部保险杠上方安装一个固态激光雷达,其固态激光雷达的下底面距车头保险杠最上端hbum厘米处。固态激光雷达用于检测地面凸起、凹陷与低矮障碍物的位置与形状信息,假设固态激光雷达采集的车辆周围第i个不平路面低矮障碍相对高度为h’n,i,包含凸起、凹陷与低矮障碍物,h’n,i可取正值和负值,单位为米。当障碍物高度低于hn0厘米时,固态激光雷达判断其为低矮障碍物,其他高度障碍物均为需要躲避碰撞的障碍物,无法直接越过。The environment and obstacle detection system includes two different types of lidars, which are equipped with different types of radars in different positions of the vehicle. For example, a solid-state lidar can be installed above the front bumper of the vehicle, and the bottom surface of the solid-state lidar is far from the front bumper. The top of the bar is h bum cm. The solid-state lidar is used to detect the position and shape information of ground bumps, depressions and low obstacles. It is assumed that the relative height of the i-th low obstacle on the uneven road around the vehicle collected by the solid-state lidar is h' n,i , including the bumps. , depressions and low obstacles, h' n,i can take positive and negative values, the unit is meters. When the height of the obstacle is lower than h n0 cm, the solid-state lidar judges it as a low obstacle, and other height obstacles are obstacles that need to avoid collision and cannot be directly crossed.

可以在车头上方距车头背面hrear厘米处安装一个32线机械式激光雷达,将此机械式激光雷达安装在固定在车头部的高为hhig厘米的固定支架上。机械式激光雷达用于检测车辆前方和左右侧方的障碍物位置信息,通过实时接收障碍物位置信息,车辆内部计算单元计算出周围障碍物或其他形式车辆的位置与运动状态信息,其中障碍物信息为运动障碍物信息与静止障碍物信息,xdj、ydj、vdj、adj分别为机械式激光雷达所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置(单位为m)、瞬时速度(单位为m/s)、瞬时加速度(m/s2),xsk为机械式激光雷达所采集的车辆周围第k个静态障碍物的纵向位置,ysk为机械式激光雷达所采集的车辆周围第k个静态障碍物的横向位置单位为m。A 32-line mechanical lidar can be installed above the front of the car at a distance of h rear cm from the back of the car. The mechanical lidar is used to detect the position information of obstacles in front of and on the left and right sides of the vehicle. By receiving the position information of obstacles in real time, the internal computing unit of the vehicle calculates the position and motion state information of surrounding obstacles or other forms of vehicles. The information is the moving obstacle information and the stationary obstacle information, x dj , y dj , v dj , and a dj are the longitudinal and lateral instantaneous positions of the jth dynamic obstacle around the vehicle collected by the mechanical lidar respectively (unit: is m), instantaneous velocity (unit is m/s), instantaneous acceleration (m/s 2 ), x sk is the longitudinal position of the k-th static obstacle around the vehicle collected by the mechanical lidar, y sk is the mechanical The lateral position unit of the kth static obstacle around the vehicle collected by the lidar is m.

环境和障碍物检测系统包含双目摄像头与单目摄像头各一个,双目摄像头安装在车头前部距车头顶部竖直距离为htop厘米处的中间位置,单目摄像头安装在车辆底盘尾部的中间位置。双目摄像头用于检测车辆前方和左右侧方的障碍物位置信息,其用于在白天并且室外光线亮度满足相应条件时辅助机械式激光雷达测距,xcj、ycj、vcj、acj分别为双目摄像头所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度,瞬时加速度。单目摄像头用于检测车辆后部其他车辆相对于自身车辆的位置信息,通过实时接收障碍物位置信息,车辆内部计算单元计算出后部车辆的位置与运动状态信息。The environment and obstacle detection system includes a binocular camera and a monocular camera. The binocular camera is installed in the middle of the front of the car at a vertical distance of h top cm from the top of the car, and the monocular camera is installed in the middle of the rear of the vehicle chassis. Location. The binocular camera is used to detect the position information of obstacles in front of the vehicle and on the left and right sides. It is used to assist the mechanical lidar ranging in the daytime and when the outdoor light brightness meets the corresponding conditions, x cj , y cj , v cj , a cj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the jth dynamic obstacle around the vehicle collected by the binocular camera, respectively. The monocular camera is used to detect the position information of other vehicles behind the vehicle relative to the own vehicle. By receiving the obstacle position information in real time, the vehicle internal computing unit calculates the position and motion state information of the rear vehicle.

上述的安装距离hbum、hrear、hhig、htop,由具体车型和整车尺寸确定。The above installation distances h bum , h rear , h hig , and h top are determined by the specific model and the size of the entire vehicle.

所述信息整合单元B将机械式激光雷达、双目摄像头采集到的信息与车车通讯系统、云端通信系统采集的车辆交互信息进行整合,精确障碍物和周边车辆状态。信息整合单元B在车辆内部计算单元进行比较、修正、融合,得到最终的障碍物与其他车辆信息,优选,所述信息整合单元B经过信息整合后的障碍物信息为:The information integration unit B integrates the information collected by the mechanical laser radar and the binocular camera with the vehicle interaction information collected by the vehicle-to-vehicle communication system and the cloud communication system to accurately determine the status of obstacles and surrounding vehicles. The information integration unit B compares, corrects, and fuses the computing unit inside the vehicle to obtain the final obstacle and other vehicle information. Preferably, the information integration unit B obtains the obstacle information after information integration as follows:

Figure GDA0003767225330000111
Figure GDA0003767225330000111

Figure GDA0003767225330000112
Figure GDA0003767225330000112

Figure GDA0003767225330000113
Figure GDA0003767225330000113

Figure GDA0003767225330000114
Figure GDA0003767225330000114

式中,xcj、ycj、vcj、acj分别为双目摄像头所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xdj、ydj、vdj、adj分别为机械式激光雷达所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xwi、ywi、vwi、awi分别为车车通讯系统检测到的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xi、yi、vi、ai分别为整合后的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xn-i、yn-i、vn-i、an-i为整合后的非线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度,其中n为机械式激光雷达所检测到的动态障碍物的数量,j=1…n;kw为交互信息准确性系数;kd为雷达信息准确性系数;kc为摄像头信息准确性系数,kw、kd和kc的取值均为小于1的正数;xd,n-i、yd,n-i、vd,n-i、ad,n-i分别为机械式激光雷达所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xc,n-i、yc,n-i、vc,n-i、ac,n-i分别为双目摄像头所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度。In the formula, x cj , y cj , v cj , and a cj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by the binocular camera; x dj , y dj , v dj , and a dj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by mechanical lidar, respectively; x wi , y wi , v wi , and a wi are respectively are the longitudinal instantaneous position, lateral instantaneous position , instantaneous speed , and instantaneous acceleration of the i - th vehicle-by-wire chassis vehicle detected by the vehicle-to-vehicle communication system; Longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the vehicle by wire-controlled chassis; x ni , y ni , v ni , and a ni are the longitudinal and lateral instantaneous positions of the integrated non-wire-controlled chassis vehicle. Instantaneous speed, instantaneous acceleration, where n is the number of dynamic obstacles detected by mechanical lidar, j=1...n; k w is the accuracy coefficient of interactive information; k d is the accuracy coefficient of radar information; k c is The camera information accuracy coefficient, k w , k d and k c are all positive numbers less than 1; x d, ni , y d, ni , v d, ni , a d, ni are mechanical lidars, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle collected; x c,ni , y c,ni , v c,ni , a c,ni are the binocular cameras, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle are collected.

kw、kd、kc均为小于1的非负数,式中的计算方法为比例权重计算,所述摄像头信息准确性系数,其大小受自然光光照强度的影响:k w , k d , and k c are all non-negative numbers less than 1. The calculation method in the formula is proportional weight calculation. The accuracy coefficient of the camera information is affected by the intensity of natural light:

Eav>30000lx,kc=0.8Eav>30000lx,k c =0.8

5000lx<Eav≤30000lx,kc=0.75000lx<Eav≤30000lx,k c =0.7

100lx<Eav≤5000lx,kc=0.5100lx<Eav≤5000lx,k c =0.5

Eav≤100lx,kc=0Eav≤100lx,k c =0

当行驶环境下光照强度大于3万勒克斯时,kc取值0.8;当行驶环境下光照强度大于5000勒克斯并小于3万勒克斯时,kc取值0.7;当行驶环境下光照强度大于100勒克斯并小于5000勒克斯时,kc取值0.5;当行驶环境下光照强度小于100勒克斯时,kc取值0。When the light intensity in the driving environment is greater than 30,000 lux, the value of k c is 0.8; when the light intensity in the driving environment is greater than 5,000 lux and less than 30,000 lux, the value of k c is 0.7; when the light intensity in the driving environment is greater than 100 lux and When the value of k c is less than 5000 lux, the value of k c is 0.5; when the light intensity in the driving environment is less than 100 lux, the value of k c is 0.

平整度信息修正单元将固态激光雷达与轮心相对高度测量仪采集的车辆行驶的周围道路平整度信息进行修正。平整度信息修正单元,其对轮心相对高度测量仪测量的第一轴车轮驶过路面的路面平整度信息,与固态激光雷达检测到的信息进行比较修正,优选,所述平整度信息修正单元的修正公式为:The flatness information correction unit corrects the flatness information of the surrounding road where the vehicle is traveling, which is collected by the solid-state lidar and the wheel center relative height measuring instrument. A flatness information correction unit, which compares and corrects the road surface flatness information measured by the wheel center relative height measuring instrument when the wheels of the first axle drive over the road surface and the information detected by the solid-state laser radar. Preferably, the flatness information correction unit The correction formula is:

Figure GDA0003767225330000131
Figure GDA0003767225330000131

式中,hn,i为修正后的车辆周围第i个不平路面低矮障碍相对高度,包含凸起、凹陷与低矮障碍物;h’n,i和h”n,i分别为固态激光雷达检测和轮心相对高度测量仪测量的车辆周围第i个不平路面低矮障碍相对高度,单位为米;vx为车辆的纵向车速,单位为m/s;kvx为纵向车速影响因子,单位为m/s。In the formula, h n,i is the relative height of the i-th uneven road low obstacle around the corrected vehicle, including bumps, depressions and low obstacles; h' n,i and h'n ,i are solid-state lasers, respectively. The relative height of the ith uneven road low obstacle around the vehicle measured by radar detection and wheel center relative height measuring instrument, in meters; vx is the longitudinal speed of the vehicle, in m/s; k vx is the longitudinal speed influence factor, The unit is m/s.

车载激光雷达和摄像头等智能驾驶传感器检测外界行驶环境和车辆周围障碍物信息,并通过车载网络专递给线控底盘系统,线控底盘系统根据外界环境和障碍物信息,利用相应的控制策略,完成独立车轮的独立制动和独立驱动操作指令,线控底盘控制系统与智能传感器系统综合实现车辆行驶过程中的稳定性和安全性。Intelligent driving sensors such as in-vehicle lidar and cameras detect the external driving environment and information of obstacles around the vehicle, and deliver it to the wire-controlled chassis system through the in-vehicle network. The wire-controlled chassis system uses corresponding control strategies according to the external environment and obstacle information to complete the The independent braking and independent driving operation commands of the independent wheels, the drive-by-wire chassis control system and the intelligent sensor system are integrated to realize the stability and safety of the vehicle during driving.

下面以三轴六轮车辆为具体实施例,详细说明本发明通过车辆间的信息交互和车辆自身搭载传感器对行驶道路环境和障碍物信息采集,使三轴六轮车辆在纵向行驶时实现车头与车尾处的主动防撞,通过六轮独立驱动和六轮独立制动完成线控底盘纵向控制,保证车辆在纵向行驶时的安全性和稳定性。The following takes a three-axle six-wheel vehicle as a specific example to describe in detail that the present invention collects the driving road environment and obstacle information through the information exchange between vehicles and the sensors mounted on the vehicle itself, so that the three-axle six-wheel vehicle can realize the front and rear of the vehicle when driving longitudinally. Active anti-collision at the place, complete the longitudinal control of the wire-controlled chassis through six-wheel independent driving and six-wheel independent braking, to ensure the safety and stability of the vehicle when driving longitudinally.

当所述底盘防撞控制系统用于控制三轴六轮车辆时,所述车轮独立线控制动系统为六轮独立线控制动系统,所述车轮独立线控驱动系统为六轮独立线控驱动系统,六个车轮均为驱动轮,每个驱动轮包括驱动模式、随动模式与放空模式三种工作模式:所述驱动模式是指车轮与地面接触,车轮所处悬架处于支持车身工作状态,并且其驱动电机起作用处于工作状态;所述随动模式是指车轮与地面接触,车轮所处悬架处于支持车身工作状态,但是驱动电机不工作,其他驱动车轮驱动车辆行驶时,车辆行驶带动随动模式下的车轮转动;所述放空模式是指车轮与地面不接触,车轮处悬架控制车轮处于抬升状态,驱动电机不工作,车轮不转动。When the chassis anti-collision control system is used to control a three-axle six-wheel vehicle, the wheel-independent brake-by-wire system is a six-wheel independent-by-wire brake system; the wheel-independent drive-by-wire system is a six-wheel independent-by-wire drive system; All wheels are driving wheels, and each driving wheel includes three working modes: driving mode, follow-up mode and emptying mode: the driving mode means that the wheel is in contact with the ground, the suspension of the wheel is in a state of supporting the body, and its The drive motor works and is in a working state; the follow-up mode means that the wheels are in contact with the ground, the suspension of the wheels is in a state of supporting the body, but the drive motor does not work, and when other driving wheels drive the vehicle, the vehicle drives the follow-up The wheel rotates in the mode; the empty mode means that the wheel is not in contact with the ground, the suspension at the wheel controls the wheel to be in a raised state, the drive motor does not work, and the wheel does not rotate.

优选,车辆前端的第一轴和车辆尾端的第三轴的驱动轮采用轮边驱动模式,车辆中间的第二轴的驱动轮采用轮毂电机驱动模式,轮边(电机)驱动是利用安装在车桥两侧的永磁轮边电机进行驱动,其将电动机、减速器机构与轮毂等高度集中成为轮边电机驱动桥,其应用在线控底盘车型车辆的第一轴与第三轴,而轮毂电机驱动采用高速内转子电机,将驱动电机整合到轮毂内部。根据底盘防撞控制系统反馈的驱动控制参数,六个独立驱动车轮分别分配驱动模式、随动模式以及放空模式中的一种,从而实现整车单轮到六轮驱动的任意组合。Preferably, the driving wheels of the first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopt the wheel-side drive mode, the driving wheel of the second axle in the middle of the vehicle adopts the in-wheel motor drive mode, and the wheel-side (motor) drive is driven by the use of a wheel mounted on the vehicle. The permanent magnet wheel side motors on both sides of the bridge are driven, which highly concentrates the motor, the reducer mechanism and the wheel hub into the wheel side motor drive axle, which is applied to the first and third axles of the on-line chassis model vehicle, while the wheel hub motor The drive adopts a high-speed inner rotor motor, which integrates the drive motor into the hub. According to the driving control parameters fed back by the chassis anti-collision control system, the six independent driving wheels are respectively assigned one of the driving mode, the follow-up mode and the emptying mode, so as to realize any combination of single-wheel to six-wheel drive of the whole vehicle.

车辆前端的第一轴和车辆尾端的第三轴采用电液耦合制动,车辆中间的第二轴采用电子机械制动。六轮独立线控制动系统包含电液耦合制动和电子机械制动两种制动系统,线控底盘车型车辆三根轴的车轮应用不同的制动系统,所述电液耦合制动系统应用于第一轴与三轴的车轮,所述电子机械制动系统应用于第二根轴的车轮。The first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopt electro-hydraulic coupling brakes, and the second axle in the middle of the vehicle adopts electro-mechanical braking. The six-wheel independent brake-by-wire system includes two types of braking systems: electro-hydraulic coupling braking and electro-mechanical braking. Different braking systems are applied to the wheels of the three axles of the chassis-by-wire vehicle. The electro-hydraulic coupling braking system is applied to the first One-axle and three-axle wheels, the electro-mechanical braking system is applied to the wheels of the second axle.

优选,六轮独立线控制动系统包含车身稳定模块与制动延迟补偿模块,其用于保证车辆稳定和制动迅速。车身稳定模块可由两部分组成,分别为第一轴和第三轴组成的车身稳定控制系统A以及第二轴的电子机械制动系统的车身稳定控制系统B,当车辆三轴均正常工作且全部车轮均不处于放空模式时,车身稳定控制系统A与车身稳定控制系统B同时工作;当第二轴处于放空模式时,仅车身稳定控制系统A正常工作,此时第一轴与第三轴四轮独立制动控制状态为:Preferably, the six-wheel independent brake-by-wire system includes a body stability module and a braking delay compensation module, which are used to ensure vehicle stability and rapid braking. The body stability module can be composed of two parts, namely the body stability control system A composed of the first and third axes and the body stability control system B of the electronic mechanical braking system of the second axis. When the three axes of the vehicle are working normally and all the When the wheels are not in the empty mode, the body stability control system A and the body stability control system B work at the same time; when the second axle is in the empty mode, only the body stability control system A works normally. The wheel independent braking control status is:

Figure GDA0003767225330000151
Figure GDA0003767225330000151

Figure GDA0003767225330000152
Figure GDA0003767225330000152

式中,ΔMZ为车辆期望横摆力矩,单位为Nm;F’x2为第一轴右侧车轮纵向制动力;ΔFY2为第一轴右侧车轮地面侧向作用力的变化量;F’x6为第三轴右侧车轮纵向制动力;ΔFY6为第一轴右侧车轮地面侧向作用力的变化量,单位为N;l1为车辆第一根轴轴心到质心的水平纵向距离;l3为车辆第三轴轴心到质心的水平纵向距离,单位为米;B1为第一轴左右侧车轮中心到轴心的距离;B3为第三轴左右侧车轮中心到轴心的距离,单位为米;F’X1为第一轴左侧车轮纵向制动力;ΔFY1为第一轴左侧车轮地面侧向作用力的变化量;F’X5为第三轴左侧车轮纵向制动力;ΔFY5为第一轴左侧车轮地面侧向作用力的变化量;δ1、δ2、δ5、δ6分别为第一轴左右侧车轮与第三轴左右侧车轮转角,单位为rad。In the formula, ΔM Z is the expected yaw moment of the vehicle, the unit is Nm; F' x2 is the longitudinal braking force of the right wheel of the first axis; ΔF Y2 is the variation of the ground lateral force of the right wheel of the first axis; F' x6 is the longitudinal braking force of the right wheel of the third axle; ΔF Y6 is the change amount of the ground lateral force of the right wheel of the first axle, the unit is N; l 1 is the horizontal longitudinal distance from the axis of the first axle of the vehicle to the center of mass ; l 3 is the horizontal longitudinal distance from the center of the third axis of the vehicle to the center of mass, in meters; B 1 is the distance from the center of the left and right wheels of the first axis to the center of the axis; B 3 is the center of the left and right wheels of the third axis to the center of the axis distance, in meters; F' X1 is the longitudinal braking force of the left wheel of the first axis; ΔF Y1 is the change of the ground lateral force of the left wheel of the first axis; F' X5 is the longitudinal direction of the left wheel of the third axis Braking force; ΔF Y5 is the variation of the ground lateral force of the left wheel of the first axis; δ 1 , δ 2 , δ 5 , δ 6 are the rotation angles of the left and right wheels of the first axis and the left and right wheels of the third axis, unit is rad.

当第二轴处于放空模式时、仅第一轴和第三轴车轮制动工作时,经过简化后为维持车身稳定,四个车轮制动的轮缸压力值分别为:When the second axle is in the emptying mode, and only the first and third axle wheel brakes work, in order to maintain the stability of the vehicle body after simplification, the wheel cylinder pressure values of the four wheel brakes are:

Figure GDA0003767225330000153
Figure GDA0003767225330000153

Figure GDA0003767225330000154
Figure GDA0003767225330000154

Figure GDA0003767225330000155
Figure GDA0003767225330000155

Figure GDA0003767225330000156
Figure GDA0003767225330000156

式中,p1、p2、p5、p6分别为第一轴左右侧车轮与第三轴左右侧车轮的制动压力,单位为MPa;FZ1、FZ2、FZ5、FZ6分别为第一轴左右侧车轮与第三轴左右侧车轮的地面垂向作用力,单位为N;Rw1、Rw3分别为第一轴和第三轴上车轮的半径,单位为米;Kb为制动压力系数,其大小为车轮制动力矩与轮缸压力的比值;ΔMZ为车辆期望横摆力矩,单位为Nm;B1为第一轴左右侧车轮中心到轴心的距离,B3为第三轴左右侧车轮中心到轴心的距离,单位为米;δ1、δ2、δ5、δ6分别为第一轴左右侧车轮与第三轴左右侧车轮转角,单位为rad。In the formula, p 1 , p 2 , p 5 , and p 6 are the braking pressures of the left and right wheels of the first axis and the left and right wheels of the third axis, respectively, in MPa; F Z1 , F Z2 , F Z5 , and F Z6 respectively is the ground vertical force of the left and right wheels of the first axis and the left and right wheels of the third axis, in N; R w1 and R w3 are the radii of the wheels on the first and third axes, respectively, in meters; K b is the braking pressure coefficient, which is the ratio of the wheel braking torque to the wheel cylinder pressure; ΔM Z is the expected yaw moment of the vehicle, in Nm; B 1 is the distance from the center of the left and right wheels of the first axis to the axle center, B 3 is the distance from the center of the left and right wheels of the third axis to the axle center, the unit is meters; δ 1 , δ 2 , δ 5 , δ 6 are the rotation angles of the left and right wheels of the first axis and the left and right wheels of the third axis, the unit is rad .

所述的制动延迟补偿模块,其用于补偿制动器执行动作延迟与通讯延时导致的制动延迟,优选,其补偿轮缸压力值计算公式为:The braking delay compensation module is used for compensating the braking delay caused by the delay of the brake execution and the delay of communication. Preferably, the calculation formula of the compensation wheel cylinder pressure value is:

Figure GDA0003767225330000161
Figure GDA0003767225330000161

式中,pcom为补偿轮缸压力值,t1为通讯延迟时间,t2’为制动器间隙减小所用时间,t2”为制动器逐渐压紧至稳定所用时间,p(t)为t时刻制动轮缸压力值,单位为MPa;从制动器起作用开始后的t1+t2’+t2”/2时间段内,ppro取值为最大轮缸压力值的30%-80%,单位为MPa,ppro的值取决于底盘防撞控制系统中的制动减速度值:In the formula, p com is the compensation wheel cylinder pressure value, t 1 is the communication delay time, t 2 ' is the time taken for the brake clearance to decrease, t 2 " is the time taken for the brake to be gradually pressed to a stable state, and p(t) is the time t. Brake wheel cylinder pressure value, the unit is MPa; within the time period of t 1 +t 2 '+t 2 ”/2 after the brake takes effect, the value of p pro is 30%-80% of the maximum wheel cylinder pressure value , the unit is MPa, the value of p pro depends on the braking deceleration value in the chassis anti-collision control system:

pro=30 a<2.5m/s2 pro=30 a<2.5m/s 2

pro=30+kbra(abra-2.5) 2.5m/s2≤a≤7.5m/s2 pro=30+k bra (a bra -2.5) 2.5m/s 2 ≤a≤7.5m/s 2

pro=80 a>7.5m/s2 pro=80 a>7.5m/s 2

式中,kbra为制动减速度比例因子,abra为底盘防撞控制系统中反馈的制动减速度,当制动减速度小于2.5m/s2时,ppro取值30,当制动减速度大于7.5m/s2时,ppro取值80。In the formula , k bra is the proportional factor of braking deceleration, a bra is the braking deceleration feedback feedback in the chassis anti-collision control system, when the braking deceleration is less than 2.5m/s When the dynamic deceleration is greater than 7.5m/s 2 , the value of p pro is 80.

车车通讯系统用与线控底盘车型车辆之间的信息交互,以及线控底盘车型车辆与其他车辆的信息交互,其交互信息包含基本车辆位置信息与车辆运动状态信息(包含线控底盘车型车辆的纵向位置xwi;线控底盘车型车辆的横向位置ywi,单位为m;线控底盘车型车辆的速度vwi,单位为m/s;线控底盘车型车辆的加速度awi,单位为m/s2),以及线控底盘车型车辆的底盘系统预期动作(包含六个车轮驱动扭矩Tdi,六个车轮制动轮缸压力pi,其中i=1…6)。The vehicle-to-vehicle communication system is used for the information interaction between the vehicle-by-wire chassis vehicle and the information interaction between the vehicle-by-wire vehicle and other vehicles. The longitudinal position x wi ; the lateral position y wi of the wire-controlled chassis model vehicle, the unit is m; the speed v wi of the wire-controlled chassis model vehicle, the unit is m/s; the acceleration of the wire-controlled chassis model vehicle a wi , the unit is m /s 2 ), and the expected behavior of the chassis system of the drive-by-wire chassis model vehicle (comprising six wheel drive torques T di , six wheel brake wheel cylinder pressures pi , where i =1...6).

车车通讯系统采用多成员分级互通通讯方式,参与通讯的车辆包括线控底盘车型车辆、搭载激光雷达与摄像头的非线控底盘车型车辆,以及非线控底盘无雷达摄像头车辆,通讯分为三级互通通讯方式:The vehicle-to-vehicle communication system adopts a multi-member hierarchical intercommunication communication method. The vehicles involved in the communication include vehicles with wire-controlled chassis models, non-wire-controlled chassis vehicles equipped with lidar and cameras, and non-wire-controlled chassis vehicles without radar cameras. The communication is divided into three types. Interoperability communication method:

第一级通讯为与线控底盘车型车辆信息交互,当第一级通讯交互连接成功后启动第二级通讯,第二级通讯为与搭载激光雷达与摄像头的非线控底盘车型车辆信息交互,在设定交互时间内未完成信息交互的车辆的信息交互级别降为第三级通讯,第三级通讯为与非线控底盘无雷达摄像头车辆、第二级通讯未交互成功车辆进行信息交互。所述互通通讯方式采用多车辆全双工多通道方式,其保证多辆线控底盘车型车辆同时收发通讯信息。The first-level communication is to interact with the vehicle information of the wire-controlled chassis models. When the first-level communication interaction is successfully connected, the second-level communication is activated. The information interaction level of vehicles that have not completed the information interaction within the set interaction time is reduced to the third-level communication. The third-level communication is the information exchange with non-wire-controlled chassis vehicles without radar cameras and vehicles that have not successfully interacted with the second-level communication. The intercommunication communication mode adopts a multi-vehicle full-duplex multi-channel mode, which ensures that a plurality of wire-controlled chassis model vehicles send and receive communication information at the same time.

云端通讯系统可以储存记录由线控底盘车型车辆的环境和障碍物检测系统传输的行驶环境信息数据,将其发送给其他车辆,同时接收其他车辆的状态信息并发送给线控底盘车型车辆,云端通讯系统与环境和障碍物检测系统检测到的障碍物信息以及车车通讯系统的交互信息进行信息融合。云端通讯系统的信息收发功能可辅助于线控底盘车型的车车通讯,针对其他车辆无法与线控底盘车型车辆进行实时的信息交互,利用云端接收其他车辆信息并进行广播,实现全部车辆互通互联,同时没有搭载激光雷达与摄像头的车辆可以接收云端存储的行驶道路环境信息。The cloud communication system can store and record the driving environment information data transmitted by the environment and obstacle detection system of the chassis-by-wire vehicle, send it to other vehicles, and at the same time receive the status information of other vehicles and send it to the chassis-by-wire vehicle, cloud The communication system performs information fusion with the obstacle information detected by the environment and obstacle detection system and the interaction information of the vehicle-to-vehicle communication system. The information sending and receiving function of the cloud communication system can assist in the vehicle-to-vehicle communication of the wire-controlled chassis models. For other vehicles that cannot conduct real-time information exchange with the wire-controlled chassis models, the cloud can be used to receive other vehicle information and broadcast it to realize the interconnection of all vehicles. At the same time, vehicles without lidar and cameras can receive the driving road environment information stored in the cloud.

对应的,一种纵向主动防撞控制方法,底盘防撞控制系统包括具有通讯功能的防撞模式和不具有通讯功能的防撞模式:Correspondingly, a longitudinal active anti-collision control method, the chassis anti-collision control system includes an anti-collision mode with a communication function and an anti-collision mode without a communication function:

具有通讯功能的防撞模式:根据环境和障碍物检测系统、车车通讯系统以及云端通讯系统整合后的障碍物信息数据,判定自车的碰撞风险,利用障碍物数据和相应控制策略决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞;Anti-collision mode with communication function: According to the obstacle information data integrated by the environment and obstacle detection system, the vehicle-to-vehicle communication system and the cloud communication system, determine the collision risk of the own vehicle, and use the obstacle data and the corresponding control strategy to decide the out-of-line control The execution of the various systems of the chassis avoids collision with dynamic and static obstacles;

不具有通讯功能的防撞模式,仅根据环境和障碍物检测系统采集的动静态障碍物信息,判断自车的碰撞风险,利用障碍物数据和相应控制策略(可选用滑模控制策略)决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞,具体算法如下:The anti-collision mode without communication function only judges the collision risk of the own vehicle according to the dynamic and static obstacle information collected by the environment and obstacle detection system, and uses the obstacle data and the corresponding control strategy (sliding mode control strategy can be selected) to decide the line. Control the execution of the various systems of the chassis to avoid collision with dynamic and static obstacles. The specific algorithm is as follows:

A)设t时刻相邻两车之间的纵向间距d(t)为:A) Let the longitudinal distance d(t) between two adjacent cars at time t be:

d(t)=xf(t)-x(t)或d(t)=x(t)-xr(t)d(t)= xf (t)-x(t) or d(t)=x(t) -xr (t)

式中,xf(t)为t时刻线控底盘车型前车的纵向位置(也即线控底盘车型前车的纵向位置随时间变化函数,下述定义类似,不再赘述),x(t)为t时刻线控底盘车型的纵向位置,xr(t)为t时刻线控底盘车型后车的纵向位置,单位为米;In the formula, x f (t) is the longitudinal position of the vehicle in front of the chassis-by-wire model at time t (that is, the time-varying function of the longitudinal position of the vehicle in front of the chassis-by-wire model, the following definitions are similar and will not be repeated), x(t ) is the longitudinal position of the wire-controlled chassis model at time t, and x r (t) is the longitudinal position of the vehicle behind the wire-controlled chassis model at time t, in meters;

B)t时刻底盘防撞控制系统控制的纵向驱动力或纵向制动力的计算公式为:B) The calculation formula of the longitudinal driving force or longitudinal braking force controlled by the chassis anti-collision control system at time t is:

Figure GDA0003767225330000181
Figure GDA0003767225330000181

Figure GDA0003767225330000182
Figure GDA0003767225330000182

式中,F(t)为t时刻车辆纵向驱动力或制动力,单位为N;m为自车的整车质量;q和k为积分滑模系数;λ1为改进车头时距系数;Fa(t)、Fr(t)分别为t时刻空气阻力和滚动阻力,单位为N;

Figure GDA0003767225330000183
为t时刻相邻辆车的纵向位置误差值的一阶导数;
Figure GDA0003767225330000184
为t时刻相邻辆车的纵向位置误差值的二阶导数;ades(t)为t时刻滑模控制策略所得到的自车的期望加速度;v1和v2分别为相邻两车中前车的纵向车速和后车的纵向车速,单位为m/s;相应控制策略为滑模控制策略,其适用于自车仅在防护前端碰撞与防护后端碰撞系统,选用包含积分项的滑模面与趋近律分别为:In the formula, F(t) is the longitudinal driving force or braking force of the vehicle at time t, the unit is N; m is the vehicle mass of the vehicle; q and k are the integral sliding mode coefficients; λ 1 is the improved headway coefficient; F a (t) and F r (t) are the air resistance and rolling resistance at time t, respectively, and the unit is N;
Figure GDA0003767225330000183
is the first derivative of the longitudinal position error value of adjacent vehicles at time t;
Figure GDA0003767225330000184
is the second derivative of the longitudinal position error value of the adjacent vehicle at time t; a des (t) is the expected acceleration of the vehicle obtained by the sliding mode control strategy at time t; v 1 and v 2 are the two adjacent vehicles, respectively The longitudinal speed of the front car and the longitudinal speed of the rear car, in m/s; the corresponding control strategy is the sliding mode control strategy, which is suitable for the self-vehicle only in the front-end collision protection and rear-end collision protection systems. The die surface and the reaching law are:

Figure GDA0003767225330000191
Figure GDA0003767225330000191

Figure GDA0003767225330000192
Figure GDA0003767225330000192

式中,λ为积分滑模系数,无量纲,e(t)为t时刻相邻两车的纵向位置误差值,单位为m;si为滑模面,G为正常数,其中,e(t)可根据t时刻线控底盘车辆与前后车的实际间距以及自车与前车的纵向期望间距来计算:In the formula, λ is the integral sliding mode coefficient, dimensionless, e(t) is the longitudinal position error value of two adjacent vehicles at time t, the unit is m; s i is the sliding mode surface, G is a constant, where e( t) It can be calculated according to the actual distance between the wire-controlled chassis vehicle and the front and rear vehicles and the longitudinal expected distance between the own vehicle and the preceding vehicle at time t:

e(t)=d(t)-dx,des(t)e(t)=d(t)-d x,des (t)

Figure GDA0003767225330000193
Figure GDA0003767225330000193

Figure GDA0003767225330000194
Figure GDA0003767225330000194

式中,dx,des(t)为t时刻自车与前车的纵向期望间距,单位为米;where d x, des (t) is the expected longitudinal distance between the ego vehicle and the preceding vehicle at time t, in meters;

C)防护前端碰撞系统判断自车的车头与前车发生碰撞的风险,当自车前方距离最近的车辆的纵向位置与自车纵向位置之差小于期望间距时,启动防护前端碰撞系统,其中自车与前车的纵向期望间距计算公式为:C) The front-end collision protection system judges the risk of collision between the front of the vehicle and the vehicle in front. When the difference between the longitudinal position of the vehicle with the closest distance in front of the vehicle and the longitudinal position of the vehicle is less than the desired distance, the front-end collision protection system is activated, in which the self-service front-end collision protection system is activated. The formula for calculating the expected longitudinal distance between the vehicle and the vehicle in front is:

Figure GDA0003767225330000195
Figure GDA0003767225330000195

式中,dx,des为自车与前车的期望间距;vx为自车纵向车速;vx,f为前车的纵向车速;ax为自车纵向加速度;ax,f为前车的纵向加速度;λ1为改进车头时距系数;λ2为速度比例系数;λ3为加速度差值系数;d为车辆最小行驶间距,单位为m;In the formula, d x, des is the expected distance between the ego vehicle and the preceding vehicle; v x is the longitudinal speed of the ego vehicle; v x, f is the longitudinal speed of the preceding vehicle; a x is the longitudinal acceleration of the ego vehicle; a x, f is the front Longitudinal acceleration of the vehicle; λ 1 is the time distance coefficient of the improved vehicle head; λ 2 is the speed proportional coefficient; λ 3 is the acceleration difference coefficient; d is the minimum driving distance of the vehicle, the unit is m;

在防护前端碰撞系统中,在道路的路面附着系数左右相同时,每根车轴的左右制动力分配相同,第一轴车轮的制动力分配比例固定,第二轴与第三轴的制动力分配由制动加速度大小决定,制动力分配公式为:In the front-end collision protection system, when the road surface adhesion coefficient is the same, the left and right braking force distribution of each axle is the same, the braking force distribution ratio of the wheels of the first axle is fixed, and the braking force distribution of the second axle and the third axle is determined by The braking acceleration is determined, and the braking force distribution formula is:

F1,bra=0.4Fbra F 1,bra = 0.4F bra

Figure GDA0003767225330000196
Figure GDA0003767225330000196

Figure GDA0003767225330000197
Figure GDA0003767225330000197

式中,F1,bra、F2,bra、F3,bra分别为第一轴、第二轴、第三轴车轮分配的制动力;abra为制动减速度;Fbra为制动力;In the formula, F 1,bra , F 2,bra , F 3,bra are the braking forces distributed by the wheels of the first, second and third axles respectively; a bra is the braking deceleration; F bra is the braking force;

D)防护后端碰撞系统判断自车的车尾与后车发生碰撞的风险,当自车与后车的纵向间距小于期望间距时且前方无车辆、障碍物或前方车辆障碍物无威胁时,启动防护后端碰撞系统,自车将处于加速状态,自车与后车纵向期望间距计算公式为:D) The rear-end collision protection system judges the risk of collision between the rear of the vehicle and the vehicle behind. When the longitudinal distance between the vehicle and the vehicle behind is less than the expected distance and there is no vehicle, obstacle or obstacle in front of the vehicle ahead, there is no threat. When the rear-end collision protection system is activated, the ego vehicle will be in an accelerating state. The formula for calculating the desired longitudinal distance between the ego car and the rear car is:

Figure GDA0003767225330000201
Figure GDA0003767225330000201

式中,dx,des’为自车与前车的期望间距;vx为自车纵向车速;vx,r为后车的纵向车速;ax为自车纵向加速度;ax,r为后车的纵向加速度;λ1为改进车头时距系数,λ2为速度比例系数,λ3为加速度差值系数,d为车辆最小行驶间距,单位为m;In the formula, d x, des' is the desired distance between the ego vehicle and the preceding car; v x is the longitudinal speed of the ego vehicle; v x, r is the longitudinal speed of the rear car; a x is the longitudinal acceleration of the ego vehicle; a x, r is the longitudinal acceleration of the ego vehicle; The longitudinal acceleration of the rear vehicle; λ 1 is the time distance coefficient of the improved headway, λ 2 is the speed proportional coefficient, λ 3 is the acceleration difference coefficient, d is the minimum driving distance of the vehicle, and the unit is m;

在防护后端碰撞系统中,在道路的路面附着系数左右相同时,每根车轴的左右驱动力分配相同,第一轴车轮的驱动力分配比例固定,第二轴与第三轴的驱动力分配由加速度大小决定,驱动力分配公式为:In the rear-end collision protection system, when the road surface adhesion coefficient is the same, the left and right driving force distribution of each axle is the same, the driving force distribution ratio of the wheels of the first axle is fixed, and the driving force distribution of the second axle and the third axle Determined by the magnitude of the acceleration, the driving force distribution formula is:

Facc,1=0.3Facc F acc,1 = 0.3F acc

Figure GDA0003767225330000202
Figure GDA0003767225330000202

Figure GDA0003767225330000203
Figure GDA0003767225330000203

式中,Facc,1、Facc,2、Facc,3分别为第一轴、第二轴、第三轴车轮分配的驱动力;aacc为加速度;Facc为驱动力;In the formula, F acc,1 , F acc,2 and F acc,3 are the driving forces distributed by the wheels of the first, second and third axles respectively; a acc is the acceleration; F acc is the driving force;

E)当相邻两辆车均为线控底盘车型车辆时,若两车之间实际纵向距离小于两车之间的期望纵向间距时,前车的防护后端碰撞系统与后车的防护前端碰撞系统同时工作,前车处于加速状态,后车处于减速度状态,前后车同时启动防护碰撞系统将缩短车辆变速运动时间。E) When the two adjacent vehicles are both drive-by-wire chassis type vehicles, if the actual longitudinal distance between the two vehicles is less than the expected longitudinal distance between the two vehicles, the rear-end collision protection system of the front vehicle and the front-end protection of the rear vehicle The collision system works at the same time, the front car is in the acceleration state, the rear car is in the deceleration state, and the front and rear cars simultaneously start the collision protection system, which will shorten the time of the vehicle shifting movement.

本发明公开了一种纵向主动防撞控制系统及方法,旨在解决在车辆纵向高速行驶时的安全问题,其针对复杂的道路变化以及周围车辆不固定的运动状态以及障碍物的位置影响,通过车辆自身传感器采集数据并利用车辆间的通讯系统收集障碍物信息,判断当前时刻车辆是否处于安全状态,并控制启动底盘防撞控制系统中的防撞控制,防撞控制分为前端防撞和后端防撞两种,当前、后车辆均搭载线控底盘,前、后车辆均启动底盘防撞控制,以保证车辆纵向行驶过程中的安全性和稳定性。The invention discloses a longitudinal active anti-collision control system and method, aiming at solving the safety problem when the vehicle is running at high speed in the longitudinal direction. The vehicle's own sensors collect data and use the inter-vehicle communication system to collect obstacle information, determine whether the vehicle is in a safe state at the current moment, and control the start of the anti-collision control in the chassis anti-collision control system. There are two types of end anti-collision. The current and rear vehicles are equipped with wire-controlled chassis, and the front and rear vehicles both start the chassis anti-collision control to ensure the safety and stability of the vehicle during longitudinal driving.

以上仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或者等效流程变换,或者直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。The above are only preferred embodiments of the present invention, and are not intended to limit the scope of the present invention. Any equivalent structure or equivalent process transformation made by using the contents of the description and drawings of the present invention, or directly or indirectly applied in other related technical fields , are similarly included in the scope of patent protection of the present invention.

Claims (7)

1.一种纵向主动防撞控制系统,包括环境和障碍物检测系统,所述环境和障碍物检测系统用于检测并采集环境信息和车辆前后左右各方障碍物位置与运动状态信息,其特征在于,还包括底盘防撞控制系统、车轮独立线控驱动系统和车轮独立线控制动系统,所述底盘防撞控制系统包括防护前端碰撞系统和防护后端碰撞系统,所述车轮独立线控驱动系统用于对车辆的各个车轮施加独立的驱动力,所述车轮独立线控制动系统用于对车辆的各个车轮施加独立的制动力,所述底盘防撞控制系统根据环境和障碍物检测系统采集的信息控制各个车轮的制动力和驱动力使得车辆实现防护前端碰撞和防护后端碰撞;所述车轮独立线控制动系统包括车身稳定模块和制动延迟补偿模块,所述车身稳定模块用于保证车辆稳定,所述制动延迟补偿模块用于补偿制动器执行动作延迟与通讯延时导致的制动延迟;1. A longitudinal active anti-collision control system, including an environment and obstacle detection system, the environment and obstacle detection system is used to detect and collect environmental information and the position and motion state information of obstacles on the left and right sides of the vehicle. It also includes a chassis anti-collision control system, a wheel independent wire-controlled drive system and a wheel independent wire-controlled brake system, the chassis anti-collision control system includes a front-end collision protection system and a rear-end collision protection system, and the wheel independent wire-controlled drive system The system is used to apply an independent driving force to each wheel of the vehicle, the wheel independent brake-by-wire system is used to apply an independent braking force to each wheel of the vehicle, and the chassis anti-collision control system is collected according to the environment and the obstacle detection system The information controls the braking force and driving force of each wheel so that the vehicle can achieve front-end collision protection and rear-end collision protection; the wheel independent brake-by-wire system includes a body stability module and a braking delay compensation module, and the body stability module is used to ensure The vehicle is stable, and the braking delay compensation module is used to compensate the braking delay caused by the delay in the execution of the brake and the delay in the communication; 所述底盘防撞控制系统用于控制三轴六轮车辆,所述车轮独立线控驱动系统为六轮独立线控驱动系统,六个车轮均为驱动轮,每个驱动轮包括驱动模式、随动模式与放空模式三种工作模式;The chassis anti-collision control system is used to control a three-axle six-wheel vehicle, the wheel independent wire-controlled drive system is a six-wheel independent wire-controlled drive system, the six wheels are all driving wheels, and each driving wheel includes a driving mode, a follow-up mode Three working modes with venting mode; 所述车轮独立线控制动系统为六轮独立线控制动系统,所述车身稳定模块和制动延迟补偿模块用于保证制动工作时的车辆自身稳定性和无延迟制动;The wheel independent brake-by-wire system is a six-wheel independent brake-by-wire system, and the vehicle body stability module and the brake delay compensation module are used to ensure the vehicle's own stability and non-delay braking during braking; 车辆前端的第一轴和车辆尾端的第三轴的驱动轮采用轮边驱动模式,车辆中间的第二轴的驱动轮采用轮毂电机驱动模式,车辆前端的第一轴和车辆尾端的第三轴采用电液耦合制动,车辆中间的第二轴采用电子机械制动;The driving wheel of the first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopts the wheel-side drive mode, the driving wheel of the second axle in the middle of the vehicle adopts the in-wheel motor drive mode, and the first axle at the front end of the vehicle and the third axle at the rear end of the vehicle adopt the in-wheel motor drive mode. The electro-hydraulic coupling brake is adopted, and the second axle in the middle of the vehicle adopts the electro-mechanical brake; 当第二轴处于放空模式时、仅第一轴和第三轴车轮制动工作时,第一轴和第三轴的四个车轮制动的轮缸压力值分别为:When the second axle is in the emptying mode and only the wheel brakes of the first and third axles are working, the wheel cylinder pressure values of the four wheel brakes of the first and third axles are:
Figure FDA0003767225320000021
Figure FDA0003767225320000021
Figure FDA0003767225320000022
Figure FDA0003767225320000022
Figure FDA0003767225320000023
Figure FDA0003767225320000023
Figure FDA0003767225320000024
Figure FDA0003767225320000024
式中,p1、p2、p5、p6分别为第一轴左右侧车轮与第三轴左右侧车轮的制动压力,单位为MPa;FZ1、FZ2、FZ5、FZ6分别为第一轴左右侧车轮与第三轴左右侧车轮的地面垂向作用力,单位为N;Rw1、Rw3分别为第一轴和第三轴上车轮的半径,单位为米;Kb为制动压力系数,其大小为车轮制动力矩与轮缸压力的比值;ΔMZ为车辆期望横摆力矩,单位为Nm;B1为第一轴左右侧车轮中心到轴心的距离,B3为第三轴左右侧车轮中心到轴心的距离,单位为米;δ1、δ2、δ5、δ6分别为第一轴左右侧车轮与第三轴左右侧车轮转角,单位为rad。In the formula, p 1 , p 2 , p 5 , and p 6 are the braking pressures of the left and right wheels of the first axis and the left and right wheels of the third axis, respectively, in MPa; F Z1 , F Z2 , F Z5 , and F Z6 respectively is the ground vertical force of the left and right wheels of the first axis and the left and right wheels of the third axis, in N; R w1 and R w3 are the radii of the wheels on the first and third axes, respectively, in meters; K b is the braking pressure coefficient, which is the ratio of the wheel braking torque to the wheel cylinder pressure; ΔM Z is the expected yaw moment of the vehicle, in Nm; B 1 is the distance from the center of the left and right wheels of the first axis to the axle center, B 3 is the distance from the center of the left and right wheels of the third axis to the axle center, the unit is meters; δ 1 , δ 2 , δ 5 , δ 6 are the rotation angles of the left and right wheels of the first axis and the left and right wheels of the third axis, the unit is rad .
2.根据权利要求1所述的一种纵向主动防撞控制系统,其特征在于,还包括车车通讯系统和云端通讯系统:所述车车通讯系统用于线控底盘车型车辆之间的信息交互,以及线控底盘车型车辆与其他车型车辆的信息交互;所述云端通讯系统用于记录线控底盘车型车辆的环境和障碍物检测系统采集的环境信息数据,并将其传递给非线控底盘车型车辆,同时将非线控底盘车型车辆的信息记录反馈给线控底盘车型车辆,完成道路车辆全部参与信息交互;所述云端通讯系统还包括信息整合单元A,所述信息整合单元A将云端通讯系统接收的信息、环境和障碍物检测系统检测到的障碍物信息以及车车通讯系统的交互信息进行信息整合。2. A longitudinal active anti-collision control system according to claim 1, further comprising a vehicle-to-vehicle communication system and a cloud communication system: the vehicle-to-vehicle communication system is used to control information between vehicles of chassis models by wire Interaction, and the information interaction between the wire-controlled chassis model vehicle and other types of vehicles; the cloud communication system is used to record the environment of the wire-controlled chassis model vehicle and the environmental information data collected by the obstacle detection system, and transmit it to the non-wire-controlled vehicle. At the same time, the information records of the non-wire-controlled chassis type vehicles are fed back to the wire-controlled chassis type vehicles, so that all road vehicles participate in the information exchange; the cloud communication system also includes an information integration unit A, and the information integration unit A will The information received by the cloud communication system, the obstacle information detected by the environment and obstacle detection system, and the interactive information of the vehicle-to-vehicle communication system are integrated. 3.根据权利要求2所述的一种纵向主动防撞控制系统,其特征在于,所述环境和障碍物检测系统包括智能环视传感器系统、轮心相对高度测量仪、信息整合单元B和平整度信息修正单元:3. A longitudinal active anti-collision control system according to claim 2, wherein the environment and obstacle detection system comprises an intelligent surround view sensor system, a wheel center relative height measuring instrument, an information integration unit B and a flatness Information correction unit: 所述智能环视传感器系统包括车头顶部机械式激光雷达,车头前部的固态激光雷达,车头顶部与前部相交处的双目摄像头以及车辆尾部的单目摄像头;The intelligent surround view sensor system includes a mechanical lidar on the top of the vehicle, a solid-state lidar on the front of the vehicle, a binocular camera at the intersection of the top of the vehicle and the front, and a monocular camera at the rear of the vehicle; 所述信息整合单元B将机械式激光雷达、双目摄像头采集到的信息与车车通讯系统、云端通信系统采集的车辆交互信息进行整合,精确障碍物和周边车辆状态;The information integration unit B integrates the information collected by the mechanical laser radar and the binocular camera with the vehicle interaction information collected by the vehicle-to-vehicle communication system and the cloud communication system to accurately determine the status of obstacles and surrounding vehicles; 平整度信息修正单元将固态激光雷达与轮心相对高度测量仪采集的车辆行驶的周围道路平整度信息进行修正。The flatness information correction unit corrects the flatness information of the surrounding road where the vehicle is traveling, which is collected by the solid-state lidar and the wheel center relative height measuring instrument. 4.根据权利要求1所述的一种纵向主动防撞控制系统,其特征在于,制动延迟补偿模块的补偿轮缸压力值为:4. A kind of longitudinal active anti-collision control system according to claim 1, is characterized in that, the compensation wheel cylinder pressure value of brake delay compensation module is:
Figure FDA0003767225320000031
Figure FDA0003767225320000031
式中,pcom为补偿轮缸压力值,t1为通讯延迟时间,t2’为制动器间隙减小所用时间,t2”为制动器逐渐压紧至稳定所用时间,从制动器起作用开始后的t1+t2’+t2”/2时间段内,ppro取值为最大轮缸压力值的30%-80%,单位为MPa,ppro的值取决于底盘防撞控制系统中的制动减速度值,p(t)为t时刻制动轮缸压力值,单位为MPa。In the formula, p com is the compensation wheel cylinder pressure value, t 1 is the communication delay time, t 2 ' is the time taken for the brake clearance to decrease, t 2 '' is the time taken for the brake to be gradually pressed to a stable state, and the time after the brake starts to work. During the time period of t 1 +t 2 '+t 2 ”/2, the value of p pro is 30%-80% of the maximum wheel cylinder pressure value, the unit is MPa, and the value of p pro depends on the chassis collision avoidance control system. Brake deceleration value, p(t) is the pressure value of the brake wheel cylinder at time t, the unit is MPa.
5.根据权利要求3所述的一种纵向主动防撞控制系统,其特征在于,所述平整度信息修正单元的修正公式为:5. A longitudinal active anti-collision control system according to claim 3, wherein the correction formula of the flatness information correction unit is:
Figure FDA0003767225320000032
Figure FDA0003767225320000032
式中,hn,i为修正后的车辆周围第i个不平路面低矮障碍相对高度;h’n,i和h”n,i分别为固态激光雷达检测和轮心相对高度测量仪测量的车辆周围第i个不平路面低矮障碍相对高度,单位为米;vx为车辆的纵向车速,单位为m/s;kvx为纵向车速影响因子,单位为m/s。In the formula, h n,i is the corrected relative height of the i-th low obstacle on the uneven road around the vehicle; h' n,i and h'n ,i are measured by solid-state lidar detection and wheel center relative height measuring instrument, respectively. The relative height of the low obstacle on the ith uneven road around the vehicle, in meters; vx is the longitudinal speed of the vehicle, in m/s; k vx is the longitudinal speed influence factor, in m/s.
6.根据权利要求3所述的一种纵向主动防撞控制系统,其特征在于,所述信息整合单元B经过信息整合后的障碍物信息为:6. A kind of longitudinal active anti-collision control system according to claim 3, is characterized in that, the obstacle information after the information integration of described information integration unit B is:
Figure FDA0003767225320000041
Figure FDA0003767225320000041
Figure FDA0003767225320000042
Figure FDA0003767225320000042
Figure FDA0003767225320000043
Figure FDA0003767225320000043
Figure FDA0003767225320000044
Figure FDA0003767225320000044
式中,xcj、ycj、vcj、acj分别为双目摄像头所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xdj、ydj、vdj、adj分别为机械式激光雷达所采集的车辆周围第j个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xwi、ywi、vwi、awi分别为车车通讯系统检测到的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xi、yi、vi、ai分别为整合后的第i辆线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xn-i、yn-i、vn-i、an-i为整合后的非线控底盘车型车辆的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度,其中n为机械式激光雷达所检测到的动态障碍物的数量,j=1…n;kw为交互信息准确性系数;kd为雷达信息准确性系数;kc为摄像头信息准确性系数,kw、kd和kc的取值均为小于1的正数;xd,n-i、yd,n-i、vd,n-i、ad,n-i分别为机械式激光雷达所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度;xc,n-i、yc,n-i、vc,n-i、ac,n-i分别为双目摄像头所采集的车辆周围第n-i个动态障碍物的纵向瞬时位置、横向瞬时位置、瞬时速度、瞬时加速度。In the formula, x cj , y cj , v cj , and a cj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by the binocular camera; x dj , y dj , v dj , and a dj are the longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the j-th dynamic obstacle around the vehicle collected by mechanical lidar, respectively; x wi , y wi , v wi , and a wi are respectively are the longitudinal instantaneous position, lateral instantaneous position , instantaneous speed , and instantaneous acceleration of the i - th vehicle-by-wire chassis vehicle detected by the vehicle-to-vehicle communication system; Longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the vehicle by wire-controlled chassis; x ni , y ni , v ni , and a ni are the longitudinal and lateral instantaneous positions of the integrated non-wire-controlled chassis vehicle. Instantaneous speed, instantaneous acceleration, where n is the number of dynamic obstacles detected by mechanical lidar, j=1...n; k w is the accuracy coefficient of interactive information; k d is the accuracy coefficient of radar information; k c is The camera information accuracy coefficient, k w , k d and k c are all positive numbers less than 1; x d, ni , y d, ni , v d, ni , a d, ni are mechanical lidars, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous velocity, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle collected; x c,ni , y c,ni , v c,ni , a c,ni are the binocular cameras, respectively The longitudinal instantaneous position, lateral instantaneous position, instantaneous speed, and instantaneous acceleration of the ni-th dynamic obstacle around the vehicle are collected.
7.一种纵向主动防撞控制方法,其特征在于,底盘防撞控制系统包括具有通讯功能的防撞模式和不具有通讯功能的防撞模式:7. A longitudinal active anti-collision control method, wherein the chassis anti-collision control system comprises an anti-collision mode with a communication function and an anti-collision mode without a communication function: 具有通讯功能的防撞模式:根据环境和障碍物检测系统、车车通讯系统以及云端通讯系统整合后的障碍物信息数据,判定自车的碰撞风险,利用障碍物数据和相应控制策略决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞;Anti-collision mode with communication function: According to the obstacle information data integrated by the environment and obstacle detection system, the vehicle-to-vehicle communication system and the cloud communication system, determine the collision risk of the own vehicle, and use the obstacle data and the corresponding control strategy to decide the out-of-line control The execution of the various systems of the chassis avoids collision with dynamic and static obstacles; 不具有通讯功能的防撞模式,仅根据环境和障碍物检测系统采集的动静态障碍物信息,判断自车的碰撞风险,利用障碍物数据和相应控制策略决策出线控底盘各系统的执行动作,避免与动静态障碍物发生碰撞,具体算法如下:The anti-collision mode without communication function only judges the collision risk of the vehicle based on the dynamic and static obstacle information collected by the environment and obstacle detection system, and uses the obstacle data and the corresponding control strategy to decide the execution actions of each system of the drive-by-wire chassis. To avoid collision with dynamic and static obstacles, the specific algorithm is as follows: A)设t时刻相邻两车之间的纵向间距d(t)为:A) Let the longitudinal distance d(t) between two adjacent cars at time t be: d(t)=xf(t)-x(t)或d(t)=x(t)-xr(t)d(t)= xf (t)-x(t) or d(t)=x(t) -xr (t) 式中,xf(t)为t时刻线控底盘车型前车的纵向位置,x(t)为t时刻线控底盘车型的纵向位置,xr(t)为t时刻线控底盘车型后车的纵向位置,单位为米;In the formula, x f (t) is the longitudinal position of the car in front of the chassis model by wire at time t, x(t) is the longitudinal position of the chassis model by wire at time t, and x r (t) is the rear car of the chassis model by wire at time t The longitudinal position of , in meters; B)t时刻底盘防撞控制系统控制的纵向驱动力或纵向制动力的计算公式为:B) The calculation formula of the longitudinal driving force or longitudinal braking force controlled by the chassis anti-collision control system at time t is:
Figure FDA0003767225320000051
Figure FDA0003767225320000051
Figure FDA0003767225320000052
Figure FDA0003767225320000052
式中,F(t)为t时刻车辆纵向驱动力或制动力,单位为N;m为自车的整车质量;q与k为积分滑模系数;λ1为改进车头时距系数;Fa(t)、Fr(t)分别为t时刻空气阻力和滚动阻力,单位为N;
Figure FDA0003767225320000053
为t时刻相邻两车的纵向位置误差值的一阶导数;
Figure FDA0003767225320000054
为t时刻相邻两车的纵向位置误差值的二阶导数;ades(t)为t时刻滑模控制策略所得到的自车的期望加速度;v1和v2分别为相邻两车中前车的纵向车速和后车的纵向车速,单位为m/s;
In the formula, F(t) is the longitudinal driving force or braking force of the vehicle at time t, the unit is N; m is the vehicle mass of the own vehicle; q and k are the integral sliding mode coefficients; λ 1 is the improved headway coefficient; F a (t) and F r (t) are the air resistance and rolling resistance at time t, respectively, and the unit is N;
Figure FDA0003767225320000053
is the first derivative of the longitudinal position error value of two adjacent vehicles at time t;
Figure FDA0003767225320000054
is the second derivative of the longitudinal position error value of the two adjacent vehicles at time t; a des (t) is the expected acceleration of the vehicle obtained by the sliding mode control strategy at time t; v 1 and v 2 are the two adjacent vehicles, respectively The longitudinal speed of the preceding vehicle and the longitudinal speed of the rear vehicle, in m/s;
Figure FDA0003767225320000055
Figure FDA0003767225320000055
Figure FDA0003767225320000061
Figure FDA0003767225320000061
式中,e(t)为t时刻相邻两车的纵向位置误差值,单位为m;si为滑模面,G为正常数;In the formula, e(t) is the longitudinal position error value of two adjacent vehicles at time t, the unit is m; s i is the sliding surface, and G is a positive number; C)防护前端碰撞系统判断自车的车头与前车发生碰撞的风险,当自车前方距离最近的车辆的纵向位置与自车纵向位置之差小于期望间距时,启动防护前端碰撞系统,其中自车与前车的纵向期望间距计算公式为:C) The front-end collision protection system judges the risk of collision between the front of the vehicle and the vehicle in front. When the difference between the longitudinal position of the vehicle with the closest distance in front of the vehicle and the longitudinal position of the vehicle is less than the desired distance, the front-end collision protection system is activated, in which the self-service front-end collision protection system is activated. The formula for calculating the expected longitudinal distance between the vehicle and the vehicle in front is:
Figure FDA0003767225320000062
Figure FDA0003767225320000062
式中,dx,des为自车与前车的期望间距;vx为自车纵向车速;vx,f为前车的纵向车速;ax为自车纵向加速度;ax,f为前车的纵向加速度;λ1为改进车头时距系数;λ2为速度比例系数;λ3为加速度差值系数;d为车辆最小行驶间距,单位为m;In the formula, d x, des is the expected distance between the ego vehicle and the preceding vehicle; v x is the longitudinal speed of the ego vehicle; v x, f is the longitudinal speed of the preceding vehicle; a x is the longitudinal acceleration of the ego vehicle; a x, f is the front Longitudinal acceleration of the vehicle; λ 1 is the time distance coefficient of the improved vehicle head; λ 2 is the speed proportional coefficient; λ 3 is the acceleration difference coefficient; d is the minimum driving distance of the vehicle, the unit is m; 启动防护前端碰撞系统,制动力分配公式为:The front-end collision protection system is activated, and the braking force distribution formula is: F1,bra=0.4Fbra F 1,bra = 0.4F bra
Figure FDA0003767225320000063
Figure FDA0003767225320000063
Figure FDA0003767225320000064
Figure FDA0003767225320000064
式中,F1,bra、F2,bra、F3,bra分别为第一轴、第二轴、第三轴车轮分配的制动力;abra为制动减速度;Fbra为制动力;In the formula, F 1,bra , F 2,bra , F 3,bra are the braking forces distributed by the wheels of the first, second and third axles respectively; a bra is the braking deceleration; F bra is the braking force; D)防护后端碰撞系统判断自车的车尾与后车发生碰撞的风险,当自车与后车的纵向间距小于期望间距时且前方无车辆、障碍物或前方车辆障碍物无威胁时,启动防护后端碰撞系统,自车将处于加速状态,自车与后车纵向期望间距计算公式为:D) The rear-end collision protection system judges the risk of collision between the rear of the vehicle and the vehicle behind. When the longitudinal distance between the vehicle and the vehicle behind is less than the expected distance and there is no vehicle, obstacle or obstacle in front of the vehicle ahead, there is no threat. When the rear-end collision protection system is activated, the ego vehicle will be in an accelerating state. The formula for calculating the desired longitudinal distance between the ego car and the rear car is:
Figure FDA0003767225320000065
Figure FDA0003767225320000065
式中,dx,des’为自车与前车的期望间距;vx为自车纵向车速;vx,r为后车的纵向车速;ax为自车纵向加速度;ax,r为后车的纵向加速度;λ1为改进车头时距系数,λ2为速度比例系数,λ3为加速度差值系数,d为车辆最小行驶间距,单位为m;In the formula, d x, des' is the desired distance between the ego vehicle and the preceding car; v x is the longitudinal speed of the ego vehicle; v x, r is the longitudinal speed of the rear car; a x is the longitudinal acceleration of the ego vehicle; a x, r is the longitudinal acceleration of the ego vehicle; The longitudinal acceleration of the rear vehicle; λ 1 is the time distance coefficient of the improved headway, λ 2 is the speed proportional coefficient, λ 3 is the acceleration difference coefficient, d is the minimum driving distance of the vehicle, and the unit is m; 启动防护后端碰撞系统,驱动力分配公式为:The rear-end collision protection system is activated, and the driving force distribution formula is: Facc,1=0.3Facc F acc,1 = 0.3F acc
Figure FDA0003767225320000071
Figure FDA0003767225320000071
Figure FDA0003767225320000072
Figure FDA0003767225320000072
式中,Facc,1、Facc,2、Facc,3分别为第一轴、第二轴、第三轴车轮分配的驱动力;aacc为加速度;Facc为驱动力;In the formula, F acc,1 , F acc,2 and F acc,3 are the driving forces distributed by the wheels of the first, second and third axles respectively; a acc is the acceleration; F acc is the driving force; E)当相邻两辆车均为线控底盘车型车辆时,若两车之间实际纵向距离小于两车之间的期望纵向间距时,前车的防护后端碰撞系统与后车的防护前端碰撞系统同时工作,前车处于加速状态,后车处于减速度状态,前后车同时启动防护碰撞系统。E) When the two adjacent vehicles are both drive-by-wire chassis type vehicles, if the actual longitudinal distance between the two vehicles is less than the expected longitudinal distance between the two vehicles, the rear-end collision protection system of the front vehicle and the front-end protection of the rear vehicle The collision system works at the same time, the front car is in the acceleration state, the rear car is in the deceleration state, and the front and rear cars simultaneously activate the collision protection system.
CN202111666415.9A 2021-12-31 2021-12-31 A longitudinal active collision avoidance control system and method Active CN114312765B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111666415.9A CN114312765B (en) 2021-12-31 2021-12-31 A longitudinal active collision avoidance control system and method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111666415.9A CN114312765B (en) 2021-12-31 2021-12-31 A longitudinal active collision avoidance control system and method

Publications (2)

Publication Number Publication Date
CN114312765A CN114312765A (en) 2022-04-12
CN114312765B true CN114312765B (en) 2022-10-25

Family

ID=81020473

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111666415.9A Active CN114312765B (en) 2021-12-31 2021-12-31 A longitudinal active collision avoidance control system and method

Country Status (1)

Country Link
CN (1) CN114312765B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115285083B (en) * 2022-09-26 2023-07-28 苏州亚太精睿传动科技股份有限公司 Vehicle braking system and vehicle braking method
CN116461508B (en) * 2023-04-27 2024-04-02 广州汽车集团股份有限公司 Vehicle control method, device, terminal and medium

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111746501A (en) * 2020-07-06 2020-10-09 清华大学 A vehicle handling limit extension method and system based on drive-brake cooperative control
CN112677963A (en) * 2021-01-07 2021-04-20 吉林大学 Intelligent networking four-wheel independent steering and independent driving electric automobile emergency obstacle avoidance system
CN113378947A (en) * 2021-06-21 2021-09-10 北京踏歌智行科技有限公司 Vehicle road cloud fusion sensing system and method for unmanned transportation in open-pit mining area

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6227333B2 (en) * 2013-08-30 2017-11-08 日立オートモティブシステムズ株式会社 Brake system

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111746501A (en) * 2020-07-06 2020-10-09 清华大学 A vehicle handling limit extension method and system based on drive-brake cooperative control
CN112677963A (en) * 2021-01-07 2021-04-20 吉林大学 Intelligent networking four-wheel independent steering and independent driving electric automobile emergency obstacle avoidance system
CN113378947A (en) * 2021-06-21 2021-09-10 北京踏歌智行科技有限公司 Vehicle road cloud fusion sensing system and method for unmanned transportation in open-pit mining area

Also Published As

Publication number Publication date
CN114312765A (en) 2022-04-12

Similar Documents

Publication Publication Date Title
US11104333B2 (en) Emergency braking system, emergency braking method and semitrailer
CN112677963B (en) Intelligent network-connected four-wheel independent steering and independent drive electric vehicle emergency obstacle avoidance system
EP4247695B1 (en) Predictive energy and motion management for multitrailer heavy-duty vehicles
US9199639B2 (en) Motion control system of vehicle
CN102030007B (en) Method for acquiring overall dynamics controlled quantity of independently driven-independent steering vehicle
CN110435623A (en) A kind of grading automatical emergency braking control system of the electric vehicle of adjust automatically
CN110614998A (en) Aggressive driving-assisted curve obstacle avoidance and road changing path planning system and method
CN107972663A (en) A kind of vehicle control system based on intelligent driving technology, device and method
CN110901630A (en) Method and system for controlling lateral stability of semi-trailer train
WO2024146195A1 (en) Automatic operation system for electronic guided rubber-tyred tram
CN114312765B (en) A longitudinal active collision avoidance control system and method
CN108717268A (en) The fastest maneuvering control system and control method for automatic driving based on optimal control and safety distance
CN105612091A (en) Vehicle motion control device
CN112109705A (en) Collision avoidance optimization control system and method for extended-range distributed driving electric vehicle
CN208376738U (en) A kind of vehicle control system based on intelligent driving technology, device
CN116946137A (en) Vehicle-road cooperative intelligent vehicle lane-changing anti-collision system based on driving intention
CN106671961A (en) Active anti-collision system based on electric automobile and control method thereof
CN104176054A (en) A kind of vehicle active anti-collision automatic lane change control system and its working method
CN113561972B (en) Obstacle avoidance control method and device, vehicle and storage medium
CN113721606A (en) Guiding type automatic driving logistics vehicle control system and method
CN206493934U (en) A kind of active anti-collision system based on electric automobile
EP4247686B1 (en) Method for reducing high-speed off-tracking in multi-trailer heavy duty vehicles
CN114889589A (en) A kind of intelligent vehicle steering and braking cooperative collision avoidance control system and method
CN114312766B (en) Control system and method based on transverse active collision avoidance
US9043071B1 (en) Steering-based scrub braking

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: No. 1 Xingyuan Road, Industrial Park, Panxian Town, Danyang City, Zhenjiang City, Jiangsu Province, China 212300

Patentee after: Jiangsu Chaoli Electric Appliance Co.,Ltd.

Country or region after: China

Address before: 59, Gao Lu, Zhenjiang, Danyang, Jiangsu

Patentee before: JIANGSU CHAOLI ELECTRIC Inc.

Country or region before: China

CP03 Change of name, title or address