Demo 5:3×3 环形 HMM 粒子滤波

这个演示对应正文例题 6。隐变量是外圈 8 个位置,转移可以选择顺时针或逆时针一步,观测是四维墙体向量 y=(N,E,S,W)。调节粒子数、初始化和传感器正确率,观察 prediction、weight update、resampling 如何把粒子云集中到符合观测的位置。

3×3 环形地图

真实位置粒子数后验质量

本轮表格

状态m(s)预测粒子数p(y|s)未归一化归一化质量重采样数

控制面板

例题模式会设置 L=8、每格一个粒子、真实初始位置 A、传感器正确率 0.9,并用确定性重采样:第一轮 A→B 且 y₁=1010,第二轮 B→C 且 y₂=1100。

当前状态

步数0
真实位置
观测 y=(N,E,S,W)
ESS
MAP 位置
阶段初始化

公式对应

prediction: \(x_t^{(l)}\sim p(x_t\mid x_{t-1}^{(l)})\)。weight update: \(\tilde w_t^{(l)}=\bar w_{t-1}^{(l)}p(y_t\mid x_t^{(l)})\)。normalization: \(\bar w_t^{(l)}=\tilde w_t^{(l)}/\sum_m\tilde w_t^{(m)}\)。resampling: 按 \(\bar w_t^{(l)}\) 复制高权重粒子并淘汰低权重粒子。