From 7027900620d29a169446e5150cb721d560ba3ec3 Mon Sep 17 00:00:00 2001 From: David Date: Mon, 26 May 2025 02:36:51 +0000 Subject: [PATCH] fix: round float imu_calib --- src/core_pkg/core_pkg/core_node.py | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) diff --git a/src/core_pkg/core_pkg/core_node.py b/src/core_pkg/core_pkg/core_node.py index ffa2d11..0f1052f 100644 --- a/src/core_pkg/core_pkg/core_node.py +++ b/src/core_pkg/core_pkg/core_node.py @@ -192,7 +192,7 @@ class SerialRelay(Node): self.get_logger().info(f"[Core to MCU] {msg}") self.ser.write(bytes(msg, "utf8")) - def anchor_feedback(self, msg): + def anchor_feedback(self, msg: String): output = msg.data parts = str(output.strip()).split(",") #self.get_logger().info(f"[ANCHOR FEEDBACK parts] {parts}") @@ -206,7 +206,7 @@ class SerialRelay(Node): self.core_feedback.bno_gyro.x = float(parts[3]) self.core_feedback.bno_gyro.y = float(parts[4]) self.core_feedback.bno_gyro.z = float(parts[5]) - self.core_feedback.imu_calib = int(parts[6]) + self.core_feedback.imu_calib = round(float(parts[6])) elif output.startswith("can_relay_fromvic,core,52"):#Accel x,y,z, heading *10 self.core_feedback.bno_accel.x = float(parts[3]) self.core_feedback.bno_accel.y = float(parts[4])