depth camera update 3

Signed-off-by: Ken Haagh <[email protected]>

people_tracking/src/people_tracking/depth_image.py

@@ -33,8 +33,8 @@ def image_callback(self, data, time_data_stored_sec: int = 60):
         #     self.depth_images.pop(0)
 
         # Store the current image
-        cv_image = self.bridge.imgmsg_to_cv2(data, desired_encoding='passthrough')
-        self.depth_images.append([data.header.stamp.secs, cv_image])
+        # cv_image = self.bridge.imgmsg_to_cv2(data, desired_encoding='passthrough')
+        self.depth_images.append([data.header.stamp.secs, data])
         rospy.loginfo("depth")
 
         # msg = data
@@ -66,7 +66,7 @@ def get_depth_data(self, data):
         #     rospy.logwarn("No depth image available.")
         #     return Image()
 
-        return self.bridge.cv2_to_imgmsg(self.depth_images[-1][1], encoding="passthrough")
+        return data#self.bridge.cv2_to_imgmsg(self.depth_images[-1][1], encoding="passthrough")
 
 
 if __name__ == '__main__':