$$
Z ^ {1} = z ^ {1}-\ hat {z} ^ {1} \\
Z ^ {2} = z ^ {2}-\ hat {z} ^ {2} \\
Z ^ {3} = z ^ {3}-\ hat {z} ^ {3} \\
Z ^ {4} = z ^ {4}-\ hat {z} ^ {4} \\
$$ << />其中$ Z $是创新。对于每次迭代,我都会得到四个创新。这个对吗?我在本书《概率机器人》第204页中使用EKF-本地化。
#1 楼
是的,考虑到两个假设,这是正确的:每个度量是独立的(即观察值$ z_i $的(高斯分布)与$ z_j $不相关)。通常这是一个合理的假设(例如,使用激光扫描仪测量路标的位置)。
数据关联是已知的。换句话说,您“只是知道”您的第一个观察结果实际上是对界标1的观察。因此,您仅可以使用界标1生成的预测观察值来计算创新量。不知道观察值属于哪个界标是两倍在这种情况下,您需要将观测值与所有*其他界标的预测观测值进行比较,并使用诸如马氏距离之类的度量来选择最有可能**的观测值。
*您可以通过仅将其与估计在传感器视场内的界标进行比较来加快此过程。其他(例如,关节兼容性)。
评论
$ \ begingroup $
如何为每个地标计算一个值?
$ \ endgroup $
–user20203
18年6月15日在17:46
评论
事实上,我的假设是正确的。我取得了很好的结果。