lego-loam在Ubuntu16.04下安装、跑包及实时建图

0 前言

lego-loam是由Tixiao Shan and Brendan Englot在论文：

LeGO-LOAM: Lightweight and Ground-Optimized Lidar Odometry and Mapping on Variable Terrain

中提出，该方法是基于loam，其主要内容在论文摘要中已经说明，内容如下：

我们提出了LeGO-LOAM，它是一种轻量级和地面优化的激光雷达里程计和建图方法，用于实时估计地面车辆的六自由度姿态。LeGO-LOAM是轻量级的，因为它可以在低功耗嵌入式系统上实现实时姿态估计。LeGO-LOAM经过地面优化，因为它在分割和优化步骤中利用了地面的约束。我们首先应用点云分割来滤除噪声，并进行特征提取，以获得独特的平面和边缘特征。然后，采用两步Levenberg-Marquardt优化方法，使用平面和边缘特征来解决连续扫描中六个自由度变换的不同分量。我们使用地面车辆从可变地形环境中收集的数据集，比较LeGO-LOAM与最先进的LOAM方法的性能，结果表明LeGO-LOAM在减少计算开销的情况下实现了相似或更好的精度。为了消除由漂移引起的姿态估计误差，我们还将LeGO-LOAM集成到SLAM框架中，并用KITTI数据集进行了测试。

本博客主要是安装该方法，并进行数据包测试，最后利用手头的velodyne16线激光雷达进行实时建图。

1 lego-loam安装

博主的安装环境为Ubuntu16.04+ROS（kinetic）+ pcl1.9
1.1 安装依赖
1）gtsam (Georgia Tech Smoothing and Mapping library, 4.0.0-alpha2)

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

1.2 安装lego-loam

cd ~/catkin_ws/src
git clone https://github.com/RobustFieldAutonomyLab/LeGO-LOAM.git
cd ..
catkin_make -j1

注：catkin_make后面的-j1是首次编译时生成相关消息类型的，后续编译可以不加。

2 lego-loam跑包测试

1）启动lego-loam
roslaunch lego_loam run.launch
注：要cd到安装包下面并添加环境如：

cd catkin_ws
source devel/setup.bash

最后使用以下命令启动lego-loam

roslaunch lego_loam run.launch

2）播放数据包

rosbag play yourbag.bag --clock --topic /velodyne_points /imu/data

注：yourbag.bag为自己录制的数据包。/imu/data是可选的，没有也没关系。我就没有这劳什子，跑的效果还行。
3 lego-loam实时建图
1）首先要修改run.launch，修改后为：

<launch>
    
    <!--- Sim Time -->
    <param name="/use_sim_time" value="false" />

    <!--- Run Rviz-->
    <node pkg="rviz" type="rviz" name="rviz" args="-d $(find lego_loam_bor)/launch/test.rviz" />

    <!--- TF -->
    <node pkg="tf" type="static_transform_publisher" name="camera_init_to_map"  args="0 0 0 1.570795   0        1.570795 /map    /camera_init 10" />
    <node pkg="tf" type="static_transform_publisher" name="camera_to_base_link" args="0 0 0 -1.570795 -1.570795 0        /camera /base_link   10" />
    <!--- 根据雷达和小车相对位置确定 -->
    <node pkg="tf" type="static_transform_publisher" name="base_link_to_velodyne" args="0 0 0 0 0 0      /base_link  /velodyne 10" />  
    <!--- LeGO-LOAM    
    <arg name="rosbag"  default=""/>
    <arg name="imu_topic" default="/imu/data"/>
    <arg name="lidar_topic" default="/velodyne_points"/>
    --> 
    <rosparam file="$(find lego_loam_bor)/config/loam_config.yaml" command="load"/>

    <node pkg="lego_loam_bor" type="lego_loam_bor"    name="lego_loam_bor"    output="screen" >
<!--
       <remap from="/lidar_points" to="$(arg lidar_topic)"/>
       <remap from="/imu/data" to="$(arg imu_topic)"/>
       <param name="rosbag"      value="$(arg rosbag)" type="string" />
       <param name="imu_topic"   value="$(arg imu_topic)" type="string" />
       <param name="lidar_topic" value="$(arg lidar_topic)" type="string" />

       <remap from="/imu/data" to="/imu"/>
--> 
       <remap from="/lidar_points" to="/velodyne_points"/>

    </node>

</launch>

2)启动velodyne16激光雷达

roslaunch velodyne_pointcloud VLP16_points.launch calibration:=/home/tl/VLP16.yaml

注：velodyn激光雷达使用请参考如下博客：
https://blog.csdn.net/zbr794866300/article/details/99305864

3）启动lego-loam

roslaunch lego_loam run.launch

4）启动成功效果

至此，大功告成！
如果有问题，可以一起交流。