机器人地图分类
尺度地图(metric map)：每一个地点都可以用坐标来表示，比如经纬度。拓扑地图(topological map)：每一个地点用一个点来表示，用边来连接相邻的点，即图论中的图。语义地图(semantic map)：每一个地点和道路都会用标签的集合来表示。占用栅格地图(occupancy grid map)
在通常的尺度地图中，对于一个点，要么有障碍物，要么没有障碍物。在占据栅格地图中，对于一个点，用p(s=1)来表示它是free状态的概率，用p(s=0)来表示它是occupied的状态的概率，两者的和为1。
定义
Odd(s)=p(s=1)p(s=0)Odd(s)=\frac{p(s=1)}{p(s=0)} Odd(s)=p(s=0)p(s=1)
作为点的状态。当获得一个新的测量值(Measurement,z{0,1})(Measurement,z~\{0,1\})(Measurement,z{0,1})时，更新
Odd(s∣z)=p(s=1∣z)p(s=0∣z)Odd(s|z)=\frac{p(s=1|z)}{p(s=0|z)} Odd(s∣z)=p(s=0∣z)p(s=1∣z)
Odd(s∣z)Odd(s|z)Odd(s∣z)表示在zzz繁盛的条件下sss的状态。
根据贝叶斯公式，我们有:
p(s=1∣z)=p(z∣s=1)p(s=1)p(z)p(s=1|z)=\frac{p(z|s=1)p(s=1)}{p(z)}p(s=1∣z)=p(z)p(z∣s=1)p(s=1)
p(s=0∣z)=p(z∣s=0)p(s=0)p(z)p(s=0|z)=\frac{p(z|s=0)p(s=0)}{p(z)}p(s=0∣z)=p(z)p(z∣s=0)p(s=0)
带入之后，得:
Odd(s∣z)=p(s=1∣z)p(s=0∣z)=p(z∣s=1)p(s=1)/p(z)p(z∣s=0)p(s=0)/p(z)=p(z∣s=1)p(z∣s=0)Odd(s)Odd(s|z)=\frac{p(s=1|z)}{p(s=0|z)}=\frac{p(z|s=1)p(s=1)/p(z)}{p(z|s=0)p(s=0)/p(z)}=\frac{p(z|s=1)}{p(z|s=0)}Odd(s)Odd(s∣z)=p(s=0∣z)p(s=1∣z)=p(z∣s=0)p(s=0)/p(z)p(z∣s=1)p(s=1)/p(z)=p(z∣s=0)p(z∣s=1)Odd(s)
两边取对数得：
logOdds(s∣z)=logp(z∣s=1)p(z∣s=1)+logOdds(s)logOdds(s|z)=log\frac{p(z|s=1)}{p(z|s=1)}+logOdds(s)logOdds(s∣z)=logp(z∣s=1)p(z∣s=1)+logOdds(s)
这样，含有测量值的项就只剩下了logp(z∣s=1)p(z∣s=0)log\frac{p(z|s=1)}{p(z|s=0)}logp(z∣s=0)p(z∣s=1),称这个比值为测量值模型(measurementmodel)(measurement\ model)(measurementmodel)，标记为lomeaslomeaslomeas。测量值的模型只有两种：
lofree=logp(z=0∣s=1)p(z=0∣s=0)lofree = log\frac{p(z=0|s=1)}{p(z=0|s=0)} lofree=logp(z=0∣s=0)p(z=0∣s=1)
looccu=logp(z=1∣s=1)p(z=1∣s=0)looccu = log\frac{p(z=1|s=1)}{p(z=1|s=0)} looccu=logp(z=1∣s=0)p(z=1∣s=1)
两者都是定值，这样，如果我们用logOdd(s)logOdd(s)logOdd(s)来表示位置sss的状态SSS的话，我们的更新规则就进一步简化成了S+=S−+lomeasS^+=S^-+lomeasS+=S−+lomeas其中S+和S−S^+和S^-S+和S−分别表示测量值之后和之前sss的状态。另外，在没有任何测量值的初始状态下，一个点的初始状态
Sinit=logOdd(s)=logp(s=1)p(s=0)=log0.50.5=0S_{init}=logOdd(s)=log\frac{p(s=1)}{p(s=0)}=log\frac{0.5}{0.5}=0 Sinit=logOdd(s)=logp(s=0)p(s=1)=log0.50.5=0
经过这样的建模，更新一个点的状态就只需要做简单的加减法。
假设我们设定looccu=0.9,lofree=−0.7looccu=0.9,lofree=-0.7looccu=0.9,lofree=−0.7。那么，一个点状态的数值越大，就表示越肯定它是OccupiedOccupiedOccupied状态，相反数值越小，就表示越肯定它是freefreefree的状态。上图展示了用两个激光传感器的数据更新地图的过程。在结果中，一个点颜色越深越肯定它是freefreefree的，颜色越浅越肯定它是occupiedoccupiedoccupied的。
转自:/p/21738718/
