diff --git a/src/arm_pkg/arm_pkg/arm_node.py b/src/arm_pkg/arm_pkg/arm_node.py index 8fcbcc6..2ebaa8b 100644 --- a/src/arm_pkg/arm_pkg/arm_node.py +++ b/src/arm_pkg/arm_pkg/arm_node.py @@ -369,7 +369,8 @@ class SerialRelay(Node): # msg.joint_temps = self.arm_feedback.joint_temps # msg.joint_voltages = self.arm_feedback.joint_voltages # msg.joint_currents = self.arm_feedback.joint_currents - + #debug print + self.get_logger().info(f"ARM NODE SENDING: Socket Feedback") self.socket_pub.publish(self.arm_feedback) #Publish feedback from arm self.arm.update_position() #Run FK and update the current position of the arm, using FK