[发明专利]一种基于量化自适应卡尔曼滤波的车辆轨迹跟踪方法

权利要求书

1.一种基于量化自适应卡尔曼滤波的车辆轨迹跟踪方法，其特征在于，所述方法包括如下步骤：

1)在智能网联交通系统中，通过DSRC技术自动识别行驶的车辆并获取相关数据，实现车载系统与路边单元的信息交互，其中，信息交互的步骤如下：

步骤1.1：当行驶车辆进入定向天线所覆盖的范围内时，车载系统会与路边单元通过DSRC技术实现双向通信，使得双方能同时发送自身存储单元上的信息，其中，车载系统发送的信息包括车辆的当前速度、当前位置和时间戳，路边单元发送的信息包括其他车道上车辆的预测位置、位于哪个方向上、几车道和加速度；

步骤1.2：路边单元将获取到的车辆信息发送到边缘云服务器进行一系列的运算操作；

2)边缘云服务器根据路边单元与车载系统之间的方位差，进行方位角计算并做相应的量化处理，针对位置信息对车辆行驶方向进行量化，其中，量化过程为：

步骤2.1：将位置信息转换成以视角存在的数字信息，其中，车辆的方向角相对于路边单元的定义为：

；

在此，各参数定义如下：

在t时刻路边单元与车载系统之间的方向角；

θ_t：将t时刻的车辆位置转化为方位角的反三角函数；

σ_t：在t时刻由信号反射引起的轴承误差噪声；

(x_t,y_t)：在t时刻车辆的当前位置；

步骤2.2：以十字路口中心作为坐标原点，对方向角进行量化处理，确定车辆所在的方向，其中，量化公式如下：

在此，各参数定义如下：

b_t：t时刻车辆在十字路口的量化方向；

q(·)：量化函数；

i：十字路口的方向标识；

步骤2.3：为了实现方向信息的具体化，对该方向的车道进行量化，将方向角重命名为将其记录为：

在此，各参数定义如下：

θ_t'：t时刻，将车辆与路边单元的相对位置转化为方位角的反三角函数；

(x_i,y_i)：方向i上路边单元的固定位置；

步骤2.4：针对上述量化公式，对车辆所在的方向进行第二次量化，确定车辆所在的车道；

在此，各参数定义如下：

q_t：在t时刻车道的量化方向；

j_i：位于方向i上的第j个车道；

n：车道总数；

3)假设仅使用最近的p+1个车辆速度进行加速度估计，第p个加速度计算方式为：

在此，各参数定义如下：

Δτ：采样时间间隔；

Δv：后一时刻与前一时刻的速度之差；

v_t-p：在t-p时刻小车的速度；

τ_t-p：在t-p时刻小车的时间戳；

a_t-p：第p个加速度值；

此后，根据p个加速度值，利用自回归滑动平均法进行车辆加速度预测，其中，预测公式如下：

在此，各参数定义如下：

a_t：在t时刻小车的加速度；

p：自回归阶数，即加速度总数；

q：移动平均阶数，即滑动总数；

β：不为零的待定系数；

不为零的待定系数；

ξ_t：在t时刻独立的误差项；

4)假设驾驶员在不变道的情况下，针对采集的相关信息，利用自适应卡尔曼滤波算法对行驶车辆进行水平位置预测，其中，水平位置的计算公式为：

利用状态空间模型将上述公式转化为状态方程和观测方程，其中，方程如下所示：

x_t+1＝A_tx_t+B_tu_t+ω_t；

z_t＝C_tx_t+ε_t；

在此，各参数定义如下：

x_t：在t时刻小车的状态向量；

A_t,B_t,C_t：在t时刻的状态转移矩阵；

u_t：在t时刻小车的加速度；

ω_t：在t时刻的系统误差，服从高斯分布N(0,Q_t)，其中，Q_t为在t时刻的过程噪声方差；

ε_t：在t时刻的测量误差，服从高斯分布N(0,R_t)，其中，R_t为在t时刻的测量噪声方差；

z_t：在t时刻系统的状态观测值；

此后，根据状态空间模型利用自适应卡尔曼滤波算法对车辆水平位置进行预测，其中，车辆位置更新的步骤如下：

步骤4.1：给定初始值和其中，表示t时刻小车水平位置的预测值，表示t时刻小车的误差协方差；

步骤4.2：根据给定的初始值计算t时刻的卡尔曼增益值K_t，其中，

步骤4.3：根据t时刻的预测值和观测值z_t，可以得到当前状态的修正值其中，公式如下：

z_t＝C_tx_t+R_t

步骤4.4：更新误差协方差的值，为预测t+1时刻的误差协方差做准备，其中，I为单位阵；

步骤4.5：根据t时刻的修正值以及加速度u_t去预测t+1时刻小车的水平位置其中，

步骤4.6：预测误差协方差，由前一时刻的误差协方差去预测后一时刻的误差协方差其中，μ_t+1为自适应遗忘因子；

步骤4.7：计算t+1时刻的加速度u_t+1，其中，计算方法如所述步骤3)中的自回归滑动平均法；

步骤4.8：更新迭代次数k为k＝k+1并重新回到步骤4.2开始新一轮的计算；

5)最后，边缘云服务器将处理好的信息通过光缆传送给路边单元，以便于下一次与车载系统的信息交互。