CN113291286B - 基于弯道横摆稳定性的辅助驾驶系统及其控制方法 - Google Patents
基于弯道横摆稳定性的辅助驾驶系统及其控制方法 Download PDFInfo
- Publication number
- CN113291286B CN113291286B CN202110554024.1A CN202110554024A CN113291286B CN 113291286 B CN113291286 B CN 113291286B CN 202110554024 A CN202110554024 A CN 202110554024A CN 113291286 B CN113291286 B CN 113291286B
- Authority
- CN
- China
- Prior art keywords
- vehicle speed
- steering wheel
- yaw stability
- driving system
- current
- 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 23
- 238000004364 calculation method Methods 0.000 claims description 24
- 230000005540 biological transmission Effects 0.000 claims description 7
- 239000000853 adhesive Substances 0.000 claims description 4
- 230000001070 adhesive effect Effects 0.000 claims description 4
- 238000004891 communication Methods 0.000 claims description 3
- 230000003247 decreasing effect Effects 0.000 claims description 2
- 230000001133 acceleration Effects 0.000 description 8
- 102100034112 Alkyldihydroxyacetonephosphate synthase, peroxisomal Human genes 0.000 description 3
- 101000799143 Homo sapiens Alkyldihydroxyacetonephosphate synthase, peroxisomal Proteins 0.000 description 3
- 238000000848 angular dependent Auger electron spectroscopy Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000007423 decrease Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000004913 activation Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000368 destabilizing effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000005070 sampling 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/02—Control of vehicle driving stability
- B60W30/045—Improving turning performance
-
- 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/06—Road conditions
- B60W40/072—Curvature of the road
-
- 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/08—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 drivers or passengers
-
- 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/107—Longitudinal acceleration
-
- 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/109—Lateral acceleration
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/12—Lateral speed
- B60W2520/125—Lateral acceleration
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/30—Road curve radius
-
- 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
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种基于弯道横摆稳定性的辅助驾驶系统,包括数据获取模块:用于获取车辆的运行参数;数据处理模块:用于确定最大目标方向盘转角和最小目标车速;控制模块:用于当辅助驾驶系统不满足开启条件、且当前车辆稳定性不满足要求时,执行强制开启辅助驾驶系统;执行单元:包括方向盘转角控制单元和车速控制单元。本发明还公开了上述辅助驾驶系统的控制方法,包括:获取车辆运行参数和前方道路的最小曲率半径;根据最小曲率半径确定最大目标方向盘转角和最小目标车速;当辅助驾驶系统不满足开启条件时、且当前车速和当前方向盘转角不满足当前车辆稳定性要求时,强制开启辅助驾驶系统。本发明提高车辆弯道横摆稳定性和安全性。
Description
技术领域
本发明涉及辅助驾驶技术领域,具体地指一种基于弯道横摆稳定性的辅助驾驶系统及其控制方法。
背景技术
在驾驶员在弯道驾驶时,主要靠经验控制车身的稳态,若驾驶员操作不当,ESC系统也只能在车身失稳或即将失稳的情况下介入进行控制,驾驶体验感不强,且车身姿态超过ESC系统所能控制的能力的情况下,车辆也会继续失稳,进而导致交通事故的发生。
随着ADAS技术的普及,ACC、LKA等功能已经大量运用,但是ACC、LKA等功能在弯道驾驶方面的应用还很受限,比如,为避免在弯道时车辆发生侧滑、甩尾等问题,在进入弯道之前ADAS系统会提示驾驶员对车辆进行接管,辅助驾驶系统会暂时退出。
现有方案一般利用辅助驾驶系统的车载摄像装置、GPS定位模块以及算法,能够提前判断道路弯道曲率半径、弯道内的车道范围,实现车道内的保持技术。但是弯道内车辆一旦发生侧滑或者失稳,ESC系统就会介入,这样就会导致辅助驾驶系统立即退出。
中国专利CN105882661A公开一种机动车弯道驾驶辅助系统的运行方式,该专利主要通过GPS模块、地图信息、车载装置实现对车辆弯道半径的计算。但是上述专利需要GPS模块、地图信息进行辅助;专利中侧重点在于弯道探测技术,并未实现弯道内驾驶的车身稳态的提前计算;专利中未实现车辆的横向方向控制,不能很好的解决当前自动驾驶领域的过弯问题。
中国专利CN110682910A公开一种弯道辅助驾驶方法及装置,该专利主要通过对弯道边缘的探测,实现车辆在弯道内的车道保持。上述专利存在的问题是:车辆横向角度的控制是基于车道线/弯道边缘采样的来计算弯道范围,实现弯道内的车道保持,不是基于车身稳态控制的出发点,不能很好的实现车身稳态的控制。
发明内容
本发明的目的就是要克服上述现有技术存在的不足,提供一种基于弯道横摆稳定性的辅助驾驶系统及其控制方法,该系统和方法可以在过弯道之前基于横摆稳定性要求提前给出转向角度和车速的建议范围,并在具有失稳风险时进行主动介入控制,提高车辆弯道横摆稳定性和安全性。
为实现上述目的,本发明提供一种基于弯道横摆稳定性的辅助驾驶系统,包括依次通讯连接的数据获取模块、数据处理模块、控制模块和执行单元;
所述数据获取模块用于获取车辆的运行参数和前方道路的曲率半径;
所述数据处理模块用于根据曲率半径确定目标方向盘转角和极限车速,以及根据目标方向盘转角、极限车速和横摆稳定性要求确定目标车速;
所述控制模块用于根据车速和方向盘转角判断横摆稳定性是否满足要求,以及当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制车速和方向盘转角满足当前横摆稳定性;
所述执行单元包括方向盘转角控制单元和车速控制单元。
进一步地,所述数据处理模块包括目标方向盘转角计算模块、极限车速计算模块、目标车速计算模块;
所述目标方向盘转角计算模块用于根据曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离确定目标方向盘转角;
所述极限车速计算模块用于构建车辆所受离心力等于最大侧向附着力的计算模型,根据计算模型和曲率半径确定极限车速;
所述目标车速计算模块用于将极限车速作为车速的初始值,并以固定步长递减,根据车速、目标方向盘转角和横摆稳定性要求判定是否满足横摆稳定性,将首次满足横摆稳定性的车速作为目标车速。
进一步地,所述控制模块包括横摆稳定性控制模块、辅助驾驶系统控制模块;
所述横摆稳定性控制模块用于根据车速和方向盘转角判定横摆稳定性是否满足要求;
所述辅助驾驶系统控制模块用于当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制车速和方向盘转角满足当前横摆稳定性。
所述辅助驾驶系统控制模块还用于,根据当前道路的曲率半径判定是否开启辅助驾驶系统。
所述辅助驾驶系统控制模块还用于,当辅助驾驶系统不满足开启条件且当前车速和当前方向盘转角满足当前横摆稳定性要求时,提醒驾驶员并显示最大目标方向盘转角和最小目标车速。
所述辅助驾驶系统控制模块还用于,当辅助驾驶系统满足开启条件时,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于最小目标车速。
本发明还提供一种基于弯道横摆稳定性的辅助驾驶系统的控制方法,包括:获取车辆运行参数和前方道路图像,得到前方道路的最小曲率半径;
根据最小曲率半径确定最大目标方向盘转角和最小极限车速,根据最大目标方向盘转角、最小极限车速和横摆稳定性要求确定最小目标车速;
当辅助驾驶系统不满足开启条件时、且当前车速和当前方向盘转角不满足当前横摆稳定性要求时,强制开启辅助驾驶系统,控制当前车速和当前方向盘转角满足当前横摆稳定性要求。
进一步地,所述最大目标方向盘转角的确定方法包括,根据最小曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离构建几何模型,通过几何模型求得。
目标方向盘转角α计算公式为
其中,l为车辆轴距;lr为车辆质心至后轴距离;i为转向传动比。
进一步地,所述最小极限车速的确定方法包括,构建车辆所受离心力等于最大侧向附着力的力学模型,根据力学模型和最小曲率半径求得。
其中m为汽车质量,v为车速,R为曲率半径,μ为路面附着系数,ax纵向加速度,ay侧向加速度,g为重力加速度。
进一步地,所述最小目标车速的确定方法包括,将最小极限车速作为车速的初始值,并以固定步长递减,根据车速、最大目标方向盘转角判定是否满足横摆稳定性要求,将首次满足横摆稳定性要求的车速作为最小目标车速。
质心侧偏角β计算公式为
K为汽车稳定性因数,m为整车质量,l为车辆轴距,lf为质心至前轴距离,lr为质心至后轴距离,kf为前轮侧偏刚度,kr为后轮侧偏刚度。
进一步地,若强制开启辅助驾驶系统,则获取车辆当前车速和当前道路的曲率半径,根据当前道路的曲率半径得到当前道路的目标方向盘转角和极限车速,根据当前道路的目标方向盘转角、极限车速和横摆稳定性要求得到当前道路的目标车速,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于当前道路的目标车速。
进一步地,当辅助驾驶系统不满足开启条件且当前车速和当前方向盘转角满足当前横摆稳定性要求时,提醒驾驶员并显示最大目标方向盘转角和最小目标车速。
进一步地,当辅助驾驶系统满足开启条件时,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于最小目标车速。
本发明的有益效果:提高车辆弯道横摆稳定性和安全性。本发明在获取弯道曲率半径时不仅获取当前道路的曲率半径,还获取前方弯道的最小曲率半径,根据最小曲率半径以及横摆稳定性的要求得到最大目标方向盘转角和最小目标车速,在辅助驾驶系统不满足开启条件时,首先通过驾驶员主动控制方向盘转角和车速,并提示驾驶员前方弯道请减速,显示最大方向盘转角和最小目标车速,在当前方向盘转角和当前车速不满足横摆稳定性时,辅助驾驶系统强制介入,首先根据当前道路的曲率半径以及横摆稳定性的要求确定目标方向盘转角和目标车速,然后控制方向盘转角和车速满足横摆稳定性的要求,因此提高了车辆过弯时的横摆稳定性和驾驶安全性。
附图说明
图1为基于弯道横摆稳定性的辅助驾驶系统结构示意图。
图2为基于弯道横摆稳定性的辅助驾驶系统的控制方法流程图。
图中各部件标号如下:数据获取模块100、数据处理模块200、目标方向盘转角计算模块210、极限车速计算模块220、目标车速计算模块230、控制模块300、横摆稳定性控制模块310、辅助驾驶系统控制模块320、执行单元400、方向盘转角控制单元410、车速控制单元420。
具体实施方式
下面具体实施方式用于对本发明的权利要求技术方案作进一步的详细说明,便于本领域的技术人员更清楚地了解本权利要求书。本发明的保护范围不限于下面具体的实施例。本领域的技术人员做出的包含有本发明权利要求书技术方案而不同于下列具体实施方式的也是本发明的保护范围。
如图1所示,一种基于弯道横摆稳定性的辅助驾驶系统,包括依次通讯连接的数据获取模块100、数据处理模块200、控制模块300和执行单元400。
数据获取模块100包括车辆运行参数获取模块和摄像装置,车辆运行参数获取模块用于获取车辆运行参数。摄像装置用于获取前方道路图像,得到当前道路的曲率半径,以及前方道路的最小曲率半径。
数据处理模块200用于根据曲率半径确定目标方向盘转角和极限车速,以及根据目标方向盘转角、极限车速和横摆稳定性要求确定目标车速;其中当将最小曲率半径输入至数据处理模块200时,会得到最大目标方向盘转角和最小极限车速,然后根据最大目标方向盘转角、最下极限车速和横摆稳定性要求确定最小目标车速。
控制模块300用于根据车速和方向盘转角判断横摆稳定性是否满足要求,以及当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制车速和方向盘转角满足当前横摆稳定性;
执行单元400包括方向盘转角控制单元410和车速控制单元420。
数据处理模块200包括目标方向盘转角计算模块210、最小极限车速计算模块220、目标车速计算模块230。
目标方向盘转角计算模块210用于根据曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离确定目标方向盘转角。
极限车速计算模块220用于构建车辆所受离心力等于最大侧向附着力的力学模型,根据力学模型和曲率半径确定极限车速。
目标车速计算模块230用于将极限车速作为车速的初始值,并以固定步长递减,根据车速、目标方向盘转角和横摆稳定性要求判定是否满足横摆稳定性,将首次满足横摆稳定性的车速作为目标车速。
控制模块300包括横摆稳定性控制模块310、辅助驾驶系统控制模块320。
横摆稳定性控制模块310用于根据车速和方向盘转角判定横摆稳定性是否满足要求。
辅助驾驶系统控制模块320用于当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制当前车速和当前方向盘转角满足当前横摆稳定性。
辅助驾驶系统控制模块320还用于,根据当前道路的曲率半径判定是否开启辅助驾驶系统。
辅助驾驶系统控制模块320还用于,当辅助驾驶系统不满足开启条件且当前车速和当前方向盘转角满足当前横摆稳定性要求时,提醒驾驶员并显示最大目标方向盘转角和最小目标车速。
辅助驾驶系统控制模块320还用于,当辅助驾驶系统满足开启条件时,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于最小目标车速。
方向盘转角控制单元410用于控制方向盘转角,车速控制单元420用于控制车速。
如图2所示,上述基于弯道横摆稳定性的辅助驾驶系统的控制如下:
1、数据获取
车辆运行参数获取模块110获取车辆运行参数,包括当前方向盘转角、当前车速、纵向加速度、侧向加速度。摄像装置120获取前方道路图像,然后通过通过ADAS系统的成熟算法得到当前道路的曲率半径,以及前方道路的最小曲率半径。因为摄影装置所获取的前方道路各个位置点的曲率半径是不同,因此获取当前道路的曲率半径是为了确定车轮即将行驶的位置的曲率半径,而获取最小曲率半径是为了获知前方在可视范围内弯道角度最大的程度,为了后续横摆稳定性控制和辅助驾驶控制提供预警信息。
作为一种优先实施例,当天气条件较恶劣时,摄像装置成像距离受影响,此时可通过高精度地图对道路几何形状进行数据制作,即通过形状点描述道路的几何形状,形状点以高精度坐标形式进行描述;计算时采用曲线拟合的方式,得到各个形状点所在曲率半径的倒数,根据道路的几何形状,进行曲线拟合后计算出离散点的曲率值,进而获得前方道路的曲率半径。
作为另一种优选实施例,前方道路的曲率半径取上述两种算法结果的最小值。
2、数据处理
数据处理模块200根据曲率半径确定目标方向盘转角和极限车速,以及根据目标方向盘转角、极限车速和横摆稳定性要求确定目标车速。
本实施例中,目标方向盘转角计算模块210首先根据曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离所构建的汽车转向几何模型确定目标方向盘转角。本实施例中,目标方向盘转角计算模块210的输入值包括当前道路的曲率半径和最小曲率半径,对应输出为当前道路的目标方向盘转角和最大目标方向盘转角。
目标方向盘转角α计算公式为
其中,l为车辆轴距;lr为车辆质心至后轴距离;i为转向传动比。
本实施例中,极限车速计算模块220构建车辆所受离心力等于最大侧向附着力的力学模型,根据力学模型和曲率半径确定极限车速。极限车速计算模块220的输入为包括当前道路的曲率半径和最小曲率半径,对应输出为当前道路的极限车速和最小极限车速。
其中m为汽车质量,v为车速,R为曲率半径,μ为路面附着系数,ax纵向加速度,ay侧向加速度,g为重力加速度。
本实施例中,目标车速计算模块230将极限车速作为车速的初始值,将车速、目标方向盘转角代入到横摆稳定性要求的判定式中,横摆稳定性控制模块310判定是否满足横摆稳定性,如果不满足,则将车速逐步以固定步长n递减,再次代入到横摆稳定性要求的判定式中,直到满足横摆稳定性要求,将首次满足横摆稳定性的车速作为目标车速。
目标车速计算模块230的两组输入分别为当前道路的目标方向盘转角、当前道路的极限车速以及、最大目标方向盘转角、最小极限车速;其对应的两个输出分别为当前道路的目标车速和最小目标车速。
质心侧偏角β计算公式为
K为汽车稳定性因数,m为整车质量,l为车辆轴距,lf为质心至前轴距离,lr为质心至后轴距离,kf为前轮侧偏刚度,kr为后轮侧偏刚度。
3、逻辑判断和执行
首先,辅助驾驶系统控制模块320判定辅助驾驶系统是否满足开启条件,如果当前道路的曲率半径大于设定的曲率半径临界值,则辅助驾驶系统开启,控制方向盘转角控制单元410和车速控制单元420执行正常辅助驾驶模式。
本实施例中,正常辅助驾驶模式控制过程为:控制方向盘转角控制单元410控制方向盘转角为当前道路的目标方向盘转角,车速控制单元420控制车速小于最小目标车速。这样,在当前道路的目标方向盘转角下,车辆的轨迹可以与道路轨迹保持一致性,不会出现偏航现象,而将车速控制在低于最小目标车速范围内,使得当前车速一定小于当前道路的目标车速,可以保证当前横摆稳定性一定满足要求,且在未来某一时刻通过最小曲率半径的位置时,也能满足该位置处的横摆稳定性要求,这样可以使得该模式下的横摆稳定性和驾驶安全性得到最大限度的保护,由于辅助驾驶系统对前方路况的判断没有驾驶员那么及时准确,控制方向盘转角和车速的速度也没有驾驶员及时,因此这样避免了辅助驾驶系统因为当前车速偏快,从而无法快速有效地进行控制方向盘转角和车速,避免了一定的驾驶风险。
如果当前道路的曲率半径小于或等于设定的曲率半径临界值,则辅助驾驶系统关闭,此时再通过横摆稳定性控制模块310根据当前车速和当前方向盘转角判定当前横摆稳定性是否满足要求,如果当前横摆稳定性满足要求,则进入驾驶员主动驾驶模式;如果当前横摆稳定性不满足要求,则进入强制辅助驾驶模式,控制方向盘转角控制单元410和车速控制单元420执行强制辅助驾驶模式。
本实施例中,驾驶员主动驾驶模式为,驾驶员通过方向盘和车速控制单元420分别开工至方向盘转角和车速,辅助驾驶系统控制模块320控制语音播放器提醒驾驶员“前方弯道,请减速”,并控制仪表盘显示最大目标方向盘转角和最小目标车速,这样,驾驶员在控制当前方向盘转角和当前车速时可以提前知道前方曲率半径最小处弯道的情况,从而提前做好控制方向盘和车速的准备,提高了驾驶员的驾驶安全性。
本实施例中,强制辅助驾驶模式为,控制方向盘转角控制单元410控制方向盘转角为当前的目标方向盘转角,车速控制单元420控制车速小于当前的目标车速。因为,如果驾驶员主动驾驶时方向盘转角偏航过大或者车速过快,均会导致当前横摆稳定性不满足要求,从而导致一定的风险,因此此时需要辅助驾驶系统强制介入进行控制,保证当前横摆稳定性满足要求即可退出强制辅助驾驶模式,而不需要控制到满足曲率半径最小位置处的横摆稳定性,此模式下依然主要以驾驶员主动控制为主。
Claims (10)
1.一种基于弯道横摆稳定性的辅助驾驶系统,其特征在于:包括依次通讯连接的数据获取模块(100)、数据处理模块(200)、控制模块(300)和执行单元(400);
所述数据获取模块(100)用于获取车辆的运行参数和前方道路的曲率半径;
所述数据处理模块(200)用于根据曲率半径确定目标方向盘转角和极限车速,以及根据目标方向盘转角、极限车速和横摆稳定性要求确定目标车速;
所述控制模块(300)用于根据车速和方向盘转角判断横摆稳定性是否满足要求,以及当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制车速和方向盘转角满足当前横摆稳定性;
所述执行单元(400)包括方向盘转角控制单元(410)和车速控制单元(420)。
2.根据权利要求1所述的基于弯道横摆稳定性的辅助驾驶系统,其特征在于:所述数据处理模块(200)包括目标方向盘转角计算模块(210)、极限车速计算模块(220)、目标车速计算模块(230);
所述目标方向盘转角计算模块(210)用于根据曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离确定目标方向盘转角;
所述极限车速计算模块(220)用于构建车辆所受离心力等于最大侧向附着力的力学模型,根据力学模型和曲率半径确定极限车速;
所述目标车速计算模块(230)用于将极限车速作为车速的初始值,并以固定步长递减,根据车速、目标方向盘转角和横摆稳定性要求判定是否满足横摆稳定性,将首次满足横摆稳定性的车速作为目标车速。
3.根据权利要求1所述的基于弯道横摆稳定性的辅助驾驶系统,其特征在于:所述控制模块(300)包括横摆稳定性控制模块(310)、辅助驾驶系统控制模块(320);
所述横摆稳定性控制模块(310)用于根据车速和方向盘转角判定横摆稳定性是否满足要求;
所述辅助驾驶系统控制模块(320)用于当辅助驾驶系统不满足开启条件、且当前横摆稳定性不满足要求时,执行强制开启辅助驾驶系统,控制车速和方向盘转角满足当前横摆稳定性。
4.一种如上述权利要求3所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:
获取车辆运行参数和前方道路图像,得到前方道路的最小曲率半径;
根据最小曲率半径确定最大目标方向盘转角和最小极限车速,根据最大目标方向盘转角、最小极限车速和横摆稳定性要求确定最小目标车速;
当辅助驾驶系统不满足开启条件时、且当前车速和当前方向盘转角不满足当前横摆稳定性要求时,强制开启辅助驾驶系统,控制当前车速和当前方向盘转角满足当前横摆稳定性要求。
5.根据权利要求4所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:所述最大目标方向盘转角的确定方法包括,根据最小曲率半径、车辆轴距、转向传动比和车辆质心至后轴距离构建几何模型,通过几何模型求得。
6.根据权利要求4所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:所述最小极限车速的确定方法包括,构建车辆所受离心力等于最大侧向附着力的力学模型,根据力学模型和最小曲率半径求得。
7.根据权利要求5或6所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:所述最小目标车速的确定方法包括,将最小极限车速作为车速的初始值,并以固定步长递减,根据车速、最大目标方向盘转角判定是否满足横摆稳定性要求,将首次满足横摆稳定性要求的车速作为最小目标车速。
8.根据权利要求7所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:若强制开启辅助驾驶系统,则获取车辆当前车速和当前道路的曲率半径,根据当前道路的曲率半径得到当前道路的目标方向盘转角和极限车速,根据当前道路的目标方向盘转角、极限车速和横摆稳定性要求得到当前道路的目标车速,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于当前道路的目标车速。
9.根据权利要求4所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:当辅助驾驶系统不满足开启条件且当前车速和当前方向盘转角满足当前横摆稳定性要求时,提醒驾驶员并显示最大目标方向盘转角和最小目标车速。
10.根据权利要求4所述的基于弯道横摆稳定性的辅助驾驶系统的控制方法,其特征在于:当辅助驾驶系统满足开启条件时,控制方向盘转角为当前道路的目标方向盘转角,控制车速小于最小目标车速。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110554024.1A CN113291286B (zh) | 2021-05-20 | 2021-05-20 | 基于弯道横摆稳定性的辅助驾驶系统及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110554024.1A CN113291286B (zh) | 2021-05-20 | 2021-05-20 | 基于弯道横摆稳定性的辅助驾驶系统及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113291286A CN113291286A (zh) | 2021-08-24 |
CN113291286B true CN113291286B (zh) | 2022-08-30 |
Family
ID=77323295
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110554024.1A Active CN113291286B (zh) | 2021-05-20 | 2021-05-20 | 基于弯道横摆稳定性的辅助驾驶系统及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113291286B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114115063A (zh) * | 2021-11-30 | 2022-03-01 | 联创汽车电子有限公司 | 车辆转向控制前馈标定方法和系统 |
CN114291071B (zh) * | 2021-12-02 | 2023-09-08 | 江铃汽车股份有限公司 | 一种车辆稳定性控制主动介入时机的判定方法、系统、可读存储介质及车辆 |
CN114013430B (zh) * | 2021-12-23 | 2023-09-19 | 东风悦享科技有限公司 | 一种行车和泊车统一的自动驾驶车辆控制方法 |
CN114394095B (zh) * | 2022-01-24 | 2023-10-13 | 东风汽车集团股份有限公司 | 基于侧前车变道意图识别的acc控制方法及装置 |
CN114590256B (zh) * | 2022-03-28 | 2024-07-09 | 智己汽车科技有限公司 | 一种弯道中的车速控制方法及设备 |
CN115649145B (zh) * | 2022-11-01 | 2023-06-06 | 智能网联汽车(山东)协同创新研究院有限公司 | 一种智能汽车转向和制动自适应协调控制系统 |
Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10141102A (ja) * | 1996-11-12 | 1998-05-26 | Honda Motor Co Ltd | 車両制御装置 |
JP2004217178A (ja) * | 2003-01-17 | 2004-08-05 | Toyota Motor Corp | カーブ半径推定装置 |
CN101326425A (zh) * | 2005-12-09 | 2008-12-17 | 通用汽车环球科技运作公司 | 用于接近和行驶在弯道上的车辆的速度控制方法 |
JP2013126854A (ja) * | 2011-11-18 | 2013-06-27 | Denso Corp | 車両用挙動制御装置 |
JP2014024472A (ja) * | 2012-07-27 | 2014-02-06 | Fuji Heavy Ind Ltd | 車両のパワーステアリング制御装置 |
CN105109491A (zh) * | 2015-08-05 | 2015-12-02 | 江苏大学 | 一种基于弯道纵向曲率的车辆行驶航向预测装置及预测方法 |
CN105667509A (zh) * | 2015-12-30 | 2016-06-15 | 苏州安智汽车零部件有限公司 | 一种用于汽车自适应巡航控制系统的弯道控制系统及方法 |
CN105882661A (zh) * | 2016-04-08 | 2016-08-24 | 重庆大学 | 机动车弯道驾驶辅助系统及运行方式 |
CN106372758A (zh) * | 2016-09-13 | 2017-02-01 | 同济大学 | 一种辅助泊车系统的路径跟随方法及装置 |
CN107097775A (zh) * | 2017-05-22 | 2017-08-29 | 合肥工业大学 | 一种液体罐车弯道行驶防侧翻预警控制系统和方法 |
CN107891860A (zh) * | 2017-11-14 | 2018-04-10 | 重庆长安汽车股份有限公司 | 基于道路曲率自适应调节车速的系统及方法 |
CN109733398A (zh) * | 2018-12-05 | 2019-05-10 | 南京航空航天大学 | 具有稳定性主动控制的自适应巡航系统及控制方法 |
CN110239551A (zh) * | 2019-07-10 | 2019-09-17 | 海汇新能源汽车有限公司 | 一种单轮制动减小转弯半径控制系统及其控制方法 |
CN110682910A (zh) * | 2019-12-05 | 2020-01-14 | 宁波均胜普瑞智能车联有限公司 | 一种弯道辅助驾驶方法及装置 |
CN110843781A (zh) * | 2019-11-27 | 2020-02-28 | 长安大学 | 一种基于驾驶员行为的车辆弯道自动控制方法 |
CN110962849A (zh) * | 2019-11-18 | 2020-04-07 | 浙江工业大学 | 一种弯道自适应巡航方法 |
CN211479292U (zh) * | 2019-12-16 | 2020-09-11 | 中国人民解放军陆军工程大学 | 一种急转弯道来车预警装置 |
CN112721930A (zh) * | 2021-01-15 | 2021-04-30 | 重庆长安汽车股份有限公司 | 车辆过弯减速度规划方法、系统、车辆及存储介质 |
-
2021
- 2021-05-20 CN CN202110554024.1A patent/CN113291286B/zh active Active
Patent Citations (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10141102A (ja) * | 1996-11-12 | 1998-05-26 | Honda Motor Co Ltd | 車両制御装置 |
JP2004217178A (ja) * | 2003-01-17 | 2004-08-05 | Toyota Motor Corp | カーブ半径推定装置 |
CN101326425A (zh) * | 2005-12-09 | 2008-12-17 | 通用汽车环球科技运作公司 | 用于接近和行驶在弯道上的车辆的速度控制方法 |
JP2013126854A (ja) * | 2011-11-18 | 2013-06-27 | Denso Corp | 車両用挙動制御装置 |
JP2014024472A (ja) * | 2012-07-27 | 2014-02-06 | Fuji Heavy Ind Ltd | 車両のパワーステアリング制御装置 |
CN105109491A (zh) * | 2015-08-05 | 2015-12-02 | 江苏大学 | 一种基于弯道纵向曲率的车辆行驶航向预测装置及预测方法 |
CN105667509A (zh) * | 2015-12-30 | 2016-06-15 | 苏州安智汽车零部件有限公司 | 一种用于汽车自适应巡航控制系统的弯道控制系统及方法 |
CN105882661A (zh) * | 2016-04-08 | 2016-08-24 | 重庆大学 | 机动车弯道驾驶辅助系统及运行方式 |
CN106372758A (zh) * | 2016-09-13 | 2017-02-01 | 同济大学 | 一种辅助泊车系统的路径跟随方法及装置 |
CN107097775A (zh) * | 2017-05-22 | 2017-08-29 | 合肥工业大学 | 一种液体罐车弯道行驶防侧翻预警控制系统和方法 |
CN107891860A (zh) * | 2017-11-14 | 2018-04-10 | 重庆长安汽车股份有限公司 | 基于道路曲率自适应调节车速的系统及方法 |
CN109733398A (zh) * | 2018-12-05 | 2019-05-10 | 南京航空航天大学 | 具有稳定性主动控制的自适应巡航系统及控制方法 |
CN110239551A (zh) * | 2019-07-10 | 2019-09-17 | 海汇新能源汽车有限公司 | 一种单轮制动减小转弯半径控制系统及其控制方法 |
CN110962849A (zh) * | 2019-11-18 | 2020-04-07 | 浙江工业大学 | 一种弯道自适应巡航方法 |
CN110843781A (zh) * | 2019-11-27 | 2020-02-28 | 长安大学 | 一种基于驾驶员行为的车辆弯道自动控制方法 |
CN110682910A (zh) * | 2019-12-05 | 2020-01-14 | 宁波均胜普瑞智能车联有限公司 | 一种弯道辅助驾驶方法及装置 |
CN211479292U (zh) * | 2019-12-16 | 2020-09-11 | 中国人民解放军陆军工程大学 | 一种急转弯道来车预警装置 |
CN112721930A (zh) * | 2021-01-15 | 2021-04-30 | 重庆长安汽车股份有限公司 | 车辆过弯减速度规划方法、系统、车辆及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN113291286A (zh) | 2021-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113291286B (zh) | 基于弯道横摆稳定性的辅助驾驶系统及其控制方法 | |
US11396294B2 (en) | Driving control apparatus for vehicle | |
JP6055525B1 (ja) | 車両の走行制御装置 | |
CN109760677B (zh) | 一种车道保持辅助方法及系统 | |
CN110001782A (zh) | 自动换道方法、系统及计算机可读存储介质 | |
WO2022001975A1 (zh) | 车辆转向控制方法、装置及系统 | |
US20150336587A1 (en) | Driving assist device | |
US10640109B2 (en) | Travel control device for vehicle | |
EP2712780B1 (en) | Method and apparatus for performing driving assistance | |
US9963070B2 (en) | Apparatus and method for displaying vehicle information | |
CN108583584B (zh) | 一种车道偏离报警方法及系统 | |
JP7211127B2 (ja) | 車両の旋回姿勢制御方法及び旋回姿勢制御装置 | |
CN111845770B (zh) | 用于识别车辆的拖挂车的系统及其方法 | |
JP2022118550A (ja) | 車両の運転支援装置 | |
JP2016206976A (ja) | 車両の運転支援制御のための先行車軌跡算出装置 | |
EP3145766B1 (en) | Method and system for the adaptation of the driving of a vehicle on a roadway in association with taking a curve | |
CN111572561B (zh) | 自动驾驶汽车的车速控制方法、装置、设备及存储介质 | |
CN112319365A (zh) | 一种变道预警辅助方法及系统 | |
CN115071680B (zh) | 车辆驾驶辅助横向控制系统安全限制方法及可读存储介质 | |
US11987252B2 (en) | Systems and methods for determining whether a vehicle is in an understeer or oversteer situation | |
KR20220011580A (ko) | 전방에 위치한 커브를 통과할 시 자기차량의 차량운전자를 지원하기 위한 방법 | |
CN114906145A (zh) | 一种车辆弯道辅助驾驶方法、系统、电子设备及存储介质 | |
CN115027466A (zh) | 一种车辆限速控制方法、系统及车辆 | |
CN114643991A (zh) | 高速工况的底盘域控制方法及相关装置 | |
US20230356715A1 (en) | Method and device for assisting with the lateral positioning of a vehicle |
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 |