From 56b8f147c4d5be0be5ee4df45ae9f23a065171dc Mon Sep 17 00:00:00 2001 From: Sem van der Hoeven Date: Mon, 5 Jun 2023 21:17:23 +0200 Subject: [PATCH] convert pos and vel data to floats --- .../api_communication/api_listener.py | 11 +++++++---- 1 file changed, 7 insertions(+), 4 deletions(-) diff --git a/src/api_communication/api_communication/api_listener.py b/src/api_communication/api_communication/api_listener.py index 7667ea84..8566aa16 100644 --- a/src/api_communication/api_communication/api_listener.py +++ b/src/api_communication/api_communication/api_listener.py @@ -138,8 +138,8 @@ class ApiListener(Node): self.armed = msg.armed self.status_data['control_mode'] = msg.control_mode self.status_data['route_setpoint'] = msg.route_setpoint - self.status_data['velocity'] = [msg.velocity[0], msg.velocity[1], msg.velocity[2]] - self.status_data['position'] = [msg.position[0], msg.position[1], msg.position[2]] + self.status_data['velocity'] = [float(msg.velocity[0]), float(msg.velocity[1]), float(msg.velocity[2])] + self.status_data['position'] = [float(msg.position[0]), float(msg.position[1]), float(msg.position[2])] self.status_data['failsafe'] = msg.failsafe except Exception as e: self.get_logger().error( @@ -182,8 +182,11 @@ class ApiListener(Node): if self.status_data_received: self.status_data_received = False if self.websocket is not None: - self.message_queue.append(json.dumps( - {'type': ResponseMessage.STATUS.name, 'data': self.status_data})) + try: + self.message_queue.append(json.dumps({'type': ResponseMessage.STATUS.name, 'data': self.status_data})) + except Exception as e: + self.get_logger().error( + 'Something went wrong while publishing the status: ' + str(e)) def handle_responses(self): """Thread to handle responses to send to the client