diff --git a/butia_image2world/scripts/butia_image2world/image2world/image2world.py b/butia_image2world/scripts/butia_image2world/image2world/image2world.py index 91d39c4..85354ea 100755 --- a/butia_image2world/scripts/butia_image2world/image2world/image2world.py +++ b/butia_image2world/scripts/butia_image2world/image2world/image2world.py @@ -327,6 +327,7 @@ def recognitions2DtoRecognitions3D(self, data): pc2 = data.points img_depth = data.image_depth camera_info = data.camera_info + image_rgb = data.image_rgb recognitions = Recognitions3D() if pc2.width*pc2.height > 0: @@ -345,6 +346,7 @@ def recognitions2DtoRecognitions3D(self, data): else: rospy.logwarn('Image2World cannot be used because pointcloud and depth images are void.') + recognitions.image_rgb = image_rgb if self.publish_markers: self.publishMarkers(recognitions.descriptions) return recognitions