diff --git a/robot_utils.py b/robot_utils.py index fc11a2b05cc37d648df5ba7f83c20fdb759025a6..d3fc8fbfbbc5277a321b734ff44cf890baa220c2 100644 --- a/robot_utils.py +++ b/robot_utils.py @@ -22,13 +22,10 @@ class RobotUtils(): raise RobotError(f"Invalid move({tcv})") def pick_place(self, start, finish) -> None: - print("A") start.extend([LIFT_HIGHT, 0, 0, -1]) self.move_to_pose(start, GRIP_OPEN, 1000) - print("B") start[2] = PICK_HIGHT self.move_to_pose(start, GRIP_OPEN, 1000) - print("C") self.move_to_pose(start, GRIP_CLOSED, 1000) start[2] = LIFT_HIGHT self.move_to_pose(start, GRIP_CLOSED, 1000)