CN113928311B - 一种车辆稳态漂移的闭环切换控制方法 - Google Patents
一种车辆稳态漂移的闭环切换控制方法 Download PDFInfo
- Publication number
- CN113928311B CN113928311B CN202111273058.XA CN202111273058A CN113928311B CN 113928311 B CN113928311 B CN 113928311B CN 202111273058 A CN202111273058 A CN 202111273058A CN 113928311 B CN113928311 B CN 113928311B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- steady
- state
- drift
- front wheel
- 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 42
- 230000007704 transition Effects 0.000 claims abstract description 26
- 230000008569 process Effects 0.000 claims abstract description 12
- 238000013459 approach Methods 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 17
- 238000013507 mapping Methods 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 7
- 238000004088 simulation Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 238000002474 experimental method Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 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
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
- 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
-
- 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
- B60W60/0015—Planning or execution of driving tasks specially adapted for safety
- B60W60/0016—Planning or execution of driving tasks specially adapted for safety of the vehicle or its occupants
-
- 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/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0008—Feedback, closed loop systems or details of feedback error signal
- B60W2050/0011—Proportional Integral Differential [PID] controller
-
- 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
- B60W2050/0034—Multiple-track, 2D vehicle model, e.g. four-wheel model
-
- 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明属于漂移控制技术领域,公开了一种车辆稳态漂移的闭环切换控制方法,包括:S1.计算车辆的稳态漂移域及稳态漂移平衡点,并基于所述稳态漂移域将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段;S2.基于二自由度车辆模型设计所述过渡阶段的过渡漂移控制器,并基于所述过渡漂移控制器控制车辆接近稳态漂移域,所述过渡漂移控制器包括纵向PID控制器和横向LQR控制器;S3.判断车辆当前状态量偏差是否进入稳态漂移域,是进入步骤S4,否返回步骤S2;S4.基于三自由度车辆模型设计所述稳态阶段的稳态漂移LQR控制器,控制车辆跟踪稳态漂移平衡点;综上,基于切换控制能够实现车辆漂移的闭环控制,具有一定的抗干扰能力。
Description
技术领域
本发明属于漂移控制技术领域,具体涉及一种车辆稳态漂移的闭环切换控制方法。
背景技术
随着汽车产业的发展和系统理论的不断成熟,汽车正向智能化和无人化方向发展。无人驾驶车辆的紧急避险能力和对各种工况的适应能力已经引起了人们的广泛关注,并成为自动驾驶新的研究方向。
汽车在漂移时,车辆处于极限工况,可以快速改变车身航向,避免或减轻碰撞,因此通过研究漂移控制提高自动驾驶车辆的紧急避险能力是一重要的研究方向。但是,目前的车辆漂移控制存在如下问题:
有较强的非线性,对于车辆漂移过程的建模非常困难,且横、纵向存在复杂的耦合性,控制难度较大:在漂移时后轮处于附着圆极限,后轮的侧向力和纵向力受附着圆极限的约束,此时车辆的横纵向存在复杂的耦合关系。目前的技术方案多数采用开环和闭环控制相结合的方式,引入专业驾驶员的经验进行开环控制,这一方案的抗扰能力弱,且需要依赖经验进行控制器设计。
发明内容
鉴于此,为解决上述背景技术中所提出的问题,本发明的目的在于提供一种车辆稳态漂移的闭环切换控制方法。
为实现上述目的,本发明提供如下技术方案:一种车辆稳态漂移的闭环切换控制方法,包括:
S1.计算车辆的稳态漂移域αy∈R+及域内的稳态漂移平衡点Xeq∈Rn,R+表示正实数,Rn表示n维向量,并基于所述稳态漂移域,将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段;
S2.基于二自由度车辆模型设计所述过渡阶段的过渡漂移控制器,并基于所述过渡漂移控制器控制车辆接近稳态漂移域,所述过渡漂移控制器包括纵向PID控制器和横向LQR控制器,且:当车辆的当前纵向速度Vx小于稳态漂移平衡点的期望纵向速度时,令车辆的当前前轮转角δ=0,并通过所述纵向PID控制器控制车辆的纵向速度由当前纵向速度Vx接近期望纵向速度/>当车辆的当前纵向速度Vx等于平衡点的期望纵向速度/>时,通过所述横向LQR控制器控制车辆的前轮转角由当前前轮转角δ接近平衡点的期望前轮转角δeq;
S3.判断车辆当前状态量偏差Δx是否进入稳态漂移域αy,是进入步骤S4,否返回步骤S2;
S4.基于三自由度车辆模型设计所述稳态阶段中的稳态漂移LQR控制器,控制车辆状态量跟踪稳态漂移平衡点,基于所述稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为平衡点的期望纵向速度和期望前轮转角δeq。
优选的,在所述步骤S1的计算车辆稳态漂移平衡点时,包括:
建立非线性车辆动力学模型,且车辆动力学模型自由度为三自由度以上;
将期望漂移的纵向速度和期望前轮转角δeq输入到所述非线性车辆动力学模型中求解得到稳态漂移平衡点Xeq。
优选的,当建立基于三自由度车辆模型的非线性车辆动力学方程时,包括:
建立三自由度车辆模型:
基于三自由度车辆模型和非线性系统,计算车辆的稳态漂移平衡点Xeq:
则/>其中m为车辆质量、Lf为车辆质心与前轴距离、和δeq分别为稳态漂移平衡点处的前轮侧向力、后轮侧向力、后轮纵向力、质心侧偏角、横摆角速度、纵向速度和前轮转角值。
优选的,在所述步骤S2中,所述二自由度车辆模型表达为:
其中,β′,r′,V′x和F′yF分别是二自由度模型下的质心侧偏角、横摆角速度、纵向速度和前轮侧向力,/>为通过线性模型计算得到的后轮侧向力。
优选的,在所述步骤S2中,基于二自由度车辆模型构建所述横向LQR控制器时,包括:
以前轮侧向力F′yF为标称控制量,构建二自由度线性偏差模型:Δx′=A′Δx′+B′Δu′;其中Δx′为线性偏差模型的状态变量,且Δx′=[Δβ′,Δr′]T=[x′-x′eq],x′=[β′,r′]T,x′eq=[βeq,req]T;Δu′为线性偏差模型的控制变量,目u′是车辆二自由度线性模型的控制量,/>A′和B′为模型参数,且/>
定义横向LQR控制器的二次型优化函数: 其中Q和R分别为状态变量和控制变量的权重矩阵,且Q=diag[wΔβ,wΔr],/>wΔβ,wΔr,/>为权重系数
定义二自由度线性偏差模型的控制律为:Δu′=-K′zΔx′;其中K′z为反馈矩阵,且K′z=-R-1B′TP′,P′通过求解方程P′A′+A′TP′-P′B′R-1B′TP′+Q=0得到;
根据反馈矩阵K′z设计前馈和反馈相结合的横向LQR控制器u′=u′FF+Δu′;其中:u′=F′yF为标称控制量;u′FF为前馈控制量,且
将所述前轮转角的标称控制量δ′输出给车辆的执行器。
优选的,在所述步骤S1和S3中:稳态漂移域αy∈R+通过计算得到,且i=1,...,2m,m为控制量数目。
优选的,在所述步骤S1和S3中:当车辆状态量的偏差Δx∈{ΔxTPΔx≤αy}时,车辆状态量偏差进入稳态漂移域,否则在车辆漂移域外;其中,P为计算得到的LQR正定对称矩阵,ubi是ub的第i个元素,umax是控制量约束的最大值,umin是控制量约束的最小值,两者均由轮胎的摩擦力极限计算得到,ueq是稳态漂移平衡点处控制量的值,ki为Kz的第i行,/>且K是由LQR控制器计算得到的线性反馈控制律。
优选的,在所述步骤S4中,基于三自由度车辆模型构建所述稳态过程中的稳态漂移LQR控制器时,包括:
以前轮侧向力FyF和后轮纵向力FxR为标称控制量,构建三自由度线性偏差模型:其中Δx为线性偏差模型的状态变量,且Δx=[Δβ,Δr,ΔVx]T=[x-xeq],状态变量x=[β,r,Vx]T,β,r和Vx分别是三自由度模型下的质心侧偏角、横摆角速度和纵向速度,状态变量在稳态漂移平衡点处的值为xeq=[βeq,req,Vx eq]T;Δu为线性偏差模型的控制变量,且/> A和B分别为状态变量和控制变量的雅克比矩阵,且
a11=0,a12=-1,
定义所述稳态漂移LQR控制器的二次型优化函数: 其中,Q=QT和R=RT为正定矩阵,Q和R分别为状态变量和控制变量的权重矩阵:wΔββ,wΔr,/>为权重系数;
定义所述三自由度线性偏差模型的控制律为:Δu=一KzΔx;其中Kz为反馈矩阵,且Kz=-R-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
根据反馈矩阵Kz设计前馈和反馈相结合的稳态漂移LQR控制器:u=uFF+Δu;其中:u为标称控制量,且Δu为线性偏差模型的控制变量,uFF为前馈控制量,且
优选的,在所述步骤S4中,通过所述稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为稳态漂移平衡点的期望纵向速度和期望前轮转角δeq时,包括:
通过所述稳态漂移LQR控制器求解得到前轮侧向力的标称控制量FyF和后轮纵向力的标称控制量FxR;
构建所述前轮侧向力的标称控制量FyF与前轮转角的实际控制量δ之间的映射关系,并求解得到前轮转角的实际控制量δ;
构建所述后轮纵向力的标称控制量FxR与后轮驱动转矩的实际控制量τ之间的映射关系,并求解得到后轮驱动转矩的实际控制量τ;
将所述前轮转角的实际控制量δ和后轮驱动转矩的实际控制量τ输出至车辆的执行器。
本发明与现有技术相比,具有以下有益效果:
在本发明中,基于所述稳态漂移域将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段,其中:对于过渡阶段,采用纵向PID控制器和横向LQR控制器进行协同控制;对于稳态阶段采用稳态漂移LQR控制器进行稳定控制;综上,这一方法避免了开环控制对于系统抗干扰能力的影响,使得稳态漂移控制方案具有可重复性,且能够实现车辆的稳态漂移,适用于极限工况下的车辆控制研究。
另外,本发明分别采用二自由度、三自由度车辆模型来描述车辆的单轨动力学,并且在考虑附着圆约束的同时,对轮胎进行映射关系的建立,由此得到轮胎侧向力和侧偏角间的关系,并实现输入量与输出量之前的精准转换及车辆的准确控制。
附图说明
图1为本发明控制方法的控制框图;
图2为本发明中过渡漂移控制器的控制框图;
图3为本发明过渡漂移控制器中纵向PID控制器的控制框图;
图4为本发明中稳态漂移LQR控制器的控制框图;
图5为利用本发明控制方法进行稳态漂移仿真实验时的路径图;
图6为利用本发明控制方法进行稳态漂移仿真实验时的质心侧偏角变化图;
图7为利用本发明控制方法进行稳态漂移仿真实验时的横摆角速度变化图;
图8为利用本发明控制方法进行稳态漂移仿真实验时的纵向速度变化图;
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1所示的控制框图可知,在本发明中提供了一种车辆稳态漂移的闭环切换控制方法,且该方法包括如下步骤:
S1.计算车辆的稳态漂移域αy∈R+及域内的稳态漂移平衡点Xeq∈Rn,R+表示正实数,Rn表示n维向量,并基于稳态漂移域,将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段;
具体,平衡点的计算过程如下:
建立非线性车辆动力学模型,且车辆动力学模型自由度为三自由度以上,以三自由度的非线性车辆动力学模型为例:建立三自由度车辆模型:
基于三自由度车辆模型和非线性系统,计算车辆的稳态漂移平衡点Xeq:
则/>其中m为车辆质量、Lf为车辆质心与前轴距离、和δeq分别为稳态漂移平衡点处的前轮侧向力、后轮侧向力、后轮纵向力、质心侧偏角、横摆角速度、纵向速度和前轮转角值;
设和δeq为已知值,将期望漂移的纵向速度/>和期望前轮转角δeq输入到非线性车辆动力学模型中求解得到稳态漂移平衡点Xeq。
S2.基于二自由度车辆模型设计过渡阶段的过渡漂移控制器,并基于过渡漂移控制器控制车辆接近稳态漂移域,过渡漂移控制器包括纵向PID控制器和横向LQR控制器,且结合图2及图3所示的控制框图可知,过渡漂移控制器的控制原理为:当车辆的当前纵向速度Vx小于稳态漂移平衡点的期望纵向速度时,令车辆的当前前轮转角δ=0,并通过纵向PID控制器控制车辆的纵向速度由当前纵向速度Vx接近期望纵向速度/>当车辆的当前纵向速度Vx等于平衡点的期望纵向速度/>时,通过横向LQR控制器控制车辆的前轮转角由当前前轮转角δ接近平衡点的期望前轮转角δeq;
在上述步骤S2中,关于二自由度车辆模型的表达为:
其中,β′,r′,V′x和F′yF分别是二自由度模型下的质心侧偏角、横摆角速度、纵向速度和前轮侧向力,/>为通过线性模型计算得到的后轮侧向力。
基于二自由度车辆模型构建横向LQR控制器时,包括:
以前轮侧向力F′yF为标称控制量,构建二自由度线性偏差模型: 其中Δx′为线性偏差模型的状态变量,且Δx′=[Δβ′,Δr′]T=[x′-x′eq],x′=[β′,r′]T,x′eq=[βeq,req]T;Δu′为线性偏差模型的控制变量,且/> u′是车辆二自由度线性模型的控制量,/>A′和B′为模型参数,且/>
定义横向LQR控制器的二次型优化函数: 其中Q和R分别为状态变量和控制变量的权重矩阵,且Q=diag[wΔβ,wΔr],为权重系数;
定义二自由度线性偏差模型的控制律为:Δu′=-K′zΔx′;其中K′z为反馈矩阵,且K′z=-R-1B′TP′,P′通过求解方程P′A′+A′TP′-P′B′R-1B′TP′+Q=0得到;
根据反馈矩阵K′z设计前馈和反馈相结合的横向LQR控制器u′=u′FF+Δu′;其中:u′=F′yF为标称控制量;u′FF为前馈控制量,且
通过横向LQR控制器控制车辆的前轮转角由当前前轮转角δ′变化到稳态漂移平衡点处的期望前轮转角δeq时,包括:
通过横向LQR控制器求解得到前轮侧向力的标称控制量F′yF;
构建前轮侧向力的标称控制量F′yF与前轮转角的实际控制量δ′之间的映射关系,并求解得到前轮转角的实际控制量δ′:
基于此,求解得到前轮转角的实际控制量δ′;这里,Bf和Cf是轮胎魔术公式参数。
将前轮转角的标称控制量δ′输出车辆的执行器。
S3.判断车辆当前状态量偏差Δx是否进入稳态漂移域αy,是进入步骤S4,否返回步骤S2;
稳态漂移域αy∈R+通过计算得到,且i=1,...,2m,m为控制量数目;
具体,当车辆状态量的偏差Δx∈{ΔxTPΔx≤αy}时,车辆状态量偏差进入稳态漂移域,否则在车辆漂移域外;其中,P为计算得到的LQR正定对称矩阵,ubi是ub的第i个元素,umax是控制量约束的最大值,umin是控制量约束的最小值,两者均由轮胎的摩擦力极限计算得到,ueq是稳态漂移平衡点处控制量的值,ki为Kz的第i行,且K是由LQR控制器计算得到的线性反馈控制律。
S4.基于三自由度车辆模型设计稳态阶段中的稳态漂移LQR控制器,控制车辆状态量跟踪稳态漂移平衡点;具体,结合图4可知:基于稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为平衡点的期望纵向速度和期望前轮转角δeq;
在上述步骤S4中,三自由度车辆模型为:
基于三自由度车辆模型构建稳态过程中的稳态漂移LQR控制器时,包括:
以前轮侧向力FyF和后轮纵向力FxR为标称控制量,构建三自由度线性偏差模型:其中Δx为线性偏差模型的状态变量,且Δx=[Δβ,Δr,ΔVx]T=[x-xeq],状态变量x=[β,r,Vx]T,β,r和Vx分别是三自由度模型下的质心侧偏角、横摆角速度和纵向速度,状态变量在稳态漂移平衡点处的值为xeq=[βeq,req,Vx eq]T;Δu为线性偏差模型的控制变量,且/> A和B分别为状态变量和控制变量的雅克比矩阵,且
a11=0,a12=-1,
定义所述稳态漂移LQR控制器的二次型优化函数: 其中,Q=QT和R=RT为正定矩阵,Q和R分别为状态变量和控制变量的权重矩阵: 为权重系数;
定义三自由度线性偏差模型的控制律为:Δu=-KzΔx;其中Kz为反馈矩阵,且Kz=-R-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
根据反馈矩阵Kz设计前馈和反馈相结合的稳态漂移LQR控制器:u=uFF+Δu;其中:u为标称控制量,且Δu为线性偏差模型的控制变量,uFF为前馈控制量,且
通过稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为稳态漂移平衡点的期望纵向速度和期望前轮转角δeq时,包括:
通过稳态漂移LQR控制器求解得到前轮侧向力的标称控制量FyF和后轮纵向力的标称控制量FxR;
构建前轮侧向力的标称控制量FyF与前轮转角的实际控制量δ之间的映射关系,并求解得到前轮转角的实际控制量δ:
基于此,求解得到前轮转角的实际控制量δ;
构建后轮纵向力的标称控制量FxR与后轮驱动转矩的实际控制量τ之间的映射关系:其中,Rw为车轮行驶过程中的有效转动半径,i0为主减速器的传动比;基于此,求解得到后轮驱动转矩的实际控制量τ;
将前轮转角的实际控制量δ和后轮驱动转矩的实际控制量τ输出至车辆的执行器。
综上,基于上述公开的方式,在本发明中进行稳态漂移仿真实验:
设该实验中车辆的初始状态为:x(0)=10m,y(0)=10m,β(0)=Orad,r(0)=0rad/s,Vx(0)=0.001m/s;
设该实验中车辆平衡点的期望前轮转角δeq=-10°,平衡点的期望纵向速度
过渡过程中的反馈矩阵Kz=1×105×[一2.9316,1.9788]
稳态过程中的反馈矩阵
基于上述参数进行实验,得到如图5-图8所示的仿真结果,由图可知,上述控制方法能有效实现车辆漂移过程中的稳态漂移控制和闭环切换控制。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (8)
1.一种车辆稳态漂移的闭环切换控制方法,其特征在于,包括:
S1.计算车辆的稳态漂移域αy∈R+及域内的稳态漂移平衡点Xeq∈Rn,R+表示正实数,Rn表示n维向量,并基于所述稳态漂移域,将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段;
S2.基于二自由度车辆模型设计所述过渡阶段的过渡漂移控制器,并基于所述过渡漂移控制器控制车辆接近稳态漂移域,所述过渡漂移控制器包括纵向PID控制器和横向LQR控制器,且:当车辆的当前纵向速度Vx小于稳态漂移平衡点的期望纵向速度时,令车辆的当前前轮转角δ=0,并通过所述纵向PID控制器控制车辆的纵向速度由当前纵向速度Vx接近期望纵向速度/>当车辆的当前纵向速度Vx等于平衡点的期望纵向速度/>时,通过所述横向LQR控制器控制车辆的前轮转角由当前前轮转角δ接近平衡点的期望前轮转角δeq;
S3.判断车辆当前状态量偏差Δx是否进入稳态漂移域αy,是进入步骤S4,否返回步骤S2;
S4.基于三自由度车辆模型设计所述稳态阶段中的稳态漂移LQR控制器,控制车辆状态量跟踪稳态漂移平衡点,基于所述稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为平衡点的期望纵向速度和期望前轮转角δeq;
在步骤S1和S3中:
稳态漂移域αy∈R+通过计算得到,且i=1,…,2m,m为控制量数目;
在步骤S1和S3中:
当车辆状态量的偏差Δx∈{ΔxTPΔx≤αy}时,车辆状态量偏差进入稳态漂移域,否则在车辆漂移域外;其中,P为计算得到的LQR正定对称矩阵,ubi是ub的第i个元素,umax是控制量约束的最大值,umin是控制量约束的最小值,两者均由轮胎的摩擦力极限计算得到,ueq是稳态漂移平衡点处控制量的值,ki为Kz的第i行,且K是由LQR控制器计算得到的线性反馈控制律。
2.根据权利要求1所述的控制方法,其特征在于,在所述步骤S1的计算车辆稳态漂移平衡点时,包括:
建立非线性车辆动力学模型,且车辆动力学模型自由度为三自由度以上;
将期望漂移的纵向速度和期望前轮转角δeq输入到所述非线性车辆动力学模型中求解得到稳态漂移平衡点Xeq。
3.根据权利要求2所述的控制方法,其特征在于,当建立基于三自由度车辆模型的非线性车辆动力学方程时,包括:
建立三自由度车辆模型:
基于三自由度车辆模型和非线性系统,计算车辆的稳态漂移平衡点Xeq:
则/>其中m为车辆质量、Lf为车辆质心与前轴距离、βeq、req、/>和δeq分别为稳态漂移平衡点处的前轮侧向力、后轮侧向力、后轮纵向力、质心侧偏角、横摆角速度、纵向速度和前轮转角值。
4.根据权利要求1所述的控制方法,其特征在于,在所述步骤S2中,所述二自由度车辆模型表达为:
其中,β',r',Vx'和F'yF分别是二自由度模型下的质心侧偏角、横摆角速度、纵向速度和前轮侧向力,/>为通过线性模型计算得到的后轮侧向力。
5.根据权利要求4所述的控制方法,其特征在于,在所述步骤S2中,基于二自由度车辆模型构建所述横向LQR控制器时,包括:
以前轮侧向力F'yF为标称控制量,构建二自由度线性偏差模型: 其中Δx'为线性偏差模型的状态变量,且Δx'=[Δβ',Δr']T=[x'-x'eq],x'=[β',r']T,x'eq=[βeq,req]T;Δu'为线性偏差模型的控制变量,且/>u'是车辆二自由度线性模型的控制量,/>A'和B'为模型参数,且/>
定义横向LQR控制器的二次型优化函数: 其中Q和R分别为状态变量和控制变量的权重矩阵,且Q=diag[wΔβ,wΔr],/> 为权重系数;
定义二自由度线性偏差模型的控制律为:Δu'=-K'zΔx';其中K'z为反馈矩阵,且K'z=-R-1B'TP',P'通过求解方程P'A'+A'TP'-P'B'R-1B'TP'+Q=0得到;
根据反馈矩阵K'z设计前馈和反馈相结合的横向LQR控制器u'=u'FF+Δu';其中:u'=F'yF为标称控制量;u'FF为前馈控制量,且
将所述前轮转角的标称控制量δ'输出给车辆的执行器。
6.根据权利要求5所述的控制方法,其特征在于,在所述步骤S2中,通过所述横向LQR控制器控制车辆的前轮转角由当前前轮转角δ'变化到稳态漂移平衡点处的期望前轮转角δeq时,包括:
通过所述横向LQR控制器求解得到前轮侧向力的标称控制量F'yF;
构建所述前轮侧向力的标称控制量F'yF与前轮转角的实际控制量δ'之间的映射关系,并求解得到前轮转角的实际控制量δ';
将所述前轮转角的标称控制量δ'输出给车辆的执行器。
7.根据权利要求1所述的控制方法,其特征在于,在所述步骤S4中,基于三自由度车辆模型构建所述稳态过程中的稳态漂移LQR控制器时,包括:
以前轮侧向力FyF和后轮纵向力FxR为标称控制量,构建三自由度线性偏差模型:其中Δx为线性偏差模型的状态变量,且Δx=[Δβ,Δr,ΔVx]T=[x-xeq],状态变量x=[β,r,Vx]T,β,r和Vx分别是三自由度模型下的质心侧偏角、横摆角速度和纵向速度,状态变量在稳态漂移平衡点处的值为xeq=[βeq,req,Vx eq]T;Δu为线性偏差模型的控制变量,且/> A和B分别为状态变量和控制变量的雅克比矩阵,且
a11=0,a12=-1,
定义所述稳态漂移LQR控制器的二次型优化函数: 其中,Q=QT和R=RT为正定矩阵,Q和R分别为状态变量和控制变量的权重矩阵: 为权重系数;
定义所述三自由度线性偏差模型的控制律为:Δu=-KzΔx;其中Kz为反馈矩阵,且Kz=-r-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
根据反馈矩阵Kz设计前馈和反馈相结合的稳态漂移LQR控制器:u=uFF+Δu;其中:u为标称控制量,且Δu为线性偏差模型的控制变量,uFF为前馈控制量,且
8.根据权利要求7所述的控制方法,其特征在于,在所述步骤S4中,通过所述稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为稳态漂移平衡点的期望纵向速度和期望前轮转角δeq时,包括:
通过所述稳态漂移LQR控制器求解得到前轮侧向力的标称控制量FyF和后轮纵向力的标称控制量FxR;
构建所述前轮侧向力的标称控制量FyF与前轮转角的实际控制量δ之间的映射关系,并求解得到前轮转角的实际控制量δ;
构建所述后轮纵向力的标称控制量FxR与后轮驱动转矩的实际控制量τ之间的映射关系,并求解得到后轮驱动转矩的实际控制量τ;
将所述前轮转角的实际控制量δ和后轮驱动转矩的实际控制量τ输出至车辆的执行器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111273058.XA CN113928311B (zh) | 2021-10-29 | 2021-10-29 | 一种车辆稳态漂移的闭环切换控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111273058.XA CN113928311B (zh) | 2021-10-29 | 2021-10-29 | 一种车辆稳态漂移的闭环切换控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113928311A CN113928311A (zh) | 2022-01-14 |
CN113928311B true CN113928311B (zh) | 2024-04-19 |
Family
ID=79285097
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111273058.XA Active CN113928311B (zh) | 2021-10-29 | 2021-10-29 | 一种车辆稳态漂移的闭环切换控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113928311B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110435657A (zh) * | 2018-05-04 | 2019-11-12 | 现代自动车株式会社 | 车辆的漂移行驶状态实现控制方法 |
CN111267856A (zh) * | 2020-01-10 | 2020-06-12 | 南京理工大学 | 一种基于纵向力预分配的车辆自动漂移控制方法和系统 |
CN111832160A (zh) * | 2020-06-29 | 2020-10-27 | 南京理工大学 | 一种基于三轮模型的车辆稳定漂移控制方法和系统 |
CN111890951A (zh) * | 2020-08-07 | 2020-11-06 | 吉林大学 | 智能电动汽车轨迹跟踪与运动控制方法 |
CN112051851A (zh) * | 2020-09-09 | 2020-12-08 | 清华大学 | 极限工况下电动四驱车辆的自主漂移控制方法及系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110395120A (zh) * | 2019-08-14 | 2019-11-01 | 厦门金龙联合汽车工业有限公司 | 一种四轮分布式驱动客车的横摆运动控制方法 |
-
2021
- 2021-10-29 CN CN202111273058.XA patent/CN113928311B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110435657A (zh) * | 2018-05-04 | 2019-11-12 | 现代自动车株式会社 | 车辆的漂移行驶状态实现控制方法 |
CN111267856A (zh) * | 2020-01-10 | 2020-06-12 | 南京理工大学 | 一种基于纵向力预分配的车辆自动漂移控制方法和系统 |
CN111832160A (zh) * | 2020-06-29 | 2020-10-27 | 南京理工大学 | 一种基于三轮模型的车辆稳定漂移控制方法和系统 |
CN111890951A (zh) * | 2020-08-07 | 2020-11-06 | 吉林大学 | 智能电动汽车轨迹跟踪与运动控制方法 |
CN112051851A (zh) * | 2020-09-09 | 2020-12-08 | 清华大学 | 极限工况下电动四驱车辆的自主漂移控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113928311A (zh) | 2022-01-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Coordination control of differential drive assist steering and vehicle stability control for four-wheel-independent-drive EV | |
CN112373470B (zh) | 紧急避让工况自动驾驶转向制动纳什博弈控制方法 | |
Hashemi et al. | Vehicle stability control: Model predictive approach and combined-slip effect | |
Yamamoto | Active control strategy for improved handling and stability | |
Taghavifar et al. | Optimal robust control of vehicle lateral stability using damped least-square backpropagation training of neural networks | |
CN113911106B (zh) | 基于博弈论的商用车横向轨迹跟随与稳定性协同控制方法 | |
Yang et al. | An adaptive hierarchical control approach of vehicle handling stability improvement based on Steer-by-Wire Systems | |
Rossetter et al. | A study of lateral vehicle control under a ‘virtual’force framework | |
Milani et al. | Smart autodriver algorithm for real-time autonomous vehicle trajectory control | |
Tan et al. | Sliding-mode control of four wheel steering systems | |
Liang et al. | A direct yaw moment control framework through robust TS fuzzy approach considering vehicle stability margin | |
Viadero-Monasterio et al. | Event-triggered robust path tracking control considering roll stability under network-induced delays for autonomous vehicles | |
Bárdos et al. | Implementation and experimental evaluation of a MIMO drifting controller on a test vehicle | |
Zheng et al. | Comparison of active front wheel steering and differential braking for yaw/roll stability enhancement of a coach | |
JP4613668B2 (ja) | 車両挙動制御装置および車両挙動制御方法 | |
Li et al. | Longitudinal and lateral control for four wheel steering vehicles | |
CN113928311B (zh) | 一种车辆稳态漂移的闭环切换控制方法 | |
Bárdos et al. | MIMO controller design for stabilizing vehicle drifting | |
Ibrahim et al. | Discontinuous stabilizing control of skid-steering mobile robot (SSMR) | |
Weber et al. | Modeling and Control for Dynamic Drifting Trajectories | |
Anwar | Brake-based vehicle traction control via generalized predictive algorithm | |
Ahmed et al. | A Novel Coordination Method for an Integrated Chassis Controller of an 8x8 Combat Vehicle | |
Guo et al. | MPC-based steady-state drift control under extreme condition | |
Li et al. | Steering of 4WD vehicles with independent wheel torque control | |
Gao et al. | Adaptive sliding mode trajectory tracking control of automated guided vehicles with sideslip angle |
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 |