aaron/rover-ros2
1
0
Fork 0
mirror of https://github.com/SHC-ASTRA/rover-ros2.git synced 2026-02-11 09:20:40 +00:00
Code Issues Packages Projects Releases Wiki Activity

Update arm node message types for anchor

Browse Source
This commit is contained in:
Tristan McGinnis
2025-02-20 15:00:17 -06:00
parent d000a2007a
commit 4090f63890
1 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
src/arm_pkg/arm_pkg/arm_node.py
View File

@@ -142,12 +142,13 @@ class SerialRelay(Node):
return
def send_cmd(self, cmd):
def send_cmd(self, msg):
if self.launch_mode == 'anchor': #if in anchor mode, send to anchor node to relay
self.anchor_pub.publish(cmd)
output = String()
output.data = msg
self.anchor_pub.publish(output)
elif self.launch_mode == 'arm': #if in standalone mode, send to MCU directly
self.ser.write(bytes(cmd, "utf8"))
#print(f"[Arm Wrote] {cmd}", end="")
self.ser.write(bytes(msg, "utf8"))
def anchor_feedback(self, msg):
self.get_logger.info(f"[Arm Anchor] {msg.data}", end="")