DeepSORT（目标跟踪算法）中的状态向量与状态转移矩阵

DeepSORT（目标跟踪算法）中的状态向量与状态转移矩阵

flyfish

状态转移矩阵（State Transition Matrix）F的构造

这篇是一定要看的，拖到文章的最后部分，需要理解状态转移矩阵怎么来的，怎么是这个样子

状态向量（State Vector）

状态向量描述系统在某个时间点的完整状态。它通常包括多个变量，例如位置、速度、加速度等，具体取决于系统的动态特性。

• 记作 ${\mathbf{x}}_k$，其中 $k$ 是时间步长。

状态转移矩阵（State Transition Matrix）

状态转移矩阵描述系统从一个时间点到下一个时间点的状态变化。它反映了状态向量的演化。

• 记作 ${\mathbf{A}}_k$，用于将状态向量从 ${\mathbf{x}}_{k-1}$ 转移到 ${\mathbf{x}}_k$：
  ${\mathbf{x}}_k={\mathbf{A}}_{k-1}{\mathbf{x}}_{k-1}+{\mathbf{B}}_{k-1}{\mathbf{u}}_{k-1}+{\mathbf{w}}_{k-1}$

• 状态向量与状态转移矩阵：状态转移矩阵 ${\mathbf{A}}_k$ 描述了状态向量 ${\mathbf{x}}_k$ 如何从时间 $k-1$ 转移到时间 $k$。例如，对于一个简单的运动模型，状态向量可能包括位置和速度，而状态转移矩阵描述了位置和速度在每个时间步长中的变化。例如，对于一个匀速直线运动模型，状态向量和状态转移矩阵可以表示为：${\mathbf{x}}_k=\left[\begin{array}{c}{x}_k\\ {\dot{x}}_k\end{array}\right],{\mathbf{A}}_k=\left[\begin{array}{cc}1& \Delta t\\ 0& 1\end{array}\right]$这里，$\Delta t$ 是时间步长。

假设我们要跟踪一个在平面上运动的物体，其状态包括位置和速度：

• 状态向量 ${\mathbf{x}}_k$:${\mathbf{x}}_k=\left[\begin{array}{c}{x}_k\\ y_k\\ {\dot{x}}_k\\ {\dot{y}}_k\end{array}\right]$这里 $x_k$ 和 $y_k$ 是位置，${\dot{x}}_k$ 和 ${\dot{y}}_k$ 是速度。
• 状态转移矩阵 ${\mathbf{A}}_k$:${\mathbf{A}}_k=\left[\begin{array}{cccc}1& 0& \Delta t& 0\\ 0& 1& 0& \Delta t\\ 0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]$这表示位置随时间步长 $\Delta t$ 变化。

状态预测

给定当前时间步长 $k-1$ 的状态向量 ${\mathbf{x}}_{k-1}$ 和状态转移矩阵 ${\mathbf{A}}_{k-1}$，下一个时间步长 $k$ 的预测状态向量 ${\hat{\mathbf{x}}}_{k|k-1}$ 可以表示为：
$${\hat{\mathbf{x}}}_{k|k-1}={\mathbf{A}}_{k-1}{\mathbf{x}}_{k-1}+{\mathbf{B}}_{k-1}{\mathbf{u}}_{k-1}$$

• ${\mathbf{A}}_{k-1}$ 是状态转移矩阵，描述了系统的动态特性。
• ${\mathbf{B}}_{k-1}$ 是控制输入矩阵，描述了控制输入如何影响系统状态。
• ${\mathbf{u}}_{k-1}$ 是控制输入向量，包含外部施加的控制量。

误差协方差预测

误差协方差矩阵 ${\mathbf{P}}_{k|k-1}$ 也需要更新，以反映预测状态的不确定性。预测步骤的误差协方差矩阵更新公式为：
${\mathbf{P}}_{k|k-1}={\mathbf{A}}_{k-1}{\mathbf{P}}_{k-1|k-1}{\mathbf{A}}_{k-1}^T+{\mathbf{Q}}_{k-1}$

• ${\mathbf{P}}_{k-1|k-1}$ 是当前时间步长 $k-1$ 的误差协方差矩阵。
• ${\mathbf{Q}}_{k-1}$ 是过程噪声协方差矩阵，反映了模型中未捕捉到的不确定性。

例子

假设我们要跟踪一个在平面上运动的物体，其状态向量包括位置和速度：
$${\mathbf{x}}_k=\left[\begin{array}{c}{x}_k\\ y_k\\ {\dot{x}}_k\\ {\dot{y}}_k\end{array}\right]$$
假设物体做匀速直线运动，状态转移矩阵可以表示为：
$$\mathbf{A}=\left[\begin{array}{cccc}1& 0& \Delta t& 0\\ 0& 1& 0& \Delta t\\ 0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]$$
在没有控制输入的情况下，预测状态的计算如下：
$${\hat{\mathbf{x}}}_{k|k-1}=\mathbf{A}{\mathbf{x}}_{k-1}$$
假设上一时间步长的状态向量为：
$${\mathbf{x}}_{k-1}=\left[\begin{array}{c}10\\ 15\\ 1\\ -1\end{array}\right]$$
其中，物体在位置 $(10,15)$ 处，速度为 $(1,-1)$ 米每秒，时间步长 $\Delta t=1$ 秒。

