CN110395263B - 基于mfac算法的液罐车侧倾稳定性控制方法、系统 - Google Patents
基于mfac算法的液罐车侧倾稳定性控制方法、系统 Download PDFInfo
- Publication number
- CN110395263B CN110395263B CN201910756801.3A CN201910756801A CN110395263B CN 110395263 B CN110395263 B CN 110395263B CN 201910756801 A CN201910756801 A CN 201910756801A CN 110395263 B CN110395263 B CN 110395263B
- Authority
- CN
- China
- Prior art keywords
- tank truck
- yaw
- control input
- moment
- tank
- 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 40
- 230000001133 acceleration Effects 0.000 claims abstract description 27
- 239000011159 matrix material Substances 0.000 claims description 58
- 239000007788 liquid Substances 0.000 claims description 42
- 230000008859 change Effects 0.000 claims description 15
- 239000000126 substance Substances 0.000 claims description 14
- 230000000694 effects Effects 0.000 abstract description 12
- 230000008569 process Effects 0.000 abstract description 4
- 238000010586 diagram Methods 0.000 description 17
- 238000004364 calculation method Methods 0.000 description 16
- 150000001875 compounds Chemical class 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 239000012530 fluid Substances 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 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
- 238000005516 engineering process Methods 0.000 description 1
- 238000012886 linear function Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000000704 physical effect Effects 0.000 description 1
- 238000005096 rolling process 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/02—Control of vehicle driving stability
- B60W30/04—Control of vehicle driving stability related to roll-over prevention
-
- 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
- B60W2300/00—Indexing codes relating to the type of vehicle
- B60W2300/12—Trucks; Load vehicles
- B60W2300/125—Heavy duty trucks
- B60W2300/128—Silo or fluid transporting vehicles
-
- 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/12—Lateral speed
- B60W2520/125—Lateral acceleration
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Vehicle Body Suspensions (AREA)
Abstract
本发明涉及一种基于MFAC算法的液罐车侧倾稳定性控制方法、系统,基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定液罐车侧倾稳定性的影响因素包括横摆角速度;针对液罐车难以建模、模型通用性差、模型准确度低的问题,基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量,省去了建模过程,而仅利用控制输入和输出进行车辆侧倾控制,适用于各种形状罐体的液罐车,控制效果好,对于保障液罐车的道路运输安全具有十分重要的意义。
Description
技术领域
本发明涉及机动车辆行驶安全技术领域,尤其涉及一种基于MFAC算法的液罐车侧倾稳定性控制方法、系统。
背景技术
液罐车是流体货物道路运输的主要载体,在生产生活中有着广泛应用。
与固体货物不同,流体货物具有易于流动的性质,在车辆运行状态发生改变时(如加减速、转弯等),货物在外力作用下冲击罐体壁面,增加了车辆惯性力,降低了车辆的制动和行驶稳定性。
罐体内多安装横向防波板以抑制纵向液体晃动的影响。由于纵向防波板的设计和安装难度大,其较为少见,致使液罐车侧向稳定性问题突出。在侧向液体晃动的影响下,罐车相比普通载货汽车更易发生侧翻事故。因此,采用主动控制的方法提高液罐车侧倾稳定性很有必要,以此来保障道路运输安全。
液罐车是一个具有无限多自由度的流固耦合动力学系统,其动力学特性受到液体冲击的影响,而液体冲击又受到罐体形状、罐内分仓数量及其结构、罐内货物充装率以及货物物理属性等的影响。因此,液罐车的动力学建模困难、模型通用性差、模型准确性低。对液罐车的主动控制不适宜采用基于模型的控制方法。
发明内容
为了解决上述技术问题,本发明的目的在于提供一种基于MFAC算法的液罐车侧倾稳定性控制方法、系统。
根据本发明的一个方面,提供了一种基于MFAC算法的液罐车侧倾稳定性控制方法,包括以下步骤:
基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度;
基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量。
进一步的,所述MFAC算法包括基于全格式动态线性化的MFAC算法。
进一步的,液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系为:
其中,
αy为液罐车的车身侧向加速度;
V为液罐车行驶速度;
r为液罐车横摆角速度;
进一步的,基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,包括:
基于MFAC算法通过液罐车动力学系统的横摆角速度输出变化量、液罐车动力学系统的伪偏导数矩阵、滑动窗口内的系统输出和理论控制输入变化量矩阵之间的第三预设关系一,液罐车动力学系统的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二,液罐车动力学系统的理论控制输入、第二步长因子、液罐车动力学系统的伪偏导数矩阵、车辆理想横摆角速度、车辆实际横摆角速度、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三,液罐车动力学系统的实际控制输入(附加横摆力矩)、液罐车动力学系统的理论控制输入之间的第三预设关系四,对行驶状态下的液罐车进行侧倾稳定性控制。
其中,液罐车动力学系统(k+1)时刻的横摆角速度输出变化量、液罐车动力学系统k时刻的伪偏导数矩阵、滑动时间窗口[k-ny+1,k]内的系统横摆角速度输出变化量和滑动时间窗口[k-nu+1,k]内的理论控制输入变化量所组成的矩阵之间的第三预设关系一为:
其中,
△r(k+1)为液罐车动力学系统在(k+1)时刻的横摆角速度变化量;
ny为控制输入线性化长度,nu为输出线性化长度。
其中,液罐车动力学系统k时刻的伪偏导数估计值、液罐车动力学系统(k-1)时刻的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统横摆角速度输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二为:
其中,
η是第一步长因子;
μ是惩罚因子;
r(k)是液罐车动力学系统在k时刻的横摆角速度输出;
r(k-1)是液罐车动力学系统在(k-1)时刻的横摆角速度输出;
其中,液罐车动力学系统k时刻的理论控制输入、液罐车动力学系统(k-1)时刻的理论控制输入、第二步长因子、液罐车动力学系统k时刻的伪偏导数矩阵、液罐车动力学系统(k+1)时刻的理想横摆角速度输出、液罐车动力学系统在k时刻的实际横摆角速度输出、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三为:
其中,
u(k)为k时刻的系统理论控制输入;
u(k-1)为(k-1)时刻的系统理论控制输入;
λ为权重因子;
ρ为第二步长因子;
r*(k+1)为液罐车动力学系统在(k+1)时刻的理想横摆角速度输出;
r(k)为液罐车动力学系统在k时刻的实际横摆角速度输出;
△r为滑动窗口内的系统横摆角速度输出变化量;
△u为滑动窗口内的系统理论控制输入变化量;
其中,液罐车动力学系统k时刻的实际控制输入(附加横摆力矩)与理论控制输入之间的第三预设关系四为:
U(k)=amp×u(k),
其中:
U(k)为液罐车动力学系统在k时刻的实际控制输入量(附加横摆力矩);
amp为扩充系数。
根据本发明的另一个方面,提供了一种基于MFAC算法的液罐车侧倾稳定性控制系统,包括:
液罐车侧倾稳定性影响因素确定单元,配置用于基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度;
液罐车侧倾稳定性控制单元,配置用于基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量。
进一步的,所述MFAC算法包括基于全格式动态线性化的MFAC算法。
与现有技术相比,本发明具有以下有益效果:
1、本发明示例的基于MFAC算法的液罐车侧倾稳定性控制方法,基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度;针对液罐车难以建模、模型通用性差、模型准确度低的问题,基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量,省去了建模过程,而仅利用系统的控制输入和输出进行车辆侧倾控制,适用于装配各种形状罐体的液罐车,控制效果好,这对于保障液罐车的道路运输安全具有十分重要的意义。
2、本发明示例的基于MFAC算法的液罐车侧倾稳定性控制系统,组成简单,通过各个组成系统及单元之间相互配合,基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,省去了建模过程,而仅利用系统的控制输入和输出进行车辆侧倾控制,控制效果好,适用于装配各种形状罐体的液罐车,可有效保障液罐车的道路运输安全。
附图说明
图1为实施例一基于MFAC算法的液罐车侧倾控制方法流程图;
图2为罐体为圆柱、罐内充液比为0.6时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图3为罐体为圆柱、罐内充液比为0.6时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的质心侧偏角示意图;
图4为罐体为圆柱、罐内充液比为0.6时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的横摆角速度示意图;
图5为罐体为圆柱、罐内充液比为0.6时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的车身侧倾角示意图;
图6为罐体为圆柱、罐内充液比为0.6时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的液体振荡摆角示意图;
图7为罐体为圆柱、罐内充液比为0.6时,液罐车CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的附加横摆力矩的示意图;
图8为罐体为椭圆柱,长短轴之比为1.5时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图9为罐体为椭圆柱,长短轴之比为1.5时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的质心侧偏角示意图;
图10为罐体为椭圆柱,长短轴之比为1.5时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的横摆角速度示意图;
图11为罐体为椭圆柱,长短轴之比为1.5时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的车身侧倾角示意图;
图12为罐体为椭圆柱,长短轴之比为1.5时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的液体振荡摆角示意图;
图13为罐体为椭圆柱,长短轴之比为1.5时,液罐车CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的附加横摆力矩的示意图;
图14为罐体为椭圆柱,长短轴之比为2.0时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图15为罐体为椭圆柱,长短轴之比为2.0时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的质心侧偏角示意图;
图16为罐体为椭圆柱,长短轴之比为2.0时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的横摆角速度示意图;
图17为罐体为椭圆柱,长短轴之比为2.0时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的车身侧倾角示意图;
图18为罐体为椭圆柱,长短轴之比为2.0时,液罐车在无控制与CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的液体振荡摆角示意图;
图19为罐体为椭圆柱,长短轴之比为2.0时,液罐车CFDL-MFAC、PFDL-MFAC和FFDL-MAFC控制下的附加横摆力矩的示意图;
图20为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图21为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的质心侧偏角示意图;
图22为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的横摆角速度示意图;
图23为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的车身侧倾角示意图;
图24为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的液体振荡摆角示意图;
图25为罐体为圆柱、罐内充液比为0.6,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的附加横摆力矩的示意图;
图26为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图27为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的质心侧偏角示意图;
图28为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的横摆角速度示意图;
图29为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的车身侧倾角示意图;
图30为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的液体振荡摆角示意图;
图31为罐体为椭圆柱,长短轴之比为1.5,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的附加横摆力矩的示意图;
图32为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的后轴横向载荷转移率示意图;
图33为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的质心侧偏角示意图;
图34为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的横摆角速度示意图;
图35为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的车身侧倾角示意图;
图36为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的液体振荡摆角示意图;
图37为罐体为椭圆柱,长短轴之比为2.0,ny=nu=3、ny=nu=4、ny=nu=5时,液罐车在FFDL-MAFC控制下的附加横摆力矩的示意图。
具体实施方式
为了更好的了解本发明的技术方案,下面结合具体实施例、说明书附图对本发明作进一步说明。
实施例一:
本实施例提供了一种基于MFAC算法的液罐车侧倾稳定性控制方法,如图1所示,包括以下步骤:
S1、基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度。
液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系为:
因此,可以通过控制车辆的横摆角速度来达到侧倾稳定性控制的目的,通过差动制动控制策略实现液罐车的侧倾控制。控制输入量为附加横摆力矩U,被控量为罐车横摆角速度r。控制系统为单输入(附加横摆力矩U)、单输出(横摆角速度r)系统。
S2、基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量。
MFAC有三种控制器的计算方法:基于紧格式动态线性化(CFDL)的MFAC控制,基于偏格式动态线性化(PFDL)的MFAC控制,基于全格式动态线性化(FFDL)的MFAC控制。
(1)基于CFDL的MFAC控制
设定液罐车动力学系统的横摆角速度变化仅与理论控制输入的当前变化量相关,其可以表示为理论控制输入变化量的线性函数,即为:
△r(k+1)=φc(k)△u(k)
式中,△r(k+1)为液罐车动力学系统在(k+1)时刻的横摆角速度变化量;Δu为理论控制输入变化量;φc为液罐车动力学系统的伪偏导数,其维度为1*1。
此时,理论控制输入量u可表示为:
式中,u(k)为k时刻的系统理论控制输入;u(k-1)为(k-1)时刻的系统理论控制输入;ρ为步长因子,计算中取值为0.5;λ为权重因子,计算中取值为1;r*(k+1)为液罐车动力学系统在(k+1)时刻的理想横摆角速度输出;r(k)为液罐车动力学系统在k时刻的实际横摆角速度输出。
液罐车动力学系统的伪偏导数估计值为:
式中,为系统在k时刻的伪偏导数估计值;为系统在k-1时刻的伪偏导数估计值;△u为系统理论控制输入的变化量;η为步长因子,计算中取值为0.8;μ为惩罚因子,计算中取值为0.5;r(k)是液罐车动力学系统在k时刻的横摆角速度输出;r(k-1)是液罐车动力学系统在(k-1)时刻的横摆角速度输出。
此时,液罐车实际的控制输入量U为:
U(k)=amp×u(k)
式中,U(k)为液罐车动力学系统实际控制输入量(附加横摆力矩);amp为扩充系数,计算中取值为2e+5。
(2)基于PFDL的MFAC控制
设定液罐车动力学系统的横摆角速度变化与滑动时间窗口[k-L+1,k]内的理论控制输入变化量相关,其可表示为:
式中,△r(k+1)为液罐车动力学系统在(k+1)时刻的横摆角速度变化量,φL(k)=[φ1(k),φ2(k),...,φL(k)]T,是液罐车动力学系统的伪偏导数矩阵,其维度为L*1;△UL(k)=[△u(k),....,△u(k-L+1)]T是滑动时间窗口内的系统理论控制输入变化量矩阵,其维度为L*1;L为控制输出线性化长度。
此时,理论控制输入量u表示为:
式中,u(k)为k时刻的系统理论控制输入;u(k-1)为(k-1)时刻的系统理论控制输入;ρ为步长因子,计算中取值为0.5,λ为权重因子,计算中取值为1;r*(k+1)为液罐车动力学系统在(k+1)时刻的理想横摆角速度输出;r(k)为液罐车动力学系统在k时刻的实际横摆角速度输出;为伪偏导数矩阵φL(k)中的第1个子矩阵;为伪偏导数矩阵φL(k)中的第i个子矩阵;△u为系统理论控制输入的变化量。
液罐车动力学系统的伪偏导数估计值为:
式中,为系统在k时刻的伪偏导数估计值;为系统在k-1时刻的伪偏导数估计值;η为步长因子,计算中取值为0.8,μ为惩罚因子,计算中取值为0.5;△UL是滑动时间窗口内的系统理论控制输入变化量矩阵;r(k)是液罐车动力学系统在k时刻的横摆角速度输出;r(k-1)是液罐车动力学系统在(k-1)时刻的横摆角速度输出。
此时,液罐车的实际控制输入量U为:
U(k)=amp×u(k)
式中,U(k)为液罐车动力学系统实际控制输入量(附加横摆力矩);amp为扩充系数,计算中取值为2e+5。
(3)基于FFDL的MFAC控制
设定液罐车动力学系统的横摆角速度变化不仅与滑动时间窗口内的理论控制输入变化量相关,还与滑动时间窗口内的输出变化量相关,其可表示为:
式中,φny,nu(k)=[φ1(k),φ2(k),...,φny(k),φny+1(k),...,φny+nu(k)]T为液罐车动力学系统的伪偏导数矩阵,其维度为(ny+nu)*1;
为滑动时间窗口[k-nu+1,k]内的控制输出变化量与滑动时间时间窗口[k-ny+1,k]内的理论控制输入变化量所组成的矩阵,其维度为(ny+nu)*1;ny为控制输出线性化长度;nu为理论控制输入线性化长度。
此时,理论控制输入量u表示为:
式中,u(k)为系统k时刻的理想控制输入;u(k-1)为系统k-1时刻的理想控制输入;ρ为步长因子,计算中取值为0.5,λ为权重因子,计算中取值为1;r*(k+1)为液罐车在k+1时刻的理想横摆角速度输出;r(k)为液罐车在k时刻的实际横摆角速度输出;△r为滑动窗口内的系统横摆角速度输出变化量;△u为滑动窗口内的系统理论控制输入变化量;为伪偏导数矩阵中的第ny+1个子矩阵;为系统伪偏导数矩阵中的第i个子矩阵。
液罐车动力学系统的伪偏导数估计值为:
式中,为系统k时刻的伪偏导数估计值;为系统k-1时刻的伪偏导数估计值;η为步长因子,计算中取值为0.8,μ惩罚因子,计算中取值为0.5;为滑动时间窗口内的系统控制输出和理论控制输入变化量矩阵;r(k)为系统在k时刻的控制输出;r(k-1)为系统在k-1时刻的控制输出。
此时,液罐车的实际控制输入量U为:
U(k)=amp×u(k)
式中,U(k)为液罐车动力学系统实际控制输入量(附加横摆力矩);amp为扩充系数,计算中取值为2e+5。
而本实施例MFAC算法为基于全格式动态线性化(FFDL)的MFAC控制算法。故基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,具体包括:
基于MFAC算法通过液罐车动力学系统的横摆角速度输出变化量、液罐车动力学系统的伪偏导数矩阵、滑动窗口内的系统输出和理论控制输入变化量矩阵之间的第三预设关系一,液罐车动力学系统的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二,液罐车动力学系统的理论控制输入、第二步长因子、液罐车动力学系统的伪偏导数矩阵、理想横摆角速度、车辆实际横摆角速度、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三,液罐车动力学系统的实际控制输入(附加横摆力矩)、液罐车动力学系统的理论控制输入之间的第三预设关系四,对行驶状态下的液罐车进行侧倾稳定性控制。
故,液罐车动力学系统(k+1)时刻的横摆角速度输出变化量、液罐车动力学系统k时刻的伪偏导数矩阵、滑动时间窗口[k-ny+1,k]内的系统横摆角速度输出变化量和滑动时间窗口[k-nu+1,k]内的理论控制输入变化量所组成的矩阵之间的第三预设关系一为:
其中,
△r(k+1)为液罐车动力学系统在(k+1)时刻的横摆角速度变化量;
ny为控制输入线性化长度,nu为控制输出线性化长度。
液罐车动力学系统k时刻的伪偏导数估计值、液罐车动力学系统(k-1)时刻的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统横摆角速度输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二为:
其中,
η是第一步长因子;
μ是惩罚因子;
r(k)是液罐车动力学系统在k时刻的横摆角速度输出;
r(k-1)是液罐车动力学系统在(k-1)时刻的横摆角速度输出;
液罐车动力学系统k时刻的理论控制输入、液罐车动力学系统(k-1)时刻的理论控制输入、第二步长因子、液罐车动力学系统k时刻的伪偏导数矩阵、液罐车动力学系统(k+1)时刻的理想横摆角速度输出、液罐车动力学系统在k时刻的实际横摆角速度输出、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三为:
其中,
u(k)为k时刻的系统理论控制输入;
u(k-1)为(k-1)时刻的系统理论控制输入;
λ为权重因子;
ρ为第二步长因子;
r*(k+1)为液罐车动力学系统在(k+1)时刻的理想横摆角速度输出;
r(k)为液罐车动力学系统在k时刻的实际横摆角速度输出;
△r为滑动窗口内的系统横摆角速度输出变化量;
△u为滑动窗口内的系统理论控制输入变化量;
液罐车动力学系统k时刻的实际控制输入(附加横摆力矩)与理论控制输入之间的第三预设关系四为:
U(k)=amp×u(k),
其中:
U(k)为液罐车动力学系统在k时刻的实际控制输入量(附加横摆力矩);
amp为扩充系数。
分别使用CFDL-MAFC、PFDL-MAFC、FFDL-MAFC三种方法求解附加横摆力矩u、实施液罐车侧倾稳定性控制。其中,PFDL-MAFC中的L取值为3,FFDL-MAFC中的ny及nu取值均为3。
(1)当罐车装载圆柱罐体(罐体横截面半径为0.89m)、罐内充液比为0.6时,设定车辆行驶速度为15m/s,并通过前轮输入0.01rad的阶跃车轮转角。此时,无控制输入下的罐车发生侧倾失稳(液罐车后轴横向载荷转移率超过1.0)。三种控制方法下的液罐车动力学响应如图2-7所示。可知,CFDL-MFAC控制下车辆后轴横向载荷转移率的第一个峰值仍会超过侧翻极限值1.0,车辆依然会发生侧翻事故。PFDL-MFAC和FFDL-MAFC控制下的罐车后轴横向载荷转移率均在1.0以下,车辆侧倾稳定性得到控制。与PFDL-MFAC相比,FFDL-MAFC的控制效果更佳。
(2)更改罐体形状为椭圆柱罐体(罐体长轴半径1.09m,短轴半径0.73m,长短轴之比为1.5;罐体长轴半径1.26m,短轴半径0.63m,长短轴之比为2),车辆运行条件不变。无控制输入下的液罐车发生侧倾失稳。此时,三种控制方法下的液罐车动力学响应分别如图8-19所示。同样地,三种控制策略中,FFDL-MFAC的控制效果最佳。
(3)进一步探究滑动窗口大小对FFDL-MFAC控制方法的影响,在ny=nu=3的基础上,对比ny=nu=4以及ny=nu=5时的液罐车控制效果。装载圆柱罐体液罐车的控制效果如图20-25所示(充液比0.6,行驶速度15m/s,前轮角阶跃输入0.01rad)。可知,ny=nu=3及ny=nu=4时,FFDL-MFAC对液罐车的控制效果基本相同。当ny=nu=5时,车辆横摆角速度的超调量得到了显著下降,车辆后轴横向载荷转移率的第一个峰值也得到了很好的控制,车辆侧倾稳定性要高于另外两组参数下的控制效果。
(4)罐体装载椭圆柱罐体(罐体长轴半径1.09m,短轴半径0.73m,长短轴之比为1.5;罐体长轴半径1.26m,短轴半径0.63m,长短轴之比为2)、车辆运行条件不变时,三种FFDL-MFAC控制方法对液罐车侧倾稳定性的控制效果如图26-37所示。同样地,ny=nu=5时FFDL-MFAC对罐车侧倾稳定性的控制效果最佳。
通过上述分析,针对液罐车难以建模、模型通用性差、模型准确度低的问题,MFAC控制方法能略去建模过程,而仅利用系统的控制输入和输出进行车辆侧倾控制,且FFDL-MFAC控制方法能够取得很好的控制效果。这对于保障液罐车的道路运输安全具有十分重要的意义。
本实施例还提供了一种基于MFAC算法的液罐车侧倾稳定性控制系统,包括:
液罐车侧倾稳定性影响因素确定单元,配置用于基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度;
液罐车侧倾稳定性控制单元,配置用于基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,罐车横摆角速度为被控量。
所述MFAC算法包括基于全格式动态线性化的MFAC算法。
应当理解,上述基于MFAC算法的液罐车侧倾控制系统记载的诸子系统或单元与上述基于MFAC算法的液罐车侧倾控制方法描述的各个步骤相对应。由此,上文针对方法描述的操作和特征同样适用于上述基于MFAC算法的液罐车侧倾控制系统的诸子系统及其中包含的单元,在此不再赘述。
以上描述仅为本申请的较佳实施例以及对所运用技术原理的说明。本领域技术人员应当理解,本申请中所涉及的发明范围,并不限于上述技术特征的特定组合而成的技术方案,同时也应涵盖在不脱离所述发明构思的情况下,由上述技术特征或其等同特征进行任意组合而形成的其它技术方案。例如上述特征与本申请中公开的(但不限于)具有类似功能。
Claims (6)
1.一种基于MFAC算法的液罐车侧倾稳定性控制方法,其特征是,包括以下步骤:
基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度,其中,液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系为:
其中,
ay为液罐车的车身侧向加速度;
V为液罐车行驶速度;
r为液罐车横摆角速度;
基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,液罐车横摆角速度为被控量,所述MFAC算法包括基于全格式动态线性化的MFAC算法,
基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,包括:
基于MFAC算法通过液罐车动力学系统的横摆角速度输出变化量、液罐车动力学系统的伪偏导数矩阵、滑动窗口内的系统输出和理论控制输入变化量矩阵之间的第三预设关系一,液罐车动力学系统的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二,液罐车动力学系统的理论控制输入、第二步长因子、液罐车动力学系统的伪偏导数矩阵、理想横摆角速度、车辆实际横摆角速度、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三,液罐车动力学系统的实际控制输入附加横摆力矩、液罐车动力学系统的理论控制输入之间的第三预设关系四,对行驶状态下的液罐车进行侧倾稳定性控制。
2.根据权利要求1所述的基于MFAC算法的液罐车侧倾稳定性控制方法,其特征是,液罐车动力学系统k+1时刻的横摆角速度输出变化量、液罐车动力学系统k时刻的伪偏导数矩阵、滑动时间窗口[k-ny+1,k]内的系统横摆角速度输出变化量和滑动时间窗口[k-nu+1,k]内的理论控制输入变化量所组成的矩阵之间的第三预设关系一为:
其中,
Δr(k+1)为液罐车动力学系统在k+1时刻的横摆角速度变化量;
Δu(k)为k时刻系统理论控制输入的变化量,Δu(k-nu+1)为k-nu+1时刻系统理论控制输入的变化量;
ny为控制输入线性化长度,nu为控制输出线性化长度。
4.根据权利要求1所述的基于MFAC算法的液罐车侧倾稳定性控制方法,其特征是,液罐车动力学系统k时刻的理论控制输入、液罐车动力学系统k-1时刻的理论控制输入、第二步长因子、液罐车动力学系统k时刻的伪偏导数矩阵、液罐车动力学系统k+1时刻的理想横摆角速度输出、液罐车动力学系统在k时刻的实际横摆角速度输出、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三为:
其中,
u(k)为k时刻的系统理论控制输入;
u(k-1)为k-1时刻的系统理论控制输入;
λ为权重因子;
ρ为第二步长因子;
ρi为第i个第二步长因子;
r*(k+1)为液罐车动力学系统在k+1时刻的理想横摆角速度输出;
r(k)为液罐车动力学系统在k时刻的实际横摆角速度输出;
Δr为滑动窗口内的系统横摆角速度输出变化量;
Δu为滑动窗口内的系统理论控制输入变化量;
5.根据权利要求1所述的基于MFAC算法的液罐车侧倾稳定性控制方法,其特征是,液罐车动力学系统k时刻的实际控制输入附加横摆力矩与理论控制输入之间的第三预设关系四为:
U(k)=amp×u(k),
其中:
U(k)为液罐车动力学系统在k时刻的实际控制输入量附加横摆力矩;
amp为扩充系数;
u(k)为k时刻的系统理论控制输入。
6.一种基于MFAC算法的液罐车侧倾稳定性控制系统,其特征是,包括:
液罐车侧倾稳定性影响因素确定单元,配置用于基于液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系及液罐车的车身侧向加速度与侧倾稳定性之间的第二预设关系,确定所述液罐车侧倾稳定性的影响因素包括液罐车的横摆角速度,其中,液罐车的车身侧向加速度、质心侧偏角速度、横摆角速度之间的第一预设关系为:
其中,
ay为液罐车的车身侧向加速度;
V为液罐车行驶速度;
r为液罐车横摆角速度;
液罐车侧倾稳定性控制单元,配置用于基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,其中,附加横摆力矩为控制输入量,液罐车横摆角速度为被控量,所述MFAC算法包括基于全格式动态线性化的MFAC算法,
基于MFAC算法通过附加横摆力矩与液罐车横摆角速度之间的第三预设关系对行驶状态下的液罐车进行侧倾稳定性控制,包括:
基于MFAC算法通过液罐车动力学系统的横摆角速度输出变化量、液罐车动力学系统的伪偏导数矩阵、滑动窗口内的系统输出和理论控制输入变化量矩阵之间的第三预设关系一,液罐车动力学系统的伪偏导数估计值、第一步长因子、滑动时间窗口内的系统输出和理论控制输入变化量矩阵、惩罚因子之间的第三预设关系二,液罐车动力学系统的理论控制输入、第二步长因子、液罐车动力学系统的伪偏导数矩阵、理想横摆角速度、车辆实际横摆角速度、权重因子、系统理论控制输入变化量、系统控制输出变化量之间的第三预设关系三,液罐车动力学系统的实际控制输入附加横摆力矩、液罐车动力学系统的理论控制输入之间的第三预设关系四,对行驶状态下的液罐车进行侧倾稳定性控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910756801.3A CN110395263B (zh) | 2019-08-16 | 2019-08-16 | 基于mfac算法的液罐车侧倾稳定性控制方法、系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910756801.3A CN110395263B (zh) | 2019-08-16 | 2019-08-16 | 基于mfac算法的液罐车侧倾稳定性控制方法、系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110395263A CN110395263A (zh) | 2019-11-01 |
CN110395263B true CN110395263B (zh) | 2020-08-11 |
Family
ID=68328460
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910756801.3A Active CN110395263B (zh) | 2019-08-16 | 2019-08-16 | 基于mfac算法的液罐车侧倾稳定性控制方法、系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110395263B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114454199B (zh) * | 2022-02-11 | 2024-02-23 | 吉林大学 | 一种基于数据控制算法的末端执行器及其设计方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4207698B2 (ja) * | 2003-07-17 | 2009-01-14 | 株式会社アドヴィックス | 車両の横転防止装置 |
KR101162495B1 (ko) * | 2006-01-19 | 2012-07-05 | 주식회사 만도 | 차량 안정성 제어 시스템의 횡가속도 추정 방법 |
CN105946863B (zh) * | 2016-06-23 | 2018-06-29 | 吉林大学 | 一种车辆行驶稳定性区域的确定方法 |
KR102429180B1 (ko) * | 2018-01-12 | 2022-08-03 | 현대자동차주식회사 | 차량 자세 제어 장치 및 방법 |
CN108657175B (zh) * | 2018-05-04 | 2020-08-11 | 合肥工业大学 | 一种基于gis系统的液罐车侧翻预警系统 |
CN109101697B (zh) * | 2018-07-18 | 2020-06-12 | 吉林大学 | 液罐汽车流-固耦合系统的整车动力学模型的建模方法 |
-
2019
- 2019-08-16 CN CN201910756801.3A patent/CN110395263B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110395263A (zh) | 2019-11-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8219282B2 (en) | System for dynamically determining vehicle rear/trunk loading for use in a vehicle control system | |
US8718872B2 (en) | Vehicle attitude controller | |
JP4631549B2 (ja) | 車両運動安定化制御装置 | |
US8718897B2 (en) | Vehicle dynamics control in electric drive vehicles | |
CN111267835B (zh) | 基于模型预测算法的四轮独立驱动汽车稳定性控制方法 | |
CN100358766C (zh) | 基于车轮纵向力的车辆行驶稳定性控制装置 | |
US7308351B2 (en) | Method for coordinating a vehicle dynamics control system with an active normal force adjustment system | |
CN108973986B (zh) | 一种基于汽车驾驶稳定区域的车辆操纵稳定性联合控制方法 | |
US11318804B2 (en) | Vehicle state estimation device, control device, suspension control device, and suspension device | |
JP4151389B2 (ja) | 車輌の挙動制御装置 | |
US20030100979A1 (en) | Enhanced system for yaw stability control system to include roll stability control function | |
US20020139599A1 (en) | Rollover stability control for an automotive vehicle using rear wheel steering and brake control | |
US9950702B2 (en) | Method for stabilizing the driving behavior of a tractor-trailer combination and vehicle movement dynamics control device | |
CN105026236A (zh) | 车辆的行驶运动控制装置 | |
JP4747722B2 (ja) | 車両の横転防止装置 | |
WO2020003550A1 (ja) | ステアリング制御装置及びステアリング装置 | |
US11548344B2 (en) | Suspension control device and suspension device | |
US6584396B2 (en) | Method for determining the lateral acceleration of a motor vehicle | |
CN110395263B (zh) | 基于mfac算法的液罐车侧倾稳定性控制方法、系统 | |
US8249790B2 (en) | Vehicle behavior control device | |
JP6553256B1 (ja) | ステアリング制御装置及びステアリング装置 | |
CN113525347A (zh) | 一种车辆控制方法、装置及计算机可读存储介质 | |
JP3872308B2 (ja) | 車輌の走行制御装置 | |
JP3400718B2 (ja) | 車両旋回運動制御装置 | |
Tao et al. | Research on Control Strategy of the Side Forklift Steering Movement Stability and Its Simulation Analysis |
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 |