CN107358679A - 一种基于新型模糊观测器的车辆质心侧偏角的估计方法 - Google Patents

一种基于新型模糊观测器的车辆质心侧偏角的估计方法 Download PDF

Info

Publication number
CN107358679A
CN107358679A CN201710446241.2A CN201710446241A CN107358679A CN 107358679 A CN107358679 A CN 107358679A CN 201710446241 A CN201710446241 A CN 201710446241A CN 107358679 A CN107358679 A CN 107358679A
Authority
CN
China
Prior art keywords
mrow
msub
mtd
mover
mtr
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
Application number
CN201710446241.2A
Other languages
English (en)
Other versions
CN107358679B (zh
Inventor
安广永
张长柱
陈启军
孙虹
沈梦娇
陈龙泉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tongji University
Original Assignee
Tongji University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Tongji University filed Critical Tongji University
Priority to CN201710446241.2A priority Critical patent/CN107358679B/zh
Publication of CN107358679A publication Critical patent/CN107358679A/zh
Application granted granted Critical
Publication of CN107358679B publication Critical patent/CN107358679B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G07CHECKING-DEVICES
    • G07CTIME OR ATTENDANCE REGISTERS; REGISTERING OR INDICATING THE WORKING OF MACHINES; GENERATING RANDOM NUMBERS; VOTING OR LOTTERY APPARATUS; ARRANGEMENTS, SYSTEMS OR APPARATUS FOR CHECKING NOT PROVIDED FOR ELSEWHERE
    • G07C5/00Registering or indicating the working of vehicles
    • G07C5/08Registering or indicating performance data other than driving, working, idle, or waiting time, with or without registering driving, working, idle or waiting time
    • G07C5/0808Diagnosing performance data
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/12Estimation 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 parameters of the vehicle itself, e.g. tyre models
    • B60W40/13Load or weight
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/12Estimation 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 parameters of the vehicle itself, e.g. tyre models
    • B60W40/13Load or weight
    • B60W2040/1315Location of the centre of gravity

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Other Investigation Or Analysis Of Materials By Electrical Means (AREA)

Abstract

本发明公布了一种基于新型模糊观测器的车辆质心侧偏角的估计方法,包括:首先,利用传感器检测车辆状态,具体为:利用横摆角传感器检测车辆行驶过程中的横摆角速度γ、利用速度传感器检测车辆行驶过程中的纵向轮速vx;接着,运用T‑S模糊建模的方法建立车辆系统的动力学模型,其中将车辆行驶过程中的前轮转角δf看作系统的外界扰动输入;然后,针对车辆动力学模型设计新型模糊观测器;最后,将测得的车辆的状态信息传递到设计的新型观测器中,运算估计得到质心侧偏角。本发明设计的新型模糊观测器有效的解决了因T‑S模糊建模出现的参数不匹配的问题,仿真实验也验证了该新型观测器的有效性。

Description

一种基于新型模糊观测器的车辆质心侧偏角的估计方法
技术领域
发明涉及一种基于新型模糊观测器的车辆质心侧偏角的估计方法,属于汽车行驶参数估计技术领域。
背景技术
随着社会经济与科学技术的发展,汽车在人们的日常生活和生产中扮演了越来越重的角色,因此消费者对其安全性能,驾驶体验等方面提出了更高的要求,为了提高车辆的操作稳定性,避免车辆失稳,汽车的主动安全控制方法被越来越多的应用到车辆系统中。这些主动安全控制方法主要包括车身电子稳定系统(ESP)、主动前轮转向技术(AFS)等,这些车辆主动安全控制技术均依赖于对车辆质心侧偏角的准确估计。
虽然存在相应的传感器可以直接测量车辆的质心侧偏角,但这些传感器往往造价昂贵,难以在量产的车辆设计与制造中被选用。从节约成本与开发方便的角度上,基于状态观测器估计车辆质心侧偏角的方法得到了大量的应用,然而传统的观测器一般为线性观测器,在系统模型精度可知,外部扰动较小的情况下,线性观测器可以较好地实现系统状态的估计。但是,当存在较强外部扰动和模型不确定性的情况下,传统的观测器很难保证系统具有较小的稳态观测误差。而车辆控制系统是一个典型的非线性控制系统,具有较大的外部随机干扰以及系统本身内在的非线性强耦合特性。因此,车辆质心侧偏角的估计对观测器的设计提出来更高的要求,需要引入新的质心侧偏角估计方法实现其精度和高效的实时估计。基于此,本发明提出一种有效解决了测量误差、参数不确定问题的车辆质心侧偏角估计方法。
发明内容
本发明所要解决的技术问题是针对现有技术存在的缺陷提供一种基于新型模糊观测器的车辆质心侧偏角的估计方法,以一种低成本的方式精确估计车辆系统的质心侧偏角,实现本发明的技术方案如下:
一种基于新型模糊观测器的车辆质心侧偏角的估计方法,包括:
步骤1:利用传感器检测车辆状态,包括:利用横摆角传感器检测车辆行驶过程中的横摆角速度γ;利用速度传感器检测车辆行驶过程中的纵向轮速vx
步骤2:运用T-S模糊建模的方法建立车辆系统的动力学模糊模型,其中将车辆行驶过程中的前轮转角δf看作系统的外界扰动输入;
步骤3:针对车辆动力学模型设计新型的观测器;
步骤4:基于所述前轮转角δf看作系统的外界扰动输入和设计获得的新型观测器构建测量误差系统,将测得的车辆的状态信息传递到设计的新型观测器中,测量误差系统运算估计得到质心侧偏角,即对于在行驶过程中方向盘转动一定角度情况下实时估计质心侧偏角。
进一步公开,所述步骤2中的车辆系统的动力学模型采用模糊模型,其建立的过程包括:
步骤2.1,车辆二自由度动力学模型为
其中,m为汽车质量,γ为车辆的横摆角速度,β为质心侧偏角,δf为车辆的前轮转角,Iz为整车绕轴的转动惯量,lf为车辆前轴到质心的距离,lr为车辆后轴到质心的距离,vx为纵向速度,Fxf,Fyf,Fxr,Fyr分别表示前轮纵向力、前轮横向力、后轮纵向力、后轮横向力, 分别表示前轮、后轮的准静态力。
在车辆高速行驶过程中,前轮转角δf比较小,接近于零。当δf趋近于零时,sinδf趋近于0,cosδf趋近于1,可以将方程(1)简化为:
根据1991年,由Pacejka提出的Magic formula轮胎经验模型,定义
其中
σf,σr分别表示前轮和后轮轮胎的侧偏松弛长度,σf,σr是由前轮和后轮的侧向弹性决定的,本发明中选取σf=0.5m,σr=0.2m。
分别表示前轮、后轮的准静态力,定义为:
其中,sign为符号函数,参数ce1,ce2,ce3与行驶路面有关,具体数值可通过实验测得。
车辆前轮的侧偏角αf与车辆后轮的侧偏角αr可以表达成
通过方程(2),(3)我们可以得到:
通过定义联合公式(3)(4)(5),将所述车辆二自由度动力学模型(1)进一步写成状态空间形式的车辆动力学模型,则表达式为
其中
x(t)=[β γ Fyf Fyr]T,ω(t)=δf
本模型中将前轮的转角δf看作外界的扰动ω(t)。
步骤2.2,利用T-S模糊建模方法对所述状态空间形式的车辆动力学模型(6)进一步改写为状态空间形式的车辆动力学模糊模型。因为在模型(6)中Cff)Crr)是非线性 函数,增加了系统稳定性分析的难度,因此本发明采用模糊建模的方法将Cff)Crr) 部线性化处理,处理过程具体为:
首先选取前提变量,选取矩阵A中的Cff),Crr)为前提变量,为了简化书写定义ξ1=Cff),ξ2=Crr)。
接着将非线性函数Cff)Crr)函数转化为线性函数:
Cff)=M11)Cfmax+M21)Cfmin (7)
Crr)=N12)Crmax+N22)Crmin (8)
其中M11),M21),N12),N22)是模糊隶属度函数,被定义为
Cfmax,Cfmin,Crmax,Crmin,分别对应着Cff),Crr)的
最大值和最小值。
接着制定模糊规则:
Fuzzy Rule i:IF ξ1 is Mj and ξ2 is Nj,
THEN x(t)=Aix(t)+Biω(t)
其中为了简化书写定义ξ1=Cff),ξ2=Crr)。矩阵Ai和Bi,i=1,2...4.分别是用Cfmax,Cfmin,Crmax,Crmin将模型(6)中矩阵A和B中的Cff),Crr)替换后得到,Mj,Nj j=1,2;表示模糊集。
根据模糊规则,模型(6)可以转化为车辆的模糊模型为
其中y(t)是测量输出,横摆角速度γ可以使用惯性导航直接测量,所以选取C=[01 0 0],v(t)是范数有界的测量干扰误差。为了观测β的值,所以选取H=[1 0 0 0]使观测输出z(t)=β。hi(ξ)≥0,i=1.2.3.4,至此,车辆的模糊模型设计完毕。
进一步公开,所述步骤3中设计新型观测器:采用车辆动力学模型的输出y(t)作为反馈量来设计本发明新型观测器,具体为:
根据输出y(t)与模糊模型(9)可以设计观测器去估计质心侧偏角,注意到在模型(9)中的前提变量ξ1,ξ2是不可测量的,因此在观测器的设计中就不能继续使用这两个前提变量,而是使用ξ1和ξ2的估计值具体的值可对方程(7)(8)中ξ1和ξ2估计后得到。
建立新型观测器的表达式:
其中表示对x的估计值,Li为观测器增益,zf(t)为对β的估计值H=[1 0 0 0],至此,求出Li观测器增益,则观测器设计完毕。
进一步公开,根据所述步骤3中设计的新型观测器建立观测误差系统,步骤4具体为:
定义估计误差
我们注意到对于这一项存在着ξ1之间参数不匹配的情况,为此本发明提出使之简化的数学处理方法:
我们可以定义,因为x(t)与w(t)在具体的稳定系统中也是范数有界的,因此定义的函数是范数有界的,则可以将这个函数看作外界干扰,这样就很好的解决了参数不匹配的问题。由此,进一步公开可以得到估计误差系统表达式为:
其中为目标输出,He(t)即输出侧偏角的测量值与估计值的误差,H为常数矩阵,
H=[1 0 0 0]
为系统外界干扰。
以上建立观测误差系统主要目的是为了保证观测器的设计是稳定的,即建立的观测器是一个稳定的系统。只有先保证稳定然后才使用这个观测器去估计,在稳定这个限制条件下得到较为准确的估计值。
验证步骤
为此,进一步公开,在使用Lyapunov法证明步骤4中的观测误差系统稳定且满足H性能指标后,可以从模糊观测器中得到车辆质心侧偏角的估计值其过程包括:
步骤5.1,证明步骤4中的测量误差系统渐近稳定,包括选取Lyapunov函数V(t)=eT(t)Pe(t),证明
其中P为正定矩阵,z(t)为误差系统输出,τ>0为H扰动衰减水平,为误差系统外界扰动。
步骤5.2,对于一个给定的τ>0,满足具体包括使用Matlab软件中的LMI工具包求解一下LMI问题:
minτ2
其中定义Yi=PLi,程序求解可以得到观测器的增益Li=P-1Yi
本发明的有益效果
1、本发明设计的新型观测器是基于二自由度的车辆动力学模型建立起来的,并通过T-S模糊建模方法对车辆的动力学模型进行了建模,与完整的七自由度车辆模型相比,本发明采用的模糊模型对车辆质心侧偏角进行了模型简化,更便于列写质心侧偏角的状态方程,便于观测器设计。
2.在系统建模时,将模型中的前轮转角作为系统的扰动。在车辆的行驶过程中,质心的侧偏角是衡量车辆状态是否安全的重要参数,特别是高速行驶时方向盘的转角会对质心侧偏角的影响比重较大,因此,在建模过程中将模型中的前轮转角作为系统的扰动,提高了模型的准确性,而大多传统的估计方法需要提前检测车辆的前轮转角。
3、在测量误差系统分析上进行了与传统方法不同的处理,具体为将测量误差中出现的参数不匹配的项看作为误差,这样大大简化了误差系统稳定的限定条件,增强了观测器的鲁棒性。
附图说明
图1为本发明的单轨车辆模型图;
图2为本发明的系统结构框图;
图3为本发明中模糊观测器观测效果图。
图4为本发明中模糊观测器观测误差图。
图5为本发明方法过程示意图。
具体实施方式
本发明提供了一种基于新型模糊观测器的车辆侧偏角估计方法,为使本发明的目的、技术方案及效果更加清楚、明确,以下将结合本发明实施实例中的技术方案进行清楚、完整的描述。
本发明的质心侧偏角估计方法是基于车身电子稳定系统(ESP)所用的常规传感器,如测速传感器、橫摆角速度传感器、加速度传感器、方向盘转角传感器等设计的,需要通过这些传感器测量车辆运行状态作为状态观测器模块的输入信号以估计车辆质心侧偏角。
下面通过具体实施实例来解释本发明对车辆质心侧偏角的估计方法:
第一步:利用传感器检测车辆状态
设计观测器估计车辆的质心侧偏角,首先应该利用车辆中已安装的传感器检测出车辆的纵向速度vx、橫摆角速度γ。利用横摆角传感器检测车辆行驶过程中的横摆角速度γ;利用速度传感器检测车辆行驶过程中的纵向轮速vx
第二步:运用T-S模糊建模的方法建立车辆系统的动力学模型
本发明的核心在于设计观测器以及对测量误差系统的分析,而观测器设计的基础在于车辆模型的结构。因此,首先应建立起车辆系统的数学模型,其中将车辆行驶过程中的前轮转角δf看作系统的外界扰动输入,即对于在行驶过程中方向盘转动一定角度情况下实时估计质心侧偏角。具体为:
车辆二自由度动力学模型的表达式
其中,m为车辆质量,γ为车辆的横摆角速度,β为质心侧偏角,δf为车辆的前轮转角,Iz为整车绕轴的转动惯量,lf为车辆前轴到质心的距离,lr为车辆后轴到质心的距离,vx为纵向速度,Fxf,Fyf,Fxr,Fyr分别表示前轮纵向力、前轮横向力、后轮纵向力、后轮横向力, 分别表示前轮、后轮的准静态力。
将其转化为状态空间形式,表达为
其中
x(t)=[β(t) γ(t) Fyf Fyr]T
其中αf,αr分别为前轮和后轮的侧偏角,σf,σr分别表示前轮和后轮轮胎的侧偏松弛长度,σf,σr是由前轮和后轮的侧向弹性决定的,本发明中选取σf=0.5m,σr=0.2m。分别表示前轮、后轮的准静态力,定义
接着利用T-S模糊建模方法对(1)的车辆二自由度动力学模型进行表达,包括:首先选取前提变量,具体为选取矩阵A中的Cff),Crr)为前提变量,
接着引入模糊隶属度函数:
Cff)=M11)Cfmax+M21)Cfmin
Crr)=N12)Crmax+N22)Crmin
其中
Cfmax,Cfmin,Crmax,Crmin,分别对应着Cff),Crr)的最大值和最小值。
接着制定模糊规则
Fuzzy Rule i:IF ξ1 is Mj and ξ2 is Nj,
THEN x(t)=Aix(t)+Biω(t)
其中矩阵Ai和Bi,j=1,2;i=1,2...4.分别是用Cii)min,Cii)max,i=r,f.将矩阵A和B中的Cii)替换后得到,模糊隶属度函数并定义为“Big”和“Small”,M1,N1表示“Big”,M2,N2表示“Small”。
接着得到状态空间形式的车辆动力学模型:
其中y(t)是测量输出,C=[0 1 0 0],v(t)是范数有界的测量干扰误差,z(t)=β(t),H=[1 0 0 0],hi(ξ)≥0,i=1...4,
所述步骤3中设计新型观测器的方法包括:将车辆动力学模型的输出y(t)作为反馈量设计模糊观测器,建立新型观测器的表达式:
其中表示对x的观测值,Li为观测器增益,zf(t)为对β的估计值H=[1 0 0 0]。
进一步公开,我们可以定义,因为x(t)与w(t)在具体的稳定系统中也是范数有界的,因此定义的函数是范数有界的,则可以将这个函数看作外界干扰,这样就很好的解决了参数不匹配的问题,根据所述步骤3中设计的新型观测器建立观测误差系统,其表达式为:
其中为目标输出,H为常数矩阵,
H=[1 0 0 0]
验证实施例
进一步公开,在使用Lyapunov法证明步骤4中的观测误差系统稳定且满足H性能指标后,可以得到车辆质心侧偏角的估计值其过程包括:
证明步骤4中的测量误差系统渐近稳定,包括选取Lyapunov函数V(t)=eT(t)Pe(t),P为正定矩阵,证明具体为:
即只需证明不等式(4)中的
接着,对于一个给定的τ>0,满足具体包括使用Matlab软件中的LMI工具包求解一个LMI问题:
minτ2
其中定义Yi=PLi,程序求解可以得到观测器的增益Li=P-1Yi
综上所述,新型观测器的构造主要包括两个步骤。第一,建立车辆系统的T-S模糊模型,将车辆的系统参数输入到模型中,将模型具体化。第二,针对车辆动力学模型设计新型观测器的表达式。
第三步:将检测的车辆状态信息传递到设计的新型观测器中,估计出质心侧偏角。
本发明实施实例中采用的车辆参数如表1所示。
定义 符号 值(单位)
车辆重量 m 1530kg
重力加速度 g 9.8m/s2
转动惯量 Iz 2315.3kg.m2
车辆前轴到质心距离 lf 1.11m
车辆后轴到质心距离 lr 1.67m
前面两个步骤已经检测到了车辆的状态信息,并得到了观测器的基本结构,第三步主要是将各个传感器检测到的状态信息传递到观测器中通过观测器的输出即可得到车辆的质心侧偏角的估计值。
在本发明实例的仿真实验工况下,观测器的观测反馈偏差曲线如图3所示。由图4得出:本发明设计的车辆质心侧偏角观测器观测误差较小,能够实现对质心侧偏角的精确观测。

