CN112298173B - 一种面向智能驾驶的车辆安全行驶控制系统及控制方法 - Google Patents
一种面向智能驾驶的车辆安全行驶控制系统及控制方法 Download PDFInfo
- Publication number
- CN112298173B CN112298173B CN202011227026.1A CN202011227026A CN112298173B CN 112298173 B CN112298173 B CN 112298173B CN 202011227026 A CN202011227026 A CN 202011227026A CN 112298173 B CN112298173 B CN 112298173B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- max
- changing
- safe
- lane change
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 230000001133 acceleration Effects 0.000 claims abstract description 72
- 238000010586 diagram Methods 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
- B60W10/06—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of combustion engines
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/04—Traffic conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/105—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
- B60W40/112—Roll movement
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/06—Combustion engines, Gas turbines
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/18—Braking system
- B60W2510/182—Brake pressure, e.g. of fluid or between pad and disc
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/06—Combustion engines, Gas turbines
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/18—Braking system
- B60W2710/182—Brake pressure, e.g. of fluid or between pad and disc
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
- B60W2710/207—Steering angle of wheels
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Regulating Braking Force (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种面向智能驾驶的车辆安全行驶控制系统及控制方法,所述控制系统包括:由车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器和车辆参数单元组成的数据采集模块、由数值计算单元、决策判断单元以及控制量输出单元组成的中央处理模块以及由转向控制系统、节气门控制系统和制动控制系统组成的执行模块;所述控制方法包括:计算本车与前车之间的期望纵向安全距离;计算本车与前车之间的期望加速度;基于期望加速度控制车辆在非变道工况下行驶;基于期望加速度控制车辆侧方变道或制动减速;本发明综合考虑本车道和侧方车道行驶环境条件,通过侧向变道或制动减速,能够有效地提高乘坐舒适性和进一步提高车辆行驶安全性。
Description
技术领域
本发明属于车辆主动安全行驶技术领域,具体涉及一种面向智能驾驶的车辆安全行驶控制系统及控制方法。
背景技术
随着科学技术的快速发展,汽车电子信息化水平得到了长足的发展,极大的提高了汽车的智能化水平和行驶安全性能。传统的汽车安全行驶控制系统包括:ACC(汽车自适应巡航系统)和AEB(汽车紧急制动系统),前者能够根据前后车辆安全车距动态调整车辆跟车车速以保障行车安全和乘坐舒适性,后者发现车辆处在危险工况时通过紧急制动来避免碰撞事故的发生;但是,在紧急情况下现有的ACC和AEB两种系统均无法完全避免车辆发生碰撞,并且,在AEB介入时,车辆以较大的制动减速度进行制动时,还极大地加剧了乘客的心理恐惧,影响乘客的乘坐体验。
发明内容
针对上述现有技术中存在的缺陷,本发明提供了一种面向智能驾驶的车辆安全行驶控制系统及控制方法,本发明综合考虑本车车道和侧方车道行驶环境条件,通过侧向变道或制动减速的方式避免发生碰撞。结合说明书附图,本发明的技术方案如下:
一种面向智能驾驶的车辆安全行驶控制系统,包括:数据采集模块、中央处理模块和执行模块,所述数据采集模块由车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元,其中,所述车辆参数单元内存储有本车车辆结构固定参数信息;
所述中央处理模块由数值计算单元、决策判断单元以及控制量输出单元组成;
所述数值计算单元用于接收车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元输出的信号并计算本车与前车之间的期望纵向安全距离、本车相对于前车之间的期望加速度、目标变道轨迹区间、安全变道区域、目标变道时域内的质心侧偏角和横摆角速度,以及侧方变道安全临界车速;
所述决策判断单元用于根据数值计算单元计算得到的数据信息作出包括:调节节气门开度控制车辆加速行驶、通过地面阻力控制车辆制动减速、调节制动主缸制动压力控制车辆制动减速、控制车辆以最大制动减速度进行制动减速、控制车辆转向跟踪目标变道轨迹进行侧方变道或控制车辆以期望加速度进行制动减速在内的控制决策;
所述控制量输出模块用于根据决策判断单元得出的决策结果,向执行模块发送控制指令;
所述执行模块包括:转向控制系统、节气门控制系统和制动控制系统。
进一步地,所述本车车辆结构固定参数信息包括:整车质量、前轴距离质心距离、后轴距离质心距离、前轴等效侧偏刚度、后轴等效侧偏刚度以及车辆宽度。
一种面向智能驾驶的车辆安全行驶控制方法,具体步骤如下:
步骤一:计算本车与前车之间的期望纵向安全距离dd;
步骤二:计算本车与前车之间的期望加速度ad;
步骤三:基于期望加速度控制车辆在非变道工况下行驶;
(1)若ad>0,则输出“车辆加速行驶”的决策结果,并控制车辆节气门开度,实现车辆加速行驶;
(2)若ad<0,且|ad|<a*,则输出“地面制动”的决策结果,通过地面阻力进行制动减速,地面阻力临界值a*的计算公式如下:
上述地面阻力临界值a*的计算公式中:
f为路面附着系数;
δ为转动惯量系数;
CD为空气阻力系数;
A为本车迎风面积;
g为重力加速度常数;
m为本车整车质量;
vx为本车纵向车速;
(3)若a*<|ad|<ab1,则输出“制动压力调节”的决策结果,并控制制动主缸的制动压力,实现车辆减速行驶;其中:
ab1=50%amax
所述制动主缸的制动压力p的计算公式如下:
制动压力p的计算公式中:
A0为制动主缸的横截面积;
m为本车整车质量;
ad为本车与前车之间的期望加速度;
g为重力加速度常数;
f为路面附着系数;
g为重力加速度常数;
CD为空气阻力系数;
A为本车迎风面积;
vx为本车纵向车速;
(4)若|ad|>ab1,则进入下述步骤四,进一步地根据期望加速度控制车辆侧方变道或制动减速;
步骤四:基于期望加速度控制车辆侧方变道或制动减速;
当ab1<|ad|<ab2时,则进行安全变道区域变道行驶控制过程,当|ad|>ab2时,则进行目标变道轨迹区间变道行驶控制过程,其中:
ab2=70%amax;
当|ad|>ab2时,所述目标变道轨迹区间变道行驶控制过程具体如下:
A1:判断目标变道轨迹区间[y1,y2]是否安全,若安全,则进入步骤A2,若不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动主缸的制动压力,使车辆以最大制动减速度amax进行制动;
A2:判断目标变道时域内的质心侧偏角β和横摆角速度ω,若β>γ1βmax或ω>γ2ωmax,控制车辆制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入下述步骤A3;反之,输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
γ1、γ2为参考系数,取值范围0.9-1.2;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
A3:再次判断新生成的目标变道轨迹区间是否安全,若安全,则输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动主缸的制动压力,实现车辆以最大制动减速度amax进行制动;
当ab1<|ad|<ab2时,所述安全变道区域变道行驶控制过程具体如下:
B1:判断安全变道区域是否安全,若安全,则进入步骤B2,若不安全,则输出“制动减速”的决策结果,并控制车辆以期望加速度ad进行制动减速;
B2:判断目标变道时域内的质心侧偏角β和横摆角速度ω,若β>βmax或ω>ωmax,控制制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入步骤B3;反之,输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
B3:再次判断新生成的安全变道区域是否安全,若安全,则输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“制动减速”的决策结果,并控制车辆以期望加速度ad进行制动减速。
进一步地,所述步骤A1中,所述目标变道轨迹区间[y1,y2]的计算公式如下:
上述目标变道轨迹区间[y1,y2]的计算公式中:
y*为目标变道轨迹;
Δy为边界阈值;
L为本车的车辆宽度。
进一步地,所述步骤B1中,所述安全变道区域为yb1、yb2和道路边界线三者包络范围内,其中:
上述安全变道区域的计算公式中:
tb为车辆变道至目标变道轨迹时间;
vx为本车纵向车速;
t表示本车行驶时间。
与现有技术相比,本发明的有益效果在于:
本发明综合考虑本车车道和侧方车道行驶环境条件,通过侧向变道或制动减速的方式避免发生碰撞,极大地提高乘坐舒适性并进一步提高了行驶的安全性。
附图说明
图1为本发明所述面向智能驾驶的车辆安全行驶控制系统的结构框图;
图2为本发明所述面向智能驾驶的车辆安全行驶控制方法的流程框图;
图3为本发明所述面向智能驾驶的车辆安全行驶控制方法中,目标变道轨迹区间示意图;
图4为本发明所述面向智能驾驶的车辆安全行驶控制方法中,安全变道区域示意图;
具体实施方式
为清楚、完整地描述本发明所述技术方案及其具体工作过程,结合说明书附图,本发明的具体实施方式如下:
实施例一:
本实施例一公开了一种面向智能驾驶的车辆安全行驶控制系统,包括:数据采集模块、中央处理模块和执行模块。
所述数据采集模块包括:车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元;其中:
所述车速传感器,用于采集本车纵向车速和本车加速度;
所述激光雷达传感器,用于采集周围车辆车速、周围车辆加速度和周围车辆距离本车车距;
所述节气门开度传感器,用于采集本车节气门开度;
所述制动压力传感器,用于采集本车制动主缸制动压力;
所述车辆参数单元用于存储本车车辆结构固定参数信息,所述本车车辆结构固定参数信息包括:整车质量、前轴距离质心距离、后轴距离质心距离、前轴等效侧偏刚度、后轴等效侧偏刚度以及车辆宽度;
上述数据采集模块中,车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元分别与中央处理模块中的数值计算单元信号连接,分别将采集或存储的数据信息送至数值计算单元作进一步计算处理。
所述中央处理模块包括:数值计算单元、决策判断单元以及控制量输出单元;其中:
所述数值计算单元,用于接收数据采集模块中车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器采集并发送的数据信息,以及调用车辆参数单元中的数据信息,并根据接收或调用的数据信息计算:本车与前车之间的期望纵向安全距离、本车相对于前车之间的期望加速度、目标变道轨迹区间、安全变道区域、目标变道时域内的质心侧偏角和横摆角速度,以及侧方变道安全临界车速;
所述决策判断单元,用于根据数值计算单元计算得到的数据信息作出相应的控制决策,包括:调节节气门开度控制车辆加速行驶、通过地面阻力控制车辆制动减速、调节制动主缸制动压力控制车辆制动减速、控制车辆以最大制动减速度进行制动减速、控制车辆转向跟踪目标变道轨迹进行侧方变道或控制车辆以期望加速度进行制动减速;
所述控制量输出模块根据决策判断单元得出的决策结果,向执行模块中对应的执行控制系统发送控制指令。
所述执行模块包括:转向控制系统、节气门控制系统和制动控制系统;其中:
所述转向控制系统,用于根据接收到的控制指令控制车辆前轮转角;
所述节气门控制系统,用于根据接收到的控制指令控制车辆节气门开度;
所述制动控制系统,用于根据接收到的控制指令控制车辆制动主缸的制动压力。
实施例二:
本具体实施例二公开了一种面向智能驾驶的车辆安全行驶控制方法,所述控制方法基于前述实施例一中所述的面向智能驾驶的车辆安全行驶控制系统,具体控制过程如下:
步骤一:计算本车与前车之间的期望纵向安全距离dd;
本车与前车之间的期望纵向安全距离dd计算公式如下:
上述期望纵向安全距离的计算公式中:
vB为同车道前车车速;
aB为同车道前车加速度;
vx为本车纵向车速;
a为本车加速度;
τ1为驾驶员制动反应时间;
τ2为制动减速度由0增长至最大的时间;
k为制动减速度增长率;
amax为最大制动减速度;
t0为本车由当前车速减速到静止的时间;
d0为最小安全距离;
vx-∫ktdt表示速度;
步骤二:计算本车与前车之间的期望加速度ad;
首先,计算本车与前车实际车距drel、本车与前车相对车速vrel以及本车与前车相对加速度arel;
(1)本车与前车实际车距drel计算公式如下:
上述本车与前车实际车距的计算公式中:
vB为同车道前车车速;
aB为同车道前车加速度;
vx为本车纵向车速;
a为本车加速度;
dz为本车与前车初始距离;
t为本车与前车行驶的时间;
(2)本车与前车相对车速vrel计算公式如下:
vrel=vB+aBt-vx-at
上述本车与前车相对车速的计算公式中:
vB为同车道前车车速;
aB为同车道前车加速度;
vx为本车纵向车速;
a为本车加速度;
t为本车与前车行驶的时间;
(3)本车与前车相对加速度arel计算公式如下:
arel=aB-a
上述本车与前车相对加速度的计算公式中:
aB为同车道前车加速度;
a为本车加速度;
然后,取状态量为:X=[drel vrel arel];控制量为u=ad,可得状态方程:
Y=CX
式中,输出量Y=drel;
上述状态方程中,A、B、E分别状态方程系数,C表示输出方程的系数,υ表示干扰项;
最后,通过求目标函数最小值:
min∫[(drel-dd)2+u2]dt
即可求得最优控制量u,即本车与前车之间的期望加速度ad;
步骤三:基于期望加速度控制车辆在非变道工况下行驶;
根据前述步骤二计算获得的本车与前车之间的期望加速度ad进行下列决策,并根据决策结果控制车辆行驶状态;
(1)若ad>0,则输出“车辆加速行驶”的决策结果,并控制节气门控制系统控制车辆节气门开度,实现车辆加速行驶;
(2)若ad<0,且|ad|<a*,则输出“地面制动”的决策结果,通过地面阻力进行制动减速;其中a*为地面阻力临界值,计算公式如下:
上述地面阻力临界值a*的计算公式中:
f为路面附着系数;
δ为转动惯量系数;
CD为空气阻力系数;
A为本车迎风面积;
g为重力加速度常数;
m为本车整车质量;
vx为本车纵向车速;
(3)若a*<|ad|<ab1,则输出“制动压力调节”的决策结果,并控制制动控制系统控制制动主缸的制动压力,实现车辆减速行驶;其中:
ab1=50%amax
所述制动主缸的制动压力p的计算公式如下:
制动压力p的计算公式中:
A0为制动主缸的横截面积;
m为本车整车质量;
ad为本车与前车之间的期望加速度;
g为重力加速度常数;
f为路面附着系数;
g为重力加速度常数;
CD为空气阻力系数;
A为本车迎风面积;
vx为本车纵向车速;
(4)若|ad|>ab1,则进入下述步骤四,进一步地根据期望加速度控制车辆侧方变道或制动减速;
步骤四:基于期望加速度控制车辆侧方变道或制动减速;
本步骤四中,根据前述步骤二计算获得的本车与前车之间的期望加速度ad进行决策,当ab1<|ad|<ab2时,则进行安全变道区域变道行驶控制过程;当|ad|>ab2时,则进行目标变道轨迹区间变道行驶控制过程,其中:
ab2=70%amax;
如图3所示,当|ad|>ab2时,所述目标变道轨迹区间变道行驶控制过程具体如下:
A1:判断目标变道轨迹区间[y1,y2]是否安全,若车辆在目标变道轨迹区间无碰撞危险,即安全,则进入下述步骤A2进一步判断目标变道时域内的质心侧偏角β和横摆角速度ω;若车辆在目标变道轨迹区间有碰撞危险,即不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动控制系统控制制动主缸的制动压力,实现车辆以最大制动减速度amax进行制动;
所述目标变道轨迹区间[y1,y2]的计算公式如下:
上述目标变道轨迹区间[y1,y2]的计算公式中:
y*为目标变道轨迹;
Δy为边界阈值;
L为本车的车辆宽度;
A2:判断目标变道时域内的质心侧偏角β和横摆角速度ω;
若β>γ1βmax或ω>γ2ωmax,控制车辆制动控制系统制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入下述步骤A3;反之,输出“侧方变道”的决策结果,并通过车辆转向控制系统控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
γ1、γ2为参考系数,取值范围0.9-1.2;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
A3:参考前述步骤A1,再次判断新生成的目标变道轨迹区间是否安全,若安全,则输出“侧方变道”的决策结果,并通过车辆转向控制系统控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动控制系统控制制动主缸的制动压力,实现车辆以最大制动减速度amax进行制动;
如图4所示,当ab1<|ad|<ab2时,所述安全变道区域变道行驶控制过程具体如下:
B1:侧方变道环境检测,判断安全变道区域是否安全,若车辆在安全变道区域内无碰撞危险,即安全,则进入下述步骤B2进一步判断目标变道时域内的质心侧偏角β和横摆角速度ω;若车辆在安全变道区域内有碰撞危险,即不安全,则输出“制动减速”的决策结果,并通过制动控制系统控制车辆以期望加速度ad进行制动减速;
所述安全变道区域为yb1、yb2和道路边界线三者包络范围内,其中:
上述安全变道区域的计算公式中:
tb为车辆变道至目标变道轨迹时间;
vx为本车纵向车速;
t表示本车行驶时间;
B2:判断目标变道时域内的质心侧偏角β和横摆角速度ω;
若β>βmax或ω>ωmax,控制车辆制动控制系统制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入下述步骤B3;反之,输出“侧方变道”的决策结果,并通过车辆转向控制系统控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
B3:参考前述步骤B1,再次判断新生成的安全变道区域是否安全,若安全,则输出“侧方变道”的决策结果,并通过车辆转向控制系统控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“制动减速”的决策结果,并通过制动控制系统控制车辆以期望加速度ad进行制动减速。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
以上所述本发明的具体实施方式,并不构成对本发明保护范围的限定。任何根据本发明的技术构思所作出的各种其他相应的改变与变形,均应包含在本发明权利要求的保护范围内。
Claims (5)
1.一种面向智能驾驶的车辆安全行驶控制方法,其特征在于:
步骤一:计算本车与前车之间的期望纵向安全距离dd;
步骤二:计算本车与前车之间的期望加速度ad;
步骤三:基于期望加速度控制车辆在非变道工况下行驶;
(1)若ad>0,则输出“车辆加速行驶”的决策结果,并控制车辆节气门开度,实现车辆加速行驶;
(2)若ad<0,且|ad|<a*,则输出“地面制动”的决策结果,通过地面阻力进行制动减速,地面阻力临界值a*的计算公式如下:
上述地面阻力临界值a*的计算公式中:
f为路面附着系数;
δ为转动惯量系数;
CD为空气阻力系数;
A为本车迎风面积;
g为重力加速度常数;
m为本车整车质量;
vx为本车纵向车速;
(3)若a*<|ad|<ab1,则输出“制动压力调节”的决策结果,并控制制动主缸的制动压力,实现车辆减速行驶;其中:
ab1=50%amax
所述制动主缸的制动压力p的计算公式如下:
制动压力p的计算公式中:
A0为制动主缸的横截面积;
m为本车整车质量;
ad为本车与前车之间的期望加速度;
g为重力加速度常数;
f为路面附着系数;
g为重力加速度常数;
CD为空气阻力系数;
A为本车迎风面积;
vx为本车纵向车速;
(4)若|ad|>ab1,则进入下述步骤四,进一步地根据期望加速度控制车辆侧方变道或制动减速;
步骤四:基于期望加速度控制车辆侧方变道或制动减速;
当ab1<|ad|<ab2时,则进行安全变道区域变道行驶控制过程,当|ad|>ab2时,则进行目标变道轨迹区间变道行驶控制过程,其中:
ab2=70%amax;
当|ad|>ab2时,所述目标变道轨迹区间变道行驶控制过程具体如下:
A1:判断目标变道轨迹区间[y1,y2]是否安全,若安全,则进入步骤A2,若不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动主缸的制动压力,使车辆以最大制动减速度amax进行制动;
A2:判断目标变道时域内的质心侧偏角β和横摆角速度ω,若β>γ1βmax或ω>γ2ωmax,控制车辆制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入下述步骤A3;反之,输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
γ1、γ2为参考系数,取值范围0.9-1.2;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
A3:再次判断新生成的目标变道轨迹区间是否安全,若安全,则输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“以最大制动减速度amax紧急制动减速”的决策结果,并控制制动主缸的制动压力,实现车辆以最大制动减速度amax进行制动;
当ab1<|ad|<ab2时,所述安全变道区域变道行驶控制过程具体如下:
B1:判断安全变道区域是否安全,若安全,则进入步骤B2,若不安全,则输出“制动减速”的决策结果,并控制车辆以期望加速度ad进行制动减速;
B2:判断目标变道时域内的质心侧偏角β和横摆角速度ω,若β>βmax或ω>ωmax,控制制动主缸的制动压力,使制动至侧方变道安全临界车速行驶,并进入步骤B3;反之,输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;其中:
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
所述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式如下:
上述目标变道时域内的最大质心侧偏角βmax和最大横摆角速度ωmax的计算公式中:
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
vx为本车纵向车速;
kr为本车后轴等效侧偏刚度;
f为路面附着系数;
g为重力加速度常数;
lr为本车的后轴距离质心距离;
lf为本车的后轴距离质心距离;
m为本车整车质量;
kr为本车后轴等效侧偏刚度;
βmax为目标变道时域内的最大质心侧偏角;
ωmax为目标变道时域内的最大横摆角速度;
B3:再次判断新生成的安全变道区域是否安全,若安全,则输出“侧方变道”的决策结果,并控制车辆前轮转角,使车辆跟踪目标变道轨迹进行侧方变道;若不安全,则输出“制动减速”的决策结果,并控制车辆以期望加速度ad进行制动减速。
4.一种面向智能驾驶的车辆安全行驶控制系统,包括:数据采集模块、中央处理模块和执行模块,其特征在于:
所述控制系统能够实现如权利要求1-3中任意一项所述控制方法;
所述数据采集模块由车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元,其中,所述车辆参数单元内存储有本车车辆结构固定参数信息;
所述中央处理模块由数值计算单元、决策判断单元以及控制量输出单元组成;
所述数值计算单元用于接收车速传感器、激光雷达传感器、节气门开度传感器、制动压力传感器以及车辆参数单元输出的信号并计算本车与前车之间的期望纵向安全距离、本车相对于前车之间的期望加速度、目标变道轨迹区间、安全变道区域、目标变道时域内的质心侧偏角和横摆角速度,以及侧方变道安全临界车速;
所述决策判断单元用于根据数值计算单元计算得到的数据信息作出包括:调节节气门开度控制车辆加速行驶、通过地面阻力控制车辆制动减速、调节制动主缸制动压力控制车辆制动减速、控制车辆以最大制动减速度进行制动减速、控制车辆转向跟踪目标变道轨迹进行侧方变道或控制车辆以期望加速度进行制动减速在内的控制决策;
所述控制量输出单元用于根据决策判断单元得出的决策结果,向执行模块发送控制指令;
所述执行模块包括:转向控制系统、节气门控制系统和制动控制系统。
5.如权利要求4所述一种面向智能驾驶的车辆安全行驶控制系统,其特征在于:
所述本车车辆结构固定参数信息包括:整车质量、前轴距离质心距离、后轴距离质心距离、前轴等效侧偏刚度、后轴等效侧偏刚度以及车辆宽度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011227026.1A CN112298173B (zh) | 2020-11-06 | 2020-11-06 | 一种面向智能驾驶的车辆安全行驶控制系统及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011227026.1A CN112298173B (zh) | 2020-11-06 | 2020-11-06 | 一种面向智能驾驶的车辆安全行驶控制系统及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112298173A CN112298173A (zh) | 2021-02-02 |
CN112298173B true CN112298173B (zh) | 2021-12-21 |
Family
ID=74326201
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011227026.1A Active CN112298173B (zh) | 2020-11-06 | 2020-11-06 | 一种面向智能驾驶的车辆安全行驶控制系统及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112298173B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113165615A (zh) * | 2021-03-16 | 2021-07-23 | 华为技术有限公司 | 车辆控制方法及装置 |
CN113619574A (zh) * | 2021-08-27 | 2021-11-09 | 中国第一汽车股份有限公司 | 一种车辆避让方法、装置、计算机设备和存储介质 |
CN113978467B (zh) * | 2021-10-28 | 2023-06-20 | 江铃汽车股份有限公司 | 一种基于正弦函数的车辆自动变道控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105857294A (zh) * | 2016-05-04 | 2016-08-17 | 常州工学院 | 一种汽车换道避撞控制方法 |
US20170096138A1 (en) * | 2015-10-06 | 2017-04-06 | Ford Global Technologies, Llc | Collision Avoidance Using Auditory Data Augmented With Map Data |
CN111645677A (zh) * | 2020-05-20 | 2020-09-11 | 吉林大学 | 一种车辆制动转向协调控制紧急防碰撞系统及控制方法 |
CN111645678A (zh) * | 2020-05-20 | 2020-09-11 | 吉林大学 | 一种车辆制动转向协调控制防碰撞系统及控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4858767B2 (ja) * | 2006-09-08 | 2012-01-18 | スズキ株式会社 | 車両用操舵装置 |
-
2020
- 2020-11-06 CN CN202011227026.1A patent/CN112298173B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20170096138A1 (en) * | 2015-10-06 | 2017-04-06 | Ford Global Technologies, Llc | Collision Avoidance Using Auditory Data Augmented With Map Data |
CN105857294A (zh) * | 2016-05-04 | 2016-08-17 | 常州工学院 | 一种汽车换道避撞控制方法 |
CN111645677A (zh) * | 2020-05-20 | 2020-09-11 | 吉林大学 | 一种车辆制动转向协调控制紧急防碰撞系统及控制方法 |
CN111645678A (zh) * | 2020-05-20 | 2020-09-11 | 吉林大学 | 一种车辆制动转向协调控制防碰撞系统及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112298173A (zh) | 2021-02-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112298173B (zh) | 一种面向智能驾驶的车辆安全行驶控制系统及控制方法 | |
WO2020187254A1 (zh) | 自动驾驶车辆的纵向控制方法系统 | |
JP3478107B2 (ja) | 車両用走行制御装置 | |
EP3435191B1 (en) | Method of controlling inter-vehicle gap(s) | |
CN109131312B (zh) | 一种智能电动汽车acc/esc集成控制系统及其方法 | |
US9108600B2 (en) | Method and device for performing closed-loop or open-loop control of the driving stability of a vehicle | |
CN103269935B (zh) | 车辆驾驶辅助装置、方法和车辆 | |
US7363155B2 (en) | Method and device for warning the driver of a motor vehicle | |
EP1818231B1 (en) | Vehicle control system | |
US8712664B2 (en) | Vehicle control apparatus | |
CN111516692A (zh) | 一种车辆在坑洼路面上行驶的控制系统及方法 | |
JP5026381B2 (ja) | 加減速制御装置 | |
CN103813950A (zh) | 用于改善行驶稳定性的方法 | |
US20090143951A1 (en) | Forward Collision Avoidance Assistance System | |
JP4873047B2 (ja) | 走行制御装置 | |
CN105172791A (zh) | 一种智能自适应巡航控制方法 | |
KR101693847B1 (ko) | 적응형 크루즈 컨트롤 시스템 및 그 제어방법 | |
KR20210135579A (ko) | 자동차의 차동 제동 시스템 및 휠 스티어링 시스템의 복합 제어를 위한 설정점을 생성하는 방법 | |
US20160311416A1 (en) | Method for regulating driving stability | |
JP2009061878A (ja) | 走行制御装置 | |
CN110040138B (zh) | 一种车辆并行辅助驾驶方法和系统 | |
CN107128307A (zh) | 一种车辆巡航控制方法、装置及汽车 | |
CN104136296A (zh) | 速度控制方法和系统 | |
CN116946137A (zh) | 一种基于驾驶意图的车路协同智能车辆换道防碰撞系统 | |
KR20200081524A (ko) | 차량 및 그 제어 방법 |
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 |