fix: anchor publishes feedback for respective feedback topics

This commit is contained in:
Tristan McGinnis
2025-04-16 20:03:54 -05:00
committed by David
parent 9826b39e7e
commit 8e3f2ee88a

View File

@@ -88,7 +88,22 @@ class SerialRelay(Node):
if output:
# All output over debug temporarily
#self.get_logger().info(f"[MCU] {output}")
self.get_logger().info(f"[MCU] {output}")
if output.startswith("can_relay_fromvic,arm"):
# Publish the message to the arm topic
msg = String()
msg.data = output
self.arm_pub.publish(msg)
elif output.startswith("can_relay_fromvic,core"):
# Publish the message to the core topic
msg = String()
msg.data = output
self.core_pub.publish(msg)
elif output.startswith("can_relay_fromvic,bio"):
# Publish the message to the bio topic
msg = String()
msg.data = output
self.bio_pub.publish(msg)
msg = String()
msg.data = output
if output.startswith("can_relay_fromvic,core"):