基于卡尔曼滤波与匈牙利算法的多目标跟踪系统

资 源 简 介

该项目提供了一个完整的多目标航迹跟踪全流程方案，旨在解决多个动态目标在视场中的运动状态估计与身份保持问题。 系统主要功能涵盖了从原始数据处理到轨迹可视化的核心步骤。首先，通过卡尔曼滤波（Kalman Filter）为每个待跟踪目标建立独立的线性运动模型，利用预测与校正循环实时估算目标的位置与速度。 其次，系统集成了高效的多目标数据关联机制，利用匈牙利算法（Hungarian Algorithm）计算检测点与现有航迹之间的代价矩阵（通常基于欧几里得距离或代价重叠度），实现多对多的一一最优匹配，防止航迹漂移或

详 情 说 明

基于卡尔曼滤波与匈牙利算法的多目标跟踪演示系统

项目介绍

本项目是一个基于 MATLAB 开发的多目标跟踪（Multi-Object Tracking, MOT）验证系统。它模拟了多个目标在二维空间内的运动轨迹，并演示了如何利用卡尔曼滤波进行状态预测与估计，结合匈牙利算法解决检测结果与现有航迹之间的关联问题。该系统能够有效地处理目标的进入、消失、短暂遮挡以及观测噪声干扰，是学习多目标跟踪算法全流程的理想方案。

功能特性

1. 运动建模与预测：为每个目标建立独立的线性恒速（Constant Velocity）运动模型，利用卡尔曼滤波进行实时预测。
2. 鲁棒的数据关联：采用匈牙利算法计算全局最优匹配，通过设置欧几里得距离阈值防止错误关联。
3. 动态航迹管理：支持航迹的全生命周期管理，包括自动初始化新目标、维护活动航迹以及清理失效航迹。
4. 遮挡与丢失处理：当目标发生短暂遮挡（无检测数据）时，系统利用卡尔曼预测值维持航迹，确保目标 ID 的连续性。
5. 实时可视化：动态展示检测点、滤波后的运动轨迹、目标矩形框以及唯一的身份标识（ID）。

系统要求

• 软件环境：MATLAB R2016b 或更高版本。
• 必备工具箱：需要支持 matchpairs 函数（通常包含在 MATLAB 核心函数库、Optimization Toolbox 或 Bioinformatics Toolbox 中）。

系统实现逻辑

系统运行流程严格遵循以下八个核心步骤：

1. 模拟数据生成：程序预设了四个目标的真实运动路径，并在每一帧中加入高斯白噪声。系统模拟了复杂的实际场景：

* 目标 1：在较晚帧数（第 70 帧后）才消失。 * 目标 2：在第 40 至 50 帧间发生遮挡。 * 目标 4：在特定帧范围内出现或跳变。

1. 卡尔曼预测：在获取新检测前，利用状态转移矩阵对现有所有航迹进行先验状态估计，计算预测位置及协方差。
2. 构建代价矩阵：计算当前帧所有检测点与所有航迹预测位置之间的欧几里得距离。
3. 数据关联（匈牙利算法）：调用分配算法寻找代价总和最小的匹配对。若距离超过设定阈值（50单位），则拒绝匹配，将其标记为未分配。
4. 航迹更新：对匹配成功的航迹，利用检测点坐标进行卡尔曼校正，更新状态向量和误差协方差，并累加可见帧数。
5. 丢失处理：对于本帧未匹配到的航迹，增加其“丢失次数”，并暂用其预测值更新历史记录以补全轨迹。
6. 航迹销毁与初始化：

* 销毁：若某航迹连续丢失帧数超过设定的上限（5 帧），则从系统中删除。 * 初始化：对于未分配的检测点，创建新的潜在航迹实例，初始状态基于该检测点坐标。

1. 可视化渲染：实时绘制检测散点、实线轨迹和目标 ID。只有当航迹稳定出现一定帧数（3 帧）后，才会被视为有效并显示在图形界面上。

关键组件与算法详情

1. 卡尔曼滤波器 (Kalman Filter)

• 状态向量：包含四个分量 $[x; v_x; y; v_y]$，分别代表水平位置、水平速度、垂直位置和垂直速度。
• 核心矩阵：

* 状态转移矩阵 (A)：实现基于恒定速度的位置演变。 * 观测矩阵 (H)：从四维状态空间提取二维的位置坐标。 * 过程噪声 (Q) 与测量噪声 (R)：模拟系统误差和传感器的测量不确定性。

2. 数据关联逻辑 (Hungarian Strategy)

• 系统通过辅助函数计算最优分配对，返回已匹配对、未分配航迹和未分配检测索引。
• 距离阈值判定是防止“误跟”的关键，它确保了跨度过大的检测点不会被错误地分配给现有的远端航迹。

3. 航迹结构设计

• 每个航迹由一个结构体表示，维护其独立的卡尔曼滤波器实例、唯一的 ID 编号、存活时间（Age）、总可见次数以及连续丢失计数。

使用方法

1. 启动 MATLAB。
2. 将系统代码文件放置在当前工作路径。
3. 在命令行窗口中直接运行系统入口函数名。
4. 观察弹出的动态图像窗口，黑色叉号代表原始检测，彩色连线和红色框代表系统生成的跟踪轨迹。
5. 通过调整顶部的参数设置（如距离阈值或最大丢失帧数），可以观察不同配置对跟踪效果的影响。