法律状态公告日
法律状态信息
法律状态
2022-08-09
授权
发明专利权授予
技术领域
本发明属于汽车技术领域,具体的说是一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法。
背景技术
智能电动汽车在地面上行驶一方面受到车辆底层驱动系统的驱动力和制动系统的制动力限制,另一方面也受到不同路面附着条件的约束。路面附着系数是车—路系统中最为关键的参数之一,它对智能电动汽车的行驶安全性能有着至关重要的影响。
依托车载摄像头、激光雷达、超声波雷达等是近年来进行路面识别的一种新的方法,但是这些设备成本较高,实际应用不确定性较强,因此并未得到广泛的推广。依托已有车载传感器信息,采用观测估计理论对路面附着系数进行准确辨识是一种更接近实际低成本应用的手段。然而实际应用中,应用于路面附着系数估计的轮胎力不确定性较强,需要采用合适的策略对其进行合理的预测估计,避免路面附着系数估计发散。此外,在轮胎滑移率过低时,基于经典轮胎模型估计的路面附着系数可靠性较低,对车辆运动控制造成安全隐患。
发明内容
本发明提供了一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,该方法有效地降低了轮胎力观测值的不确定性,能够精确的估计在车辆滑移率较高时的路面附着系数,在车辆滑移率较低时对估计的路面附着系数结果进行合理的修正。
本发明技术方案结合附图说明如下:
一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,包括以下步骤:
步骤一、基于车辆动力学模型对车辆的状态参数进行求解;
步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;
步骤三、采用最小二乘法对路面附着系数进行了估计;
步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。
步骤一中所述状态参数包括车速、制动压力、前轮转角、轮胎滑移率、侧偏角和车轮垂向力;所述车速、制动压力、前轮转角由传感器获得;所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算出。
所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算的具体方法如下:
11)建立包含车辆纵向、侧向和横摆运动的三自由度模型,得车辆动力学模型方程为:
ma
ma
式中,F
12)根据动力学平衡关系得到车轮的动力学方程为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;I
13)智能电动汽车的四轮驱动力矩可以表示为:
式中,T
14)车辆制动过程中由制动力形成的制动力矩表示为:
T
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;T
15)车轮受到地面的垂向反作用力与车辆加速和减速形成的惯性力存在关系,表示为:
式中,F
16)选用前左轮纵向力,前右轮纵向力,后左轮纵向力,后右轮纵向力,前轮总侧向力,后轮总侧向力,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统状态变量,即
式中,X表示系统状态变量;
H
H
式中,Φ表示系统状态变量矩阵;B表示系统输入矩阵;H表示系统输出矩阵;r表示车辆滚动半径;I表示单位矩阵;T
17)采用刷子模型表征车辆轮胎的纵向力和车辆轮胎的侧向力之间的联系,表示为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;F
18)根据车轮旋转角速度、前轮转角、车速以及车辆结构参数,计算各个轮胎的滑移率:
式中,κ
19)智能电动汽车在行驶过程中,对应轮胎侧偏角为:
式中,α
所述步骤二的具体方法如下:
21)将连续的车辆动力学空间方程(8)转换为离散系统状态空间方程,即:
式中,X(k)表示第k时刻离散系统的状态变量;u(k)表示第k时刻离散系统的输入;X(k+1)表示第k+1时刻离散系统的状态变量;Φ
22)假设离散系统的激励噪声w(k)和观测噪声v(k)是均值为零、方差各为 Q和R的不相关白噪声,离散系统的初始状态X(0)不相关于激励噪声w(k)和观测噪声v(k);那么卡尔曼滤波的一步预测为:
式中,
23)离散系统状态更新矩阵为:
式中,
24)卡尔曼滤波增益矩阵表示为:
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;H
25)一步预测协方差矩阵为:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φ
26)在一步预测协方差矩阵中引入遗忘因子进行修正,即:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φ
协方差矩阵更新方程为:
P(k+1|k+1)=(I-K(k+1)H
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;H
27)通过式(19)-(24)迭代,估算获得离散系统的状态变量
其中,F
所述步骤三的具体方法如下:
31)对刷子模型进行改写,即:
y(k)=f(k,θ(k)) (25)
式中,y(k)=[F
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)通过最小二乘法对路面附着系数进行估计,设定最小二乘法代价函数为:
式中,
34)为了使得代价函数最小,基于刷子轮胎模型的递归最小二乘法为:
L(k)=P(k-1)F
P(k)=Λ
式中,
35)通过(30)-(32)迭代,估算获得估计的刷子轮胎模型的状态向量
所述步骤四的具体方法如下:
41)在滑移率小时,附着系数μ与滑移率κ近似为正比例关系,即:
式中,κ
42)设定基于斜率法的最小二乘法代价函数为:
式中,
43)为了使得代价函数最小,设计基于斜率法的递归最小二乘法为:
式中,
44)通过式(35)-(37)迭代,估算获得斜率法估算的路面附着系数
最终,修正后的路面附着系数估计结果表示为:
式中,
本发明的有益效果为:
1)本发明搭建的车辆动力学模型完整的考虑了车辆行驶过程的非线性动力学问题,充分表征了智能电动汽车在结构化道路行驶中所表现的关键行为特征;
2)本发明基于卡尔曼滤波算法设计的轮胎力观测器有效地降低了轮胎力观测值的不确定性,为路面附着系数估计提供精确、稳定的轮胎力信息;
3)本发明基于最小二乘法和刷子模型能够精确的估计在车辆滑移率较高时的路面附着系数;
4)本发明基于最小二乘法和斜率法能够在车辆滑移率较低时对估计的路面附着系数结果进行合理的修正。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明的算法构图;
图2为三自由度车辆动力学模型示意图;
图3为车轮受力示意图;
图4为低附着路面轮胎力观测器结果图;
图5为低附着路面下路面附着系数估计结果图;
图6为高附着路面轮胎力观测器结果图;
图7为高附着路面下路面附着系数估计结果图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本发明相关的部分而非全部结构。
参阅图1,一种基于卡尔曼滤波和最小二乘法的车辆路面附着系数估计方法,包括以下步骤:
步骤一、参阅图2,为了便于分析,忽略车辆俯仰、侧倾特性,假设车辆左右轮受力对称,基于车辆动力学模型对车辆的状态参数进行求解;
所述状态参数包括车速、制动压力、前轮转角、轮胎滑移率、侧偏角和车轮垂向力;所述车速、制动压力、前轮转角由传感器获得;所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算出。
所述轮胎滑移率、侧偏角和车轮垂向力由车辆动力学模型计算的具体方法如下:
11)建立包含车辆纵向、侧向和横摆运动的三自由度模型,得车辆动力学模型方程为:
ma
ma
式中,F
12)车辆在行驶过程中,车轮在地面上行驶时的受力情况如图3所示。根据动力学平衡关系得到车轮的动力学方程为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;I
13)智能电动汽车的四轮驱动力矩可以表示为:
式中,T
14)车辆制动过程中由制动力形成的制动力矩表示为:
T
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;T
15)车轮受到地面的垂向反作用力与车辆加速和减速形成的惯性力存在关系,表示为:
式中,F
16)选用前左轮纵向力,前右轮纵向力,后左轮纵向力,后右轮纵向力,前轮总侧向力,后轮总侧向力,前左车轮转动角速度,前右车轮转动角速度,后左车轮转动角速度,后右车轮转动角速度和车辆质心处横摆角速度为系统状态变量,即
式中,X表示系统状态变量;
H
H
式中,Φ表示系统状态变量矩阵;B表示系统输入矩阵;H表示系统输出矩阵;r表示车辆滚动半径;I表示单位矩阵;T
17)车辆轮胎的纵向力和侧向力与路面附着系数紧密相关。采用刷子模型表征车辆轮胎的纵向力和车辆轮胎的侧向力之间的联系,表示为:
式中,i=fl,fr,rl,rr分别表示对应的前左车轮,前右车轮,后左车轮和后右车轮;F
18)根据车轮旋转角速度、前轮转角、车速以及车辆结构参数,计算各个轮胎的滑移率:
式中,κ
19)智能电动汽车在行驶过程中,前轮转角较小,对应轮胎侧偏角为:
式中,α
步骤二、基于卡尔曼滤波估计出车辆行驶过程中轮胎受到的轮胎力;该算法是基于已知的观测值,通过最小化估计值的均方差实现对未知值的估计。
具体方法如下:
21)将连续的车辆动力学空间方程(8)转换为离散系统状态空间方程,即:
式中,X(k)表示第k时刻离散系统的状态变量;u(k)表示第k时刻离散系统的输入;X(k+1)表示第k+1时刻离散系统的状态变量;Φ
22)假设离散系统的激励噪声w(k)和观测噪声v(k)是均值为零、方差各为 Q和R的不相关白噪声,离散系统的初始状态X(0)不相关于激励噪声w(k)和观测噪声v(k);那么卡尔曼滤波的一步预测为:
式中,
23)离散系统状态更新矩阵为:
式中,
24)卡尔曼滤波增益矩阵表示为:
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;H
25)一步预测协方差矩阵为:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φ
26)在一步预测协方差矩阵中引入遗忘因子进行修正,即:
式中,P(k+1|k)表示根据第k时刻的误差协方差与状态向量对k+1时刻的预测协方差矩阵;Φ
协方差矩阵更新方程为:
P(k+1|k+1)=(I-K(k+1)H
式中,K(k+1)表示第k+1时刻卡尔曼滤波增益矩阵;H
27)通过式(19)-(24)迭代,估算获得离散系统的状态变量
其中,F
步骤三、采用最小二乘法对路面附着系数进行了估计;
具体方法如下:
31)对刷子模型进行改写,即:
y(k)=f(k,θ(k)) (25)
式中,y(k)=[F
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)通过最小二乘法对路面附着系数进行估计,设定最小二乘法代价函数为:
式中,
34)为了使得代价函数最小,基于刷子轮胎模型的递归最小二乘法为:
L(k)=P(k-1)F
P(k)=Λ
式中,
35)通过(30)-(32)迭代,估算获得估计的刷子轮胎模型的状态向量
步骤四、通过斜率法对步骤三中低滑移率下的路面附着系数估计结果进行修正。
具体方法如下:
41)在滑移率小时,附着系数μ与滑移率κ近似为正比例关系,即:
式中,κ
42)设定基于斜率法的最小二乘法代价函数为:
式中,
43)为了使得代价函数最小,设计基于斜率法的递归最小二乘法为:
式中,
44)通过式(35)-(37)迭代,估算获得斜率法估算的路面附着系数
最终,修正后的路面附着系数估计结果表示为:
式中,
实施例
我们基于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内收敛,说明高附着路面下识别算法具有不错的响应速度。
机译: 车辆的路面摩擦系数估计方法和车辆的路面摩擦系数估计方法
机译: 车辆路面摩擦系数估计装置及车辆路面摩擦系数估计方法
机译: 用于车辆的轮胎-地面附着系数估计方法,涉及当实现瞬时附着的条件时,验证瞬时附着的利用条件并估计轮胎-地面附着系数。