一种侧翻预警系统及其预警方法与流程

技术特征：

1.一种侧翻预警系统，其特征在于，包含传感器模块、预警ECU、灯控ECU和报警灯组；

所述传感器模块设置在汽车的车体上，包含方向盘转角传感器、侧倾角速度传感器、侧倾角传感器、俯仰角传感器、俯仰角速度传感器、纵向速度传感器、纵向加速度信号，侧向速度传感器、侧向加速度传感器、横摆角速度传感器，分别用于测量汽车的方向盘转角、侧倾角、角速度，俯仰角、俯仰角速度，纵向车速、纵向加速度，侧向速度、侧向加速度和横摆角速度；

所述报警灯组包含第一至第三报警灯；

所述预警ECU分别和方向盘转角传感器、侧倾角速度传感器、侧倾角传感器、俯仰角传感器、俯仰角速度传感器、纵向速度传感器、纵向加速度传感器，侧向速度传感器、侧向加速度传感器、横摆角速度传感器、灯控ECU相连，用于根据传感器模块的感应数据计算汽车四个车轮的垂向力、并分别判断汽车四个车轮的垂向力是否等于零后将判断结果传递给所述灯控ECU；

所述灯控ECU还分别和所述第一至第三报警灯相连，用于根据接收到的判断结果控制第一至第三报警灯工作。

2.基于所述权利要求1所述的侧翻预警系统的预警方法，其特征在于，包含以下步骤：

步骤1)，传感器模块测得汽车的方向盘转角信号、侧倾角信号、角速度信号，俯仰角信号、俯仰角速度信号，纵向车速信号、纵向加速度信号，侧向速度信号、侧向加速度信号和横摆角速度信号，并将其传递给所述预警ECU；

步骤2)，预警ECU计算汽车四个车轮的垂向力；

步骤2.1)，采用卡尔曼滤波模块接收传感器模块的感应信号，结合轮胎垂向力的计算公式所需的状态量进行迭代计算，得到最优估计的系统状态值；

步骤2.2)，将当前系统状态量的最优估计值带入轮胎垂向力的计算公式，得出当前轮胎垂向力的精确值；

步骤3)，预警ECU分别判断汽车四个车轮的垂向力是否等于零后将判断结果传递给所述灯控ECU；

步骤4)，灯控ECU根据接收到的判断结果控制第一至第三报警灯工作，具体如下：

若只有一个小于0的信号则开启第一报警灯，若有2个等于0的信号第一和第二报警灯，若大于2个小于0信号则开启全部报警灯。

3.基于所述权利要求1所述的侧翻预警系统的预警方法，其特征在于，所述步骤2.1)和步骤2.2)中轮胎垂向力的计算公式如下：

式中，F_fl,F_fr,F_rr,F_rl分别为左前轮、右前轮、右后轮、左后轮的垂向力；

m为车辆质量，g为重力加速度；a、b分别为质心到前轴和后轴距离；l为前后轴距离；

K_θ为俯仰刚度；C_θ为俯仰阻尼；θ为俯仰角，为俯仰角速度；

为侧倾刚度；为侧倾阻尼；为侧倾角，为侧倾角速度；T为轮距；

m_d为车辆簧下质量，m_s为车辆簧上质量；h_d为簧下质量质心高度，h_sr为侧倾中心到地面高度，h_sp为俯仰中心到地面高度；

V_x、分别为纵向速度和侧向加速度，V_y、分别为侧向速度和侧向加速度；r为车辆横摆角速度；为俯仰角加速度；e为簧上质量质心到侧倾中心距离；为侧倾角加速度。

4.基于所述权利要求3所述的侧翻预警系统的预警方法，其特征在于，所述步骤2.1)中卡尔曼滤波器的具体设定如下：

离散系统方程X_k和观测方程Z_k如下：

$\begin{array}{c}{X}_k=F_k{X}_{k-1}+B_k{U}_{k-1}+W_{k-1}\\ Z_k=H_k{X}_k+V_k\end{array};$

式中，F_k、B_k为系统方程的状态矩阵和输入矩阵，H_k为观测方程的状态矩阵，W_k、V_k分别为过程噪声和观测噪声；k为迭代步数；

预测误差协方差矩阵：P_k/k-1＝F_kP_k-1/k-1F_k^T+Q_k；

卡尔曼增益矩阵：K_k＝P_k/k-1H_k^T(H_kP_k/k-1H_k^T+R_k)^-1；

状态更新矩阵：X_k/k＝X_k/k-1+K_k(Z_k-H_kX_k/k-1)；

误差协方差更新矩阵：P_k/k＝(I-K_kH_k)P_k/k-1

式中：Q_k为W_k的方差，R_k为V_k的方差，H_k^T为H_k的转秩矩阵，F_k^T为F_k的转秩矩阵，P_k为预测误差协方差矩阵，K_k为卡尔曼增益矩阵；过程噪声W_k和测量噪声V_k均为高斯白噪声。