ROS 2: depth_image_proc/point_cloud_xyzi_radial Add intensity convers…

…ion (copy) for float (#867) Ported from ROS 1 https://github.com/ros-perception/image_pipeline/pull/336/files Signed-off-by: Alejandro Hernández Cordero <[email protected]>
ros-perception · Jan 19, 2024 · 27de114 · 27de114
1 parent 6d5edd8
commit 27de114
Show file tree

Hide file tree

Showing 2 changed files with 4 additions and 0 deletions.
diff --git a/depth_image_proc/src/point_cloud_xyzi.cpp b/depth_image_proc/src/point_cloud_xyzi.cpp
@@ -214,6 +214,8 @@ void PointCloudXyziNode::imageCb(
     convertIntensity<uint16_t>(intensity_msg, cloud_msg);
   } else if (intensity_msg->encoding == enc::TYPE_16UC1) {
     convertIntensity<uint16_t>(intensity_msg, cloud_msg);
+  } else if (intensity_msg->encoding == enc::TYPE_32FC1) {
+    convertIntensity<float>(intensity_msg, cloud_msg);
   } else {
     RCLCPP_ERROR(
       get_logger(), "Intensity image has unsupported encoding [%s]",

diff --git a/depth_image_proc/src/point_cloud_xyzi_radial.cpp b/depth_image_proc/src/point_cloud_xyzi_radial.cpp
@@ -157,6 +157,8 @@ void PointCloudXyziRadialNode::imageCb(
     convertIntensity<uint16_t>(intensity_msg, cloud_msg);
   } else if (intensity_msg->encoding == sensor_msgs::image_encodings::TYPE_16UC1) {
     convertIntensity<uint16_t>(intensity_msg, cloud_msg);
+  } else if (intensity_msg->encoding == sensor_msgs::image_encodings::TYPE_32FC1) {
+    convertIntensity<float>(intensity_msg, cloud_msg);
   } else {
     RCLCPP_ERROR(
       get_logger(), "Intensity image has unsupported encoding [%s]",