1.一种考虑越野环境扰动的地面车辆四轮侧偏刚度估计方法,其特征在于,包括以下步骤:步骤一:建立考虑耦合坡度的车辆动力学模型和车辆运动学模型;通过车辆动力学坐标转换使无人地面车辆能够动态适应同时涵盖横坡与纵坡的路面对车辆动力学特性的影响;
步骤二:构建包含四轮独立侧偏刚度的无人地面车辆系统;通过选取无人地面车辆系统变量,建立四轮侧偏刚度估计状态空间方程并进行离散化;
步骤三:设计基于自适应遗忘最小二乘的四轮侧偏刚度估计方法;基于自适应滤波器设计自适应遗忘最小二乘代价函数,从而获取四轮独立侧偏刚度估计律,实现越野环境下轮胎侧偏刚度的估计;
其中,所述步骤一的具体方法如下:
S11:定义三个坐标系,分别为全局坐标系、车辆坐标系和车辆投影坐标系;其中,全局坐标系固定于平坦地面,车辆坐标系位于车辆重心,车辆投影坐标系原点为车辆重心在XOY平面上的投影;
S12:全局坐标系下车辆的重力会产生沿车辆坐标系的附加力和,如下所示:(1)
(2)
(3)
式中,为纵向附加力;为横向附加力;为垂向附加力;为车辆投影坐标系道车辆坐标系的坐标变换矩阵;为全局坐标系到车辆投影坐标系的坐标变换矩阵;为道路侧向坡度;为道路纵向坡度;为车辆投影航向角;为车辆质量;;
S13:建立忽略车辆的侧倾、俯仰和垂向运动的耦合坡度上的车辆动力学模型,如下所示:(4)
(5)
式中,为车辆横摆转矩;为车辆侧偏角;为车辆横摆角速度;为车辆纵向速度;为车辆横向速度;为四个轮胎的纵向力,为四个轮胎的侧向力,为时代表前轮,为时代表后轮,为时代表右轮,为时代表左轮;为理想前轮转向角;为车辆重心距前轴的距离;为车辆重心距后轴的距离;为车辆轮距;为横向附件力;
假定车辆转角和纵向加速度为零,则将式(4)和式(5)改写为:(6)
(7)
式中,为耦合坡度引起的车辆横摆力矩;为由于车轮转矩分配引起的附加车辆横摆力矩;为地面摩擦系数;为车辆所受右侧垂向力;为车辆所受左侧垂向力;
在耦合坡度及侧向加速度影响下,两侧轮胎垂向力计算为:(8)
(9)
式中,为车辆轴距;为道路坡度;为车辆质心距地面高度;
通过将轮胎模型线性化,前后轴轮胎所受侧向力能够表示如下:(10)
(11)
(12)
(13)
,(14)
式中,为四个轮胎的侧偏刚度,为时代表前轮,为时代表后轮,为时代表右轮,为时代表左轮;为前轮的侧偏角;为后轮的侧偏角;为车轮的名义侧偏刚度;为轮胎侧偏刚度变化范围;为时变刚度修正系数,为时代表前轮,为时代表后轮,为时代表右轮,为时代表左轮;
综合公式(1)-(14),建立考虑耦合坡度的车辆动力学模型:(15)
(16)
式中,为车辆前轴侧偏刚度;为车辆后轴侧偏刚度;
S14:在参考路径上建立Frenet坐标系;横向误差为车辆重心与参考路径重心的距离,航向误差为车辆实际航向角与处参考路径切向角的差;
车辆运动学模型表示为:
(17)
式中,为道路曲率。
2.根据权利要求1所述的一种考虑越野环境扰动的地面车辆四轮侧偏刚度估计方法,其特征在于,所述步骤二的具体方法如下:S21:结合考虑耦合坡度的车辆动力学模型和车辆运动学模型, 选取无人地面车辆路径跟踪系统变量:选取状态变量,输入变量,扰动变量,其中,为实际前轮转向角;
S22:依据无人地面车辆路径跟踪系统变量,建立用于四轮侧偏刚度估计的状态空间方程:(18)
(19)
(20)
式中,
;
;
;
;
;
;
式中,为状态变量;为输入变量;为扰动变量;为无人地面车辆系统矩阵;为无人地面车辆基准系统矩阵;为无人地面车辆左前轮胎系统矩阵;为无人地面车辆右前轮胎系统矩阵;为无人地面车辆左后轮胎系统矩阵;为无人地面车辆右后轮胎系统矩阵;为无人地面车辆输入矩阵;为无人地面车辆基准输入矩阵;为无人地面车辆左前轮胎输入矩阵;为无人地面车辆右前轮胎输入矩阵;为无人地面车辆状态干扰矩阵;为前轮名义侧偏刚度;为后轮名义侧偏刚度;为前轮侧偏刚度变化范围;为后轮侧偏刚度变化范围;为左前轮时变刚度修正系数;为右前轮时变刚度修正系数;为左后轮时变刚度修正系数;为右后轮时变刚度修正系数;
S23:将路径跟踪系统状态空间方程离散化;模型预测控制采用离散模型来预测被控对象的未来状态,并通过滚动优化得到最优控制量;将连续时间下的系统状态空间方程进行离散化;采用前向欧拉离散化方法将(18)中的连续时间矩阵进行离散化,并得到离散后的路径跟踪系统状态空间方程:(21)(22)
式中,为无人地面车辆基准离散系统矩阵;为无人地面车辆左前轮胎离散系统矩阵;为无人地面车辆右前轮胎离散系统矩阵;为无人地面车辆左后轮胎离散系统矩阵,为无人地面车辆右后轮胎离散系统矩阵;为无人地面车辆基准离散输入矩阵;为无人地面车辆左前轮胎离散输入矩阵;为无人地面车辆右前轮胎离散输入矩阵,为单位矩阵;为系统离散时间间隔;为第个周期的状态变量;为第个周期的输入变量;为第个周期的干扰变量;为第个周期的状态变量;为无人地面车辆离散状态干扰矩阵;为无人地面车辆左前,右前,左后,右后轮胎离散系统矩阵;为无人地面车辆左前,右前,左后,右后轮胎系统矩阵;为无人地面车辆左前,右前轮胎离散输入矩阵;为无人地面车辆左前,右前轮胎输入矩阵。
3.根据权利要求2所述的一种考虑越野环境扰动的地面车辆四轮侧偏刚度估计方法,其特征在于,所述步骤三的具体方法如下:S31:建立包含自适应滤波器的轮胎侧偏刚度估计器:(23)
(24)
式中,为回归矩阵;为观测残差;为时变轮胎刚度修正系数;为第步的左前轮时变刚度修正系数;为第步的右前轮时变刚度修正系数;为第步的左后轮时变刚度修正系数;为第步的右后轮时变刚度修正系数;
引入自适应滤波器以保证参数更新的持续性,避免估计发散:(25)
式中,第步的自适应滤波器;为Schur稳定增益矩阵;为回归矩阵;;为第步的自适应滤波器;
设计轮胎侧偏刚度估计器如下:
(26)
式中,为时刻的状态变量估计值;为时刻的时变轮胎刚度修正系数估计值;为时刻的时变轮胎刚度修正系数估计误差;为时刻的状态变量估计误差;为时刻的状态变量估计值;为时刻的时变轮胎刚度修正系数估计值;
S32:设计包含遗忘因子的递归最小二乘代价函数;结合式(25)和式(26),获得时刻的状态变量估计误差:(27)
构建辅助变量将分解为影响的真实参数误差项和与参数无关的误差项:(28)
(29)
式中,为时刻的与参数无关的误差项;为时刻的真实参数误差项;
将视为输出量,通过最小化时变刚度修正系数估计值和拟合常值误差项,设计包含双线性优化的遗忘递归最小二乘代价函数,并将非线性问题解耦为:(30)
式中,为遗忘递归最小二乘代价函数;为遗忘因子;为拟合常值误差项;为当前时域步数;为最大时域步数;为时刻的真实参数误差项;第步的自适应滤波器;为时刻的时变轮胎刚度修正系数估计值;为时刻的时变轮胎刚度修正系数;
S33:通过最小化代价函数获得轮胎侧偏刚度估计律:(31)
定义逆协方差矩阵,时变轮胎刚度修正系数估计值表达为如下形式:(32)
(33)
式中,为时刻的逆协方差矩阵;
结合式(32)和式(33),经代数变换,建立如下基于AFRLS方法的轮胎侧偏刚度估计器:(34)
式中,为时刻的时变轮胎刚度修正系数估计值;为时刻的逆协方差矩阵。