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的内容改为以下：

<launch><node pkg="point_cloud_converter" name="point_cloud_converter" type="point_cloud_converter_node" ><remap from="points_in" to="/vins_estimator/point_cloud"/><remap from="points2_out" to="/points" /></node>
</launch>

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

<launch><node pkg="point_cloud_converter" name="point_cloud_converter" type="point_cloud_converter_node" ><remap from="points_in" to="/vins_estimator/point_cloud"/><remap from="points2_out" to="/points" /></node><node pkg="octomap_server" type="octomap_server_node" name="octomap_server"><param name="resolution" value="0.05" /><!-- fixed map frame (set to 'map' if SLAM or localization running!) --><param name="frame_id" type="string" value="world" /><!-- maximum range to integrate (speedup!) --><param name="sensor_model/max_range" value="5.0" /><!-- data source to integrate (PointCloud2) --><remap from="cloud_in" to="/surfel_fusion/rgb_pointcloud" /></node>
</launch>

二、开始运行

启动相机：

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话题，即可看到八叉树地图，如下：

 

三、最终建图效果