CN113928311A - 一种车辆稳态漂移的闭环切换控制方法 - Google Patents
一种车辆稳态漂移的闭环切换控制方法 Download PDFInfo
- Publication number
- CN113928311A CN113928311A CN202111273058.XA CN202111273058A CN113928311A CN 113928311 A CN113928311 A CN 113928311A CN 202111273058 A CN202111273058 A CN 202111273058A CN 113928311 A CN113928311 A CN 113928311A
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 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 7
- 239000011159 matrix material Substances 0.000 claims description 20
- 238000013507 mapping Methods 0.000 claims description 13
- 238000005457 optimization Methods 0.000 claims description 6
- 238000013461 design Methods 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 239000013598 vector Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 8
- 238000004088 simulation Methods 0.000 description 6
- 238000002474 experimental method Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 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
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000003638 chemical reducing agent Substances 0.000 description 1
- 238000010276 construction 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
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/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的计算车辆稳态漂移平衡点时,包括:
建立非线性车辆动力学模型,且车辆动力学模型自由度为三自由度以上;
优选的,当建立基于三自由度车辆模型的非线性车辆动力学方程时,包括:
基于三自由度车辆模型和非线性系统,计算车辆的稳态漂移平衡点Xeq: 则其中m为车辆质量、Lf为车辆质心与前轴距离、和δeq分别为稳态漂移平衡点处的前轮侧向力、后轮侧向力、后轮纵向力、质心侧偏角、横摆角速度、纵向速度和前轮转角值。
优选的,在所述步骤S2中,所述二自由度车辆模型表达为:
优选的,在所述步骤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′为模型参数,且
定义二自由度线性偏差模型的控制律为:Δu′=-K′zΔx′;其中K′z为反馈矩阵,且K′z=-R-1B′TP′,P′通过求解方程P′A′+A′TP′-P′B′R-1B′TP′+Q=0得到;
将所述前轮转角的标称控制量δ′输出给车辆的执行器。
优选的,在所述步骤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分别为状态变量和控制变量的雅克比矩阵,且
定义所述三自由度线性偏差模型的控制律为:Δu=-KzΔx;其中Kz为反馈矩阵,且Kz=-R-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
通过所述稳态漂移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分别为稳态漂移平衡点处的前轮侧向力、后轮侧向力、后轮纵向力、质心侧偏角、横摆角速度、纵向速度和前轮转角值;
S2.基于二自由度车辆模型设计过渡阶段的过渡漂移控制器,并基于过渡漂移控制器控制车辆接近稳态漂移域,过渡漂移控制器包括纵向PID控制器和横向LQR控制器,且结合图2及图3所示的控制框图可知,过渡漂移控制器的控制原理为:当车辆的当前纵向速度Vx小于稳态漂移平衡点的期望纵向速度时,令车辆的当前前轮转角δ=0,并通过纵向PID控制器控制车辆的纵向速度由当前纵向速度Vx接近期望纵向速度当车辆的当前纵向速度Vx等于平衡点的期望纵向速度时,通过横向LQR控制器控制车辆的前轮转角由当前前轮转角δ接近平衡点的期望前轮转角δeq;
在上述步骤S2中,关于二自由度车辆模型的表达为:
基于二自由度车辆模型构建横向LQR控制器时,包括:
以前轮侧向力F′yF为标称控制量,构建二自由度线性偏差模型: 其中Δx′为线性偏差模型的状态变量,且Δx′=[Δβ′,Δr′]T=[x′-x′eq],x′=[β′,r′]T,x′eq=[βeq,req]T;Δu′为线性偏差模型的控制变量,且 u′是车辆二自由度线性模型的控制量,A′和B′为模型参数,且
定义二自由度线性偏差模型的控制律为:Δu′=-K′zΔx′;其中K′z为反馈矩阵,且K′z=-R-1B′TP′,P′通过求解方程P′A′+A′TP′-P′B′R-1B′TP′+Q=0得到;
通过横向LQR控制器控制车辆的前轮转角由当前前轮转角δ′变化到稳态漂移平衡点处的期望前轮转角δeq时,包括:
通过横向LQR控制器求解得到前轮侧向力的标称控制量F′yF;
构建前轮侧向力的标称控制量F′yF与前轮转角的实际控制量δ′之间的映射关系,并求解得到前轮转角的实际控制量δ′:
将前轮转角的标称控制量δ′输出车辆的执行器。
S3.判断车辆当前状态量偏差Δx是否进入稳态漂移域αy,是进入步骤S4,否返回步骤S2;
具体,当车辆状态量的偏差Δx∈{ΔxTPΔx≤αy}时,车辆状态量偏差进入稳态漂移域,否则在车辆漂移域外;其中,P为计算得到的LQR正定对称矩阵,ubi是ub的第i个元素,umax是控制量约束的最大值,umin是控制量约束的最小值,两者均由轮胎的摩擦力极限计算得到,ueq是稳态漂移平衡点处控制量的值,ki为Kz的第i行,且K是由LQR控制器计算得到的线性反馈控制律。
S4.基于三自由度车辆模型设计稳态阶段中的稳态漂移LQR控制器,控制车辆状态量跟踪稳态漂移平衡点;具体,结合图4可知:基于稳态漂移LQR控制器使车辆的当前纵向速度Vx和当前前轮转角δ保持为平衡点的期望纵向速度和期望前轮转角δeq;
基于三自由度车辆模型构建稳态过程中的稳态漂移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分别为状态变量和控制变量的雅克比矩阵,且
定义三自由度线性偏差模型的控制律为:Δu=-KzΔx;其中Kz为反馈矩阵,且Kz=-R-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
通过稳态漂移LQR控制器求解得到前轮侧向力的标称控制量FyF和后轮纵向力的标称控制量FxR;
构建前轮侧向力的标称控制量FyF与前轮转角的实际控制量δ之间的映射关系,并求解得到前轮转角的实际控制量δ:
将前轮转角的实际控制量δ和后轮驱动转矩的实际控制量τ输出至车辆的执行器。
综上,基于上述公开的方式,在本发明中进行稳态漂移仿真实验:
设该实验中车辆的初始状态为:x(0)=10m,y(0)=10m,β(0)=Orad,r(0)=0rad/s,Vx(0)=0.001m/s;
过渡过程中的反馈矩阵Kz=1×105×[-2.9316,1.9788]
基于上述参数进行实验,得到如图5-图8所示的仿真结果,由图可知,上述控制方法能有效实现车辆漂移过程中的稳态漂移控制和闭环切换控制。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。
Claims (10)
1.一种车辆稳态漂移的闭环切换控制方法,其特征在于,包括:
S1.计算车辆的稳态漂移域αy∈R+及域内的稳态漂移平衡点Xeq∈Rn,R+表示正实数,Rn表示n维向量,并基于所述稳态漂移域,将车辆的漂移过程分解为接近稳态漂移域的过渡阶段和进入稳态漂移域的稳态阶段;
S2.基于二自由度车辆模型设计所述过渡阶段的过渡漂移控制器,并基于所述过渡漂移控制器控制车辆接近稳态漂移域,所述过渡漂移控制器包括纵向PID控制器和横向LQR控制器,且:当车辆的当前纵向速度Vx小于稳态漂移平衡点的期望纵向速度时,令车辆的当前前轮转角δ=0,并通过所述纵向PID控制器控制车辆的纵向速度由当前纵向速度Vx接近期望纵向速度当车辆的当前纵向速度Vx等于平衡点的期望纵向速度时,通过所述横向LQR控制器控制车辆的前轮转角由当前前轮转角δ接近平衡点的期望前轮转角δeq;
S3.判断车辆当前状态量偏差Δx是否进入稳态漂移域αy,是进入步骤S4,否返回步骤S2;
5.根据权利要求4所述的控制方法,其特征在于,在所述步骤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′为模型参数,且
定义二自由度线性偏差模型的控制律为:Δu′=-K′zΔx′;其中K′z为反馈矩阵,且K′z=-R-1B′TP′,P′通过求解方程P′A′+A′TP′-P′B′R-1B′TP′+Q=0得到;
将所述前轮转角的标称控制量δ′输出给车辆的执行器。
6.根据权利要求5所述的控制方法,其特征在于,在所述步骤S2中,通过所述横向LQR控制器控制车辆的前轮转角由当前前轮转角δ′变化到稳态漂移平衡点处的期望前轮转角δeq时,包括:
通过所述横向LQR控制器求解得到前轮侧向力的标称控制量F′yF;
构建所述前轮侧向力的标称控制量F′yF与前轮转角的实际控制量δ′之间的映射关系,并求解得到前轮转角的实际控制量δ′;
将所述前轮转角的标称控制量δ′输出给车辆的执行器。
9.根据权利要求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分别为状态变量和控制变量的雅克比矩阵,且
定义所述三自由度线性偏差模型的控制律为:Δu=-KzΔx;其中Kz为反馈矩阵,且Kz=-R-iBTP,P可以通过求解方程PA+ATP-PBR-iBTP+Q=0得到;
通过所述稳态漂移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 true CN113928311A (zh) | 2022-01-14 |
CN113928311B 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 (6)
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 | 清华大学 | 极限工况下电动四驱车辆的自主漂移控制方法及系统 |
US20210046922A1 (en) * | 2019-08-14 | 2021-02-18 | Xiamen King Long United Automotive Industry Co., Ltd. | Yaw motion control method for four-wheel distributed vehicle |
-
2021
- 2021-10-29 CN CN202111273058.XA patent/CN113928311B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110435657A (zh) * | 2018-05-04 | 2019-11-12 | 现代自动车株式会社 | 车辆的漂移行驶状态实现控制方法 |
US20210046922A1 (en) * | 2019-08-14 | 2021-02-18 | Xiamen King Long United Automotive Industry Co., Ltd. | Yaw motion control method for four-wheel distributed vehicle |
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 |
---|---|
CN113928311B (zh) | 2024-04-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Shi et al. | Planning the trajectory of an autonomous wheel loader and tracking its trajectory via adaptive model predictive control | |
Singhal et al. | Robust trajectory tracking control of non-holonomic wheeled mobile robots using an adaptive fractional order parallel fuzzy PID controller | |
Prado et al. | Tube-based nonlinear model predictive control for autonomous skid-steer mobile robots with tire–terrain interactions | |
Taghavifar et al. | Optimal robust control of vehicle lateral stability using damped least-square backpropagation training of neural networks | |
CN111142534B (zh) | 一种智能车横纵向综合轨迹跟踪方法及控制系统 | |
CN112829766B (zh) | 一种基于分布式驱动电动车辆的自适应路径跟踪方法 | |
Hou et al. | Autonomous drift controller for distributed drive electric vehicle with input coupling and uncertain disturbance | |
CN110209177A (zh) | 基于模型预测和自抗扰的无人驾驶汽车控制系统及方法 | |
CN113911106A (zh) | 基于博弈论的商用车横向轨迹跟随与稳定性协同控制方法 | |
Yang et al. | An adaptive hierarchical control approach of vehicle handling stability improvement based on Steer-by-Wire Systems | |
CN111679575A (zh) | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 | |
Park et al. | Rear-wheel steering control for enhanced steady-state and transient vehicle handling characteristics | |
CN116184835A (zh) | 考虑输入时延与速度时变的无人驾驶车辆跟踪控制方法 | |
CN117492453B (zh) | 一种面向批量化运营车辆的未建模补偿控制方法 | |
CN103439883A (zh) | 汽车底盘集成系统神经网络广义逆解耦控制器及构造方法 | |
JP2024514548A (ja) | デバイスのアクチュエータを自律的に駆動するための方法 | |
CN113928311A (zh) | 一种车辆稳态漂移的闭环切换控制方法 | |
Ibrahim et al. | Discontinuous stabilizing control of skid-steering mobile robot (SSMR) | |
Morin et al. | Time-varying exponential stabilization of chained form systems based on a backstepping technique | |
Pandiaraj et al. | Novel ARC-Fuzzy Coordinated Automatic Tracking Control of Four-Wheeled Mobile Robot. | |
CN111949038A (zh) | 一种考虑迭代滑模的移动机器人解耦控制方法 | |
Gao et al. | Adaptive sliding mode trajectory tracking control of automated guided vehicles with sideslip angle | |
CN117068138B (zh) | 一种基于安全边界约束的整车稳态漂移控制方法 | |
CN105667585A (zh) | 基于指令滤波器的无人驾驶汽车前轮转向操纵控制方法 | |
Kokot et al. | A unified MPC design approach for AGV path following |
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 |