论文的标题是：LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain

• 标题给出的应用场景是 可变地形
• 重点是 轻量级 并 利用 地面优化
• 本质依然是一个 激光雷达里程计和建图

摘要部分

文章提出了一种轻量级、基于地面优化的激光里程计和建图算法LeGo-Loam,能够实时的进行六自由度位姿估计，应用在地面的车辆上面。

_强调应用在车辆上面就是因为在应用该算法的时候，雷达必须水平安装（主要设计地面优化部分），像LOAM和LIO-SAM的话对于安装角点是没有要求的，并且在运行过程中角度也可以改变。_

LeGo-Loam是一套轻量级的算法，可以在低功耗嵌入式系统中进行实时的位姿估计。_LOAM的实时性是要求在x86性能比较好的平台的上进行，LeGo-Loam在算力下降的平台上依然可以实时进行_

该算法基于地面优化，在分割和优化的过程中利用地面的存在

首先进行点云分类，并利用分类去除了一部分噪声点，通过特征提取获得面点和角点（_这部分和LOAM一样_）
通过两步的LM优化方法，利用角点和面点，进行相邻帧的位姿计算。—-前端部分

用地面小车在可变地形上采集的数据，和LOAM进行比较，LeGO-LOAM在降低计算量的同时达到了相似或更好的精度。

把LeGO-LOAM集成到一个SLAM的框架里面去，用关键帧的概念对后端进行一个管理，来消除累计误差，用回环检测的方法（_LOAM没有的部分_）—-后端部分。

简介部分

技术背景：

地图构建和状态估计是智能机器人中很重要的一个功能

有很多人对此付出了很多努力，通过两种方法：

• 基于视觉
• 基于激光雷达

视觉SLAM的优势可以很好的进行回环检测，但是对光照和视角的变换很敏感

激光SLAM的优势是可以在晚上依然可用，并且可以得到高精度的测量

因此论文用3d激光雷达进行实时的SLAM

传统的求解相邻两帧位姿的方式就是通过迭代最近邻点的方式（ICP），当场景非常大时，包含很多的点，那么ICP方法会非常耗时。针对ICP有几种升级的方法，将点与局部平面进行匹配，面到地图的匹配，并利用并行计算，使效率得到提升。

后面继续介绍了些点云配准的算法

LOAM的优势

LOAM是一种低漂移并且实时的激光雷达里程计和建图的方法

LOAM是通过提取角点和面点建立约束，来求取帧间的位姿变换。特征点是通过计算点的曲率进行判断的

LOAM的实时性是通过将估计问题分成了两个独立的算法进行，一种算法以高频运行，低精度估计传感器运动。另一种算法运行频率较低，但返回高精确运动估计。

在KITTI数据集上，仅通过激光雷达的估计，LOAM的精度是最好的。

LOAM的问题

指出LOAM在该工作场景中的问题

工作场景描述：
该工作场景是在地面的小车上装一个3D的激光雷达，来获得实时可靠的6自由度位姿估计。并且将算法部署到小规模的嵌入式系统中。

问题：

• 1 计算量的问题
  许多无人机驾驶的车辆上无法安装强大的计算单元

• 2 运动激烈时候的问题
  当小车在多种场景下跑的时候，由于颠簸，运动并不是十分平滑，导致数据有运动畸变。（LOAM是通过匀速模型进行的畸变去除，此时不再适用）由于运动强烈也会导致联系两帧的特征点匹配出现异常。
  另外，大量的激光点云对于低功耗的嵌入式平台很难达到实时性

当把LOAM直接用到上面的场景上，当UGV运动比较平稳，并且特征稳定，计算资源足够的时候，可以实现低漂移的运动估计

但是资源受到限制，LOAM的表现就会退化。在场景点云比较多的时候，要计算每个点的曲率是比较耗时的，低算力的平台上计算就跟不上了

• 3 噪点的问题
  UGV 的运行环境有很多的噪点。如果雷达和地面比较近，那么地面上的噪声也会影响LOAM的表现
  比如在草地上跑，可能会把草提取成角点，这样很难再找到匹配对。树叶是不是稳定的特征点

提出LeGO-LOAM的解决办法

因此提出了一种轻量的，通过地面优化的的LOAM（LeGO-LOAM）

点云的分类是通过先地面分割后，之后去除不可靠的特征点（解决噪点问题）

由于是基于地面的优化，LeGO-LOAM通过两步的优化来进行位姿的估计。（解决轻量化问题）
第一步，通过从地面点中提取面点，然后进行z roll pitch 的估计（不估计 x y yaw）
第二步，通过角点来进行 x y yaw的估计

并且集成了回环优化来修正位姿漂移。

整体框架如下：

• 输入：三维激光点云
• 输出：六自由度位姿估计

整个系统可以分为五个模块：

• 分割：指获取单次扫描的点云，并将其投影到距离图像上进行分割。
• 特征提取：分割的点云被发送到特征提取模块。
• 激光雷达里程计：使用从先前模块中提取的特征来寻找与连续扫描相关的变换。
• 激光建图部分：这些特征在激光建图部分被转换到全局点云地图中进一步处理。
• 变换集成模块：融合来自激光雷达里程计和激光雷达建图的姿态估计结果，并输出最终的姿态估计。

相对于LOAM中的原始通用框架，该系统旨在提高地面车辆的效率和精度。

硬件系统

论文的框架由两种激光雷达的数据进行的测

激光雷达

• 1 VLP-16：
  测量范围最远100米，精度为±3厘米
  30°（+-15°）的垂直视场（FOV）和360°的水平FOV
  16通道传感器提供2°的垂直角分辨率
  水平角分辨根据旋转速率不同，从0.1°到0.4°变化
  10Hz的扫描速率，水平角分辨率为0.2°

• 2 HDL-64E
  60°的水平FOV
  48个通道
  垂直FOV为26.9°

移动车辆

使用的UGV是Clearpath Jackal
锂电池供电
最大速度为2.0米/秒，最大有效载荷为20千克
集成低成本惯性测量单元（IMU），型号为CH Robotics UM6
如下图所示

计算单元

计算单元进行验证的有两个

• 1 嵌入式计算设备 Nvidia Jetson TX2
  Jetson TX2是一款嵌入式计算设备，配备ARM Cortex-A57 CPU。

• 2 台式计算机 2.5GHz i7-4710MQ
  电脑CPU以与LOAM中使用的计算硬件相同