一种考虑车车通讯数据概率化丢失的车辆状态估计方法技术

本发明专利技术公开了一种考虑车车通讯数据概率化丢失的车辆状态估计方法，其技术方案要点是包括通过无线通讯模块建立车车通讯网络，以及建立数据传输规则和数据丢失概率化模型，并通过车车通讯将前车纵向速度和横向加速度信号传递给后车，后车根据该信息与非线性动力学模型结合利用先验与后验相结合的滤波方法估计前车的侧向速度和横摆角速度。本发明专利技术可以实现无线通讯数据发生部分丢失下的分布式驱动车辆状态高精度估计同时大幅减少通讯带宽。辆状态高精度估计同时大幅减少通讯带宽。辆状态高精度估计同时大幅减少通讯带宽。

【技术实现步骤摘要】
一种考虑车车通讯数据概率化丢失的车辆状态估计方法


[0001]本专利技术涉及新能源汽车
，更具体的说是涉及一种考虑车车通讯数据概率化丢失的车辆状态估计方法。

技术介绍

[0002]对智能网联车辆运动状态的准确估计可以为其他车辆的实时驾驶决策提供有效的辅助，车辆的运动状态直接关系到车辆的驾驶操作，因此运动状态的估计一直是汽车的核心技术。
[0003]然而，现有的估计分布式驱动车辆状态的研究没有充分考虑车车通信的优势，同时也忽略了数据传输过程中的数据丢失，这导致这些技术在复杂场景下无法实车应用。

技术实现思路

