diff --git a/calibrators/tag_based_pnp_calibrator/launch/apriltag_16h5.launch.py b/calibrators/tag_based_pnp_calibrator/launch/apriltag_16h5.launch.py index 5ab10024..9851cca2 100644 --- a/calibrators/tag_based_pnp_calibrator/launch/apriltag_16h5.launch.py +++ b/calibrators/tag_based_pnp_calibrator/launch/apriltag_16h5.launch.py @@ -21,9 +21,21 @@ def add_launch_arg(name: str, default_value=None): launch_arguments.append(DeclareLaunchArgument(name, default_value=default_value)) add_launch_arg("image_topic", "/camera/image") + add_launch_arg("image_compressed_topic", "/camera/image/compressed") add_launch_arg("camera_info_topic", "/camera/camera_info") add_launch_arg("apriltag_detections_topic", "apriltag/detection_array") + decompressor_node = ComposableNode( + package="autoware_image_transport_decompressor", # The package containing the component + plugin="autoware::image_preprocessor::ImageTransportDecompressor", # The registered plugin name + name="decompressor", # Node name within the container + remappings=[ + ("decompressor/input/compressed_image", LaunchConfiguration("image_compressed_topic")), + ("decompressor/output/raw_image", LaunchConfiguration("image_topic")), + ], + parameters=[{"encoding": "default"}], + ) + composable_node = ComposableNode( name="apriltag", package="apriltag_ros", @@ -42,7 +54,7 @@ def add_launch_arg(name: str, default_value=None): namespace="apriltag", package="rclcpp_components", executable="component_container", - composable_node_descriptions=[composable_node], + composable_node_descriptions=[decompressor_node, composable_node], output="screen", ) diff --git a/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml b/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml index 4af18237..91c478a6 100644 --- a/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml +++ b/calibrators/tag_based_pnp_calibrator/launch/calibrator.launch.xml @@ -1,5 +1,6 @@ + @@ -37,6 +38,7 @@ + diff --git a/sensor_calibration_manager/launch/drs/tag_based_pnp_calibrator.launch.xml b/sensor_calibration_manager/launch/drs/tag_based_pnp_calibrator.launch.xml index 3a5a0bc7..2417d84d 100644 --- a/sensor_calibration_manager/launch/drs/tag_based_pnp_calibrator.launch.xml +++ b/sensor_calibration_manager/launch/drs/tag_based_pnp_calibrator.launch.xml @@ -46,17 +46,9 @@ - - - - op - - - - - +