diff --git a/src/openarm_servo_control/openarm_servo_control/ik_controller.py b/src/openarm_servo_control/openarm_servo_control/ik_controller.py index 7d21d26..de25d65 100644 --- a/src/openarm_servo_control/openarm_servo_control/ik_controller.py +++ b/src/openarm_servo_control/openarm_servo_control/ik_controller.py @@ -292,7 +292,7 @@ class ArucoIKController(Node): self.prev_filtered_pos = curr_pos self.prev_filtered_quat = curr_quat - curr_pos[0] = np.clip(curr_pos[0], 0, 0.8) + curr_pos[0] = np.clip(curr_pos[0], -0.8, 0.8) curr_pos[1] = np.clip(curr_pos[1], -0.2, 0.2) + 0.15 curr_pos[2] = np.clip(curr_pos[2], 0.0, 0.3) + 0.27 # pose.pose.position.x = 0.1