CN110588633B - 一种智能汽车极限工况下路径跟踪与稳定控制方法 - Google Patents
一种智能汽车极限工况下路径跟踪与稳定控制方法 Download PDFInfo
- Publication number
- CN110588633B CN110588633B CN201910771636.9A CN201910771636A CN110588633B CN 110588633 B CN110588633 B CN 110588633B CN 201910771636 A CN201910771636 A CN 201910771636A CN 110588633 B CN110588633 B CN 110588633B
- Authority
- CN
- China
- Prior art keywords
- control
- longitudinal
- longitudinal force
- feedback
- vehicle
- 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 22
- 230000001133 acceleration Effects 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 14
- 238000007781 pre-processing Methods 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 239000004576 sand Substances 0.000 claims description 2
- 238000012546 transfer Methods 0.000 claims description 2
- 239000000853 adhesive Substances 0.000 abstract description 2
- 230000001070 adhesive effect Effects 0.000 abstract description 2
- 230000003044 adaptive effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 229920006395 saturated elastomer Polymers 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008447 perception Effects 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
-
- 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/10—Path keeping
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种智能汽车极限工况下路径跟踪与稳定控制方法,包括纵向控制、横向控制与稳定性控制。纵向控制采取前馈控制和反馈控制,前馈控制根据车辆加速度得出前馈纵向力;反馈纵向控制通过控制滑移率和侧偏角之间的关系得到反馈纵向力;再由前馈纵向力和反馈纵向力得到总的纵向力,再由总的纵向力得到汽车节气门开度和制动主缸压力,从而达到充分利用轮胎附着力的极限工况;横向控制采用自适应模型预测控制;稳定性控制运用博弈控制方法将纵向力与轨迹跟踪控制和横向稳定性控制进行博弈,获取附加横摆力矩和前轮转角、纵向力均衡解,优化弯道运动过程中车辆运动速度和前轮转角。本发明能够提高轨迹跟踪精度的同时提升车辆横向稳定性。
Description
技术领域
本发明属于智能汽车控制领域,特别涉及了一种智能汽车在极限工况下的控制方法。
背景技术
随着计算机信息处理技术进的快速发展,基于高效环境感知的无人驾驶车辆技术迅速提高,其中一个重要目标就是提高无人驾驶车辆的行驶速度,使之在高速条件下具有良好的稳定性和安全性。而在高速行驶状况下,许多交通事故是由于驾驶员无法控制车辆在其摩擦极限下引起的,面向无人驾驶的终极目标,要求智能汽车控制***在复杂工况条件下,具有精确、高效、可靠的控制能力,保证车辆转向稳定性、行驶安全。传统的控制器无法满足智能车在极限工况下的轨迹跟踪与稳定性的要求。
发明内容
针对上述问题,本发明提出了一种智能汽车在极限工况下的控制方法,在摩擦极限下跟踪路径,控制方法包括纵向控制、横向控制与稳定性控制。在建立参考路径的基础上,纵向控制方面采取前馈和反馈的控制策略,前馈纵向控制根据车辆加速度得出前馈纵向力;反馈纵向控制通过控制滑移率和侧偏角之间的关系得到反馈纵向输入,由反馈纵向输入得到轮胎饱和和不饱和情况的下的反馈纵向力;再由前馈纵向力和反馈纵向力得到总的纵向力,再由总的纵向力得到汽车的节气门开度和制动主缸压力,从而能够达到充分利用轮胎附着力的极限工况。侧偏角和滑移率的关系采用滑动圆来进行表示。此外,若是轮胎并未在极限工况下运行,反馈纵向控制会发出额外的纵向力命令使得车辆充分利用可用摩擦力。横向控制,即路径跟踪控制采用自适应模型预测控制,车速的急剧变化让传统的模型预测控制产生模型失配,所以采用自适应模型预测控制的办法进行横向控制。此外针对极限工况下跟踪精度与横向稳定性差的问题,稳定性控制运用博弈控制方法将纵向力与轨迹跟踪控制和横向稳定性控制进行博弈,获取附加横摆力矩和前轮转角、纵向力均衡解,优化弯道运动过程中车辆运动速度和前轮转角。提高轨迹跟踪精度同时提升车辆横向稳定性。
本发明的有益效果:
1、本发明提出的纵向前馈反馈控制的思想,将智能汽车极限工况下侧偏角与滑移率包含在其中,提高智能汽车在极限工况下的纵向速度跟踪能力;
2、本发明提出的自适应模型预测控制的思想,实时根据当前车速更新车辆状态模型,提高路径跟踪精度;
3、本发明提出的协调博弈的思想,运用博弈控制方法将纵向力与轨迹跟踪控制和横向稳定性控制进行博弈,获取附加横摆力矩和前轮转角、纵向力均衡解,优化弯道运动过程中车辆运动速度和前轮转角。提高轨迹跟踪精度同时提升车辆横向稳定性。
附图说明
图1是控制***流程图。
具体实施方式
下面结合附图对本发明作进一步说明。
纵向控制
纵向控制器由前馈控制和反馈控制组成。前馈控制根据加速度来决定加速和制动,而反馈控制则根据滑移率与侧偏角等相关参数来调节车速。
通过下式计算出沿路径的期望纵向加速度ax,Ux为纵向车速,因此,根据牛顿第二定律,沿路径的前馈纵向力Fx,ff可以计算得出:
Fxff=max
反馈纵向控制通过控制滑移率和侧偏角之间的关系得到反馈纵向输入轮胎的滑移率s定义为:
其中Vω=rω为车轮速度,ω为车轮滚动角速度;r为车轮半径,V是车轮中心沿轮胎纵轴的速度。当s=speak时,轮胎产生最大纵向力,相对应于最大加速或者最大制动。speak是驱动力或制动力峰值对应的滑移率。
其中Ux,d是期望速度,kspeed是速度反馈增益,通过提高速度反馈增益kspeed,可以实现更快的速度跟踪的功能,可是,如果速度反馈增益kspeed过大,则过大的纵向引起车身的俯仰振荡,这是不期望的。
因此,总的纵向力Fx是由加速度计算出的前馈纵向力与滑动圆计算出的反馈纵向力的和。纵向力Fx表示为:
所求的Fx若为正值,则为驱动力Fx,t,负值则为制动力Fx,b。
横向控制
横向控制,即路径跟踪控制,采用自适应模型预测控制,车速的急剧变化让传统的模型预测控制产生模型失配,所以采用自适应模型预测控制的方法进行横向控制。
因为在极限工况下,汽车的横向动力学因为速度随时间快速变化而变化,自适应模型预测控制能够在线不断根据车速的变化更新车辆的状态模型,避免模型失配,从而提高跟踪精度与稳定性。在每一时间步长内,针对车速变化,更新车辆状态
其中x为侧向速度、横摆角、横摆角速度和侧向位置等状态量,u是前轮转角,A为状态量矩阵,B为控制量矩阵;离散化得
稳定性控制
稳定性控制采用博弈协调控制,主要在上述纵向控制计算出的纵向力、自适应模型预测控制决策前轮转角的基础上,将纵向力、前轮转角与车辆横摆力矩作为三个博弈对象,通过反馈车辆实际状态进行内环博弈优化控制。
假设初始状态x(t0)=x0,其中状态量x=[β,γ]T,β为质心侧偏角γ为横摆角速度,博弈对象为下式表述的状态空间方程
Ac为状态量矩阵,B1、B2、B3分别为对应的控制量矩阵;
将纵向力F(t)、前轮转角δf(t)和横摆力矩M(t)作为三个博弈方ui(t)=[δf,M,Fx]T,i=1,2,3,对于三个博弈对象可建立以下二次型代价函数
其中权重矩阵Qi≥0,Rij>0为正对称矩阵。
对于上述线性二次型微分博弈问题可以求解出一个特有的开环纳什均衡解:
其中,中间量Pi、Si满足以下黎卡提方程:
Φ(t,0)满足以下传递函数:
PiA+ATPi+Qi-PiSiPi=0(i=1,2,3)
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。
Claims (5)
1.一种智能汽车极限工况下路径跟踪与稳定控制方法,其特征在于,包括纵向控制、横向控制与稳定性控制;所述纵向控制采取前馈控制和反馈控制,前馈纵向控制根据车辆加速度得出前馈纵向力;反馈纵向控制通过控制滑移率和侧偏角之间的关系得到反馈纵向输入,再由反馈纵向输入分别得到在轮胎饱和和不饱和情况下的反馈纵向力;由前馈纵向力和反馈纵向力得到总纵向力,再由总纵向力得到汽车的节气门开度和制动主缸压力;所述横向控制采用自适应模型预测控制;所述稳定性控制运用博弈控制方法,将总纵向力、前轮转角与车辆横摆力矩进行博弈,获取附加横摆力矩和前轮转角、纵向力均衡解,优化车辆运动速度和前轮转角;
所述横向控制的具体方法如下:
在每一时间步长内,针对车速变化,更新车辆状态
其中x为侧向速度、横摆角、横摆角速度和侧向位置状态量,u是前轮转角,A为状态量矩阵,B为控制量矩阵;离散化得
所述稳定性控制采用的博弈控制方法如下:
假设初始状态x(t0)=x0,其中状态量x=[β,γ]T,β为质心侧偏角γ为横摆角速度,博弈对象为下式表述的状态空间方程
其中,Ac为状态量矩阵,B1、B2、B3分别为对应的控制量矩阵;将纵向力F(t)、前轮转角δf(t)和横摆力矩M(t)作为三个博弈方ui(t)=[δf,M,F]T,i=1,2,3;针对三个博弈对象建立以下二次型代价函数
其中权重矩阵Qi≥0,Rij>0均为正对称矩阵;
利用上述线性二次型微分求解出一个开环纳什均衡解:
其中,Pi满足以下黎卡提方程:
Φ(t,0)满足以下传递函数:
PiA+ATPi+Qi-PiSiPi=0(i=1,2,3)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910771636.9A CN110588633B (zh) | 2019-08-21 | 2019-08-21 | 一种智能汽车极限工况下路径跟踪与稳定控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910771636.9A CN110588633B (zh) | 2019-08-21 | 2019-08-21 | 一种智能汽车极限工况下路径跟踪与稳定控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110588633A CN110588633A (zh) | 2019-12-20 |
CN110588633B true CN110588633B (zh) | 2021-07-20 |
Family
ID=68854820
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910771636.9A Active CN110588633B (zh) | 2019-08-21 | 2019-08-21 | 一种智能汽车极限工况下路径跟踪与稳定控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110588633B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111267846B (zh) * | 2020-02-11 | 2021-05-11 | 南京航空航天大学 | 一种基于博弈论的周围车辆交互行为预测方法 |
CN111959500B (zh) * | 2020-08-07 | 2022-11-11 | 长春工业大学 | 一种基于轮胎力分配的汽车路径跟踪性能提升方法 |
CN111897344B (zh) * | 2020-08-14 | 2021-11-16 | 清华大学 | 一种兼顾稳定性的自动驾驶汽车路径跟踪控制方法 |
CN112373470B (zh) * | 2020-11-17 | 2022-01-28 | 聊城大学 | 紧急避让工况自动驾驶转向制动纳什博弈控制方法 |
CN112572410B (zh) * | 2020-12-15 | 2022-11-15 | 长春工业大学 | 一种基于稳定状态预测的汽车侧向稳定性提升方法 |
CN113788008B (zh) * | 2021-07-20 | 2023-06-27 | 浙江万安科技股份有限公司 | 一种基于纳什-mpc的集成底盘轨迹跟踪控制方法 |
CN113753054B (zh) * | 2021-09-23 | 2023-01-20 | 扬州亚星客车股份有限公司 | 一种车辆线控底盘控制方法、装置、电子设备及介质 |
CN113978450B (zh) * | 2021-10-11 | 2023-06-27 | 聊城大学 | 一种抗侧倾的商用车路径跟踪博弈控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1673006A (zh) * | 2004-03-26 | 2005-09-28 | 丰田自动车株式会社 | 基于车轮纵向力的车辆行驶稳定性控制装置 |
CN108216210A (zh) * | 2016-12-20 | 2018-06-29 | 丰田自动车株式会社 | 车辆稳定性控制装置 |
CN108422901A (zh) * | 2018-05-10 | 2018-08-21 | 吉林大学 | 一种基于整车综合性能最优的电动轮驱动车辆车轮转矩多目标优化方法 |
CN108944866A (zh) * | 2018-07-06 | 2018-12-07 | 长春工业大学 | 一种改善转向与制动协同控制的自适应模型预测控制算法 |
US10220843B2 (en) * | 2016-02-23 | 2019-03-05 | Deka Products Limited Partnership | Mobility device control system |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8170767B2 (en) * | 2007-10-30 | 2012-05-01 | Ford Global Technologies, Llc | Vehicle stability control system and method |
-
2019
- 2019-08-21 CN CN201910771636.9A patent/CN110588633B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1673006A (zh) * | 2004-03-26 | 2005-09-28 | 丰田自动车株式会社 | 基于车轮纵向力的车辆行驶稳定性控制装置 |
US10220843B2 (en) * | 2016-02-23 | 2019-03-05 | Deka Products Limited Partnership | Mobility device control system |
CN108216210A (zh) * | 2016-12-20 | 2018-06-29 | 丰田自动车株式会社 | 车辆稳定性控制装置 |
CN108422901A (zh) * | 2018-05-10 | 2018-08-21 | 吉林大学 | 一种基于整车综合性能最优的电动轮驱动车辆车轮转矩多目标优化方法 |
CN108944866A (zh) * | 2018-07-06 | 2018-12-07 | 长春工业大学 | 一种改善转向与制动协同控制的自适应模型预测控制算法 |
Also Published As
Publication number | Publication date |
---|---|
CN110588633A (zh) | 2019-12-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110588633B (zh) | 一种智能汽车极限工况下路径跟踪与稳定控制方法 | |
CN109144076B (zh) | 一种多车辆横纵向耦合协同控制***及控制方法 | |
CN112519882B (zh) | 一种车辆参考轨迹跟踪方法及*** | |
CN110329255B (zh) | 一种基于人机协同策略的车道偏离辅助控制方法 | |
CN109017760B (zh) | 车辆期望轨迹跟踪方法、装置及滚动时域优化算法 | |
CN110780674A (zh) | 一种提高自动驾驶轨迹跟踪控制的方法 | |
CN111923908A (zh) | 一种融合稳定性的智能汽车路径跟踪控制方法 | |
CN112622895B (zh) | 一种应用于自动驾驶的轨迹控制的预估控制方法 | |
CN112109732A (zh) | 一种智能驾驶自适应曲线预瞄方法 | |
CN111679575B (zh) | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 | |
CN113911106B (zh) | 基于博弈论的商用车横向轨迹跟随与稳定性协同控制方法 | |
CN113335309B (zh) | 一种车辆纵向控制方法和装置 | |
CN109017446B (zh) | 期待路径车辆纵向速度追踪控制方法及装置 | |
CN111923907B (zh) | 一种基于多目标性能融合的车辆纵向跟踪控制方法 | |
CN116560371A (zh) | 基于自适应模型预测控制的自动驾驶车辆路径跟踪方法 | |
CN113741450B (zh) | 一种车辆自动驾驶横向自适应控制方法 | |
CN115489594A (zh) | 一种纯跟踪智能车路径跟随控制方法 | |
CN117518779A (zh) | 一种参数自适应的智能巡逻车高精度轨迹跟踪控制方法 | |
CN207274660U (zh) | 一种应用于全自动泊车的蠕行速度控制装置 | |
CN112660129A (zh) | 一种智能线控底盘加速度控制***与控制方法 | |
CN116834754A (zh) | 一种自动驾驶车辆自适应调速的横纵协同控制方法 | |
CN114896694B (zh) | 一种基于两点预瞄的路径跟踪控制方法 | |
CN116520700A (zh) | 一种欠驱动自动驾驶车辆的路径跟踪控制方法 | |
CN116691668A (zh) | 一种大型智能车辆的横向控制方法 | |
Huang et al. | Cascade optimization control of unmanned vehicle path tracking under harsh driving conditions |
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 |