D455+VINS-Fusion+surfelmapping 稠密建图（三）

继续，由surfelmapping建立的点云生成octomap八叉树栅格地图

 

一、安装OctomapServer 建图包

安装插件

sudo apt-get install ros-melodic-octomap-ros 
sudo apt-get install ros-melodic-octomap-msgs
sudo apt-get install ros-melodic-octomap-server
sudo apt-get install ros-melodic-octomap-rviz-plugins

编译OctomapServer 建图包 

cd ~/catkin_ws/src
git clone https://github.com/OctoMap/octomap_mapping.git
cd ..
catkin_make

但是我们通过点云转octomap需要的是pointcloud2类型，所以我们需要先把pointcloud转换为pointcloud2，源码地址如下：源码

cd ~/catkin_ws/src
git clone https://github.com/1332927388/pcl2octomap.git
cd ..
catkin_make

将point_cloud_converter.launch的内容改为以下：

修改octomap_server/launch中的octomap_mapping.launch中的point ，将两个文件写在一起，修改后如下：

二、开始运行

启动相机：

roslaunch realsense2_camera stereo-imu.launch

开启跟踪节点：

rosrun vins vins_node ~/catkin_ws/src/VINS-Fusion/config/euroc/euroc_stereo_imu_config.yaml

开启闭环：

rosrun loop_fusion loop_fusion_node ~/catkin_ws/src/VINS-Fusion/config/euroc/euroc_stereo_imu_config.yaml

启动 Surfel Fusion

roslaunch surfel_fusion vins_realsense.launch

启动八叉树建图

roslaunch octomap_server octomap_mapping.launch

在rviz中添加occupancygrid，并选择/octomap_full话题，即可看到八叉树地图，如下：

 

三、最终建图效果