CN113954873A - 一种基于降维模型的转向和制动一体化路径跟踪控制方法 - Google Patents
一种基于降维模型的转向和制动一体化路径跟踪控制方法 Download PDFInfo
- Publication number
- CN113954873A CN113954873A CN202111285179.6A CN202111285179A CN113954873A CN 113954873 A CN113954873 A CN 113954873A CN 202111285179 A CN202111285179 A CN 202111285179A CN 113954873 A CN113954873 A CN 113954873A
- Authority
- CN
- China
- Prior art keywords
- tire
- model
- path tracking
- dimension reduction
- cost function
- 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
- 230000009467 reduction Effects 0.000 title claims abstract description 56
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000005457 optimization Methods 0.000 claims abstract description 23
- 239000011159 matrix material Substances 0.000 claims description 26
- 230000001133 acceleration Effects 0.000 claims description 13
- 238000010276 construction Methods 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 239000002131 composite material Substances 0.000 claims 1
- 238000004364 calculation method Methods 0.000 abstract description 5
- 238000013461 design Methods 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 206010039203 Road traffic accident Diseases 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000034994 death Effects 0.000 description 1
- 231100000517 death Toxicity 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001052 transient effect 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0019—Control system elements or transfer functions
- B60W2050/0028—Mathematical models, e.g. for simulation
- B60W2050/0031—Mathematical model of the vehicle
-
- 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)
- Automation & Control Theory (AREA)
- Human Computer Interaction (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明提供一种基于降维模型的转向和制动一体化路径跟踪控制方法,属于自动驾驶汽车路径跟踪控制技术领域。所述方法包括:构建汽车动力学模型、车轮动力学模型以及UniTire轮胎模型;对汽车动力学模型进行降维,构建汽车动力学降维模型;根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器;其中,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标;根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制。采用本发明,能够避免极限工况下因轮胎力过度利用导致车辆侧滑及现有的基于MPC的转向和制动一体化路径跟踪控制方法计算负担重、实时性差的问题。
Description
技术领域
本发明涉及自动驾驶汽车路径跟踪控制技术领域,特别是指一种基于降维模型的转向和制动一体化路径跟踪控制方法。
背景技术
过去十年中,全球交通拥堵和道路安全状况持续恶化。在我国,交通拥堵带来的经济损失占城市人口可支配收入的20%,相当于国内生产总值(GDP)的5-8%。另一方面,交通事故每年在全世界造成约135万人死亡和约1.85万亿美元的经济损失。缓解交通拥堵、减少交通事故、提高道路交通安全已成为世界各国亟待解决的问题。
近年来,自动驾驶技术的快速发展为解决这些问题带来了希望。路径跟踪控制作为自动驾驶的最后一环,对实现汽车的自主驾驶和行驶稳定性起着至关重要的作用。迄今为止,路径跟踪控制已经得到了广泛的研究。然而,由于交通环境和车辆系统的复杂性,路径跟踪控制仍然面临许多挑战。特别是极限工况下的避撞机动,由于车辆系统和轮胎系统的强非线性和耦合特,对路径跟踪控制提出了更高要求。目前,路径跟踪控制主要通过转向控制实现。然而,在极限工况下的避撞机动中,由于轮胎侧向力通常接近饱和,仅利用转向可能无法避免碰撞,甚至导致车辆侧滑。因此,在一些极限工况下的避撞机动中引入制动控制可以提高自动驾驶汽车的路径跟踪性能和稳定性。
目前,转向和制动集成的路径跟踪控制研究多采用分层式控制方法,控制器首先计算前轮转角和附加横摆力矩,然后根据分配规则将附加横摆力矩分配给相应的车轮进行制动。然而,分层式路径跟踪控制在求解前轮转角和附加横摆力矩时不能考虑制动执行机构的物理约束。因此,分层式路径跟踪控制无法确保控制输入的最优性。针对该问题,论文[Wang G,Liu L,Meng Y,Gu Q and Bai G.Integrated path tracking control ofsteering and braking based on holistic MPC.IFAC-PapersOnLine,54(2):45-50,2021.]基于模型预测控制(MPC)设计了一种转向和制动一体化路径跟踪控制方法,基于MPC的控制方法可以考虑转向和制动执行机构的物理约束,并直接求解出前轮转角和四个车轮的制动力矩,解决了分层式路径跟踪控制无法确保控制输入最优性的问题。然而,由于控制输入的维度较高以及控制器模型较为复杂使得基于MPC的转向和制动一体化路径跟踪控制方法的计算负担巨大、实时性差,在工程应用中面临巨大挑战。另一方面,该研究未考虑轮胎力的优化问题,控制器在求解控制输入时无法保证各个轮胎的轮胎力利用最优,在极限工况下的避撞机动中面临因某个轮胎的轮胎力过度利用导致车辆侧滑的问题。
发明内容
本发明实施例提供了基于降维模型的转向和制动一体化路径跟踪控制方法,能够解决现有基于MPC的转向和制动一体化路径跟踪控制方法计算负担重、实时性差,在工程中难以应用的技术问题,以及极限工况下因轮胎力过度利用导致车辆侧滑的技术问题。所述技术方案如下:
本发明实施例提供了一种基于降维模型的转向和制动一体化路径跟踪控制方法,包括:
构建汽车动力学模型、车轮动力学模型以及UniTire轮胎模型;
对汽车动力学模型进行降维,构建汽车动力学降维模型;
根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器;其中,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标;
根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制。
进一步地,构建的汽车动力学模型表示为:
其中,Vx为纵向速度,Vy为侧向速度,为侧向加速度,γ和都表示为横摆角速度,为横摆角加速度,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮,δf为前轮转角,m为汽车质量,lf和lr分别是汽车质心至前、后轴的距离,w为轮距,Iz为横摆转动惯量,为横摆角,为汽车在大地坐标系中的侧向速度。
进一步地,构建的汽车动力学模型表示为:
其中,Jz为车轮转动惯量,表示车轮旋转角加速度,Re,ij为有效滚动半径,Fx,ij为纵向轮胎力,Tb,ij为制动力矩,下标ij=fl、fr、rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮。
进一步地,构建的UniTire轮胎模型表示为:
其中,Fx和Fy分别为Fx,ij、Fy,ij的简写形式,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮,为无量纲总切力,E为综合曲率因子,Ex和Ey分别为纵向力和侧向力曲率因子,φ为相对综合滑移率,φn为修正后的相对综合滑移率,λ为总切力方向因子,φx和φy分别为相对纵向和侧向滑移率,μx和μy分别为纵向和侧向摩擦系数,μx0和μy0分别为稳态纵向和侧向摩擦系数,vsx和vsy分别为轮胎相对地面的纵向和侧向滑移速度,v为车轮中心速度,Kx和Ky分别为纵滑刚度和侧偏刚度;Sx和Sy分别为UniTire坐标系中的轮胎纵向和侧向滑移率,κ和α分别为ISO轮胎坐标系中的轮胎纵向滑移率和侧偏角,Fz为Fz,ij的简写形式,Fz、Fz0和Fzn分别表示轮胎载荷、额定轮胎载荷和无量纲轮胎载荷;η、pl1、pl2、pl3、pu0、pu1、pu2、pu3、pe1、pe2、pk1、pk2、pk3、φc、sl1、sl2、sl3、su0、su1、su2、su3、se1、se2、sk1、sk2和sk3为UniTire轮胎模型的辨识参数。
进一步地,所述对汽车动力学模型进行降维,构建汽车动力学降维模型包括:
计算剩余可用轮胎力:
其中,表示当前时刻的剩余可用轮胎力,下标ij=fl、fr、rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮;μFz,ij表示轮胎附着力,μ为μij的简写形式,μ表示路面摩擦系数,Fz为Fz,ij的简写形式,Fz表示轮胎载荷,和分别表示当前时刻的横向和纵向轮胎力;
根据得到的剩余可用轮胎力,计算剩余纵向可利用轮胎力:
确定前、后轮胎的剩余可用纵向轮胎力之比:
其中,下标fj=fl、fr,下标rj=rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮;
对式(19)进行如下近似:
对Rj进行修正:
基于式(21),得到在任意时刻,后轮胎的纵向轮胎力为:
将式(23)代入构建的汽车动力学模型中,得到汽车动力学降维模型:
其中,Vx为纵向速度,Vy为侧向速度,为侧向加速度,γ表示为横摆角速度,为横摆角加速度,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮,δf为前轮转角,m为汽车质量,lf和lr分别是汽车质心至前、后轴的距离,w为轮距,Iz为横摆转动惯量,和分别表示修正后的左侧和右侧车轮的前后纵向力之比。
进一步地,所述根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器包括:
根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,确定所述基于降维模型的一体化MPC路径跟踪控制器的系统模型如下:
其中,函数fu(t)(·)表示ξ(t)、u(t)与的函数关系,是ξ关于时间的一阶导数,t表示时域,状态变量 为横摆角,Y为汽车在大地坐标系中的侧向位置,控制输出控制输入u=[δf,Tb,fl,Tb,fr,Tb,rl,Tb,rr]T,Tb,ij为制动力矩,h表示输出映射,表示为:
采用四阶Runge-Kutta方法离散化系统模型,将其转化为增量模型:
其中,△ξ和△u分别表示ξ和u的增量,k表示当前离散时刻,k-1表示前一离散时刻;
基于式(26),构建MPC预测方程对系统未来状态进行预测,其中,MPC预测方程表示为:
其中,P和M分别表示预测时域和控制时域,k+n|k表示在当前k时刻对k+n时刻的预测,n=1…P;
基于式(27)可得到系统未来的预测输出为:
基于式(28),定义预测输出序列Υ(k+1)为:
其中,上标T表示矩阵的转置;
定义参考输出R(k+1)和控制输入序列△U(k)为:
确定轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数,将确定的轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数进行相加,得到总代价函数;
确定系统约束,其中,所述系统约束包括:稳定性约束和执行机构约束;
根据得到的总代价函数、系统模型和系统约束,对一体化MPC路径跟踪控制器进行描述。
进一步地,所述确定轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数,将确定的轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数进行相加,得到总代价函数包括:
其中,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮;
基于式(32)得到轮胎力优化代价函数J1为:
确定路径跟踪代价函数J2,表示为:
J2=||ΓΥ(Υ(k+1)-R(k+1))||2 (34)
确定的控制输入平滑性代价函数J3表示为:
J3=||ΓU△U(k)||2 (35)
将式(33)-(35)进行相加,得到总代价函数:
其中,JMPC表示总代价函数。
进一步地,所述确定系统约束包括:
对汽车侧向位置、横摆角以及各车轮的轮胎力进行约束如下:
其中,下标max表示最大值;
对执行机构进行约束如下:
进一步地,所述根据得到的总代价函数、系统模型和系统约束,对一体化MPC路径跟踪控制器进行描述包括:
根据得到的总代价函数、系统模型和系统约束,将基于降维模型的一体化MPC路径跟踪控制问题描述为:
并服从于:
i)式(26)所示的系统模型;
ii)式(37)和(38)所示的约束条件。
进一步地,所述根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制包括:
采用Active-Set算法,求解式(39)所示的控制问题,得到最优开环控制序列△U(k),并选取△U(k)中的第一组元素△u(k)应用于待控制的自动驾驶汽车,实现路径跟踪控制。
本发明实施例提供的技术方案带来的有益效果至少包括:
本发明实施例中,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标,能够保证每个轮胎的轮胎力利用最优,避免极限工况下因轮胎力过度利用导致车辆侧滑,提高极限工况下的路径跟踪性能;并基于降维模型构建一体化MPC路径跟踪控制器,能够有效解决现有的基于MPC的转向和制动一体化路径跟踪控制方法计算负担重、实时性差的问题,显著提高系统的实时性。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的基于降维模型的转向和制动一体化路径跟踪控制方法的整体逻辑示意图;
图2为本发明实施例提供的基于降维模型的转向和制动一体化路径跟踪控制方法的流程示意图;
图3为本发明实施例提供的汽车动力学模型示意图;
图4为本发明实施例提供的车轮动力学模型示意图;
图5为本发明实施例提供的剩余可用轮胎力示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。
本实施例中,提供了一种基于降维模型的转向和制动一体化路径跟踪控制方法,其整体控制逻辑如图1所示,一体化MPC路径跟踪控制器通过获取参考路径信息,包括参考侧向位置Yref和参考横摆角路面摩擦系数μ以及自动驾驶汽车反馈的纵向速度Vx、侧向速度Vy、横摆角速度γ、侧向位置Y和横摆角优化求解出汽车的前轮转角δf和四个车轮的制动力矩Tb,ij,并输入给自动驾驶汽车,实现路径跟踪控制。总体来讲,如图2所示,本明实施例包括四部分:
1.汽车动力学模型、车轮动力学模型以及统一(UniTire)轮胎模型构建(S101)
2.汽车动力学模型降维(S102)
3.一体化模型预测控制(Model Predictive Control,MPC)路径跟踪控制器构建(S103)
4.控制问题求解(S104)
如图2所示,本发明实施例提供了一种基于降维模型的转向和制动一体化路径跟踪控制方法,包括:
S101,构建汽车动力学模型、车轮动力学模型以及UniTire轮胎模型;具体包括以下三个子部分:
A1,构建汽车动力学模型,如图3所示,其表达式如下:
其中,Vx为纵向速度,Vy为侧向速度,为侧向加速度,γ和都表示为横摆角速度,为横摆角加速度,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮,δf为前轮转角,m为汽车质量,lf和lr分别是汽车质心至前、后轴的距离,w为轮距,Iz为横摆转动惯量,为横摆角,为汽车在大地坐标系中的侧向速度。
A2,构建车轮动力学模型,如图4所示,其表达式如下:
A3,构建UniTire轮胎模型,其表达式如下:
其中,Fx和Fy分别为Fx,ij、Fy,ij的简写形式,为无量纲总切力,E为综合曲率因子,Ex和Ey分别为纵向力和侧向力曲率因子,φ为相对综合滑移率,φn为修正后的相对综合滑移率,λ为总切力方向因子,φx和φy分别为相对纵向和侧向滑移率,μx和μy分别为纵向和侧向摩擦系数,μx0和μy0分别为稳态纵向和侧向摩擦系数,vsx和vsy分别为轮胎相对地面的纵向和侧向滑移速度,v为车轮中心速度,Kx和Ky分别为纵滑刚度和侧偏刚度;Sx和Sy分别为UniTire坐标系中的轮胎纵向和侧向滑移率,κ和α分别为ISO轮胎坐标系中的轮胎纵向滑移率和侧偏角,Fz为Fz,ij的简写形式,Fz、Fz0和Fzn分别为轮胎载荷、额定轮胎载荷和无量纲轮胎载荷;η、pl1、pl2、pl3、pu0、pu1、pu2、pu3、pe1、pe2、pk1、pk2、pk3、φc、sl1、sl2、sl3、su0、su1、su2、su3、se1、se2、sk1、sk2和sk3为UniTire轮胎模型的辨识参数。
S102,对汽车动力学模型进行降维,构建汽车动力学降维模型;具体可以包括以下步骤:
B1,确定模型降维方法,具体可以包括以下步骤:
B11,根据轮胎摩擦极限,如图5所示,计算当前时刻的剩余可用轮胎力:
B12,根据计算得到的当前时刻的剩余可用轮胎力,进而得到剩余纵向可利用轮胎力为:
B13,确定前、后轮胎的剩余可用纵向轮胎力的比例关系,可以表示为:
其中,下标fj=fl、fr,下标rj=rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮;
B16,为避免轮胎力接近摩擦极限时Rj的值变得不稳定,设计如下函数对Rj进行修正:
最终,类比式(21),在任意时刻,后轮胎的纵向轮胎力可以表示为:
B2,构建汽车动力学降维模型
本实施例中,将式(23)代入式(1),得到汽车动力学降维模型如下:
S103,根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器;其中,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标;具体可以包括以下步骤:
C1,确定系统模型
本实施例中,联立式(24)和(2)-(16),得到所述基于降维模型的一体化MPC路径跟踪控制器的系统模型如下:
其中,函数fu(t)(·)表示ξ(t)、u(t)与的函数关系,是ξ关于时间的一阶导数,t表示时域,状态变量 为横摆角,Y为汽车在大地坐标系中的侧向位置,控制输出控制输入u=[δf,Tb,fl,Tb,fr,Tb,rl,Tb,rr]T,输出映射
然后,采用四阶Runge-Kutta方法离散化系统模型,将其转化为增量模型:
其中,△ξ和△u分别表示ξ和u的增量,k表示当前离散时刻,k-1表示前一离散时刻。
C2,确定预测方程,具体可以包括以下步骤:
基于式(26),构建如下MPC预测方程对系统未来状态进行预测:
其中,P和M分别表示预测时域和控制时域,(k+n|k)表示在当前k时刻对k+n时刻的预测,n=1…P。
基于式(27)可得到系统未来的预测输出,如下:
基于式(28),定义预测输出序列Υ(k+1),如下:
其中,上标T表示矩阵的转置;
定义参考输出R(k+1)和控制输入序列△U(k),如下:
C3,确定代价函数,具体可以包括以下步骤:
C31,确定轮胎力优化代价函数
然后,基于式(32)得到轮胎力优化代价函数J1如下:
C32,确定路径跟踪代价函数
本实施例中,为描述自动驾驶汽车的路径跟踪性能,定义路径跟踪代价函数J2如下:
J2=||ΓΥ(Υ(k+1)-R(k+1))||2 (34)
C33,确定控制输入平滑性代价函数
本实施例中,为描述控制输入的平滑程度,定义控制输入平滑性代价函数J3,如下:
J3=||ΓU△U(k)||2 (35)
C34,确定总代价函数
本实施例中,将式(33)-(35)进行相加,得到总代价函数如下:
本实施例中,在代价函数中加入了轮胎力优化指标,以保证每个轮胎的轮胎力利用最优,避免极限工况下车辆侧滑,提高极限工况下的路径跟踪性能。
C4,设计系统约束,其包括两部分:
C41,设计稳定性约束
本实施例中,为保持汽车稳定,对汽车侧向位置、横摆角以及各车轮的轮胎力进行约束如下:
其中,下标max表示最大值。
C42,设计执行机构约束
本实施例中,为避免超出执行机构的物理极限,对执行机构进行约束如下:
C5,控制问题描述
本实施例中,基于降维模型的一体化MPC路径跟踪控制问题描述为:
并服从于:
i)如式(26)所示的系统模型;
ii)如式(37)和(38)所示的约束条件。
S104,根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制。
本实施例中,采用有效集算法(Active-Set)算法,求解式(39)所示的路径跟踪控制问题,得到最优开环控制序列△U(k),并选取△U(k)中的第一组元素△u(k)应用于待控制的自动驾驶汽车,实现路径跟踪控制。
本发明实施例所述的基于降维模型的转向和制动一体化路径跟踪控制方法,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标,能够保证每个轮胎的轮胎力利用最优,避免极限工况下因轮胎力过度利用导致车辆侧滑,提高极限工况下的路径跟踪性能;并基于降维模型构建一体化MPC路径跟踪控制器,能够有效解决现有的基于MPC的转向和制动一体化路径跟踪控制方法计算负担重、实时性差的问题,显著提高系统的实时性。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,包括:
构建汽车动力学模型、车轮动力学模型以及UniTire轮胎模型;
对汽车动力学模型进行降维,构建汽车动力学降维模型;
根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器;其中,在一体化MPC路径跟踪控制器中加入了轮胎力优化指标;
根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制。
4.根据权利要求1所述的基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,构建的UniTire轮胎模型表示为:
其中,Fx和Fy分别为Fx,ij、Fy,ij的简写形式,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮,F为无量纲总切力,E为综合曲率因子,Ex和Ey分别为纵向力和侧向力曲率因子,φ为相对综合滑移率,φn为修正后的相对综合滑移率,λ为总切力方向因子,φx和φy分别为相对纵向和侧向滑移率,μx和μy分别为纵向和侧向摩擦系数,μx0和μy0分别为稳态纵向和侧向摩擦系数,vsx和vsy分别为轮胎相对地面的纵向和侧向滑移速度,v为车轮中心速度,Kx和Ky分别为纵滑刚度和侧偏刚度;Sx和Sy分别为UniTire坐标系中的轮胎纵向和侧向滑移率,κ和α分别为ISO轮胎坐标系中的轮胎纵向滑移率和侧偏角,Fz为Fz,ij的简写形式,Fz、Fz0和Fzn分别表示轮胎载荷、额定轮胎载荷和无量纲轮胎载荷;η、pl1、pl2、pl3、pu0、pu1、pu2、pu3、pe1、pe2、pk1、pk2、pk3、φc、sl1、sl2、sl3、su0、su1、su2、su3、se1、se2、sk1、sk2和sk3为UniTire轮胎模型的辨识参数。
5.根据权利要求1所述的基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,所述对汽车动力学模型进行降维,构建汽车动力学降维模型包括:
计算剩余可用轮胎力:
其中,表示当前时刻的剩余可用轮胎力,下标ij=fl、fr、rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮;μFz,ij表示轮胎附着力,μ为μij的简写形式,μ表示路面摩擦系数,Fz为Fz,ij的简写形式,Fz表示轮胎载荷,和分别表示当前时刻的横向和纵向轮胎力;
根据得到的剩余可用轮胎力,计算剩余纵向可利用轮胎力:
确定前、后轮胎的剩余可用纵向轮胎力之比:
其中,下标fj=fl、fr,下标rj=rl、rr,fl、fr、rl和rr分别指左前、右前、左后和右后车轮;
对式(19)进行如下近似:
对Rj进行修正:
基于式(21),得到在任意时刻,后轮胎的纵向轮胎力为:
将式(23)代入构建的汽车动力学模型中,得到汽车动力学降维模型:
6.根据权利要求5所述的基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,所述根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,构建基于降维模型的一体化MPC路径跟踪控制器包括:
根据构建的汽车动力学降维模型、车轮动力学模型以及UniTire轮胎模型,确定所述基于降维模型的一体化MPC路径跟踪控制器的系统模型如下:
其中,函数fu(t)(·)表示ξ(t)、u(t)与的函数关系,是ξ关于时间的一阶导数,t表示时域,状态变量 为横摆角,Y为汽车在大地坐标系中的侧向位置,控制输出控制输入u=[δf,Tb,fl,Tb,fr,Tb,rl,Tb,rr]T,Tb,ij为制动力矩,h表示输出映射,表示为:
采用四阶Runge-Kutta方法离散化系统模型,将其转化为增量模型:
其中,△ξ和△u分别表示ξ和u的增量,k表示当前离散时刻,k-1表示前一离散时刻;
基于式(26),构建MPC预测方程对系统未来状态进行预测,其中,MPC预测方程表示为:
其中,P和M分别表示预测时域和控制时域,k+n|k表示在当前k时刻对k+n时刻的预测,n=1…P;
基于式(27)可得到系统未来的预测输出为:
基于式(28),定义预测输出序列Υ(k+1)为:
其中,上标T表示矩阵的转置;
定义参考输出R(k+1)和控制输入序列△U(k)为:
确定轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数,将确定的轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数进行相加,得到总代价函数;
确定系统约束,其中,所述系统约束包括:稳定性约束和执行机构约束;
根据得到的总代价函数、系统模型和系统约束,对一体化MPC路径跟踪控制器进行描述。
7.根据权利要求6所述的基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,所述确定轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数,将确定的轮胎力优化代价函数、路径跟踪代价函数和控制输入平滑性代价函数进行相加,得到总代价函数包括:
其中,Fx,ij和Fy,ij分别为纵向和侧向轮胎力,下标ij=fl、fr、rl、rr,fl,fr,rl和rr分别指左前、右前、左后和右后车轮;
基于式(32)得到轮胎力优化代价函数J1为:
确定路径跟踪代价函数J2,表示为:
J2=||ΓΥ(Υ(k+1)-R(k+1))||2 (34)
确定的控制输入平滑性代价函数J3表示为:
J3=||ΓU△U(k)||2 (35)
将式(33)-(35)进行相加,得到总代价函数:
其中,JMPC表示总代价函数。
10.根据权利要求9所述的基于降维模型的转向和制动一体化路径跟踪控制方法,其特征在于,所述根据构建的一体化MPC路径跟踪控制器,对路径跟踪控制问题进行求解,实现路径跟踪控制包括:
采用Active-Set算法,求解式(39)所示的控制问题,得到最优开环控制序列△U(k),并选取△U(k)中的第一组元素△u(k)应用于待控制的自动驾驶汽车,实现路径跟踪控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111285179.6A CN113954873B (zh) | 2021-11-01 | 2021-11-01 | 一种基于降维模型的转向和制动一体化路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111285179.6A CN113954873B (zh) | 2021-11-01 | 2021-11-01 | 一种基于降维模型的转向和制动一体化路径跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113954873A true CN113954873A (zh) | 2022-01-21 |
CN113954873B CN113954873B (zh) | 2023-04-25 |
Family
ID=79468799
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111285179.6A Active CN113954873B (zh) | 2021-11-01 | 2021-11-01 | 一种基于降维模型的转向和制动一体化路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113954873B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108839652A (zh) * | 2018-06-27 | 2018-11-20 | 聊城大学 | 一种车辆失稳可控域的自动驾驶紧急避让系统 |
CN109255094A (zh) * | 2018-08-10 | 2019-01-22 | 重庆邮电大学 | 基于SVR_Adaboost改进算法的商用货车质量估计方法 |
CN110217227A (zh) * | 2019-06-25 | 2019-09-10 | 长春工业大学 | 一种适用于冰雪道路工况的转向制动联合避撞控制方法 |
CN110217229A (zh) * | 2019-06-25 | 2019-09-10 | 长春工业大学 | 一种适用于高速极限工况的路径跟踪控制方法 |
CN111965977A (zh) * | 2020-08-06 | 2020-11-20 | 长春工业大学 | 一种基于轮胎均等后备能力的汽车稳定性控制方法 |
CN111959527A (zh) * | 2020-08-07 | 2020-11-20 | 长春工业大学 | 一种基于转角优化序列的汽车路径跟踪控制方法 |
CN111959500A (zh) * | 2020-08-07 | 2020-11-20 | 长春工业大学 | 一种基于轮胎力分配的汽车路径跟踪性能提升方法 |
CN112904849A (zh) * | 2021-01-18 | 2021-06-04 | 北京科技大学 | 一体式自动驾驶汽车换道轨迹规划和跟踪控制方法及系统 |
-
2021
- 2021-11-01 CN CN202111285179.6A patent/CN113954873B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108839652A (zh) * | 2018-06-27 | 2018-11-20 | 聊城大学 | 一种车辆失稳可控域的自动驾驶紧急避让系统 |
CN109255094A (zh) * | 2018-08-10 | 2019-01-22 | 重庆邮电大学 | 基于SVR_Adaboost改进算法的商用货车质量估计方法 |
CN110217227A (zh) * | 2019-06-25 | 2019-09-10 | 长春工业大学 | 一种适用于冰雪道路工况的转向制动联合避撞控制方法 |
CN110217229A (zh) * | 2019-06-25 | 2019-09-10 | 长春工业大学 | 一种适用于高速极限工况的路径跟踪控制方法 |
CN111965977A (zh) * | 2020-08-06 | 2020-11-20 | 长春工业大学 | 一种基于轮胎均等后备能力的汽车稳定性控制方法 |
CN111959527A (zh) * | 2020-08-07 | 2020-11-20 | 长春工业大学 | 一种基于转角优化序列的汽车路径跟踪控制方法 |
CN111959500A (zh) * | 2020-08-07 | 2020-11-20 | 长春工业大学 | 一种基于轮胎力分配的汽车路径跟踪性能提升方法 |
CN112904849A (zh) * | 2021-01-18 | 2021-06-04 | 北京科技大学 | 一体式自动驾驶汽车换道轨迹规划和跟踪控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113954873B (zh) | 2023-04-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9821800B2 (en) | Processor for a vehicle | |
CN111959500B (zh) | 一种基于轮胎力分配的汽车路径跟踪性能提升方法 | |
JP5462373B2 (ja) | 車両の運動制御装置 | |
CN111258323A (zh) | 一种智能车辆轨迹规划与跟踪的联合控制方法 | |
CN108773376A (zh) | 一种融合驾驶意图的汽车多目标分层协同控制与优化方法 | |
EP4253181A1 (en) | Vehicle front and rear drive torque distribution method and apparatus, and vehicle | |
CN112904849A (zh) | 一体式自动驾驶汽车换道轨迹规划和跟踪控制方法及系统 | |
CN111965977B (zh) | 一种基于轮胎均等后备能力的汽车稳定性控制方法 | |
JP2016182959A (ja) | 車両の運動制御装置 | |
JP2018030582A (ja) | 車両の運動制御装置、及び運動制御プログラム | |
CN115542813A (zh) | 无人驾驶车辆控制方法、装置、电子设备及存储介质 | |
CN113682282A (zh) | 一种车辆稳定性控制方法、系统、车辆和存储介质 | |
Li et al. | Adaptive sliding mode control of lateral stability of four wheel hub electric vehicles | |
Németh et al. | Design of actuator interventions in the trajectory tracking for road vehicles | |
CN116729417B (zh) | 一种基于非合作博弈的人机共驾横纵向联合控制方法 | |
CN113954873A (zh) | 一种基于降维模型的转向和制动一体化路径跟踪控制方法 | |
Guastadisegni et al. | Vehicle stability control through pre-emptive braking | |
CN113327457B (zh) | 一种基于车路协同技术的车辆避碰系统及方法 | |
CN114435399A (zh) | 基于预测模型的自动驾驶汽车稳定性路径跟踪方法 | |
CN113954821B (zh) | 一种转向和扭矩矢量一体化车辆稳定性控制方法 | |
CN110758404B (zh) | 一种针对车辆稳定系统执行器故障的容错控制方法 | |
Németh et al. | Control design based on the integration of steering and suspension systems | |
Zhang et al. | Hierarchical Vehicle Stability Control Strategy Based on Unscented Kalman Filter Estimation | |
EP4368468A1 (en) | Methods and systems for calculating control variables of a vehicle | |
CN117465419A (zh) | 考虑侧倾的车辆轨迹跟踪与稳定性协调控制方法 |
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 |