AMCL理解(一)

AMCL干什么?

   说白了就是2D的概率定位系统,输入激光雷达数据,里程计数据,输出机器人在地图中的位姿,用的是自适应蒙特卡洛定位方法,这个方法是在已知地图中使用粒子滤波方法得到位姿的。

  1. MCL算法和AMCl算法的区别

AMCL算法增加了短期和长期的指数滤波器衰减率αslowαfast,换句话说MCL中αslowαfast为0,AMCL中的不为0.

AMCL理解(一)

  1. 四个参数的含义

AMCL理解(一)

3)xt代表M个粒子的集合,第5行利用运动模型从旧粒子采样获取新位姿,第6行它的重要性权重依据测量模型设置。

AMCL理解(一)

4)AMCL中最重要的地方就是随机采样概率

AMCL理解(一)

(5)motion_model用的是《概率机器人》这本书第5章的sample_motion_model_velociy