机动目标跟踪—匀速转弯CT模型/匀速圆周运动

Posted 2023-01-14 脑壳二

机动目标跟踪—匀速转弯CT模型/匀速圆周运动

原创不易，路过的各位大佬请点个赞

针对机动目标跟踪的探讨、技术支持欢迎联系，也可以站内私信
WX: ZB823618313

机动目标跟踪—匀速转弯CT模型/匀速圆周运动

• 机动目标跟踪—匀速转弯CT模型/匀速圆周运动
• • 1. 对机动目标跟踪的理解
  • 2. 目标模型概述
  • 3. 匀速圆周运动CT
  • • 3.1 匀速圆周运动CT模型(连续)
    • 3.2 匀速圆周运动CT模型(离散)
    • 3.3 匀速圆周运动CT模型(转弯角速度未知)
  • 4 匀速圆周运动CT模型目标跟踪
  • • 4.1 卡尔曼滤波跟踪CT目标
    • 4.2 扩展卡尔曼滤波跟踪
    • 4.3 无迹卡尔曼滤波跟踪
  • 5 匀加速运动CA模型
  • 6 匀速转弯CT模型
  • 7 Singer模型
  • 8 “当前”统计模型
  • 9 Jerk统计模型

1. 对机动目标跟踪的理解

  机动目标跟踪一直是目标跟踪领域研究的难点和重点问题。建立目标运动模型和滤波算法是目标跟踪的两个重要因素。由于目标的机动具有不可预测性，使得我们很难建立精确的目标运动模型。如何建立一种有效的模型来反映目标真实的运动轨迹是高机动目标跟踪系统急需解决的问题。经过近三十年的研究，该领域取得了许多重要成果。

个人理解：机动目标跟踪拥有三要素：

被跟踪目标建模（也是本博客重点）
传感器测量（另一个博客介绍）
滤波器设计（见目标跟踪专栏）

  从算法层面，在目标跟踪系统中，常用的滤波算法是以卡尔曼滤波器为基本框架的估计算法。卡尔曼滤波器是一种线性、无偏、以误差均方差最小为准则的最优估计算法，它有精确的数学形式和优良的使用效能。卡尔曼滤波方法实质上是一种数据处理方法，它采用递推滤波方法，根据获取的量测数据由递推方程递推给出新的状态估计。由于计算量和存储量小，比较容易满足实时计算的要求，在工程实践中得到广泛应用。
  除此之外，非线性滤波也广泛应用与机动目标跟踪，比如：

扩展卡尔曼滤波EKF
无迹卡尔曼滤波UKF
容积卡尔曼滤波CKF
求积卡尔曼滤波QKF
中心差分卡尔曼滤波CDKF
Divided difference filter DDF
高斯混合滤波GSF
强跟踪滤波STF
粒子滤波PF
… …

2. 目标模型概述

  机动目标模型描述了目标状态随着时间变化的过程。一个好的模型抵得上大量的数据。当前几乎所有的目标跟踪算法都是基于模型进行状态估计的。在卡尔曼滤波器被引入目标跟踪领域后，基于状态空间的机动目标建模成为主要研究对象之一。

1. 目标的空间运动基于不同的运动轨迹和坐标系
   一维运动
   二维运动
   三维运动

2. 根据不同方向的运动是否相关
   坐标间不耦合模型
   坐标间耦合模型

坐标间不耦合模型： 这类模型假设三维空间三个正交方向上的目标机动过程不耦合。目标机动是飞行器受到外力作用而使得加速度变化所致，所以对机动建模的难点在于对目标加速度的描述。对于无机动目标，常速(Constant Velocity，CV〉模型常用于描述这类目标的运动，而常加速度(Constant Acceleration，CA）模型则常用于描述加速度趋近常数的机动目标的运动。

本博客主要讲下面的模型：

坐标间耦合模型： 坐标间耦合模型绝大多数情况下指的是转弯运动模型。由于此类模型与坐标密切相关，所以可以分为两类:二维转弯模型和三维转弯模型。二维转弯模型又称为平面转弯模型，即CT模型。

下面二维匀加速运动CA模型：

3. 匀速圆周运动CT

CT运动模型是用来模拟目标进行角速度$\Omega (t)$恒定的转弯运动时的运动模型。与CT模型相对应的状态向量为
$$X=[x,\dot{x},y,\dot{y},,\Omega (t){]}^T$$
式中，$y(t)$和$\dot{y}(t)$是与$x$垂直方向上的速度和加速度。假设其角速度$\Omega (t)$在一定时间段内是恒定的，则该转弯模型为匀速转弯模型，匀速转弯模型有个优良的性质：
在$\Omega (t)$已知是，CT模型是线性模型，反之如果$\Omega (t)$未知，则为非线性模型

下面主要普遍应用的角速度已知的匀速转弯模型

3.1 匀速圆周运动CT模型(连续)

目标状态为：x维位置和速度加速度、y维位置速度加速度、即$$X=[x,\dot{x}，y,\dot{y}{]}^T$$

CT模型为：
$$\dot{X}(t)=\left[\begin{array}{cccc}0& 1& 0& 0\\ 0& 0& 0& -\omega \\ 0& 0& 0& 1\\ 0& \omega & 0& 0\end{array}\right]X(t)+\left[\begin{array}{cc}0& 0\\ 1& 0\\ 0& 0\\ 0& 1\end{array}\right]W(t)$$

3.2 匀速圆周运动CT模型(离散)

离散化上述模型：

$$X_{k+1}=\left[\begin{array}{cccc}1& \frac{\sin (\omega T)}{\omega }& 0& -\frac{1-\cos (\omega T)}{\omega }\\ 0& \cos (\omega T)& 0& -\sin (\omega T)\\ 0& \frac{1-\cos (\omega T)}{\omega }& 1& \frac{\sin (\omega T)}{\omega }\\ 0& \sin (\omega T)& 0& \cos (\omega T)\end{array}\right]X_k+\left[\begin{array}{cc}{T}^2/2& 0\\ T& 0\\ 0& T^2/2\\ 0& T\end{array}\right]W_k$$

令
F k = [ 1 sin ⁡ ( ω T ) ω 0 − 1 − cos ⁡ ( ω T ) ω 0 cos ⁡ ( ω T ) 0 − sin ⁡ ( ω T ) 0 1 − cos ⁡ ( ω T ) ω 1 sin ⁡ ( ω T ) ω 0 sin ⁡ ( ω T ) 0 cos ⁡ ( ω T ) ] , G k = [ T 2 / 2 0 T 0 0 T 2 / 2