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

add current angles to ik debug output

Browse Source
This commit is contained in:
Tristan McGinnis
2025-05-07 14:07:51 -05:00
committed by David
parent 35208150ef
commit d270235088
1 changed files with 1 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -420,7 +420,7 @@ class SerialRelay(Node):
#Print for IK DEBUG
tempMsg = String()
tempMsg.data = "Current Position: " + str(current_position) + "\nInput Vector" + str(input_raw) + "\nTarget Position: " + str(target_position)
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)
# Debug output for current position