状态转移计算为：
$${\hat{\mathbf{x}}}_{k|k-1}=\left[\begin{array}{cccc}1& 0& 1& 0\\ 0& 1& 0& 1\\ 0& 0& 1& 0\\ 0& 0& 0& 1\end{array}\right]\left[\begin{array}{c}10\\ 15\\ 1\\ -1\end{array}\right]=\left[\begin{array}{c}10+1\\ 15-1\\ 1\\ -1\end{array}\right]=\left[\begin{array}{c}11\\ 14\\ 1\\ -1\end{array}\right]$$
因此，通过状态转移矩阵，得到了下一个时间步长的预测状态向量 $${\hat{\mathbf{x}}}_{k|k-1}=\left[\begin{array}{c}11\\ 14\\ 1\\ -1\end{array}\right]$$。

在卡尔曼滤波中，控制输入（control input）指的是系统在每个时间步长可以施加的外部影响或干预。控制输入常用于表示可以影响系统状态的外部因素，例如驾驶员对汽车的操控、无人机的推力指令等。

控制输入的作用

控制输入用于描述外部控制如何影响系统状态的变化。它在状态转移方程中起到了修正预测状态的作用，帮助更准确地反映系统的动态。

控制输入的数学描述

状态转移方程中引入控制输入项，使状态更新更全面：
$${\mathbf{x}}_k={\mathbf{A}}_{k-1}{\mathbf{x}}_{k-1}+{\mathbf{B}}_{k-1}{\mathbf{u}}_{k-1}+{\mathbf{w}}_{k-1}$$
其中：

• ${\mathbf{A}}_{k-1}$：状态转移矩阵，描述系统的内在动力学。
• ${\mathbf{B}}_{k-1}$：控制输入矩阵，描述控制输入对系统状态的影响。
• ${\mathbf{u}}_{k-1}$：控制输入向量，表示外部施加的控制。
• ${\mathbf{w}}_{k-1}$：过程噪声，表示模型中未捕捉到的随机扰动。

示例

假设我们在跟踪一辆汽车，状态向量包括位置和速度：
$${\mathbf{x}}_k=\left[\begin{array}{c}{x}_k\\ {\dot{x}}_k\end{array}\right]$$

无控制输入的情况

状态转移矩阵假设汽车做匀速运动：
$$\mathbf{A}=\left[\begin{array}{cc}1& \Delta t\\ 0& 1\end{array}\right]$$
预测下一时间步的状态为：
$${\hat{\mathbf{x}}}_{k|k-1}=\mathbf{A}{\mathbf{x}}_{k-1}$$

有控制输入的情况

假设汽车可以通过加速或减速改变速度，控制输入向量表示加速度：
$${\mathbf{u}}_k=a_k$$
控制输入矩阵描述加速度对速度和位置的影响：
$$\mathbf{B}=\left[\begin{array}{c}0.5\Delta t^2\\ \Delta t\end{array}\right]$$
状态转移方程引入控制输入后变为：
$${\hat{\mathbf{x}}}_{k|k-1}=\mathbf{A}{\mathbf{x}}_{k-1}+\mathbf{B}{\mathbf{u}}_{k-1}$$

具体计算

假设上一时间步的状态向量为：
$${\mathbf{x}}_{k-1}=\left[\begin{array}{c}10\\ 5\end{array}\right]$$
其中，位置为10米，速度为5米每秒。时间步长 $\Delta t=1$ 秒。

如果加速度为2米每秒平方（$a_k=2$），则控制输入向量为：
$${\mathbf{u}}_{k-1}=2$$
状态转移矩阵和控制输入矩阵为：
$$\mathbf{A}=\left[\begin{array}{cc}1& 1\\ 0& 1\end{array}\right],\mathbf{B}=\left[\begin{array}{c}0.5\\ 1\end{array}\right]$$
预测下一时间步的状态为：
$${\hat{\mathbf{x}}}_{k|k-1}=\mathbf{A}{\mathbf{x}}_{k-1}+\mathbf{B}{\mathbf{u}}_{k-1}=\left[\begin{array}{cc}1& 1\\ 0& 1\end{array}\right]\left[\begin{array}{c}10\\ 5\end{array}\right]+\left[\begin{array}{c}0.5\\ 1\end{array}\right]\cdot 2=\left[\begin{array}{c}15\\ 5\end{array}\right]+\left[\begin{array}{c}1\\ 2\end{array}\right]=\left[\begin{array}{c}16\\ 7\end{array}\right]$$
因此，通过引入控制输入，预测得到下一时间步的位置为16米，速度为7米每秒。

在卡尔曼滤波中，测量向量通过观测矩阵可以得到与实际测量值进行比较的预测测量值。这是滤波器更新步骤中的一个关键部分，用于校正预测的状态。