激光SLAM算法学习（一）

激光SLAM简介

1、SLAM是什么
SLAM是同步定位与地图构建Simultaneous Localization And Mapping)的缩写，最早由Hugh Durrant-Whyte 和 John J.Leonard提出。SLAM主要用于解决移动机器人在未知环境中运行时定位导航与地图构建的问题。

SLAM通常包括如下几个部分，特征提取，数据关联，状态估计，状态更新以及特征更新等。对于其中每个部分，均存在多种方法。针对每个部分，我们将详细解释其中一种方法。在实际使用过程中，读者可以使用其他的方法代替本文中说明的方法。这里，我们以室内环境中运行的移动机器人为例进行说明，读者可以将本文提出的方法应用于其他的环境以及机器人中。其中包括2D-SLAM和3D-SLAM。一下大概分为三种形式：
Localization：在给定地图的情况下，估计机器人的位姿。
SLAM：同时估计机器人的位姿和环境地图。
Mapping：在给定机器人位姿的情况下，估计环境地图。

2、SLAM的分类

3、SLAM的框架

Graph-based SLAM
?? 0:? ,?|? 1:? ,? 1:? )
Node：机器人的位姿
Edge：节点之间的空间约束关系
Graph：表示SLAM的过程


激光SLAM包含图优化前与图优化后的地图。

图优化前：

图优化后：

4、激光SLAM

Filter-based SLAM：
?? ? ,?|? 1:? ,? 1:? )
状态更新 & 地图更新State & Map Update)
测量预测Measurement Prediction)
进行测量Measurement)
数据关联Data Association)
状态预测State Prediction)

传感器数据包括：
惯性测量单元IMU)
激光雷达Lidar)
轮式里程计Wheel Odometry)

地图类型：
覆盖栅格地图Occupany Grid Map)
点云地图

激光SLAM帧间匹配算法：
ICPIterative Closest Point)
NDTNormal Distribution Transfomation)
PI-ICPPoint-to-Line Iterative Closest Point)
CSMCorrelation Scan Match)
回环检测：
Scan-to-Scan
Map-to-Map
Scan-to-Map