[发明专利]基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法及系统

权利要求书

1.一种基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法，其特征在于，所述质心侧偏角估计方法包括：

建立三自由度车辆动力学模型；所述三自由度车辆动力学模型为与质心侧偏角相关的动力学模型；

根据所述三自由度车辆动力学模型，确定无迹卡尔曼滤波器的状态方程和观测方程，并确定所述无迹卡尔曼滤波器的输入量、状态量以及观测量；所述输入量包括前轮转角以及纵向加速度；所述状态量包括质心侧偏角、横摆角速度和纵向车速；所述观测量包括侧向加速度和横摆角速度；

采用M估计器算法，计算权重因子；所述权重因子为协方差的权重因子；所述协方差包括所述观测量的协方差以及所述状态量和所述观测量之间的协方差；根据以下公式计算权重因子；所述公式为：其中，w为权重因子；e＝v_k，e在无迹卡尔曼滤波算法中被称为新息，v_k～(0，R)为零均值、协方差为R的白噪声，表示观测误差；表示估计规模；ξ为阈值，用来界定观测信号中是否出现离群点；θ表示影响方程；

当时，表示观测信号中没有离群点，影响方程为当时，表示观测信号中出现离群点，影响方程变为

结合所述权重因子、当前时刻的所述状态量、所述无迹卡尔曼滤波器的状态方程和观测方程，采用无迹卡尔曼滤波算法，对下一时刻的质心侧偏角进行估计。

2.根据权利要求1所述的基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法，其特征在于，在结合所述权重因子、当前时刻的所述状态量、所述无迹卡尔曼滤波器的状态方程和观测方程，采用无迹卡尔曼滤波算法，对下一时刻的质心侧偏角进行估计之前，所述基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法还包括：

对当前时刻的所述状态量进行无迹变换，得到多个sigma点，并计算每个所述sigma点的权值。

3.根据权利要求1所述的基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法，其特征在于，所述建立三自由度车辆动力学模型，具体包括：

根据以下公式建立三自由度车辆动力学模型；所述公式为：

其中，为质心侧偏角的导数；为横摆角速度的导数；为纵向加速度的导数；k1，k2分别为前、后轮胎的侧偏刚度；m为整车质量；v_x为纵向速度；β为质心侧偏角；a，b分别为质心到前、后轴的距离；γ为横摆角速度；δ为前轮转角；I_z为绕z轴转动惯量；a_x为纵向加速度。

4.根据权利要求3所述的基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法，其特征在于，所述无迹卡尔曼滤波器的状态方程为：

x_k+1＝f(x_k,u)+w_k；

其中，下标k表示第k时刻，下标k+1表示第k+1时刻，x_k表示k时刻的状态量，x_k+1表示k+1时刻的状态量，w_k～(0，Q)为零均值、协方差为Q的白噪声，表示预测误差；u表示输入量[δ，a_x]^T；

所述无迹卡尔曼滤波器的观测方程为：

z_k＝h(x_k,u)+v_k；

其中，z_k表示k时刻的观测量，v_k～(0，R)为零均值、协方差为R的白噪声，表示观测误差。