机动目标跟踪——三维匀速运动模型CV
Posted 脑壳二
tags:
篇首语：本文由小常识网(cha138.com)小编为大家整理，主要介绍了机动目标跟踪——三维匀速运动模型CV相关的知识，希望对你有一定的参考价值。
机动目标跟踪——三维匀速运动模型CV
原创不易，路过的各位大佬请点个赞
WX: ZB823618313
机动目标跟踪——目标模型概述
1. 对机动目标跟踪的理解
机动目标跟踪一直是目标跟踪领域研究的难点和重点问题。建立目标运动模型和滤波算法是目标跟踪的两个重要因素。由于目标的机动具有不可预测性，使得我们很难建立精确的目标运动模型。如何建立一种有效的模型来反映目标真实的运动轨迹是高机动目标跟踪系统急需解决的问题。经过近三十年的研究，该领域取得了许多重要成果。
个人理解：机动目标跟踪拥有三要素：
被跟踪目标建模（也是本博客重点）
传感器测量（另一个博客介绍）
滤波器设计（见目标跟踪专栏）
从算法层面，在目标跟踪系统中，常用的滤波算法是以卡尔曼滤波器为基本框架的估计算法。卡尔曼滤波器是一种线性、无偏、以误差均方差最小为准则的最优估计算法，它有精确的数学形式和优良的使用效能。卡尔曼滤波方法实质上是一种数据处理方法，它采用递推滤波方法，根据获取的量测数据由递推方程递推给出新的状态估计。由于计算量和存储量小，比较容易满足实时计算的要求，在工程实践中得到广泛应用。
除此之外，非线性滤波也广泛应用与机动目标跟踪，比如：
扩展卡尔曼滤波EKF
无迹卡尔曼滤波UKF
容积卡尔曼滤波CKF
求积卡尔曼滤波QKF
中心差分卡尔曼滤波CDKF
Divided difference filter DDF
高斯混合滤波GSF
强跟踪滤波STF
粒子滤波PF
… …
2. 目标模型概述
机动目标模型描述了目标状态随着时间变化的过程。一个好的模型抵得上大量的数据。当前几乎所有的目标跟踪算法都是基于模型进行状态估计的。在卡尔曼滤波器被引入目标跟踪领域后，基于状态空间的机动目标建模成为主要研究对象之一。
目标的空间运动基于不同的运动轨迹和坐标系
一维运动
二维运动
三维运动根据不同方向的运动是否相关
坐标间不耦合模型
坐标间耦合模型
坐标间不耦合模型： 这类模型假设三维空间三个正交方向上的目标机动过程不耦合。目标机动是飞行器受到外力作用而使得加速度变化所致，所以对机动建模的难点在于对目标加速度的描述。对于无机动目标，常速(Constant Velocity，CV〉模型常用于描述这类目标的运动，而常加速度(Constant Acceleration，CA）模型则常用于描述加速度趋近常数的机动目标的运动。
坐标间耦合模型： 坐标间耦合模型绝大多数情况下指的是转弯运动模型。由于此类模型与坐标密切相关，所以可以分为两类:二维转弯模型和三维转弯模型。二维转弯模型又称为平面转弯模型，即CT模型。
下面讲机动目标不同的模型：
3. 三维匀速CV运动模型
3.1 连续时间匀速运动CV模型
目标状态为：x维位置和速度、y维位置速度、z维位置速度、即 X = [ x , x ˙ ， y , y ˙ ， z , z ˙ ] T X=[x, \\dotx，y, \\doty，z, \\dotz]^T X=[x,x˙，y,y˙，z,z˙]T
CV模型为：
X
˙
(
t
)
=
[
0
1
0
0
0
0
0
0
0
0
0
0
0
0
0
1
0
0
0
0
0
0
0
0
0
0
0
0
0
1
0
0
0
0
0
0
]
X
(
t
)
+
[
0
0
0
1
0
0
0
0
0
0
1
0
0
0
0
0
0
1
]
W
(
t
)
\\dotX(t)=\\beginbmatrix0&1&0&0&0&0\\\\0&0&0&0&0&0\\\\0&0&0&1&0&0\\\\0&0&0&0 &0&0\\\\0&0&0&0&0&1\\\\ 0&0&0&0 &0&0 \\endbmatrixX(t) + \\beginbmatrix0&0&0\\\\1&0&0\\\\0&0&0\\\\0&1&0\\\\0&0&0\\\\0&0&1\\endbmatrixW(t)
X˙(t)=⎣⎢⎢⎢⎢⎢⎢⎡000000100000000000001000000000000010⎦⎥⎥⎥⎥⎥⎥⎤X(t)+⎣⎢⎢⎢⎢⎢⎢⎡010000000100000001⎦⎥⎥⎥⎥⎥⎥⎤W(t)
3.2 离散时间匀速运动CV模型
离散化上述模型：
三维匀速运动模型(离散)：
X
k
+
1
=
[
1
T
0
0
0
0
0
1
0
0
0
0
0
0
1
T
0
0
0
0
0
1
0
0
0
0
0
0
1
T
0
0
0
0
0
1
]
X
k
+
[
T
2
/
2
0
0
T
0
0
0
T
2
/
2
0
0
T
0
0
0
T
2
/
2
0
0
T
]
W
k
X_k+1=\\beginbmatrix1&T&0&0&0&0\\\\0&1&0&0&0&0\\\\0&0&1&T&0&0\\\\0&0&0&1 &0&0\\\\0&0&0&0&1&T\\\\0&0&0&0&0&1\\endbmatrixX_k + \\beginbmatrixT^2/2&0&0\\\\T&0&0\\\\0&T^2/2&0\\\\0&T&0\\\\0&0& T^2/2\\\\0&0&T\\endbmatrixW_k
Xk+1=⎣⎢⎢⎢⎢⎢⎢⎡100000T1000000100000T1000000100000T1⎦⎥⎥⎥⎥⎥⎥⎤Xk+⎣⎢⎢⎢⎢⎢⎢⎡T2/2T000000T2/2T000000T2/2T⎦⎥⎥⎥⎥⎥⎥⎤Wk