Turtlebot :" where am I? " -——amcl的原理

当我们给turtlebot一张先验地图让它规划一条从A点(它的当前位置)到B点(地图上任意点)的路线时, turtlebot是怎么确定自己的当前位置A点呢 , turtlebot_navigation给我们的答案是 amcl.

amcl stands for adaptive Monte Carlo localization.

mcl(蒙特卡洛定位)法使用的是粒子滤波的方法来进行定位的。而粒子滤波很粗浅的说就是一开始在地图空间很均匀的撒一把粒子,然后通过获取机器人的motion来移动粒子,比如机器人向前移动了一米,所有的粒子也就向前移动一米,不管现在这个粒子的位置对不对。使用每个粒子所处位置模拟一个传感器信息跟观察到的传感器信息(一般是激光)作对比,从而赋给每个粒子一个概率。之后根据生成的概率来重新生成粒子,概率越高的生成的概率越大。这样的迭代之后,所有的粒子会慢慢地收敛到一起,机器人的确切位置也就被推算出来了。

初始状态下robot在第一个门,传感器返回true有门,于是分配更多权重的粒子(particles)在有门的地方,向右走到第二个门和第三个门中间,传感器返回false无门,于是分配更多的权重给无门的地方,继续向左走到第二个门,传感器返回true有门,继续分配给有门的地方,现在我们可以看到分配了更多权重的粒子的地方,就是robot的真实位置。实际情况中,经过多次数的迭代之后,越逼近moving base 的真实位置。

  • 0
    点赞
  • 2
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值