diff --git a/launch/tier4_perception_launch/launch/object_recognition/detection/pointcloud_map_filter.launch.py b/launch/tier4_perception_launch/launch/object_recognition/detection/pointcloud_map_filter.launch.py index 93d395ca3e466..18cb428bba093 100644 --- a/launch/tier4_perception_launch/launch/object_recognition/detection/pointcloud_map_filter.launch.py +++ b/launch/tier4_perception_launch/launch/object_recognition/detection/pointcloud_map_filter.launch.py @@ -83,6 +83,7 @@ def create_compare_map_pipeline(self): down_sample_topic = ( "/perception/obstacle_segmentation/pointcloud_map_filtered/downsampled/pointcloud" ) + intermediate_topic = "/perception/obstacle_segmentation/pointcloud_map_filtered/before_area_filter/pointcloud" components.append( ComposableNode( package="pointcloud_preprocessor", @@ -112,7 +113,7 @@ def create_compare_map_pipeline(self): remappings=[ ("input", down_sample_topic), ("map", "/map/pointcloud_map"), - ("output", LaunchConfiguration("output_topic")), + ("output", intermediate_topic), ("map_loader_service", "/map/get_differential_pointcloud_map"), ("kinematic_state", "/localization/kinematic_state"), ], @@ -133,6 +134,27 @@ def create_compare_map_pipeline(self): ], ) ) + components.append( + ComposableNode( + package="pointcloud_preprocessor", + plugin="pointcloud_preprocessor::VectorMapInsideAreaFilterComponent", + name="vector_map_inside_area_filter", + remappings=[ + ("input/vector_map", "/map/vector_map"), + ("input", intermediate_topic), + ("output", LaunchConfiguration("output_topic")), + ], + parameters=[ + { + "use_z_filter": True, + "z_threshold": 0.15, + } + ], + extra_arguments=[ + {"use_intra_process_comms": False}, + ], + ) + ) return components