diff --git a/src/arm_pkg/arm_pkg/arm_node.py b/src/arm_pkg/arm_pkg/arm_node.py index 1762337..9701d68 100644 --- a/src/arm_pkg/arm_pkg/arm_node.py +++ b/src/arm_pkg/arm_pkg/arm_node.py @@ -133,19 +133,18 @@ class SerialRelay(Node): axis3 = msg.axis3 #Send controls for arm - command = "can_relay_tovic,arm,18," + str(msg.brake) + "\n" + command = "can_relay_tovic,arm,18," + str(int(msg.brake)) + "\n" command += "can_relay_tovic,arm,39," + str(axis0) + "," + str(axis1) + "," + str(axis2) + "," + str(axis3) + "\n" - #self.send_cmd(command) #Send controls for end effector command += "can_relay_tovic,digit,35," + str(msg.effector_roll) + "\n" - #self.send_cmd(command) - + + command += "can_relay_tovic,digit,36,0," + str(msg.effector_yaw) + "\n" - #self.send_cmd(command) + command += "can_relay_tovic,digit,26," + str(msg.gripper) + "\n" - #self.send_cmd(command) + command += "can_relay_tovic,digit,28," + str(msg.laser) + "\n"