velodyne＋cartographer 2D构建栅格地图

velodyne＋cartographer 2D构建栅格地图

  已经许久未更新博客，最近在做项目指标测试的时候，需要与单车cartographer建图进行对比实验。由于实验室的多线激光雷达是velodyne VLP16 而cartographer建图主要是利用速腾的rslidar16激光雷达来运行的，为了消除激光雷达型号对实验指标的影响，不得不进行改动。关于cartographer的安装相关问题就不在这里做过多说明，有需要的可以去参考这个链接cartographer安装
  这篇博客主要说如何利用velodyne VLP16 进行cartographer 2D建图和地图保存。

程序修改

  程序的需修改主要就两部分运行文件和激光雷达环境配置文件

launch文件创建与编写

  在cartographer_ros/launch 文件夹下创建一个建图程序，可以自己随便命名，不和现有的重复就行。（我这里是demo_VLP16_2d.launch）。上程序：

<launch>
  <param name="/use_sim_time" value="true" />

  <node name="cartographer_node" pkg="cartographer_ros"
      type="cartographer_node" args="
          -configuration_directory $(find cartographer_ros)/configuration_files
          -configuration_basename velodyne.lua"
      output="screen">
    <remap from="scan" to="scan" />
  </node>

  <node name="cartographer_occupancy_grid_node" pkg="cartographer_ros"
      type="cartographer_occupancy_grid_node" args="-resolution 0.05" />
//resolution 0.05 这个参数可以修改，主要是建图时rviz中的分辨率
  <node name="rviz" pkg="rviz" type="rviz" required="true"
      args="-d $(find cartographer_ros)/configuration_files/demo_2d.rviz" />

</launch>

lua 文件编写

  在cartographer_ros/configuration_files文件夹下，创建velodyne的lua文件，我这里是velodyne.lua
将下面的代码复制进去。

include "map_builder.lua"
include "trajectory_builder.lua"

options = {
  map_builder = MAP_BUILDER,
  trajectory_builder = TRAJECTORY_BUILDER,
  map_frame = "map",
  tracking_frame = "velodyne",
  published_frame = "velodyne",
  odom_frame = "odom",
  provide_odom_frame = true,
  publish_frame_projected_to_2d = false,
  use_odometry = false,
  use_nav_sat = false,
  use_landmarks = false,
  num_laser_scans = 1,
  num_multi_echo_laser_scans = 0,
  num_subdivisions_per_laser_scan = 1,
  num_point_clouds = 0,
  lookup_transform_timeout_sec = 0.2,
  submap_publish_period_sec = 0.3,
  pose_publish_period_sec = 5e-3,
  trajectory_publish_period_sec = 30e-3,
  rangefinder_sampling_ratio = 1.,
  odometry_sampling_ratio = 1.,
  fixed_frame_pose_sampling_ratio = 1.,
  imu_sampling_ratio = 1.,
  landmarks_sampling_ratio = 1.,
}

MAP_BUILDER.use_trajectory_builder_2d = true

TRAJECTORY_BUILDER_2D.submaps.num_range_data = 35
TRAJECTORY_BUILDER_2D.min_range = 0.3
TRAJECTORY_BUILDER_2D.max_range = 8.
TRAJECTORY_BUILDER_2D.missing_data_ray_length = 1.
TRAJECTORY_BUILDER_2D.use_imu_data = false
TRAJECTORY_BUILDER_2D.use_online_correlative_scan_matching = true
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.linear_search_window = 0.1
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.translation_delta_cost_weight = 10.
TRAJECTORY_BUILDER_2D.real_time_correlative_scan_matcher.rotation_delta_cost_weight = 1e-1

POSE_GRAPH.optimization_problem.huber_scale = 1e2
POSE_GRAPH.optimize_every_n_nodes = 35
POSE_GRAPH.constraint_builder.min_score = 0.65

return options

  完成上述两个文件，保存并重新编译cartographer功能包！！！！！一定要重新编译！！！注意如果是安按照我上面提供的连接安装的cartographer，编译时不能用catkin_make，用下面这句：

catkin_make_isolated --install --use-ninja

编译没问题后，就可以进行测试了。

测试

  首先启动激光雷达，然后运行cartographer建图程序

roslaunch velodyne_pointcloud VLP16.launch
//
cd cartographer
source ioslated_devel/setup.bash
roslaunch cartographer_ros demo_VLP16_2d.launch

基本上到这里就可以出图了，下面是建图过程

地图保存

  我一开始是想按照正常的cartographer2D栅格地图保存的方式来保存所建地图来着，但是觉得太费事了，还需要将.pbstream地图转换成.pgm和yaml格式。这里推荐大家一个好用的功能包，使用它就可以像保存gmapping栅格地图一样保存cartographer 2d地图了。这个功能包是基于map_server改进的，具体原理是由于carto保存地图格式和map_saver不一致，对相关源码进行修改即可，修改后的包在这个链接里戳这里
即使你已经安装了map_server这里不影响，你只需要新建一个工作空间将这个功能包复制进去，编译一下就可了。使用时，也是就是正常的地图保存指令rosrun map_server map_saver -f <绝对路径>/<地图名字>。
下面是我的建图

最近太懒了，一直没更新。重新振作起来，再次出发！！！
后面那个连接，如果GitHub登不上的可以私聊我，我给你发。或者过一阵子我看看能否上传资源。
（致谢：感谢同为工大你却那么优秀的@合工大机器人实验室！撒花✿✿ヽ(°▽°)ノ✿）