KF V.S. GM-PHD

在计算机视觉的多目标跟踪（MOT）任务中，卡尔曼滤波（KF）和高斯混合概率假设密度（GM-PHD）滤波器是两种经典的状态估计方法，但它们的原理和应用场景存在显著差异。以下是两者的核心机制和对比：

---

1. 卡尔曼滤波（KF）

核心思想

• 状态估计：基于线性动态模型和高斯噪声假设，通过“预测-更新”循环迭代估计目标的状态（如位置、速度）。
• 恒定速度模型（CV模型）：假设目标在短时间内运动速度恒定，适用于简单运动场景。

工作流程（以目标跟踪为例）

1. 预测（Predict）：
   • 根据上一时刻的状态${\mathbf{x}}_{k-1}$和状态转移矩阵$\mathbf{F}$，预测当前状态${\mathbf{x}}_k^{-}$和协方差${\mathbf{P}}_k^{-}$。
   • 例如：
   $${\mathbf{x}}_k^{-}=\mathbf{F}{\mathbf{x}}_{k-1},\mathbf{F}=\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]$$
   （状态向量通常为$\mathbf{x}=[x,y,v_x,v_y{]}^{\top }$，$\Delta t$为时间间隔）

2. 更新（Update）：
   • 将预测状态与当前帧的检测结果（观测${\mathbf{z}}_k$）融合，通过卡尔曼增益$\mathbf{K}$修正状态和协方差。
   • 更新公式：
   $${\mathbf{x}}_k={\mathbf{x}}_k^{-}+\mathbf{K}({\mathbf{z}}_k-\mathbf{H}{\mathbf{x}}_k^{-})$$
   （$\mathbf{H}$为观测矩阵，将状态映射到观测空间）

3. 数据关联：
   • 通常与匈牙利算法或IoU匹配结合，将检测框与预测状态关联。

优点

• 计算高效，适合实时系统。
• 对线性高斯运动模型表现稳定。

局限性

• 依赖线性模型，难以处理复杂运动（如急转弯）。
• 需手动设计状态向量和噪声参数。

---

2. 高斯混合概率假设密度（GM-PHD）滤波器

核心思想

• 多目标贝叶斯滤波：直接估计所有目标的联合概率密度（PHD），避免显式数据关联。
• 随机有限集（RFS）：将目标和观测建模为随机集合，处理目标出现、消失和杂波。

工作流程

1. 预测步骤：
   • 根据上一时刻的PHD（高斯混合形式）和运动模型，预测当前PHD。
   • 例如：
   $$D_{k|k-1}(\mathbf{x})=\sum _i{w}_{k-1}^{(i)}\mathcal{N}(\mathbf{x};\mathbf{F}{\mu }_{k-1}^{(i)},\mathbf{Q}+\mathbf{F}{\mathbf{P}}_{k-1}^{(i)}{\mathbf{F}}^{\top })$$
   （$w_{k-1}^{(i)}$为权重，$\mathbf{Q}$为过程噪声）

2. 更新步骤：
   • 将当前帧的观测${\mathbf{z}}_k$与预测PHD融合，计算后验PHD。
   • 更新公式（考虑漏检和杂波）：
   $$D_k(\mathbf{x})=(1-p_D)D_{k|k-1}(\mathbf{x})+\sum _{\mathbf{z}\in {\mathbf{Z}}_k}\frac{p_D{D}_{k|k-1}(\mathbf{x})g(\mathbf{z}|\mathbf{x})}{{\lambda }_c(\mathbf{z})+\int p_{D}g(\mathbf{z}|\xi )D_{k|k-1}(\xi )d\xi }$$
   （$p_D$为检测概率，${\lambda }_c$为杂波强度）

3. 目标提取：
   • 从后验PHD中提取高斯分量，保留权重大于阈值的分量作为目标状态估计。

优点

• 自动处理目标数量的变化（新生、消失）。
• 无需显式数据关联，适合高杂波场景。

局限性

• 计算复杂度高于KF（尤其高斯分量多时）。
• 需调参（如杂波强度、检测概率）。

---

3. 对比总结

特性	卡尔曼滤波（KF）	GM-PHD滤波器
适用场景	线性运动、目标数量固定	目标数量动态变化、高杂波环境
数据关联	需显式匹配（如匈牙利算法）	隐式处理（通过PHD融合）
计算效率	高效（适合实时）	较高（高斯分量多时慢）
参数依赖	运动模型、噪声协方差	杂波模型、检测概率
典型应用	SORT、DeepSORT	MOT中的杂波场景（如雷达跟踪）

---

4. 现代改进与联合方法

• KF的扩展：
• EKF/UKF：处理非线性运动（如转弯模型）。
• 自适应KF：动态调整噪声参数。
• GM-PHD的改进：
• LMB/PHD：结合标签管理，避免ID切换。
• 联合检测跟踪（如FairMOT、CenterTrack）：
• 将检测、运动估计、关联模型端到端训练，平衡精度与效率。