more picture logging

This commit is contained in:
Sem van der Hoeven
2023-05-30 12:48:17 +02:00
parent 02875313f6
commit 5843575649

View File

@@ -123,6 +123,7 @@ class ApiListener(Node):
self.future = self.take_picture_client.call_async(self.take_picture_request)
rclpy.spin_until_future_complete(self, self.future)
result_filename = self.future.result()
self.get_logger().info("Received result filename: " + result_filename)
with open(result_filename, 'rb') as f:
self.get_logger().info('Reading image')
image_data = f.read()
@@ -224,10 +225,10 @@ class ApiListener(Node):
self.get_logger().info('Emergency stop command received')
# emergency stop: set to attitude mode and stop, also disarm
else:
self.get_logger().error('Received unknown command')
self.get_logger().error('Received unknown command ' + str(message_json['command']) )
self.send_available_commands()
except TypeError:
self.get_logger().error('Received unknown command')
self.get_logger().error('Received unknown type')
self.send_available_commands()
except json.JSONDecodeError:
self.get_logger().error('Received invalid JSON')