print debug to screen & ik debug publisher

This commit is contained in:
Tristan McGinnis
2025-05-07 14:11:24 -05:00
committed by David
parent d270235088
commit bd5c3c3c5a

View File

@@ -422,6 +422,7 @@ class SerialRelay(Node):
tempMsg = String() tempMsg = String()
tempMsg.data = "Current Position: " + str(current_position) + "\nInput Vector" + str(input_raw) + "\nTarget Position: " + str(target_position) + "\nAngles: " + str(self.arm.current_angles) tempMsg.data = "Current Position: " + str(current_position) + "\nInput Vector" + str(input_raw) + "\nTarget Position: " + str(target_position) + "\nAngles: " + str(self.arm.current_angles)
self.ik_debug.publish(tempMsg) self.ik_debug.publish(tempMsg)
self.get_logger().info(f"[IK] {tempMsg.data}")
# Debug output for current position # Debug output for current position
#tempMsg.data = "Current Position: " + str(current_position) #tempMsg.data = "Current Position: " + str(current_position)