Claims (5)

1.一种基于新型模糊观测器的车辆质心侧偏角的估计方法,其特征在于,包括步骤:
步骤1:利用传感器检测车辆状态,包括:利用横摆角传感器检测车辆行驶过程中的横摆角速度γ;利用速度传感器检测车辆行驶过程中的纵向轮速vx
步骤2:运用T-S模糊建模的方法建立车辆系统的动力学模糊模型,其中将车辆行驶过程中的前轮转角δf看作系统的外界扰动输入;
步骤3:针对车辆动力学模型设计新型的观测器;
步骤4:基于所述前轮转角δf看作系统的外界扰动输入和设计获得的新型观测器构建测量误差系统,将测得的车辆的状态信息传递到设计的新型观测器中,测量误差系统运算估计得到质心侧偏角。
2.如权利要求1所述的方法,其特征在于,所述步骤2中的车辆系统的动力学模型采用模糊模型,其建立的过程包括:
步骤2.1,车辆二自由度动力学模型为
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>mv</mi> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>+</mo> <mi>&amp;gamma;</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>F</mi> <mrow> <mi>x</mi> <mi>f</mi> </mrow> </msub> <msub> <mi>sin&amp;delta;</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <msub> <mi>cos&amp;delta;</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>I</mi> <mi>z</mi> </msub> <mover> <mi>&amp;gamma;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>x</mi> <mi>f</mi> </mrow> </msub> <msub> <mi>sin&amp;delta;</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <msub> <mi>cos&amp;delta;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中,m为汽车质量,γ为车辆的横摆角速度,β为质心侧偏角,δf为车辆的前轮转角,Iz为整车绕轴的转动惯量,lf为车辆前轴到质心的距离,lr为车辆后轴到质心的距离,vx为纵向速度,Fxf,Fyf,Fxr,Fyr分别表示前轮纵向力、前轮横向力、后轮纵向力、后轮横向力, 分别表示前轮、后轮的准静态力;
在车辆高速行驶过程中,前轮转角δf比较小,接近于零。当δf趋近于零时,sinδf趋近于0,cosδf趋近于1,可以将方程(1)简化为:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <msub> <mi>mv</mi> <mi>x</mi> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mi>&amp;gamma;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>&amp;gamma;</mi> <mo>&amp;CenterDot;</mo> </mover> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> <mrow> <mo>(</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>
定义
<mrow> <msub> <mover> <mi>F</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>=</mo> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>,</mo> <msub> <mover> <mi>F</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>r</mi> </msub> </mfrac> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>
其中
σf,σr分别表示前轮和后轮轮胎的侧偏松弛长度,σf,σr是由前轮和后轮的侧向弹性决定的,本发明中选取σf=0.5m,σr=0.2m;
分别表示前轮、后轮的准静态力,定义为:
<mrow> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>=</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mfrac> <mrow> <msub> <mi>mgl</mi> <mi>r</mi> </msub> </mrow> <mrow> <msub> <mi>l</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mrow> <mn>1</mn> <mo>-</mo> <msup> <mi>e</mi> <mrow> <mo>-</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>|</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>|</mo> </mrow> </mrow> </msup> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>3</mn> </mrow> </msub> <mo>|</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>|</mo> <mo>)</mo> </mrow> <mo>,</mo> </mrow>
<mrow> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>=</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mfrac> <mrow> <msub> <mi>mgl</mi> <mi>r</mi> </msub> </mrow> <mrow> <msub> <mi>l</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>1</mn> </mrow> </msub> <mo>(</mo> <mrow> <mn>1</mn> <mo>-</mo> <msup> <mi>e</mi> <mrow> <mo>-</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>2</mn> </mrow> </msub> <mrow> <mo>|</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>|</mo> </mrow> </mrow> </msup> </mrow> <mo>)</mo> <mo>-</mo> <msub> <mi>c</mi> <mrow> <mi>e</mi> <mn>3</mn> </mrow> </msub> <mo>|</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>|</mo> <mo>)</mo> </mrow> <mo>,</mo> </mrow> 1
其中,sign为符号函数,参数ce1,ce2,ce3与行驶路面有关,具体数值可通过实验测得;
车辆前轮的侧偏角αf与车辆后轮的侧偏角αr可以表达成
<mrow> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>=</mo> <msub> <mi>&amp;delta;</mi> <mi>f</mi> </msub> <mo>-</mo> <mi>&amp;beta;</mi> <mo>-</mo> <mfrac> <mrow> <msub> <mi>l</mi> <mi>f</mi> </msub> <mi>&amp;gamma;</mi> </mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> </mfrac> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mo>=</mo> <mo>-</mo> <mi>&amp;beta;</mi> <mo>+</mo> <mfrac> <mrow> <msub> <mi>l</mi> <mi>r</mi> </msub> <mi>&amp;gamma;</mi> </mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> </mfrac> <mo>,</mo> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>4</mn> <mo>)</mo> </mrow> </mrow>
通过方程(2),(3)可以得到:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>&amp;beta;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&amp;gamma;</mi> <mo>&amp;CenterDot;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>F</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>F</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <mrow> <msub> <mi>mv</mi> <mi>x</mi> </msub> </mrow> </mfrac> <mrow> <mo>(</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> <mo>-</mo> <mi>&amp;gamma;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <mn>1</mn> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> <mrow> <mo>(</mo> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>f</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>r</mi> </msub> </mfrac> <mrow> <mo>(</mo> <mo>-</mo> <msub> <mi>F</mi> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>F</mi> <mo>&amp;OverBar;</mo> </mover> <mrow> <mi>y</mi> <mi>r</mi> </mrow> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>
通过定义联合公式(3)(4)(5),将所述车辆二自由度动力学模型(1)进一步写成状态空间形式的车辆动力学模型,则表达式为
<mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>A</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>B</mi> <mi>&amp;omega;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
其中
x(t)=[β γ Fyf Fyr]T,ω(t)=δf
<mrow> <mi>A</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> <mtd> <mfrac> <mn>1</mn> <mrow> <msub> <mi>mv</mi> <mi>x</mi> </msub> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mn>1</mn> <mrow> <msub> <mi>mv</mi> <mi>x</mi> </msub> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mfrac> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>I</mi> <mi>z</mi> </msub> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>C</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>l</mi> <mi>f</mi> </msub> <msub> <mi>C</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;sigma;</mi> <mi>r</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <msub> <mi>l</mi> <mi>r</mi> </msub> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;sigma;</mi> <mi>r</mi> </msub> </mfrac> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mfrac> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>&amp;sigma;</mi> <mi>r</mi> </msub> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> <mi>B</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>v</mi> <mi>x</mi> </msub> <msub> <mi>C</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> </mrow> <msub> <mi>&amp;sigma;</mi> <mi>f</mi> </msub> </mfrac> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>
本模型中将前轮的转角δf看作外界的扰动ω(t);
步骤2.2,利用T-S模糊建模方法对所述状态空间形式的车辆动力学模型(6)进一步改写为状态空间形式的车辆动力学模糊模型;
本发明采用模糊建模的方法对Cff)Crr)局部线性化处理,处理过程具体为:
首先选取前提变量,选取矩阵A中的Cff),Crr)为前提变量,为了简化书写定义ξ1=Cff),ξ2=Crr);
接着将非线性函数Cff)Crr)函数转化为线性函数:
Cff)=M11)Cfmax+M21)Cfmin (7)
Crr)=N12)Crmax+N22)Crmin (8)
其中M11),M21),N12),N22)是模糊隶属度函数,被定义为
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>M</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>m</mi> <mi>i</mi> <mi>n</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>max</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>min</mi> </mrow> </msub> </mrow> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>M</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>f</mi> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>f</mi> <mi>m</mi> <mi>i</mi> <mi>n</mi> </mrow> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> 2
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>N</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>min</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>min</mi> </mrow> </msub> </mrow> </mfrac> </mrow> </mtd> <mtd> <mrow> <msub> <mi>N</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;xi;</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfrac> <mrow> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>&amp;alpha;</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mrow> <mi>r</mi> <mi>min</mi> </mrow> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced>
Cfmax,Cfmin,Crmax,Crmin,分别对应着Cff),Crr)的
最大值和最小值。
接着制定模糊规则:
Fuzzy Rule i:IF ξ1 is Mj and ξ2 is Nj,
THEN x(t)=Aix(t)+Biω(t)
其中为了简化书写定义ξ1=Cff),ξ2=Crr)。矩阵Ai和Bi,i=1,2...4.分别是用Cfmax,Cfmin,Crmax,Crmin将模型(6)中矩阵A和B中的Cff),Crr)替换后得到,Mj,Nj j=1,2;表示模糊集。
根据模糊规则,模型(6)可以转化为车辆的模糊模型为
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <msub> <mi>h</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;xi;</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mi>x</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> <mi>&amp;omega;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>C</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>z</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>H</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>
其中y(t)是测量输出,横摆角速度γ可以使用惯性导航直接测量,所以选取C=[0 1 00],v(t)是范数有界的测量干扰误差。为了观测β的值,所以选取H=[1 0 0 0]使观测输出z(t)=β。hi(ξ)≥0,i=1.2.3.4,
3.如权利要求1所述的方法,其特征在于,所述步骤3中设计新型观测器:采用车辆动力学模型的输出y(t)作为反馈量来设计本发明新型观测器。
4.如权利要求3所述的方法,其特征在于,具体方法为:
根据输出y(t)与模糊模型(9)可以设计观测器去估计质心侧偏角,
ξ1和ξ2由估计值代替;具体的值可对方程(7)(8)中ξ1和ξ2估计后得到。
建立新型观测器的表达式:
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <msub> <mi>h</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mover> <mi>&amp;xi;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>&amp;lsqb;</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>L</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>y</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>-</mo> <mover> <mi>y</mi> <mo>^</mo> </mover> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>y</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>C</mi> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mi>f</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>H</mi> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>
其中表示对x的估计值,Li为观测器增益,zf(t)为对β的估计值H=[1 0 0 0],i=1.2.3.4,
5.如权利要求1所述的方法,其特征在于,所述步骤4:
根据设计的新型观测器建立观测误差系统,具体为:
定义估计误差
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>e</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <mover> <mi>x</mi> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mover> <mover> <mi>x</mi> <mo>^</mo> </mover> <mo>&amp;CenterDot;</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mi>h</mi> <mrow> <mo>(</mo> <mi>&amp;xi;</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mi>x</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>+</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> <mi>&amp;omega;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>-</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mi>h</mi> <mrow> <mo>(</mo> <mover> <mi>&amp;xi;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>{</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>L</mi> <mi>i</mi> </msub> <mo>&amp;lsqb;</mo> <mi>C</mi> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>C</mi> <mover> <mi>x</mi> <mo>^</mo> </mover> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>}</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mi>h</mi> <mrow> <mo>(</mo> <mi>&amp;xi;</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mo>+</mo> <msub> <mi>L</mi> <mi>i</mi> </msub> <mi>C</mi> <mo>)</mo> </mrow> <mi>e</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>-</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mi>h</mi> <mrow> <mo>(</mo> <mover> <mi>&amp;xi;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> <mi>&amp;omega;</mi> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <mo>+</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mi>h</mi> <mrow> <mo>(</mo> <mover> <mi>&amp;xi;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <msub> <mi>L</mi> <mi>i</mi> </msub> <mi>v</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <msubsup> <mo>&amp;Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </msubsup> <mo>&amp;lsqb;</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>&amp;xi;</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>h</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mover> <mi>&amp;xi;</mi> <mo>^</mo> </mover> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> <mo>&amp;lsqb;</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mi>x</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> <mi>&amp;omega;</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&amp;rsqb;</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
给出简化的数学处理方法:
定义因为x(t)与w(t)在具体的稳定系统中也是范数有界的,因此定义的函数是范数有界的,则可以将这个函数看作外界干扰,得到估计误差系统表达式为:
其中 为目标输出,He(t)输出侧偏角的测量值与估计值的误差,H为常数矩阵,
<mrow> <msub> <mover> <mi>A</mi> <mo>&amp;OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>A</mi> <mi>i</mi> </msub> <mo>-</mo> <msub> <mi>L</mi> <mi>i</mi> </msub> <mi>C</mi> <mo>,</mo> </mrow>
<mrow> <msub> <mover> <mi>B</mi> <mo>&amp;OverBar;</mo> </mover> <mi>i</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>I</mi> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>B</mi> <mi>i</mi> </msub> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>L</mi> <mi>i</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
H=[1 0 0 0]
为系统外界干扰。
CN201710446241.2A 2017-06-14 2017-06-14 一种基于新型模糊观测器的车辆质心侧偏角的估计方法 Active CN107358679B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710446241.2A CN107358679B (zh) 2017-06-14 2017-06-14 一种基于新型模糊观测器的车辆质心侧偏角的估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710446241.2A CN107358679B (zh) 2017-06-14 2017-06-14 一种基于新型模糊观测器的车辆质心侧偏角的估计方法

Publications (2)

Publication Number Publication Date
CN107358679A true CN107358679A (zh) 2017-11-17
CN107358679B CN107358679B (zh) 2019-10-18

Family

ID=60273921

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710446241.2A Active CN107358679B (zh) 2017-06-14 2017-06-14 一种基于新型模糊观测器的车辆质心侧偏角的估计方法

Country Status (1)

Country Link
CN (1) CN107358679B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108287934A (zh) * 2017-12-11 2018-07-17 江苏大学 一种基于纵向力观测器的车辆质心侧偏角鲁棒估计方法
CN108454628A (zh) * 2018-04-17 2018-08-28 吉林大学 一种驾驶员在环的人车协同转向滚动优化控制方法
CN109606466A (zh) * 2018-11-29 2019-04-12 广东工业大学 一种四轮独立驱动电动车辆的主动转向控制方法
CN111186445A (zh) * 2020-01-20 2020-05-22 北京主线科技有限公司 自动驾驶车辆横向控制方法及其系统
CN111361571A (zh) * 2020-02-13 2020-07-03 江苏大学 一种基于gpi的同时估计车辆质心侧偏角和扰动的方法
CN113183950A (zh) * 2021-05-11 2021-07-30 江苏大学 一种电动汽车主动前轮转向的自适应控制方法
CN114692418A (zh) * 2022-04-07 2022-07-01 深圳技术大学 质心侧偏角估计方法、装置、智能终端及存储介质
CN115422764A (zh) * 2022-09-22 2022-12-02 西北工业大学太仓长三角研究院 一种基于无源性的侧向车速估计方法
CN116729407A (zh) * 2023-08-15 2023-09-12 蘑菇车联信息科技有限公司 车辆横向速度检测方法、电子设备及存储介质

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009006214A1 (de) * 2009-01-27 2010-07-29 Volkswagen Ag Verfahren zum Bereitstellen einer Umfeldrepräsentation eines Fahrzeugs
CN102529976A (zh) * 2011-12-15 2012-07-04 东南大学 一种基于滑模观测器的车辆运行状态非线性鲁棒估计方法
CN105835889A (zh) * 2016-04-12 2016-08-10 江苏大学 一种基于二阶滑模观测器的车辆质心侧偏角的估计方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009006214A1 (de) * 2009-01-27 2010-07-29 Volkswagen Ag Verfahren zum Bereitstellen einer Umfeldrepräsentation eines Fahrzeugs
CN102529976A (zh) * 2011-12-15 2012-07-04 东南大学 一种基于滑模观测器的车辆运行状态非线性鲁棒估计方法
CN105835889A (zh) * 2016-04-12 2016-08-10 江苏大学 一种基于二阶滑模观测器的车辆质心侧偏角的估计方法

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108287934A (zh) * 2017-12-11 2018-07-17 江苏大学 一种基于纵向力观测器的车辆质心侧偏角鲁棒估计方法
CN108454628A (zh) * 2018-04-17 2018-08-28 吉林大学 一种驾驶员在环的人车协同转向滚动优化控制方法
CN108454628B (zh) * 2018-04-17 2019-06-04 吉林大学 一种驾驶员在环的人车协同转向滚动优化控制方法
CN109606466A (zh) * 2018-11-29 2019-04-12 广东工业大学 一种四轮独立驱动电动车辆的主动转向控制方法
CN109606466B (zh) * 2018-11-29 2021-10-19 广东工业大学 一种四轮独立驱动电动车辆的主动转向控制方法
CN111186445A (zh) * 2020-01-20 2020-05-22 北京主线科技有限公司 自动驾驶车辆横向控制方法及其系统
CN111361571B (zh) * 2020-02-13 2022-12-16 江苏大学 一种基于gpi的同时估计车辆质心侧偏角和扰动的方法
CN111361571A (zh) * 2020-02-13 2020-07-03 江苏大学 一种基于gpi的同时估计车辆质心侧偏角和扰动的方法
CN113183950A (zh) * 2021-05-11 2021-07-30 江苏大学 一种电动汽车主动前轮转向的自适应控制方法
CN113183950B (zh) * 2021-05-11 2024-03-19 江苏大学 一种电动汽车主动前轮转向的自适应控制方法
CN114692418A (zh) * 2022-04-07 2022-07-01 深圳技术大学 质心侧偏角估计方法、装置、智能终端及存储介质
CN115422764A (zh) * 2022-09-22 2022-12-02 西北工业大学太仓长三角研究院 一种基于无源性的侧向车速估计方法
CN115422764B (zh) * 2022-09-22 2023-11-24 西北工业大学太仓长三角研究院 一种基于无源性的侧向车速估计方法
CN116729407A (zh) * 2023-08-15 2023-09-12 蘑菇车联信息科技有限公司 车辆横向速度检测方法、电子设备及存储介质
CN116729407B (zh) * 2023-08-15 2023-11-28 蘑菇车联信息科技有限公司 车辆横向速度检测方法、电子设备及存储介质

Also Published As

Publication number Publication date
CN107358679B (zh) 2019-10-18

Similar Documents

Publication Publication Date Title
CN107358679B (zh) 一种基于新型模糊观测器的车辆质心侧偏角的估计方法
CN105946858B (zh) 基于遗传算法的四驱电动汽车状态观测器参数优化方法
CN105835889B (zh) 一种基于二阶滑模观测器的车辆质心侧偏角的估计方法
Zhao et al. Design of a nonlinear observer for vehicle velocity estimation and experiments
CN102730000B (zh) 车辆动态质心的计算方法、横摆力矩的计算方法和系统
CN104077459B (zh) 一种基于悬架kc特性的汽车底盘操稳性能分析模型建立方法
CN110341714B (zh) 一种同时估计车辆质心侧偏角和扰动的方法
Wei et al. Vehicle sideslip angle estimation based on general regression neural network
JPH06273187A (ja) 車体重心スリップ角計測装置
CN103279675B (zh) 轮胎-路面附着系数与轮胎侧偏角的估计方法
Jia et al. Model-based estimation for vehicle dynamics states at the limit handling
Huang et al. Calculation algorithm of tire‐road friction coefficient based on limited‐memory adaptive extended Kalman filter
Zhao et al. Distributed and self-adaptive vehicle speed estimation in the composite braking case for four-wheel drive hybrid electric car
Xu et al. Estimation of road friction coefficient and vehicle states by 3‐DOF dynamic model and HSRI model based on information fusion
CN115406446A (zh) 基于神经网络与无迹卡尔曼滤波的多轴特种车状态估计方法
Song et al. Reliable estimation of automotive states based on optimized neural networks and moving horizon estimator
CN111361571B (zh) 一种基于gpi的同时估计车辆质心侧偏角和扰动的方法
Liu et al. Vehicle State estimation based on adaptive fading unscented Kalman filter
Li et al. Vehicle velocity estimation for real-time dynamic stability control
Shao et al. Nonlinear adaptive observer for side slip angle and road friction estimation
McBride et al. Estimation of vehicle tire-road contact forces: A comparison between artificial neural network and observed theory approaches
Fouka et al. Motorcycle state estimation and tire cornering stiffness identification applied to road safety: Using observer-based identifiers
Huang et al. Estimation of sideslip angle based on extended Kalman filter
CN108413923B (zh) 一种基于鲁棒混合滤波的车辆侧倾角与俯仰角估计方法
CN105953998A (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