diff --git a/src/arm_pkg/arm_pkg/arm_node.py b/src/arm_pkg/arm_pkg/arm_node.py index f44766f..29e2379 100644 --- a/src/arm_pkg/arm_pkg/arm_node.py +++ b/src/arm_pkg/arm_pkg/arm_node.py @@ -413,7 +413,8 @@ class SerialRelay(Node): #Target position is current position + normalized vector - target_position = self.arm.get_position_vector() + input_raw + #target_position = self.arm.get_position_vector() + input_raw + target_position = map(sum, zip(self.arm.get_position_vector(), input_raw)) tempMsg.data = "Target Position: " + str(target_position) self.debug_pub.publish(tempMsg)