1.一种考虑车车通讯数据概率化丢失的车辆状态估计方法,其特征在于:具体包括一下步骤:S1:基于车载传感器获得前车纵向速度、横向速度和横摆角速度信号并建立包括纵向速度、横向速度和横摆角速度的非线性车辆动力学模型和轮胎力计算模型;
S2:基于车载的无线通讯网路建立无线通讯数据间隔发送规则并构建数据丢失概率模型,设计状态估计的更新方程和量测方程;
S3:结合非线性车辆动力学模型与数据丢失概率模型,利用事件触发容积卡尔曼滤波对车辆的质心侧偏角进行估计生成估计值,此后将估计值代入作为下一时刻的输入值,根据第二步和第三步的动态循环完成前车质心偏角估计。
2.根据权利要求1所述的一种考虑车车通讯数据概率化丢失的车辆状态估计方法,其特征在于:所述步骤S1中的非线性车辆动力学模型根据车辆模型动力学方程构建,所述车辆模型动力学方程具体为:其中:i=f,r分别表示前轮和后轮,j=l,r分别表示左轮和后轮,vx为车辆纵向速度,Fxfl为轮胎纵向力,Fyfl为轮胎侧向力,Mz为车辆横摆力矩,γ为横摆角速度,m为汽车总质量,a为前轴到质心的距离,b为后轴到质心的距离,δ为前轮转角,ax为纵向加速度,ay为侧向加速度,Iz为绕z轴的转动惯量,μ为路面附着系统,β为质心侧偏角,Tf,Tr分别为车辆前轴和后轴轮距;
由于四轮轮毂电机驱动电动汽车四轮驱动或制动转矩独立可控,建立用于计算四个车轮的纵向力的轮胎力计算模型:其中: 为车辆驱动力矩,wij为车轮转速,J为车轮转动惯量,R为车轮滚动半径。
3.根据权利要求1所述的一种考虑车车通讯数据概率化丢失的车辆状态估计方法,其特征在于:所述步骤S2中数据发生规则和概率化丢失模型的建立具体方式为:建立无线通讯数据间隔发送规则:
其中: 表征目前正在传输到后车的测量值, 是上一时刻传输到后车的测量值,zk是当前时刻前车传感器的测量输出值,ρ是数据是否发送的阈值,γk是作为前车传感器数据是否被传输的指标,当γk为0值表征预测器在进行下一次迭代更新时仍然使用前一时刻的测量数据,当γk为1值时表征最新的纵向速度和横向加速度的测量值被传输到状态估计器中;
建立数据丢失概率化模型:
其中:δ→∞和I是一个单位矩阵,当λk=0,传感器的测量数据将在传输过程中丢失,当λk=1,估计器将接收传感器的当前测量数据;
根据公式(1)‑公式(6)建立前车状态估计更新方程与测量方程:状态变量为:
T
xk=[r,β]
量测变量为:
T
z=[r]
输入变量为:
T
u=[δ,vx,Fxfl,Fxfr,Fxrl,Fxrl,Fyfl,Fyfr,Fyrl,Fyrl]其中:k为采样时间,xk为状态变量,zk为测量变量,f为状态转移函数,Γ为测量输出函T数,[] 为矩阵装置,uk为输入变量,vk为系统过程噪声,过程噪声的协方差为 ζk为系统测量噪声,测量噪声的协方差为Rk,vk和ζk是零均值高斯白噪声,彼此不相关,初始状态x0也独立于所有的噪声信号。
4.根据权利要求1所述的一种考虑车车通讯数据概率化丢失的车辆状态估计方法,其特征在于:所述步骤S3中事件触发容积卡尔曼滤波方法,步骤如下:计算初始的状态向量和协方差矩阵:
其中:E是进行数学期望,x0表示待预测向量初值,P0表示对应的初始协方差矩阵;
计算基本的容积点 和权重
其中:C是容积点,n=3是状态向量维度;
对公式(12)中的协方差矩阵P0进行对角化得到其中:U和V分别是上三角和下三角矩阵,S是对角矩阵;
计算容积点:
对容积点进行先验传播:
估计估计状态 和协方差
定义递推滤波形式如下:
其中:Kk+1是Mk+1估计器的增益矩阵, 是后验估计值, 是先验估计值;
设定后验状态估计偏差为 先验状态估计偏差为 当γk+1=1时,增益Kk+1和后验误差协方差其中: 和Pzz,k+1分别是一般状态估计误差协方差和估计测量协方差;当γk+1=0时,等式(19)可以表达为:对f(xk,uk)在 进行一阶泰勒展开得到:其中:αk是一个代表高阶项的矩阵;
对Γ(xk+1,uk+1)进行一阶泰勒展开得到:其中:θk是一个代表高阶项的矩阵;
公式(10)减去公式(22), 可以表达如下:根据公式(25), 可以改写为:
根据公式(27), 计算如下:
其中:
因为ek和ζk是独立的,所述Zk+1等于零,对于Ωk+1和ψk+1应用如下引理,对于两个向量x,yn∈R,R为实数集合且σ>0.有;
T T T ‑1 T
xy+yx≤axx+a yy (29)根据公式(28),有以下不等式:
把公式(29)带入公式(27), 的上界 为:其中a1和a2是一个正数,基于等式(20)和(30),误差协方差上界 表达如下:对 相对Mk+1求微分等于零:
增益Mk+1如下:
在获得增益矩阵后对 进行对角化:
计算容积点:
对容积点进行先验传播:
估计测量向量 和新息协方差 以及互协方差通过公式(20)和公式(34)计算出的Kk+1或者Mk+1值,并通过公式(19)进行状态后验更新。