激光slam：LeGO-LOAM---代码编译安装与gazebo测试-Toy模板网

这篇具有很好参考价值的文章主要介绍了激光slam：LeGO-LOAM---代码编译安装与gazebo测试。希望对大家有所帮助。如果存在错误或未考虑完全的地方，请大家不吝赐教，您也可以点击"举报违法"按钮提交疑问。

LeGO-LOAM 简介

LeGO-LOAM 的英文全称是 lightweight and ground optimized lidar odometry and mapping。轻量化具有地面优化的激光雷达里程计和建图
lego-loam,SLAM,激光SLAM,算法,3d激光slam,LeGO-LOAM

其框架如下，大体和LOAM是一致的
lego-loam,SLAM,激光SLAM,算法,3d激光slam,LeGO-LOAM
LeGO-LOAM是基于LOAM的改进版本，其主要目的是为了实现小车在多变地形下的定位和建图，针对前端和后端都做了一系列的改进。

在原本的LOAM中比如应用场景是：AGV在草地中行驶，草地中的点会很有可能提取为角点，但是这种点是不稳定的，相比于楼房、树干等稳定的角点，希望要把地面上的角点去除掉。

LeGO-LOAM更轻量化，不影响精度的情况下减轻计算负荷，保障了嵌入式平台的实时性

相比LOAM改进部分

前端：

1 对地面点进行分类和提取，避免一些边缘点的提取
2 应用了一个简单的点云聚类算法，剔除了一些可能的outlier
3 两步迭代求解前端里程计，不影响精度的情况下减轻计算负荷，保障了嵌入式平台的实时性

后端：

1 使用slam中关键帧的概念对后端部分进行了重构
2 引入回环检测和位姿图优化概念，使得地图的全局一致性更好

LeGO-LOAM 代码编译安装

github的地址是：https://github.com/RobustFieldAutonomyLab/LeGO-LOAM

已被测试ROS版本有：

indigo
kinetic
melodic

它的依赖库有gtsam。所以需要先安装gtsam

wget -O ~/Downloads/gtsam.zip https://github.com/borglab/gtsam/archive/4.0.0-alpha2.zip
cd ~/Downloads/ && unzip gtsam.zip -d ~/Downloads/
cd ~/Downloads/gtsam-4.0.0-alpha2/
mkdir build && cd build
cmake ..
sudo make install

cmake 可以改成如下指令

cmake -DGTSAM_BUILD_EITH_MARCH_NATIVE=OFF -DGTSAM_USE_SYSTEM_EIGEN=ON ..

目的是设置一些宏
DGTSAM_BUILD_EITH_MARCH_NATIVE 是开启css加速的宏，要关闭。避免其它库（比如PCL或者自己代码）没有开启的话，会造成运行时出现异常的情况
DGTSAM_USE_SYSTEM_EIGEN 这个是用系统装的eigen编译的宏，要开启。OFF的话会用gtsam自带的eigen，代码运行存在两个版本eigen会容易出问题

之后下载LeGO-LOAM的ROS功能包

git clone https://github.com/RobustFieldAutonomyLab/LeGO-LOAM.git

然后放在ROS的工作空间

然后编译，注意第一次编译要用

catkin_make -j1

之后再编译就不用 -j1 了

这么做的原因就是LeGO-LOAM有一些自定义的msg。
-j1 则会通过单线程编译。把自定义的msg编译到。

如果直接用catkin_make 则会根据计算机有几个核，进行几线程的编译。

编译成功的话会生成 LeGO-LOAM的可执行文件
lego-loam,SLAM,激光SLAM,算法,3d激光slam,LeGO-LOAM

LeGO-LOAM Gazebo测试

下面通过直接搭的gazebo测试场景对 LeGO-LOAM进行一个初步测试

在运行之前需要根据使用的激光雷达型号，在utility.h文件中对些变量进行设置
该文件的位置在 include文件夹下：
lego-loam,SLAM,激光SLAM,算法,3d激光slam,LeGO-LOAM

激光雷达的点云 Topic 名称

extern const string pointCloudTopic = "/velodyne_points";

激光雷达的参数包括

线束
水平点数
水平角点分辨率
垂直角度分辨率
与水平方向的夹角
扫描到地面的激光线数

在gazebo中搭建的仿真场景是用的 Velodyne-16的激光雷达，其配置如下：

// VLP-16
extern const int N_SCAN = 16;
extern const int Horizon_SCAN = 1800;
extern const float ang_res_x = 0.2;
extern const float ang_res_y = 2.0;
extern const float ang_bottom = 15.0+0.1;
extern const int groundScanInd = 7;