机动目标跟踪——Jerk模型
Posted 脑壳二
tags:
篇首语：本文由小常识网(cha138.com)小编为大家整理，主要介绍了机动目标跟踪——Jerk模型相关的知识，希望对你有一定的参考价值。
机动目标跟踪——Jerk模型
原创不易，路过的各位大佬请点个赞
WX: ZB823618313
机动目标跟踪——Jerk模型
1. 对机动目标跟踪的理解
1.1. 对机动目标跟踪的理解
机动目标跟踪一直是目标跟踪领域研究的难点和重点问题。建立目标运动模型和滤波算法是目标跟踪的两个重要因素。由于目标的机动具有不可预测性，使得我们很难建立精确的目标运动模型。如何建立一种有效的模型来反映目标真实的运动轨迹是高机动目标跟踪系统急需解决的问题。经过近三十年的研究，该领域取得了许多重要成果。
个人理解：机动目标跟踪拥有三要素：
被跟踪目标建模（本博客重点讲：Jerk模型）
传感器测量（另一个博客介绍）
滤波器设计（见目标跟踪专栏）
从算法层面，在目标跟踪系统中，常用的滤波算法是以卡尔曼滤波器为基本框架的估计算法。卡尔曼滤波器是一种线性、无偏、以误差均方差最小为准则的最优估计算法，它有精确的数学形式和优良的使用效能。卡尔曼滤波方法实质上是一种数据处理方法，它采用递推滤波方法，根据获取的量测数据由递推方程递推给出新的状态估计。由于计算量和存储量小，比较容易满足实时计算的要求，在工程实践中得到广泛应用。
除此之外，非线性滤波也广泛应用与机动目标跟踪，比如：
扩展卡尔曼滤波EKF
无迹卡尔曼滤波UKF
容积卡尔曼滤波CKF
求积卡尔曼滤波QKF
中心差分卡尔曼滤波CDKF
Divided difference filter DDF
高斯混合滤波GSF
强跟踪滤波STF
粒子滤波PF
… …
1.2. 目标模型概述
机动目标模型描述了目标状态随着时间变化的过程。一个好的模型抵得上大量的数据。当前几乎所有的目标跟踪算法都是基于模型进行状态估计的。在卡尔曼滤波器被引入目标跟踪领域后，基于状态空间的机动目标建模成为主要研究对象之一。
常用的目标运动模型包括：
匀速运动模型，CV
匀加速运动模型，CA
匀速转弯模型，CT
Singer 模型
“当前”统计模型
Jerk 模型
目标的空间运动基于不同的运动轨迹和坐标系
一维运动
二维运动
三维运动根据不同方向的运动是否相关
坐标间不耦合模型
坐标间耦合模型
2. 一维Jerk模型
Jerk模型假设目标加速度变化率服从零均值、平稳一阶时间相关过程，其时间相关函数为指数衰减形式，即加速度变化率
j
(
t
)
j(t)
j(t)满足：
R
j
(
τ
)
=
E
[
j
(
t
)
j
(
t
+
τ
)
]
=
σ
2
e
−
α
∣
τ
∣
,
α
≥
0
R_j(\\tau)=E[j(t)j(t+\\tau)]=\\sigma^2e^-\\alpha|\\tau|, \\alpha\\geq0
Rj(τ)=E[j(t)j(t+τ)]=σ2e−α∣τ∣,α≥0
其中：
σ
\\sigma
σ为加加速度的方差；
α
\\alpha
α为自相关时间常数，也称之为机动频率。
通过Wiener-Kolmogorov白化过程进行处理可得关于加速度在状态空间的描述方式为
j
˙
(
t
)
=
−
α
j
(
t
)
+
w
(
t
)
\\dotj(t)=-\\alpha j(t) +w(t)
j˙(t)=−αj(t)+w(t)
其中：
w
(
t
)
w(t)
w(t)是均值为0，方差为
σ
2
\\sigma^2
σ2的高斯白噪声。
2.1. Jerk模型（连续）
令状态向量为
X
=
[
x
,
x
˙
,
x
¨
,
d
x
¨
/
d
t
]
T
X=[x, \\dotx,\\ddotx, d\\ddotx/dt]^T
X=[x,x˙,x¨,dx¨/dt]T
则加速度为
j
(
t
)
=
d
x
¨
(
t
)
/
d
t
j(t)=d\\ddotx(t)/dt
j(t)=dx¨(t)/dt
连续时间Jerk模型为
X
˙
(
t
)
=
[
0
1
0
0
0
0
1
0
0
0
0
1
0
0
0
−
α
]
X
(
t
)
+
[
0
0
0
1
]
w
(
t
)
\\dotX(t)=\\beginbmatrix0&1&0&0\\\\0&0&1&0\\\\0&0&0&1\\\\0&0&0&-\\alpha\\endbmatrixX(t) + \\beginbmatrix0\\\\0\\\\0\\\\1\\endbmatrixw(t)
X˙(t)=⎣⎢⎢⎡000010000100001−α⎦⎥⎥⎤X(t)+⎣⎢⎢⎡0001⎦⎥⎥⎤w(t)
Jerk模型也可以表述为
X
˙
(
t
)
=
A
X
(
t
)
+
B
w
(
t
)
\\dotX(t)=AX(t) + Bw(t)
X˙(t)=AX(t)+Bw(t)
其中
A
=
[
0
1
0
0
0
0
1
0
0
0
0
1
0
0
0
−
α
]
,
B
=
[
0
0
0
1
]
A=\\beginbmatrix0&1&0&0\\\\0&0&1&0\\\\0&0&0&1\\\\0&0&0&-\\alpha\\endbmatrix, B= \\beginbmatrix0\\\\0\\\\0\\\\1\\endbmatrix
A=⎣⎢⎢⎡000010000100001−α⎦⎥⎥⎤,B=⎣⎢⎢⎡0001⎦⎥⎥⎤
2.2. Jerk模型（离散）
周期T采样离散化后，转化为离散时间状态方程为：
X
k
+
1
=
F
k
X
k
+
W
k
X_k+1=F_kX_k + W_k
Xk+1=FkXk+Wk
其中
F
k
=
[
1
T
T
2
/
2
p
1
0
1
T
q
1
0
0
1
r
1
0
0
0
s
1
]
F_k=\\beginbmatrix1&T&T^2/2&p1\\\\0&1&T &q1 \\\\0&0&1 &r1\\\\ 0&0&0&s1\\endbmatrix
Fk=⎣⎢⎢⎡1000T100T2/2T10p1q1r1s1⎦⎥⎥⎤
其中：
p 1 = ( 2 − 2 α
以上是关于机动目标跟踪——Jerk模型的主要内容，如果未能解决你的问题，请参考以下文章