基于已知位姿的建图方法

目前较为简单的SLAM建图过程都是将定位和建图进行分离,在确定机器人位姿后,通过激光传感器的测量量对周围环境进行建图。

如何利用激光传感器的测量信息进行建图,主要是三种方法:

1. 覆盖栅格建图算法

slam11-gridmaps-

4.pdf

3.3MB

2. 计数建图算法

3. TSDF建图算法

 

1.覆盖栅格建图

 

基于已知位姿的建图方法

 

基于已知位姿的建图方法

 

基于已知位姿的建图方法

 

基于已知位姿的建图方法

2. 计数建图

基于已知位姿的建图方法

3. TSDF建图

基于已知位姿的建图方法

 

基于已知位姿的建图方法

 

基于已知位姿的建图方法

 

整体算法的思想是最小二乘法。可以对不同测量信息进行拟合,得到目标位置。

基于已知位姿的建图方法

总结

针对Occupancy Grid和Count Model

优势:这两种算法计算量比较小,实现也较为简单。Occupancy Grid只需对Grid Log Likelihood进行加法更新;Count Model只需对Grid Hit/Miss计数进行加法更新。之后便可通过公式获取每个栅格的占用概率,进而构建整张地图。

劣势:这两个算法对测量噪声较为敏感,得到的障碍物可能占用多个栅格,无法获取环境曲面的精确位置。

针对TSDF

优势:TSDF方法通过加权线性最小二乘,使用多帧观测值进行平均计算来融合,能够有效减小测量噪声的影响。同时可以通过线性插值得到TSDF的零点位置来获取环境曲面的精确位置。最终得到障碍物仅会占用一个栅格。

劣势:计算复杂,实时性较差。需要更多的工程优化(如并行计算)来保证建图效率。