CN111679575A - 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 - Google Patents
一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 Download PDFInfo
- Publication number
- CN111679575A CN111679575A CN202010407838.8A CN202010407838A CN111679575A CN 111679575 A CN111679575 A CN 111679575A CN 202010407838 A CN202010407838 A CN 202010407838A CN 111679575 A CN111679575 A CN 111679575A
- Authority
- CN
- China
- Prior art keywords
- control
- controller
- nominal
- nominal system
- model
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- 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/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法,在智能感知车辆外部环境和自身参数的基础上,首先建立横向和横摆两个方向的路径跟踪误差模型,并且在此基础上考虑未建模动态和风阻、道路坡度和道路不平度造成的外界干扰,建立标称***约束。基于此数学模型设计控制器,该控制器由两部分组成,一部分为由标称***作为被控对象,设计模型预测控制器;另外一部分为附加反馈控制,用于减少实际***与标称***之间的偏差,附加反馈控制率采用滑模控制法,通过两部分控制率的组合,可以在保证路径跟踪的同时有效减少外界因素的干扰,提高控制器的鲁棒性。
Description
技术领域
本发明涉及一种智能汽车控制领域,尤其涉及一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法。
背景技术
智能汽车是一种极为复杂的非线性***,轨迹跟踪工业应用中往往是将其动力学模型进行简化,这一过程中经常忽略了一些未建模动态,使得其动力学模型与实际被控对象不符,其次,在智能汽车的运行过程中,往往会因为风阻、路面坡度及路面不平整性造成干扰。现有的性能较好的控制方法如模型预测控制是一种基于模型的控制器,其控制精度往往取决于被控对象的数学模型与实际的匹配度,因此在收到外界干扰情况下的鲁棒性不能得到保证。
发明内容
为解决上述技术问题,本发明提供一种鲁棒模型预测控制的智能轨迹跟踪控制器及其构造方法,在智能感知车辆外部环境和自身参数的基础上,首先建立横向和横摆两个方向的路径跟踪误差模型,并且在此基础上考虑未建模动态和风阻、道路坡度和道路不平度造成的外界干扰,建立标称***约束。基于此数学模型设计控制器,该控制器由两部分组成,一部分为由标称***作为被控对象,设计模型预测控制器;另外一部分为附加反馈控制,用于减少实际***与标称***之间的偏差,附加反馈控制率采用滑模控制法,通过两部分控制率的组合,可以在保证路径跟踪的同时有效减少外界因素的干扰,提高控制器的鲁棒性。
本发明基于鲁棒模型预测控制智能汽车轨迹跟踪控制器的技术方案是:所述基于鲁棒模型预测控制智能汽车轨迹跟踪控制器包括:智能汽车动力学路径跟踪误差模型,约束生成模块,标称***模型预测控制器,附加反馈控制器。
所述的智能汽车动力学路径跟踪误差模型用于作为标称***模型预测控制器的预测方程,预测出预测时域内的***状态量,以便求解最优控制量。
所述的约束生成模块用于将实际***的约束转化为标称***的约束。根据实际***的干扰项上界,根据不变集理论写出***的鲁棒正不变集,假设标称***与实际***之间存在线性控制率,进而由实际***的约束集写出标称***的状态量和控制量的约束集。
所述的标称***模型预测控制器用于求解控制率的第一部分——标称***轨迹跟踪控制率,该控制器将参考轨迹作为输入,根据预测方程将最优控制问题转化为非线性规划问题,求解出前馈前轮转角。
所述的附加反馈控制器用于驱使实际***的状态量向标称***的状态轨迹靠近进而使得实际***无限接近标称***。该控制器采用滑模控制方法,将当前时刻标称***的状态量与实际***的状态量和道路期望航向角作为输入,选择合适的滑模面和滑模面参数,将反馈控制率输出。
所述的基于鲁棒模型预测控制智能汽车轨迹跟踪控制器将上述标称***模型预测控制器的控制率与附加反馈控制器的控制率叠加作为最终的前轮转角信号,发送给被控车辆,被控车辆再将当前的状态量反馈给附加控制器,从而形成闭环控制。
本发明的有益效果:
1.本发明建立模型预测控制,可以显式的添加各种约束,因此方便将轮胎的侧偏角和滑移率约束在线性范围内,从而可以简化轮胎动力学模型,从而提高控制器计算速度,保证实时性;
2.在模型预测控制的基础上使用滑模控制来抑制***的未建模动态和外界扰动,将扰动带来的影响控制在一定范围内。
附图说明
图1是智能汽车简化等效图。
图2是模型预测控制流程图。
图3是鲁棒模型预测控制智能汽车轨迹跟踪控制流程图。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,对智能汽车动力学进行简化,建立横向和横摆是两个方向的路径跟踪误差模型:
其中,m为整车质量,Iz为整车绕Z轴的转动惯量,Cf,Cr分别为前轮和后轮的侧偏刚度,lf,lr分别为整车质心到前轴和后轴的距离,Vx为纵向速度,ey为汽车当前位置与车道中心线的横向偏差,eψ为车辆当前航向角与车道中心线方向角的偏差,δ为控制量前轮转角,ψdes为期望航向角。
如图1所示,考虑***未建模动态和风阻、道路坡度和道路不平度造成的外加扰动w,并且|w|≤wbound,wbound是这个干扰的上限,重新构建***的状态空间方程:
标称***约束的构建:
首先定义实际***与标称***,实际***即上述考虑未建模动态和有界干扰的***:
其中A为状态转移矩阵,B为控制矩阵,χ为状态量约束集,U为控制量约束集。
标称***即不考虑未建模动态和有界干扰的***:
定义为实际***x与标称***之间的偏差,为标称***控制量。假设存在线性控制率ufd=ke,k为控制率增益。定义Z为该***的鲁棒正不变集,因此(为闵可夫斯基集合加法),从而标称***的状态量约束和控制量约束改写为:
基于鲁棒模型预测控制智能汽车轨迹跟踪控制器的构建:
鲁棒模型预测控制的控制率主要由两部分组成,一部分为标称***的模型预测控制控制率,另一部分为处理附加扰动项的附加反馈控制率:
如图2所示,构建标称***的模型预测控制器。根据标称***的动态方程预测出在预测时域内的***状态量,并与预测时域内的参考轨迹状态量做差,写出代价函数:
其中,Np为预测时域,Nc控制时域,Q为输出量的权重,R为控制量的权重,xref为目标参考轨迹。
如图3所示,设计附加反馈控制的目的是为了减少并消除实际***中的外界干扰。
考虑上述被控对象,设计滑模面为σ(e)=sTe,s为滑模面系数。将Lyapunov函数定义为:
滑模面σ(e)=sTe求导得:
其中ρ为柔因子。
从而求得:
即得到ufeedback=u;
最终得到鲁棒模型预测控制器的控制率:
即将此控制率作为前轮转角作用给被控对象,然后实际***将当前的状态量反馈给附加反馈控制器从而形成闭环控制。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技术所创的等效方式或变更均应包含在本发明的保护范围之内。
Claims (9)
1.一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器,其特征在于,包括:智能汽车动力学路径跟踪误差模型,约束生成模块,标称***模型预测控制器,附加反馈控制器;
所述的智能汽车动力学路径跟踪误差模型用于作为标称***模型预测控制器的预测方程,预测出预测时域内的***状态量,以便求解最优控制量;
所述的约束生成模块用于将实际***的约束转化为标称***的约束,根据实际***的干扰项上界,根据不变集理论写出***的鲁棒正不变集,假设标称***与实际***之间存在线性控制率,进而由实际***的约束集写出标称***的状态量和控制量的约束集;
所述的标称***模型预测控制器用于求解控制率的第一部分,即标称***轨迹跟踪控制率,该控制器将参考轨迹作为输入,根据预测方程将最优控制问题转化为非线性规划问题,求解出前馈前轮转角;
所述的附加反馈控制器用于驱使实际***的状态量向标称***的状态轨迹靠近进而使得实际***无限接近标称***;
所述的基于鲁棒模型预测控制智能汽车轨迹跟踪控制器将上述标称***模型预测控制器的控制率与附加反馈控制器的控制率叠加作为最终的前轮转角信号,发送给被控车辆,被控车辆再将当前的状态量反馈给附加控制器,形成闭环控制。
2.根据权利要求1所述的一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器,其特征在于,所述附加反馈控制器采用滑模控制方法,将当前时刻标称***的状态量与实际***的状态量和道路期望航向角作为输入,选择合适的滑模面和滑模面参数,将反馈控制率输出。
3.一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器的构造方法,其特征在于,包括如下步骤:
S1,在智能感知车辆外部环境和自身参数的基础上,建立横向和横摆两个方向的路径跟踪误差模型;
S2,在步骤S1模型的基础上考虑未建模动态和风阻、道路坡度和道路不平度造成的外界干扰,建立标称***约束;
S3,基于步骤S2的模型设计控制器,所述控制器包括两部分,一部分为由标称***作为被控对象,设计标称***的模型预测控制器;另外一部分为附加反馈控制器,用于减少实际***与标称***之间的偏差;将两部分控制率组合,实现智能汽车轨迹跟踪。
5.根据权利要求3所述的一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器的构造方法,其特征在于,所述S2的具体包括如下:
假设***未建模动态和风阻、道路坡度和道路不平度造成的外加扰动w,并且|w|≤wbound,wbound是这个干扰的上限,重新构建***的状态空间方程如下:
标称***约束的构建如下:
首先定义实际***与标称***,实际***即上述考虑未建模动态和有界干扰的***:
标称***即不考虑未建模动态和有界干扰的***:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010407838.8A CN111679575B (zh) | 2020-05-14 | 2020-05-14 | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010407838.8A CN111679575B (zh) | 2020-05-14 | 2020-05-14 | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111679575A true CN111679575A (zh) | 2020-09-18 |
CN111679575B CN111679575B (zh) | 2022-05-20 |
Family
ID=72452466
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010407838.8A Active CN111679575B (zh) | 2020-05-14 | 2020-05-14 | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111679575B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112918490A (zh) * | 2021-03-19 | 2021-06-08 | 吉林大学 | 一种分布式驱动车辆的轨迹跟踪控制策略 |
CN114415523A (zh) * | 2022-03-30 | 2022-04-29 | 北京理工大学 | 一种车辆协同运动控制方法及*** |
CN115497281A (zh) * | 2022-08-16 | 2022-12-20 | 清华大学 | 混合交通场景下多队列领航车的鲁棒模型预测控制方法 |
CN116974297A (zh) * | 2023-06-27 | 2023-10-31 | 北京五木恒润科技有限公司 | 基于多目标优化的冲突消解方法、装置、介质及电子设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005339241A (ja) * | 2004-05-27 | 2005-12-08 | Nissan Motor Co Ltd | モデル予測制御装置および車両用推奨操作量生成装置 |
CN107161207A (zh) * | 2017-05-08 | 2017-09-15 | 江苏大学 | 一种基于主动安全的智能汽车轨迹跟踪控制***及控制方法 |
CN109885883A (zh) * | 2019-01-21 | 2019-06-14 | 江苏大学 | 一种基于gk聚类算法模型预测的无人车横向运动的控制方法 |
CN110687907A (zh) * | 2019-09-23 | 2020-01-14 | 江苏大学 | 基于模型动态重构的智能汽车解耦预测控制器及其控制方法 |
CN111123701A (zh) * | 2019-11-27 | 2020-05-08 | 武汉理工大学 | 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法 |
-
2020
- 2020-05-14 CN CN202010407838.8A patent/CN111679575B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005339241A (ja) * | 2004-05-27 | 2005-12-08 | Nissan Motor Co Ltd | モデル予測制御装置および車両用推奨操作量生成装置 |
CN107161207A (zh) * | 2017-05-08 | 2017-09-15 | 江苏大学 | 一种基于主动安全的智能汽车轨迹跟踪控制***及控制方法 |
CN109885883A (zh) * | 2019-01-21 | 2019-06-14 | 江苏大学 | 一种基于gk聚类算法模型预测的无人车横向运动的控制方法 |
CN110687907A (zh) * | 2019-09-23 | 2020-01-14 | 江苏大学 | 基于模型动态重构的智能汽车解耦预测控制器及其控制方法 |
CN111123701A (zh) * | 2019-11-27 | 2020-05-08 | 武汉理工大学 | 基于管道预测模型的自动驾驶路径跟踪抗干扰控制方法 |
Non-Patent Citations (1)
Title |
---|
王艺等: "基于模型预测控制的智能网联汽车路径跟踪控制器设计", 《机械工程学报》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112918490A (zh) * | 2021-03-19 | 2021-06-08 | 吉林大学 | 一种分布式驱动车辆的轨迹跟踪控制策略 |
CN114415523A (zh) * | 2022-03-30 | 2022-04-29 | 北京理工大学 | 一种车辆协同运动控制方法及*** |
CN114415523B (zh) * | 2022-03-30 | 2022-08-26 | 北京理工大学 | 一种车辆协同运动控制方法及*** |
CN115497281A (zh) * | 2022-08-16 | 2022-12-20 | 清华大学 | 混合交通场景下多队列领航车的鲁棒模型预测控制方法 |
CN115497281B (zh) * | 2022-08-16 | 2024-03-19 | 清华大学 | 混合交通场景下多队列领航车的鲁棒模型预测控制方法 |
CN116974297A (zh) * | 2023-06-27 | 2023-10-31 | 北京五木恒润科技有限公司 | 基于多目标优化的冲突消解方法、装置、介质及电子设备 |
CN116974297B (zh) * | 2023-06-27 | 2024-01-26 | 北京五木恒润科技有限公司 | 基于多目标优化的冲突消解方法、装置、介质及电子设备 |
Also Published As
Publication number | Publication date |
---|---|
CN111679575B (zh) | 2022-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111679575B (zh) | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 | |
CN107992681B (zh) | 一种电动汽车主动前轮转向***的复合控制方法 | |
CN108107731B (zh) | 一种基于轮胎非线性特性的汽车稳定性控制方法 | |
CN107415939B (zh) | 一种分布式驱动电动汽车转向稳定性控制方法 | |
CN108107732B (zh) | 主动前轮转向和直接横摆力矩联合的汽车稳定性控制方法 | |
CN112622903A (zh) | 一种车辆跟随驾驶环境下自主车辆的纵向和横向控制方法 | |
CN109050658B (zh) | 基于模型预测控制的汽车主动前轮转向自适应调节方法 | |
CN113753080B (zh) | 一种自动驾驶汽车横向运动自适应参数控制方法 | |
CN110262229B (zh) | 基于mpc的车辆自适应路径追踪方法 | |
CN111959527B (zh) | 一种基于转角优化序列的汽车路径跟踪控制方法 | |
CN112829766B (zh) | 一种基于分布式驱动电动车辆的自适应路径跟踪方法 | |
CN111158349A (zh) | 一种基于多步线性化策略的无人驾驶车辆模型预测控制方法 | |
CN109050659B (zh) | 一种基于时变动力学模型的四轮转向汽车稳定性控制方法 | |
CN113126623B (zh) | 一种考虑输入饱和的自适应动态滑模自动驾驶车辆路径跟踪控制方法 | |
CN111142534B (zh) | 一种智能车横纵向综合轨迹跟踪方法及控制*** | |
Wang et al. | Autonomous vehicle trajectory following: A flatness model predictive control approach with hardware-in-the-loop verification | |
CN113183957A (zh) | 车辆控制方法、装置、设备及自动驾驶车辆 | |
Hang et al. | Path-tracking controller design for a 4WIS and 4WID electric vehicle with steer-by-wire system | |
CN114967475A (zh) | 一种无人驾驶车辆轨迹跟踪与稳定性鲁棒控制方法及*** | |
Saikia et al. | Vehicle stability enhancement using sliding mode based active front steering and direct yaw moment control | |
CN113525415A (zh) | 基于齿条力观测的自动驾驶汽车分层抗扰路径跟踪*** | |
CN112606843A (zh) | 一种基于Lyapunov-MPC技术的智能车辆路径跟踪控制方法 | |
Ley-Rosas et al. | Observer based sliding mode controller for vehicles with roll dynamics | |
Wu et al. | Vehicle active steering control research based on two-DOF robust internal model control | |
Wang et al. | A yaw stability-guaranteed hierarchical coordination control strategy for four-wheel drive electric vehicles using an unscented Kalman filter |
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 |