卡尔曼滤波粒子滤波移动物体追踪复现 来源于国外某课程的学习报告资料，含英语报告PDF和完整的M...

卡尔曼滤波粒子滤波移动物体追踪复现 来源于国外某课程的学习报告资料，含英语报告PDF和完整的MATLAB程序及用于测试的视频文件（报告中也使用改视频文件）。 程序包含3种物体追踪算法 1卡尔曼滤波移动物体追踪。 2粒子滤波移动目标跟踪。 3将kalman滤波和粒子滤波结合起来进行移动物体实时追踪。 报告详细信息及程序运行结果请参考附图

在移动目标追踪领域，算法的选择直接影响着实时性和鲁棒性。最近复现了三种经典追踪方案，发现不同方法的特性差异远比想象中有趣。先看最经典的卡尔曼滤波实现——这算法就像个经验丰富的快递员，总能预测包裹下一秒的位置。

MATLAB代码里有个关键函数处理状态更新：

function [x_updated, P_updated] = kalman_update(x_pred, P_pred, z, H, R) K = P_pred * H' / (H * P_pred * H' + R); % 计算卡尔曼增益 x_updated = x_pred + K*(z - H*x_pred); % 状态修正 P_updated = (eye(4) - K*H)*P_pred; % 协方差更新 end

这段代码最妙的地方在于卡尔曼增益的计算（第2行）。当传感器噪声R变大时，K会减小，算法更相信自己的预测而不是测量数据。实际调试时发现，视频中目标突然被遮挡时，适当调高R参数能有效避免追踪框乱飘。

粒子滤波的实现完全是另一种画风。初始化时撒出500个粒子随机分布在目标周围：

particles = repmat(initial_pos, n_particles, 1) + randn(n_particles,4)*20; weights = ones(n_particles, 1)/n_particles;

每个粒子都像无头苍蝇般随机移动，但会根据与真实目标的相似度获得权重。重采样阶段特别有趣——权重低的粒子被淘汰，高权重的粒子开始"繁殖"。实测发现当目标快速转向时，这种蒙特卡洛方法比卡尔曼滤波更跟得上节奏。

两者的结合方案才真正展现了工程智慧。在kalmanpffusion.m中看到这样的处理逻辑：

% 混合跟踪核心逻辑 if confidence < threshold % 当卡尔曼预测置信度下降 pf_results = particle_filter(frame); % 启动粒子滤波 kalman_state = fuse_states(kalman_pred, pf_results); % 状态融合 else kalman_state = kalman_update(kalman_pred); % 正常卡尔曼更新 end

这种动态切换机制在目标被树木遮挡时（测试视频第47秒）特别有效。卡尔曼滤波提供基础预测，当遇到复杂情况时粒子群立即介入，像一群侦察兵快速锁定目标新位置。

调试时踩过个坑：粒子数量设为1000时FPS直接掉到8，降到500后流畅度翻倍却偶尔丢失目标。最后采用动态粒子数量机制——当目标运动剧烈时自动增加粒子密度，算是找到了性能平衡点。这些实践细节在教科书里可不会写，得亲手调过才知道。