[0004]针对现有技术存在的不足，本专利技术的目的在于提供一种考虑车车通讯数据概率化丢失的车辆状态估计方法，能够解决针对
技术介绍
中所提及到的缺陷。
[0005]为实现上述目的，本专利技术提供了如下技术方案：
[0006]一种考虑车车通讯数据概率化丢失的车辆状态估计方法，具体包括一下步骤：
[0007]S1：基于车载传感器获得前车纵向速度、横向速度和横摆角速度信号并建立包括纵向速度、横向速度和横摆角速度的非线性车辆动力学模型和轮胎力计算模型；
[0008]S2：基于车载的无线通讯网路建立无线通讯数据间隔发送规则并构建数据丢失概率模型，设计状态估计的更新方程和量测方程；
[0009]S3：结合非线性车辆动力学模型与数据丢失概率模型，利用事件触发容积卡尔曼滤波对车辆的质心侧偏角进行估计生成估计值，此后将估计值代入作为下一时刻的输入值，根据第二步和第三步的动态循环完成前车质心偏角估计。
[0010]作为本专利技术的进一步改进，所述步骤S1中的非线性车辆动力学模型根据车辆模型动力学方程构建，所述车辆模型动力学方程具体为：
[0011][0012][0013][0014][0015][0016]其中：i＝f,r分别表示前轮和后轮，j＝l,r分别表示左轮和后轮，v
x
为车辆纵向速度，F
xfl
为轮胎纵向力，F
yfl
为轮胎侧向力，M
z
为车辆横摆力矩，γ为横摆角速度，m为汽车总质量，a为前轴到质心的距离，b为后轴到质心的距离，δ为前轮转角，a
x
为纵向加速度，a
y
为侧向加速度，I
z
为绕z轴的转动惯量，μ为路面附着系统，β为质心侧偏角，T
f
，T
r
分别为车辆前轴和后轴轮距；
[0017]由于四轮轮毂电机驱动电动汽车四轮驱动或制动转矩独立可控，建立用于计算四个车轮的纵向力的轮胎力计算模型：
[0018][0019]其中：为车辆驱动力矩，w
ij
为车轮转速，J为车轮转动惯量，R为车轮滚动半径。
[0020]作为本专利技术的进一步改进，所述步骤S2中数据发生规则和概率化丢失模型的建立具体方式为：
[0021]建立无线通讯数据间隔发送规则：
[0022][0023][0024]其中：表征目前正在传输到后车的测量值，是上一时刻传输到后车的测量值，z
k
是当前时刻前车传感器的测量输出值，ρ是数据是否发送的阈值，γ
k
是作为前车传感器数据是否被传输的指标，当γ
k
为0值表征预测器在进行下一次迭代更新时仍然使用前一时刻的测量数据，当γ
k
为1值时表征最新的纵向速度和横向加速度的测量值被传输到状态估计器中；
[0025]建立数据丢失概率化模型：
[0026][0027]其中：δ
→
∞和I是一个单位矩阵，当λ
k
＝0，传感器的测量数据将在传输过程中丢失，当λ
k
＝1，估计器将接收传感器的当前测量数据；
[0028]根据公式(1)
‑
公式(6)建立前车状态估计更新方程与测量方程：
[0029][0030]状态变量为：
[0031]x
k
＝[r,β]T
[0032]量测变量为：
[0033]z＝[r]T
[0034]输入变量为：
[0035]u＝[δ,v
x
,F
xfl
,F
xfr
,F
xrl
,F
xrl
,F
yfl
,F
yfr
,F
yrl
,F
yrl
]T
[0036]其中：k为采样时间，x
k
为状态变量，z
k
为测量变量，f为状态转移函数，Γ为测量输出函数，[]T
为矩阵装置，u
k
为输入变量，v
k
为系统过程噪声，过程噪声的协方差为ζ
k
为系统测量噪声，测量噪声的协方差为R
k
，v
k
和ζ
k
是零均值高斯白噪声，彼此不相关，初始状态x0也独立于所有的噪声信号。
[0037]作为本专利技术的进一步改进，所述步骤S3中事件触发容积卡尔曼滤波方法，步骤如下：
[0038]计算初始的状态向量和协方差矩阵：
[0039][0040][0041]其中：E是进行数学期望，x0表示待预测向量初值，P0表示对应的初始协方差矩阵；
[0042]计算基本的容积点和权重
[0043][0044][0045]其中：C是容积点，n＝3是状态向量维度；
[0046]对公式(12)中的协方差矩阵P0进行对角化得到
[0047][0048]其中：U和V分别是上三角和下三角矩阵，S是对角矩阵；
[0049]计算容积点：
[0050][0051]对容积点进行先验传播：
[0052][0053]估计估计状态和协方差
[0054][0055][0056]定义递推滤波形式如下：
[0057][0058]其中：K
k+1
是M
k+1
估计器的增益矩阵，是后验估计值，是先验估计值；
[0059]设定后验状态估计偏差为先验状态估计偏差为
[0060]当γ
k+1
＝1时，增益K
k+1
和后验误差协方差
[0061][0062][0063]其中：和P
zz,k+1
分别是一般状态估计误差协方差和估计测量协方差；
[0064]当γ
k+1
＝0时，等式(19)可以表达为：
[0065][0066]对f(x
k
,u
k
)在进行一阶泰勒展开得到：
[0067][0068][0069]其中：α
k
是一个代表高阶项的矩阵；
[0070]对Γ(x
k+1
,u
k+1
)进行一阶泰勒本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种考虑车车通讯数据概率化丢失的车辆状态估计方法，其特征在于：具体包括一下步骤：S1：基于车载传感器获得前车纵向速度、横向速度和横摆角速度信号并建立包括纵向速度、横向速度和横摆角速度的非线性车辆动力学模型和轮胎力计算模型；S2：基于车载的无线通讯网路建立无线通讯数据间隔发送规则并构建数据丢失概率模型，设计状态估计的更新方程和量测方程；S3：结合非线性车辆动力学模型与数据丢失概率模型，利用事件触发容积卡尔曼滤波对车辆的质心侧偏角进行估计生成估计值，此后将估计值代入作为下一时刻的输入值，根据第二步和第三步的动态循环完成前车质心偏角估计。2.根据权利要求1所述的一种考虑车车通讯数据概率化丢失的车辆状态估计方法，其特征在于：所述步骤S1中的非线性车辆动力学模型根据车辆模型动力学方程构建，所述车辆模型动力学方程具体为：辆模型动力学方程具体为：辆模型动力学方程具体为：辆模型动力学方程具体为：辆模型动力学方程具体为：其中：i＝f,r分别表示前轮和后轮，j＝l,r分别表示左轮和后轮，v
x
为车辆纵向速度，F
xfl
为轮胎纵向力，F
yfl
为轮胎侧向力，M
z
为车辆横摆力矩，γ为横摆角速度，m为汽车总质量，a为前轴到质心的距离，b为后轴到质心的距离，δ为前轮转角，a
x
为纵向加速度，a
y
为侧向加速度，I
z
为绕z轴的转动惯量，μ为路面附着系统，β为质心侧偏角，T
f
，T
r
分别为车辆前轴和后轴轮距；由于四轮轮毂电机驱动电动汽车四轮驱动或制动转矩独立可控，建立用于计算四个车轮的纵向力的轮胎力计算模型：
其中：为车辆驱动力矩，w
ij
为车轮转速，J为车轮转动惯量，R为车轮滚动半径。3.根据权利要求1所述的一种考虑车车通讯数据概率化丢失的车辆状态估计方法，其特征在于：所述步骤S2中数据发生规则和概率化丢失模型的建立具体方式为：建立无线通讯数据间隔发送规则：建立无线通讯数据间隔发送规则：其中：表征目前正在传输到后车的测量值，是上一时刻传输到后车的测量值，z
k
是当前时刻前车传感器的测量输出值，ρ是数据是否发送的阈值，γ
k
是作为前车传感器数据是否被传输的指标，当γ
k
为0值表征预测器在进行下一次迭代更新时仍然使用前一时刻的测量数据，当γ
k
为1值时表征最新的纵向速度和横向加速度的测量值被传输到状态估计器中；建立数据丢失概率化模型：其中：δ
→
∞和I是一个单位矩阵，当λ
k
＝0，传感器的测量数据将在传输过程中丢失，当λ
k
＝1，估计器将接收传感器的当前测量数据；根据公式(1)
‑
公式(6)建立前车状态估计更新方程与测量方程：状态变量为：x
k
＝[r,β]
T
量测变量为：z＝[r]
T
输入变量为：u＝[δ,v
x
,F
xfl
,F
xfr
,F
xrl
,F
xrl
,F
yfl
,F
yfr
,F
yrl
,F
yrl
...

【专利技术属性】
技术研发人员：汪，
申请(专利权)人：英博超算南京科技有限公司，
类型：发明
国别省市：