CN113460056A - 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 - Google Patents
一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 Download PDFInfo
- Publication number
- CN113460056A CN113460056A CN202110884295.3A CN202110884295A CN113460056A CN 113460056 A CN113460056 A CN 113460056A CN 202110884295 A CN202110884295 A CN 202110884295A CN 113460056 A CN113460056 A CN 113460056A
- Authority
- CN
- China
- Prior art keywords
- representing
- wheel
- vehicle
- tire
- matrix
- 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
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
- 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/02—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 ambient conditions
- B60W40/06—Road conditions
- B60W40/064—Degree of grip
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/15—Correlation function computation including computation of convolution operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/18—Braking system
- B60W2510/182—Brake pressure, e.g. of fluid or between pad and disc
-
- 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/10—Longitudinal speed
-
- 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
- B60W2530/00—Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Abstract
本发明属于汽车技术领域,具体的说是一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法。包括以下步骤:步骤一、基于车辆动力学模型对车辆的状态参数进行求解;步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;步骤三、采用最小二乘法对路面附着系数进行了估计;步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。本发明有效地降低了轮胎力观测值的不确定性,能够精确的估计在车辆滑移率较高时的路面附着系数,在车辆滑移率较低时对估计的路面附着系数结果进行合理的修正。
Description
技术领域
本发明属于汽车技术领域,具体的说是一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法。
背景技术
智能电动汽车在地面上行驶一方面受到车辆底层驱动系统的驱动力和制动系统的制动力限制,另一方面也受到不同路面附着条件的约束。路面附着系数是车—路系统中最为关键的参数之一,它对智能电动汽车的行驶安全性能有着至关重要的影响。
依托车载摄像头、激光雷达、超声波雷达等是近年来进行路面识别的一种新的方法,但是这些设备成本较高,实际应用不确定性较强,因此并未得到广泛的推广。依托已有车载传感器信息,采用观测估计理论对路面附着系数进行准确辨识是一种更接近实际低成本应用的手段。然而实际应用中,应用于路面附着系数估计的轮胎力不确定性较强,需要采用合适的策略对其进行合理的预测估计,避免路面附着系数估计发散。此外,在轮胎滑移率过低时,基于经典轮胎模型估计的路面附着系数可靠性较低,对车辆运动控制造成安全隐患。
发明内容
本发明提供了一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,该方法有效地降低了轮胎力观测值的不确定性,能够精确的估计在车辆滑移率较高时的路面附着系数,在车辆滑移率较低时对估计的路面附着系数结果进行合理的修正。
本发明技术方案结合附图说明如下:
一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,包括以下步骤:
步骤一、基于车辆动力学模型对车辆的状态参数进行求解;
步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;
步骤三、采用最小二乘法对路面附着系数进行了估计;
步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。
步骤一中所述状态参数包括车速、制动压力、前轮转角、轮胎滑移率、侧偏角和车轮垂向力;所述车速、制动压力、前轮转角由传感器获得;所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算出。
所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算的具体方法如下:
11)建立包含车辆纵向、侧向和横摆运动的三自由度模型,得车辆动力学模型方程为:
max=[cosδcosδ1 1-sinδ0]Ftire (1)
may=[sinδsinδ0 0 cosδ1]Ftire (2)
式中,Ftire=[Fxfl Fxfr Fxrl Fxrr Fyf Fyr]T表示轮胎力集合;Fxfl表示前左轮纵向力;Fxfr表示前右轮纵向力;Fxrl表示后左轮纵向力;Fxrr表示后右轮纵向力;Fyf=(Fyfl+Fyfr)表示前轮总侧向力;Fyr=(Fyrl+Fyrr)表示后轮总侧向力;Fyfl表示前左轮侧向力;Fyfr表示前右轮侧向力;Fyrl表示后左轮侧向力;Fyrr表示后右轮侧向力;m表示整车质量,ax表示车辆纵向加速度;ay表示车辆侧向加速度;δ表示车辆前轮转角;Iz表示车辆绕z轴的转动惯量;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;tw表示轮距;表示车辆质心处横摆角加速度;
12)根据动力学平衡关系得到车轮的动力学方程为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Iwi表示轮胎旋转惯性质量;表示车轮转动角加速度;Tdi表示车轮的驱动转矩;Tbi表示车轮的驱动转矩与制动转矩;Fxi表示车轮受到地面的纵向反作用力;r表示车辆滚动半径;TFi=(a+bvi)Fzir表示车轮受到的滚动阻力矩;a和b表示滚动阻力系数参数值;vi表示车轮中心处的纵向速度;Fzi表示车轮受到地面的垂向反作用力;
13)智能电动汽车的四轮驱动力矩可以表示为:
式中,Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Te表示整车动力电机输出转矩;i0表示传动系的传动比;ηt表示传动系的传动效率;
14)车辆制动过程中由制动力形成的制动力矩表示为:
Tbi=kbiPwi (6)
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Tbi表示车轮的制动转矩;kbi表示制动效能因数;Pwi表示轮缸制动压力;
15)车轮受到地面的垂向反作用力与车辆加速和减速形成的惯性力存在关系,表示为:
式中,Fzfl表示前左车轮受到地面的垂向反作用力;Fzfr表示前右车轮受到地面的垂向反作用力;Fzrl表示后左车轮受到地面的垂向反作用力;Fzrr表示后右车轮受到地面的垂向反作用力;m表示整车质量;ax表示车辆纵向加速度; ay表示车辆侧向加速度;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;hg表示质心高度;tw表示轮距;
16)选用前左轮纵向力,前右轮纵向力,后左轮纵向力,后右轮纵向力,前轮总侧向力,后轮总侧向力,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统状态变量,即选用车辆纵向加速度,车辆侧向加速度,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统输出,那么得到车辆动力学空间方程为:
Hx=[cosδcosδ1 1 -sinδ0],
Hy=[sinδsinδ0 0 cosδ1],
式中,Φ表示系统状态变量矩阵;B表示系统输入矩阵;H表示系统输出矩阵;r表示车辆滚动半径;I表示单位矩阵;Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Tbfl表示前左车轮的制动转矩;Tbfr表示前右车轮的制动转矩;Tbrl表示后左车轮的制动转矩;Tbrr表示后右车轮的制动转矩;Iwfl表示前左车轮的轮胎旋转惯性质量;Iwfr表示前右车轮的轮胎旋转惯性质量;Iwrl表示后左车轮的轮胎旋转惯性质量;Iwrr表示后右车轮的轮胎旋转惯性质量;Iz表示车辆绕Z轴的转动惯量;Hx表示纵向力矩阵;Hy表示侧向力矩阵;表示横摆角矩阵;lf表示车辆质心至前轴的距离;lr表示车辆质心至后轴的距离;δ表示车辆前轮转角;tw表示轮距;m表示整车质量;TFfl表示前左车轮受到的滚动阻力矩;TFfr表示前右车轮受到的滚动阻力矩;TFrl表示后左车轮受到的滚动阻力矩;TFrr表示后右车轮受到的滚动阻力矩;
17)采用刷子模型表征车辆轮胎的纵向力和车辆轮胎的侧向力之间的联系,表示为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Fxi表示车轮受到地面的纵向反作用力;Fyi表示车轮受到地面的侧向反作用力;Cxi表示轮胎的纵向刚度;Cαi表示轮胎的侧向刚度;κi表示轮胎的滑移率;αi表示轮胎侧偏角;fi表示刷子模型刚度系数;Fti表示刷子模型表征力;μ表示路面附着系数;Fzi表示车轮受到地面的垂向反作用力;
18)根据车轮旋转角速度、前轮转角、车速以及车辆结构参数,计算各个轮胎的滑移率:
式中,κfl表示前左轮滑移率;κfr表示前右轮滑移率;κrl表示后左轮滑移率;κrr表示后右轮滑移率;ωfl表示前左轮转动角速度;ωfr表示前右轮转动角速度;ωrl表示后左轮转动角速度;ωrr表示后右轮转动角速度;r表示车辆滚动半径;vx表示车辆纵向速度;vy表示车辆侧向速度;tw表示轮距;δfl表示车辆前左轮转角;δfr表示车辆前右轮转角;lf表示车辆质心到前轴距离;表示车辆质心处横摆角速度;
19)智能电动汽车在行驶过程中,对应轮胎侧偏角为:
式中,αfl表示前左轮轮胎侧偏角;αfr表示前右轮轮胎侧偏角;αrl表示后左轮轮胎侧偏角;αrr表示后右轮轮胎侧偏角;表示车辆质心处横摆角速度; lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;δfl表示车辆前左轮转角;δfr表示车辆前右轮转角;β表示车辆质心侧偏角;vx表示车辆纵向速度;
所述步骤二的具体方法如下:
21)将连续的车辆动力学空间方程(8)转换为离散系统状态空间方程,即:
式中,X(k)表示第k时刻离散系统的状态变量;u(k)表示第k时刻离散系统的输入;X(k+1)表示第k+1时刻离散系统的状态变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;Y(k)表示第k 时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;w(k)表示第k时刻离散系统的激励噪声;v(k)表示第k时刻离散系统的观测噪声;
22)假设离散系统的激励噪声w(k)和观测噪声v(k)是均值为零、方差各为 Q和R的不相关白噪声,离散系统的初始状态X(0)不相关于激励噪声w(k)和观测噪声v(k);那么卡尔曼滤波的一步预测为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;表示第k时刻的离散系统变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;u(k) 表示第k时刻离散系统的输入;
23)离散系统状态更新矩阵为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵; Y(k+1)表示第k+1时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;表示经校正后第k+1时刻卡尔曼滤波的估计值;
24)卡尔曼滤波增益矩阵表示为:
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Hk表示第k 时刻离散系统的输出矩阵;R表示观测噪声v(k)的方差;
25)一步预测协方差矩阵为:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第 k时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;
26)在一步预测协方差矩阵中引入遗忘因子进行修正,即:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第k 时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;s表示遗忘因子;
协方差矩阵更新方程为:
P(k+1|k+1)=(I-K(k+1)Hk)P(k+1|k) (24)
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;Hk表示第k时刻离散系统的输出矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对 k+1时刻的预测协方差矩阵;P(k+1|k+1)为经校正后的协方差矩阵;I表示单位矩阵;
其中,Fxfl表示前左轮纵向力;Fxfr表示前右轮纵向力;Fxrl表示后左轮纵向力;Fxrr表示后右轮纵向力;Fyf=(Fyfl+Fyfr)表示前轮总侧向力; Fyr=(Fyrl+Fyrr)表示后轮总侧向力;Fyfl表示前左轮侧向力;Fyfr表示前右轮侧向力;Fyrl表示后左轮侧向力;Fyrr表示后右轮侧向力;ωfl表示前左轮转动角速度;ωfr表示前右轮转动角速度;ωrl表示后左轮转动角速度;ωrr表示后右轮转动角速度,表示车辆质心处横摆角速度;
所述步骤三的具体方法如下:
31)对刷子模型进行改写,即:
y(k)=f(k,θ(k)) (25)
式中,y(k)=[Fx,Fy]表示第k时刻的轮胎力;Fx表示车轮受到地面的纵向反作用力;Fy表示车轮受到地面的侧向反作用力;f(k,θ(k))表示第k时刻的刷子轮胎模型;θ(k)=[Cx,Cα,μ]T表示第k时刻刷子轮胎模型的状态向量;Cx表示轮胎的纵向刚度;Cα表示轮胎的侧向刚度;μ表示路面附着系数;
32)对y(k)进行一阶泰勒展开,并忽略高阶项,得:
y(k)≈F(k)(θ(k)-θ(k-1))+f(θ(k-1),k-1) (26)
式中,y(k)表示第k时刻的轮胎力;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;θ(k)为第k时刻刷子轮胎模型的状态向量;f(θ(k-1),k-1)表示第k-1时刻的刷子轮胎模型;F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置,且有:
式中,F(k)表示y(k)对θ(k)的雅可比矩阵的转置;θ(k)为第k时刻刷子轮胎模型的状态向量;f(k,θ)表示刷子轮胎模型;θ表示刷子轮胎模型的状态向量;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;
令z(k)=y(k)-f(θ(k-1),k-1)+F(k)θ(k-1),那么:
z(k)≈F(k)θ(k) (28)
式中,F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k 时刻的轮胎力;θ(k)第k时刻刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;
33)通过最小二乘法对路面附着系数进行估计,设定最小二乘法代价函数为:
式中,表示基于刷子轮胎模型的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;z(i)表示第i时刻可测量轮胎力矩阵;F(i)表示第i时刻y(i)对θ(i)的雅可比矩阵的转置;θ(i)为第i时刻刷子轮胎模型的状态向量;表示第i时刻估计的刷子轮胎模型的状态向量;
34)为了使得代价函数最小,基于刷子轮胎模型的递归最小二乘法为:
L(k)=P(k-1)FT(k)(I+F(k)P(k-1)FT(k))-1 (31)
P(k)=Λ-1(I-L(k)F(k))P(k-1)Λ-1 (32)
式中,表示第k时刻估计的刷子轮胎模型的状态向量;表示第k-1时刻估计的刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;F(k-1)表示第k-1时刻y(k-1)对θ(k-1)的雅可比矩阵的转置;y(k-1) 表示第k-1时刻的轮胎力,θ(k-1)第k-1时刻刷子轮胎模型的状态向量,L(k) 表示第k时刻基于刷子模型的递推最小二成法增益矩阵;F(k)表示第k时刻 y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k时刻的轮胎力;P(k)表示第k 时刻基于刷子模型的最小二乘法更新矩阵;P(k-1)表示第k-1时刻基于刷子模型的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵,I表示单位矩阵;
35)通过(30)-(32)迭代,估算获得估计的刷子轮胎模型的状态向量中的路面附着系数;其中,表示基于刷子模型估计的轮胎的纵向刚度,表示基于刷子模型估计的轮胎的侧向刚度,表示基于刷子模型估计的路面附着系数。
所述步骤四的具体方法如下:
41)在滑移率小时,附着系数μ与滑移率κ近似为正比例关系,即:
式中,κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;μs(k)表示第k时刻用于斜率法真实的路面附着系数;
42)设定基于斜率法的最小二乘法代价函数为:
式中,表示基于斜率法的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;κ-1(i)表示第i时刻轮胎的滑移率的倒数;Fz(i)表示第i时刻车轮受到地面的垂向反作用力,Fx(i)表示第i时刻车轮受到地面的纵向反作用力,为第i时刻斜率法估算的路面附着系数;
43)为了使得代价函数最小,设计基于斜率法的递归最小二乘法为:
式中,表示第k时刻斜率法估算的路面附着系数;表示第 k-1时刻斜率法估算的路面附着系数;κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;Ls(k)表示第k时刻基于斜率法的递推最小二成法增益矩阵;Ps(k)表示第k时刻基于斜率法的最小二乘法更新矩阵;Ps(k-1)表示第k-1时刻基于斜率法的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵;I表示单位矩阵;
最终,修正后的路面附着系数估计结果表示为:
本发明的有益效果为:
1)本发明搭建的车辆动力学模型完整的考虑了车辆行驶过程的非线性动力学问题,充分表征了智能电动汽车在结构化道路行驶中所表现的关键行为特征;
2)本发明基于卡尔曼滤波算法设计的轮胎力观测器有效地降低了轮胎力观测值的不确定性,为路面附着系数估计提供精确、稳定的轮胎力信息;
3)本发明基于最小二乘法和刷子模型能够精确的估计在车辆滑移率较高时的路面附着系数;
4)本发明基于最小二乘法和斜率法能够在车辆滑移率较低时对估计的路面附着系数结果进行合理的修正。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明的算法构图;
图2为三自由度车辆动力学模型示意图;
图3为车轮受力示意图;
图4为低附着路面轮胎力观测器结果图;
图5为低附着路面下路面附着系数估计结果图;
图6为高附着路面轮胎力观测器结果图;
图7为高附着路面下路面附着系数估计结果图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
参阅图1,一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,包括以下步骤:
步骤一、参阅图2,为了便于分析,忽略车辆俯仰、侧倾特性,假设车辆左右轮受力对称,基于车辆动力学模型对车辆的状态参数进行求解;
所述状态参数包括车速、制动压力、前轮转角、轮胎滑移率、侧偏角和车轮垂向力;所述车速、制动压力、前轮转角由传感器获得;所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算出。
所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算的具体方法如下:
11)建立包含车辆纵向、侧向和横摆运动的三自由度模型,得车辆动力学模型方程为:
max=[cosδcosδ1 1 -sinδ0]Ftire (1)
may=[sinδsinδ0 0 cosδ1]Ftire (2)
式中,Ftire=[Fxfl Fxfr Fxrl Fxrr Fyf Fyr]T表示轮胎力集合;Fxfl表示前左轮纵向力;Fxfr表示前右轮纵向力;Fxrl表示后左轮纵向力;Fxrr表示后右轮纵向力;Fyf=(Fyfl+Fyfr)表示前轮总侧向力;Fyr=(Fyrl+Fyrr)表示后轮总侧向力;Fyfl表示前左轮侧向力;Fyfr表示前右轮侧向力;Fyrl表示后左轮侧向力;Fyrr表示后右轮侧向力;m表示整车质量,ax表示车辆纵向加速度;ay表示车辆侧向加速度;δ表示车辆前轮转角;Iz表示车辆绕z轴的转动惯量;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;tw表示轮距;表示车辆质心处横摆角加速度;
12)车辆在行驶过程中,车轮在地面上行驶时的受力情况如图3所示。根据动力学平衡关系得到车轮的动力学方程为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Iwi表示轮胎旋转惯性质量;表示车轮转动角加速度;Tdi表示车轮的驱动转矩;Tbi表示车轮的驱动转矩与制动转矩;Fxi表示车轮受到地面的纵向反作用力;r表示车辆滚动半径;TFi=(a+bvi)Fzir表示车轮受到的滚动阻力矩;a和b表示滚动阻力系数参数值;vi表示车轮中心处的纵向速度;Fzi表示车轮受到地面的垂向反作用力;
13)智能电动汽车的四轮驱动力矩可以表示为:
式中,Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Te表示整车动力电机输出转矩;i0表示传动系的传动比;ηt表示传动系的传动效率;
14)车辆制动过程中由制动力形成的制动力矩表示为:
Tbi=kbiPwi (6)
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Tbi表示车轮的制动转矩;kbi表示制动效能因数;Pwi表示轮缸制动压力;
15)车轮受到地面的垂向反作用力与车辆加速和减速形成的惯性力存在关系,表示为:
式中,Fzfl表示前左车轮受到地面的垂向反作用力;Fzfr表示前右车轮受到地面的垂向反作用力;Fzrl表示后左车轮受到地面的垂向反作用力;Fzrr表示后右车轮受到地面的垂向反作用力;m表示整车质量;ax表示车辆纵向加速度; ay表示车辆侧向加速度;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;hg表示质心高度;tw表示轮距;
16)选用前左轮纵向力,前右轮纵向力,后左轮纵向力,后右轮纵向力,前轮总侧向力,后轮总侧向力,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统状态变量,即选用车辆纵向加速度,车辆侧向加速度,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统输出,那么得到车辆动力学空间方程为:
Hx=[cosδcosδ1 1 -sinδ0],
Hy=[sinδsinδ0 0 cosδ1],
式中,Φ表示系统状态变量矩阵;B表示系统输入矩阵;H表示系统输出矩阵;r表示车辆滚动半径;I表示单位矩阵;Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Tbfl表示前左车轮的制动转矩;Tbfr表示前右车轮的制动转矩;Tbrl表示后左车轮的制动转矩;Tbrr表示后右车轮的制动转矩;Iwfl表示前左车轮的轮胎旋转惯性质量;Iwfr表示前右车轮的轮胎旋转惯性质量;Iwrl表示后左车轮的轮胎旋转惯性质量;Iwrr表示后右车轮的轮胎旋转惯性质量;Iz表示车辆绕Z轴的转动惯量;Hx表示纵向力矩阵;Hy表示侧向力矩阵;表示横摆角矩阵;lf表示车辆质心至前轴的距离;lr表示车辆质心至后轴的距离;δ表示车辆前轮转角;tw表示轮距;m表示整车质量;TFfl表示前左车轮受到的滚动阻力矩;TFfr表示前右车轮受到的滚动阻力矩;TFrl表示后左车轮受到的滚动阻力矩; TFrr表示后右车轮受到的滚动阻力矩;
17)车辆轮胎的纵向力和侧向力与路面附着系数紧密相关。采用刷子模型表征车辆轮胎的纵向力和车辆轮胎的侧向力之间的联系,表示为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Fxi表示车轮受到地面的纵向反作用力;Fyi表示车轮受到地面的侧向反作用力;Cxi表示轮胎的纵向刚度;Cαi表示轮胎的侧向刚度;κi表示轮胎的滑移率;αi表示轮胎侧偏角;fi表示刷子模型刚度系数;Fti表示刷子模型表征力;μ表示路面附着系数;Fzi表示车轮受到地面的垂向反作用力;
18)根据车轮旋转角速度、前轮转角、车速以及车辆结构参数,计算各个轮胎的滑移率:
式中,κfl表示前左轮滑移率;κfr表示前右轮滑移率;κrl表示后左轮滑移率;κrr表示后右轮滑移率;ωfl表示前左轮转动角速度;ωfr表示前右轮转动角速度;ωrl表示后左轮转动角速度;ωrr表示后右轮转动角速度;r表示车辆滚动半径;vx表示车辆纵向速度;vy表示车辆侧向速度;tw表示轮距;δfl表示车辆前左轮转角;δfr表示车辆前右轮转角;lf表示车辆质心到前轴距离;表示车辆质心处横摆角速度;
19)智能电动汽车在行驶过程中,前轮转角较小,对应轮胎侧偏角为:
式中,αfl表示前左轮轮胎侧偏角;αfr表示前右轮轮胎侧偏角;αrl表示后左轮轮胎侧偏角;αrr表示后右轮轮胎侧偏角;表示车辆质心处横摆角速度; lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;δfl表示车辆前左轮转角;δfr表示车辆前右轮转角;β表示车辆质心侧偏角;vx表示车辆纵向速度;
步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;该算法是基于已知的观测值,通过最小化估计值的均方差实现对未知值的估计。
具体方法如下:
21)将连续的车辆动力学空间方程(8)转换为离散系统状态空间方程,即:
式中,X(k)表示第k时刻离散系统的状态变量;u(k)表示第k时刻离散系统的输入;X(k+1)表示第k+1时刻离散系统的状态变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;Y(k)表示第k 时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;w(k)表示第k时刻离散系统的激励噪声;v(k)表示第k时刻离散系统的观测噪声;
22)假设离散系统的激励噪声w(k)和观测噪声v(k)是均值为零、方差各为 Q和R的不相关白噪声,离散系统的初始状态X(0)不相关于激励噪声w(k)和观测噪声v(k);那么卡尔曼滤波的一步预测为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;表示第k时刻的离散系统变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;u(k) 表示第k时刻离散系统的输入;
23)离散系统状态更新矩阵为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵; Y(k+1)表示第k+1时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;表示经校正后第k+1时刻卡尔曼滤波的估计值;
24)卡尔曼滤波增益矩阵表示为:
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Hk表示第k 时刻离散系统的输出矩阵;R表示观测噪声v(k)的方差;
25)一步预测协方差矩阵为:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第 k时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;
26)在一步预测协方差矩阵中引入遗忘因子进行修正,即:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第k 时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;s表示遗忘因子;
协方差矩阵更新方程为:
P(k+1|k+1)=(I-K(k+1)Hk)P(k+1|k) (24)
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;Hk表示第k时刻离散系统的输出矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对 k+1时刻的预测协方差矩阵;P(k+1|k+1)为经校正后的协方差矩阵;I表示单位矩阵;
其中,Fxfl表示前左轮纵向力;Fxfr表示前右轮纵向力;Fxrl表示后左轮纵向力;Fxrr表示后右轮纵向力;Fyf=(Fyfl+Fyfr)表示前轮总侧向力; Fyr=(Fyrl+Fyrr)表示后轮总侧向力;Fyfl表示前左轮侧向力;Fyfr表示前右轮侧向力;Fyfl表示后左轮侧向力;Fyrr表示后右轮侧向力;ωfl表示前左轮转动角速度;ωfr表示前右轮转动角速度;ωrl表示后左轮转动角速度;ωrr表示后右轮转动角速度,表示车辆质心处横摆角速度。
步骤三、采用最小二乘法对路面附着系数进行了估计;
具体方法如下:
31)对刷子模型进行改写,即:
y(k)=f(k,θ(k)) (25)
式中,y(k)=[Fx,Fy]表示第k时刻的轮胎力;Fx表示车轮受到地面的纵向反作用力;Fy表示车轮受到地面的侧向反作用力;f(k,θ(k))表示第k时刻的刷子轮胎模型;θ(k)=[Cx,Cα,μ]T表示第k时刻刷子轮胎模型的状态向量;Cx表示轮胎的纵向刚度;Cα表示轮胎的侧向刚度;μ表示路面附着系数;
32)对y(k)进行一阶泰勒展开,并忽略高阶项,得:
y(k)≈F(k)(θ(k)-θ(k-1))+f(θ(k-1),k-1) (26)
式中,y(k)表示第k时刻的轮胎力;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;θ(k)为第k时刻刷子轮胎模型的状态向量;f(θ(k-1),k-1)表示第k-1时刻的刷子轮胎模型;F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置,且有:
式中,F(k)表示y(k)对θ(k)的雅可比矩阵的转置;θ(k)为第k时刻刷子轮胎模型的状态向量;f(k,θ)表示刷子轮胎模型;θ表示刷子轮胎模型的状态向量;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;
令z(k)=y(k)-f(θ(k-1),k-1)+F(k)θ(k-1),那么:
z(k)≈F(k)θ(k) (28)
式中,F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k 时刻的轮胎力;θ(k)第k时刻刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;
33)通过最小二乘法对路面附着系数进行估计,设定最小二乘法代价函数为:
式中,表示基于刷子轮胎模型的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;z(i)表示第i时刻可测量轮胎力矩阵;F(i)表示第i时刻y(i)对θ(i)的雅可比矩阵的转置;θ(i)为第i时刻刷子轮胎模型的状态向量;表示第i时刻估计的刷子轮胎模型的状态向量;
34)为了使得代价函数最小,基于刷子轮胎模型的递归最小二乘法为:
L(k)=P(k-1)FT(k)(I+F(k)P(k-1)FT(k))-1 (31)
P(k)=Λ-1(I-L(k)F(k))P(k-1)Λ-1 (32)
式中,表示第k时刻估计的刷子轮胎模型的状态向量;表示第k-1时刻估计的刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;F(k-1)表示第k-1时刻y(k-1)对θ(k-1)的雅可比矩阵的转置;y(k-1) 表示第k-1时刻的轮胎力,θ(k-1)第k-1时刻刷子轮胎模型的状态向量,L(k) 表示第k时刻基于刷子模型的递推最小二成法增益矩阵;F(k)表示第k时刻 y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k时刻的轮胎力;P(k)表示第k 时刻基于刷子模型的最小二乘法更新矩阵;P(k-1)表示第k-1时刻基于刷子模型的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵,I表示单位矩阵;表示××;
35)通过(30)-(32)迭代,估算获得估计的刷子轮胎模型的状态向量中的路面附着系数;其中,表示基于刷子模型估计的轮胎的纵向刚度,表示基于刷子模型估计的轮胎的侧向刚度,表示基于刷子模型估计的路面附着系数。
步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。
具体方法如下:
41)在滑移率小时,附着系数μ与滑移率κ近似为正比例关系,即:
式中,κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;μs(k)表示第k时刻用于斜率法真实的路面附着系数;
42)设定基于斜率法的最小二乘法代价函数为:
式中,表示基于斜率法的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;κ-1(i)表示第i时刻轮胎的滑移率的倒数;Fz(i)表示第i时刻车轮受到地面的垂向反作用力,Fx(i)表示第i时刻车轮受到地面的纵向反作用力,为第i时刻斜率法估算的路面附着系数;
43)为了使得代价函数最小,设计基于斜率法的递归最小二乘法为:
式中,表示第k时刻斜率法估算的路面附着系数;表示第 k-1时刻斜率法估算的路面附着系数;κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;Ls(k)表示第k时刻基于斜率法的递推最小二成法增益矩阵;Ps(k)表示第k时刻基于斜率法的最小二乘法更新矩阵;Ps(k-1)表示第k-1时刻基于斜率法的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵;I表示单位矩阵;
最终,修正后的路面附着系数估计结果表示为:
实施例
我们基于MATLAB/Simulink与车辆动力学软件CarSim搭建了联合仿真平台用于对本申请的轨迹跟踪控制器进行测试。
第一组工况为低附着路面下的制动工况,设置0s时车辆制动系统开始介入,且制动压力为2Mpa,路面附着系数为0.3,车辆初始车速为100km/h。实验结果如图4、图5所示。
从图中可以看出,所建立的轮胎力观测器在低附着路面上轮胎力和路面附着系数估计精度较高。路面附着系数估计算法能够较快的收敛到估计的路面附着系数,约为0.2816左右。与道路实际路面附着系数相比,估计的相对误差为6.13%,满足实际车辆运动控制使用需求。
第二组工况为高附着路面下的制动工况,设置路面的附着系数为0.7,并且设置车辆的制动压力为2MPa,制动起始时间为0s,车辆初始车速为100km/h。实验结果如图6、图7所示。
从图中可以看出,测器收敛后轮胎纵向力的估计误差最大值为202.76N,此时估计的相对误差6.31%。路面附着系数估计值为0.7152,估计的相对误差2.17%,同时RLS算法能在0.4s内收敛,说明高附着路面下识别算法具有不错的响应速度。
Claims (6)
1.一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,包括以下步骤:
步骤一、基于车辆动力学模型对车辆的状态参数进行求解;
步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;
步骤三、采用最小二乘法对路面附着系数进行了估计;
步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。
2.根据权利要求1所述的一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,步骤一中所述状态参数包括车速、制动压力、前轮转角、轮胎滑移率、侧偏角和车轮垂向力;所述车速、制动压力、前轮转角由传感器获得;所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算出。
3.根据权利要求2所述的一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,
所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算的具体方法如下:
11)建立包含车辆纵向、侧向和横摆运动的三自由度模型,得车辆动力学模型方程为:
max=[cosδ cosδ 1 1 -sinδ 0]Ftire (1)
may=[sinδ sinδ 0 0 cosδ 1]Ftire (2)
式中,Ftire=[Fxfl Fxfr Fxrl Fxrr Fyf Fyr]T表示轮胎力集合;Fxfl表示前左轮纵向力;Fxfr表示前右轮纵向力;Fxrl表示后左轮纵向力;Fxrr表示后右轮纵向力;Fyf=(Fyfl+Fyfr)表示前轮总侧向力;Fyr=(Fyrl+Fyrr)表示后轮总侧向力;Fyfl表示前左轮侧向力;Fyfr表示前右轮侧向力;Fyrl表示后左轮侧向力;Fyrr表示后右轮侧向力;m表示整车质量,ax表示车辆纵向加速度;ay表示车辆侧向加速度;δ表示车辆前轮转角;Iz表示车辆绕z轴的转动惯量;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;tw表示轮距;表示车辆质心处横摆角加速度;
12)根据动力学平衡关系得到车轮的动力学方程为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Iwi表示轮胎旋转惯性质量;表示车轮转动角加速度;Tdi表示车轮的驱动转矩;Tbi表示车轮的驱动转矩与制动转矩;Fxi表示车轮受到地面的纵向反作用力;r表示车辆滚动半径;TFi=(a+bvi)Fzir表示车轮受到的滚动阻力矩;a和b表示滚动阻力系数参数值;vi表示车轮中心处的纵向速度;Fzi表示车轮受到地面的垂向反作用力;
13)智能电动汽车的四轮驱动力矩可以表示为:
式中,Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Te表示整车动力电机输出转矩;i0表示传动系的传动比;ηt表示传动系的传动效率;
14)车辆制动过程中由制动力形成的制动力矩表示为:
Tbi=kbiPwi (6)
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Tbi表示车轮的制动转矩;kbi表示制动效能因数;Pwi表示轮缸制动压力;
15)车轮受到地面的垂向反作用力与车辆加速和减速形成的惯性力存在关系,表示为:
式中,Fzfl表示前左车轮受到地面的垂向反作用力;Fzfr表示前右车轮受到地面的垂向反作用力;Fzrl表示后左车轮受到地面的垂向反作用力;Fzrr表示后右车轮受到地面的垂向反作用力;m表示整车质量;ax表示车辆纵向加速度;ay表示车辆侧向加速度;lf表示车辆质心到前轴距离;lr表示车辆质心到后轴距离;hg表示质心高度;tw表示轮距;
16)选用前左轮纵向力,前右轮纵向力,后左轮纵向力,后右轮纵向力,前轮总侧向力,后轮总侧向力,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统状态变量,即选用车辆纵向加速度,车辆侧向加速度,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统输出,那么得到车辆动力学空间方程为:
Hx=[cosδ cosδ 1 1 -sinδ 0],
Hy=[sinδ sinδ 0 0 cosδ 1],
式中,Φ表示系统状态变量矩阵;B表示系统输入矩阵;H表示系统输出矩阵;r表示车辆滚动半径;I表示单位矩阵;Tdfl表示前左车轮的驱动转矩;Tdfr表示前右车轮的驱动转矩;Tdrl表示后左车轮的驱动转矩;Tdrr表示后右车轮的驱动转矩;Tbfl表示前左车轮的制动转矩;Tbfr表示前右车轮的制动转矩;Tbrl表示后左车轮的制动转矩;Tbrr表示后右车轮的制动转矩;Iwfl表示前左车轮的轮胎旋转惯性质量;Iwfr表示前右车轮的轮胎旋转惯性质量;Iwrl表示后左车轮的轮胎旋转惯性质量;Iwrr表示后右车轮的轮胎旋转惯性质量;Iz表示车辆绕Z轴的转动惯量;Hx表示纵向力矩阵;Hy表示侧向力矩阵;表示横摆角矩阵;lf表示车辆质心至前轴的距离;lr表示车辆质心至后轴的距离;δ表示车辆前轮转角;tw表示轮距;m表示整车质量;TFfl表示前左车轮受到的滚动阻力矩;TFfr表示前右车轮受到的滚动阻力矩;TFrl表示后左车轮受到的滚动阻力矩;TFrr表示后右车轮受到的滚动阻力矩;
17)采用刷子模型表征车辆轮胎的纵向力和车辆轮胎的侧向力之间的联系,表示为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;Fxi表示车轮受到地面的纵向反作用力;Fyi表示车轮受到地面的侧向反作用力;Cxi表示轮胎的纵向刚度;Cαi表示轮胎的侧向刚度;κi表示轮胎的滑移率;αi表示轮胎侧偏角;fi表示刷子模型刚度系数;Fti表示刷子模型表征力;μ表示路面附着系数;Fzi表示车轮受到地面的垂向反作用力;
18)根据车轮旋转角速度、前轮转角、车速以及车辆结构参数,计算各个轮胎的滑移率:
式中,κfl表示前左轮滑移率;κfr表示前右轮滑移率;κrl表示后左轮滑移率;κrr表示后右轮滑移率;ωfl表示前左轮转动角速度;ωfr表示前右轮转动角速度;ωrl表示后左轮转动角速度;ωrr表示后右轮转动角速度;r表示车辆滚动半径;vx表示车辆纵向速度;vy表示车辆侧向速度;tw表示轮距;δfl表示车辆前左轮转角;δfr表示车辆前右轮转角;lf表示车辆质心到前轴距离;表示车辆质心处横摆角速度;
19)智能电动汽车在行驶过程中,对应轮胎侧偏角为:
4.根据权利要求3所述的一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,所述步骤二的具体方法如下:
21)将连续的车辆动力学空间方程(8)转换为离散系统状态空间方程,即:
式中,X(k)表示第k时刻离散系统的状态变量;u(k)表示第k时刻离散系统的输入;X(k+1)表示第k+1时刻离散系统的状态变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;Y(k)表示第k时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;w(k)表示第k时刻离散系统的激励噪声;v(k)表示第k时刻离散系统的观测噪声;
22)假设离散系统的激励噪声w(k)和观测噪声v(k)是均值为零、方差各为Q和R的不相关白噪声,离散系统的初始状态X(0)不相关于激励噪声w(k)和观测噪声v(k);那么卡尔曼滤波的一步预测为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;表示第k时刻的离散系统变量;Φk表示第k时刻离散系统的状态变量矩阵;Bk表示第k时刻离散系统的输入矩阵;u(k)表示第k时刻离散系统的输入;
23)离散系统状态更新矩阵为:
式中,表示根据第k时刻离散系统的状态变量对k+1时刻离散系统的状态变量进行预测的值;K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;Y(k+1)表示第k+1时刻离散系统的输出;Hk表示第k时刻离散系统的输出矩阵;表示经校正后第k+1时刻卡尔曼滤波的估计值;
24)卡尔曼滤波增益矩阵表示为:
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Hk表示第k时刻离散系统的输出矩阵;R表示观测噪声v(k)的方差;
25)一步预测协方差矩阵为:
式中,P(k+l|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第k时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;
26)在一步预测协方差矩阵中引入遗忘因子进行修正,即:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φk表示第k时刻离散系统的状态变量矩阵;P(k|k)表示第k时刻离散系统的协方差矩阵;Q表示激励噪声w(k)的方差;s表示遗忘因子;
协方差矩阵更新方程为:
P(k+1|k+1)=(I-K(k+1)Hk)P(k+1|k) (24)
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;Hk表示第k时刻离散系统的输出矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;P(k+1|k+1)为经校正后的协方差矩阵;I表示单位矩阵;
5.根据权利要求1所述的一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,所述步骤三的具体方法如下:
31)对刷子模型进行改写,即:
y(k)=f(k,θ(k)) (25)
式中,y(k)=[Fx,Fy]表示第k时刻的轮胎力;Fx表示车轮受到地面的纵向反作用力;Fy表示车轮受到地面的侧向反作用力;f(k,θ(k))表示第k时刻的刷子轮胎模型;θ(k)=[Cx,Cα,μ]T表示第k时刻刷子轮胎模型的状态向量;Cx表示轮胎的纵向刚度;Cα表示轮胎的侧向刚度;μ表示路面附着系数;
32)对y(k)进行一阶泰勒展开,并忽略高阶项,得:
y(k)≈F(k)(θ(k)-θ(k-1))+f(θ(k-1),k-1) (26)
式中,y(k)表示第k时刻的轮胎力;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;θ(k)为第k时刻刷子轮胎模型的状态向量;f(θ(k-1),k-1)表示第k-1时刻的刷子轮胎模型;F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置,日有:
式中,F(k)表示y(k)对θ(k)的雅可比矩阵的转置;θ(k)为第k时刻刷子轮胎模型的状态向量;f(k,θ)表示刷子轮胎模型;θ表示刷子轮胎模型的状态向量;θ(k-1)为第k-1时刻刷子轮胎模型的状态向量;
令z(k)=y(k)-f(θ(k-1),k-1)+F(k)θ(k-1),那么:
z(k)≈F(k)θ(k) (28)
式中,F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k时刻的轮胎力;θ(k)第k时刻刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;
33)通过最小二乘法对路面附着系数进行估计,设定最小二乘法代价函数为:
式中,表示基于刷子轮胎模型的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;z(i)表示第i时刻可测量轮胎力矩阵;F(i)表示第i时刻y(i)对θ(i)的雅可比矩阵的转置;θ(i)为第i时刻刷子轮胎模型的状态向量;表示第i时刻估计的刷子轮胎模型的状态向量;
34)为了使得代价函数最小,基于刷子轮胎模型的递归最小二乘法为:
L(k)=P(k-1)FT(k)(I+F(k)P(k-1)FT(k))-1 (31)
P(k)=Λ-1(I-L(k)F(k))P(k-1)Λ-1 (32)
式中,表示第k时刻估计的刷子轮胎模型的状态向量;表示第k-1时刻估计的刷子轮胎模型的状态向量;z(k)为第k时刻可测量轮胎力矩阵;F(k-1)表示第k-1时刻y(k-1)对θ(k-1)的雅可比矩阵的转置;y(k-1)表示第k-1时刻的轮胎力,θ(k-1)第k-1时刻刷子轮胎模型的状态向量,L(k)表示第k时刻基于刷子模型的递推最小二成法增益矩阵;F(k)表示第k时刻y(k)对θ(k)的雅可比矩阵的转置;y(k)表示第k时刻的轮胎力;P(k)表示第k时刻基于刷子模型的最小二乘法更新矩阵;P(k-1)表示第k-1时刻基于刷子模型的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵,I表示单位矩阵;
6.根据权利要求1所述的一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,其特征在于,所述步骤四的具体方法如下:
41)在滑移率小时,附着系数μ与滑移率κ近似为正比例关系,即:
式中,κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;μs(k)表示第k时刻用于斜率法真实的路面附着系数;
42)设定基于斜率法的最小二乘法代价函数为:
式中,表示基于斜率法的递归最小二乘法代价函数;Λ表示最小二乘法的遗忘因子矩阵;κ-1(i)表示第i时刻轮胎的滑移率的倒数;Fz(i)表示第i时刻车轮受到地面的垂向反作用力,Fx(i)表示第i时刻车轮受到地面的纵向反作用力,为第i时刻斜率法估算的路面附着系数;
43)为了使得代价函数最小,设计基于斜率法的递归最小二乘法为:
式中,表示第k时刻斜率法估算的路面附着系数;表示第k-1时刻斜率法估算的路面附着系数;κ-1(k)表示第k时刻轮胎的滑移率的倒数;Fz(k)表示第k时刻车轮受到地面的垂向反作用力;Fx(k)表示第k时刻车轮受到地面的纵向反作用力;Ls(k)表示第k时刻基于斜率法的递推最小二成法增益矩阵;Ps(k)表示第k时刻基于斜率法的最小二乘法更新矩阵;Ps(k-1)表示第k-1时刻基于斜率法的最小二乘法更新矩阵;Λ表示最小二乘法的遗忘因子矩阵;I表示单位矩阵;
最终,修正后的路面附着系数估计结果表示为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110884295.3A CN113460056B (zh) | 2021-08-03 | 2021-08-03 | 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110884295.3A CN113460056B (zh) | 2021-08-03 | 2021-08-03 | 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113460056A true CN113460056A (zh) | 2021-10-01 |
CN113460056B CN113460056B (zh) | 2022-08-09 |
Family
ID=77883866
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110884295.3A Active CN113460056B (zh) | 2021-08-03 | 2021-08-03 | 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113460056B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114212074A (zh) * | 2022-02-22 | 2022-03-22 | 北京航空航天大学 | 基于路面附着系数估计的车辆主动转向防侧翻控制方法 |
CN115571156A (zh) * | 2022-09-23 | 2023-01-06 | 东南大学 | 基于传感器融合的前车横向与纵向运动状态联合估计方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102005060219A1 (de) * | 2005-12-16 | 2007-06-21 | Ford Global Technologies, LLC, Dearborn | Verfahren und Vorrichtung zur Abschätzung des Reibkoeffizienten zwischen Straße und Reifen eines Kraftfahrzeuges |
WO2007116123A1 (en) * | 2006-04-11 | 2007-10-18 | Valtion Teknillinen Tutkimuskeskus | Method for collecting information on road surface slipperiness |
JP2012056364A (ja) * | 2010-09-06 | 2012-03-22 | Nissan Motor Co Ltd | タイヤ接地状態推定装置 |
CN102768177A (zh) * | 2012-07-12 | 2012-11-07 | 吉林大学 | 一种路面附着系数实时检测方法与测试系统 |
CN103407451A (zh) * | 2013-09-03 | 2013-11-27 | 东南大学 | 一种道路纵向附着系数估计方法 |
CN103434511A (zh) * | 2013-09-17 | 2013-12-11 | 东南大学 | 一种车速与道路附着系数的联合估计方法 |
CN104325980A (zh) * | 2014-10-16 | 2015-02-04 | 北京汽车股份有限公司 | 附着系数估计方法及装置 |
CN107901914A (zh) * | 2017-09-26 | 2018-04-13 | 同济大学 | 一种车辆质心侧偏角及路面附着系数联合估计系统 |
CN109515442A (zh) * | 2018-11-06 | 2019-03-26 | 吉林大学 | 四轮驱动电动汽车路面附着系数估计方法 |
US20190263421A1 (en) * | 2016-07-29 | 2019-08-29 | Zf Friedrichshafen Ag | Determining driving state variables |
CN112248986A (zh) * | 2020-10-23 | 2021-01-22 | 厦门理工学院 | 一种车辆自动制动方法、装置、设备和存储介质 |
-
2021
- 2021-08-03 CN CN202110884295.3A patent/CN113460056B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102005060219A1 (de) * | 2005-12-16 | 2007-06-21 | Ford Global Technologies, LLC, Dearborn | Verfahren und Vorrichtung zur Abschätzung des Reibkoeffizienten zwischen Straße und Reifen eines Kraftfahrzeuges |
WO2007116123A1 (en) * | 2006-04-11 | 2007-10-18 | Valtion Teknillinen Tutkimuskeskus | Method for collecting information on road surface slipperiness |
JP2012056364A (ja) * | 2010-09-06 | 2012-03-22 | Nissan Motor Co Ltd | タイヤ接地状態推定装置 |
CN102768177A (zh) * | 2012-07-12 | 2012-11-07 | 吉林大学 | 一种路面附着系数实时检测方法与测试系统 |
CN103407451A (zh) * | 2013-09-03 | 2013-11-27 | 东南大学 | 一种道路纵向附着系数估计方法 |
CN103434511A (zh) * | 2013-09-17 | 2013-12-11 | 东南大学 | 一种车速与道路附着系数的联合估计方法 |
CN104325980A (zh) * | 2014-10-16 | 2015-02-04 | 北京汽车股份有限公司 | 附着系数估计方法及装置 |
US20190263421A1 (en) * | 2016-07-29 | 2019-08-29 | Zf Friedrichshafen Ag | Determining driving state variables |
CN107901914A (zh) * | 2017-09-26 | 2018-04-13 | 同济大学 | 一种车辆质心侧偏角及路面附着系数联合估计系统 |
CN109515442A (zh) * | 2018-11-06 | 2019-03-26 | 吉林大学 | 四轮驱动电动汽车路面附着系数估计方法 |
CN112248986A (zh) * | 2020-10-23 | 2021-01-22 | 厦门理工学院 | 一种车辆自动制动方法、装置、设备和存储介质 |
Non-Patent Citations (2)
Title |
---|
JIAN ZHAO等: "Development and Verification of the Tire/Road Friction Estimation Algorithm for Antilock Braking System", 《MATHEMATICAL PROBLEMS IN ENGINEERING》 * |
余卓平等: "路面附着系数估算技术发展现状综述", 《汽车工程》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114212074A (zh) * | 2022-02-22 | 2022-03-22 | 北京航空航天大学 | 基于路面附着系数估计的车辆主动转向防侧翻控制方法 |
CN114212074B (zh) * | 2022-02-22 | 2022-04-29 | 北京航空航天大学 | 基于路面附着系数估计的车辆主动转向防侧翻控制方法 |
CN115571156A (zh) * | 2022-09-23 | 2023-01-06 | 东南大学 | 基于传感器融合的前车横向与纵向运动状态联合估计方法 |
CN115571156B (zh) * | 2022-09-23 | 2023-12-26 | 东南大学 | 基于传感器融合的前车横向与纵向运动状态联合估计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113460056B (zh) | 2022-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2927066B1 (en) | Model-based longitudinal stiffness estimation system and method | |
EP2927065B1 (en) | Road surface friction and surface type estimation system and method | |
Li et al. | Comprehensive tire–road friction coefficient estimation based on signal fusion method under complex maneuvering operations | |
EP3028909B1 (en) | Intelligent tire-based road friction estimation system and method | |
US6508102B1 (en) | Near real-time friction estimation for pre-emptive vehicle control | |
EP1627779B1 (en) | Tire grip performance estimation device and method and running state control method | |
JP3458839B2 (ja) | 路面の最大摩擦係数推定装置 | |
EP3115765B1 (en) | Tire sensor-based vehicle state estimation system and method | |
US6631317B2 (en) | Attitude sensing system for an automotive vehicle | |
CN113460056B (zh) | 一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法 | |
US20090177346A1 (en) | Dynamic estimation of vehicle inertial parameters and tire forces from tire sensors | |
Lenzo et al. | On the experimental analysis of single input single output control of yaw rate and sideslip angle | |
US20100174437A1 (en) | method of determining vehicle properties | |
US6745112B2 (en) | Method of estimating quantities that represent state of vehicle | |
Shim et al. | Model-based road friction estimation | |
Pi et al. | Design and evaluation of sideslip angle observer for vehicle stability control | |
CN110979026B (zh) | 一种基于实时路况的分布式驱动公交车转矩分配方法 | |
JP2002145037A (ja) | 車両の路面摩擦係数推定装置 | |
CN111547059A (zh) | 一种分布式驱动电动汽车惯性参数估计方法 | |
CN102165300A (zh) | 用于求出汽车重心的方法和设备 | |
CN111959516B (zh) | 一种车辆状态与路面附着系数联合估计的方法 | |
Song et al. | Chassis integrated control for 4WIS distributed drive EVs with model predictive control based on the UKF observer | |
CN111688715A (zh) | 四轮驱动电动汽车基于融合技术的质心侧偏角观测方法 | |
US6853886B2 (en) | Method of estimating quantities that represent state of vehicle | |
JP3748334B2 (ja) | 車両の姿勢制御装置 |
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 |