feat(map): add launch_pointcloud_map_loader

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>

Author: kosuke55

launch/tier4_map_launch/launch/map.launch.xml

@@ -17,11 +17,14 @@
   <let name="container_type" value="component_container" unless="$(var use_multithread)"/>
   <let name="container_type" value="component_container_mt" if="$(var use_multithread)"/>
 
+  <!-- whether use pointcloud map -->
+  <arg name="launch_pointcloud_map_loader" default="true" description="launch pointcloud map loader"/>
+
   <group>
     <push-ros-namespace namespace="map"/>
 
     <node_container pkg="rclcpp_components" exec="$(var container_type)" name="map_container" namespace="" output="screen">
-      <composable_node pkg="map_loader" plugin="PointCloudMapLoaderNode" name="pointcloud_map_loader">
+      <composable_node pkg="map_loader" plugin="PointCloudMapLoaderNode" name="pointcloud_map_loader" if="$(var launch_pointcloud_map_loader)">
         <param from="$(var pointcloud_map_loader_param_path)"/>
         <param name="pcd_paths_or_directory" value="[$(var pointcloud_map_path)]"/>
         <param name="pcd_metadata_path" value="$(var pointcloud_map_metadata_path)"/>

map/map_height_fitter/src/map_height_fitter.cpp

@@ -72,8 +72,9 @@ MapHeightFitter::Impl::Impl(rclcpp::Node * node) : tf2_listener_(tf2_buffer_), n
 
   const auto map_loader_name = node->declare_parameter<std::string>("map_loader_name");
   params_map_loader_ = rclcpp::AsyncParametersClient::make_shared(node, map_loader_name);
-  params_map_loader_->wait_for_service();
-  params_map_loader_->get_parameters({enable_partial_load}, callback);
+  if (params_map_loader_->wait_for_service(std::chrono::seconds(5.0))) {
+    params_map_loader_->get_parameters({enable_partial_load}, callback);
+  }
 }
 
 void MapHeightFitter::Impl::on_map(const sensor_msgs::msg::PointCloud2::ConstSharedPtr msg)