Lego-LOAM论文阅读笔记

LOAM在UGV上的问题

（1）UGV 没有足够的算力来计算每个点的 smoothness

（2）安装在 UGV 上的传感器靠近地面，容易得到不稳定的特征。例如 grass，tree leaf 等

核心思想

（1）在特征提取步骤，对地面进行分割(适用于 UGV，减小特征搜索范围)以及对点云聚类(去除散乱的点)来保证特征的质量，并且采用两步L-M算法来进行里程计位姿求解。相比于LOAM，可以实现在嵌入式平台上实时运行。

（2）以帧为单位构建 pose-graph 进行回环优化，使得全局地图可以调整

系统框图

里程计

（1）将当前帧点云投影到 range image，利用“a column-wise evaluation”提取地面

（2）对非地面点云进行聚类(BFS，广度优先搜索)，丢掉点云数量少于30的类

（3）按照 LOAM 中的公式计算每个点的 Smoothness，并将每条线划分为6个区域，在每个区域中提取线面特征(线特征只在非地面点云中提取，面特征只在地面点云中提取)

（4）同类特征匹配并结合两步 L-M 算法计算位姿(误差函数还是点到线，点到面的距离)