Skip to content
Snippets Groups Projects
Commit bf27e523 authored by Lukas Hoffleit's avatar Lukas Hoffleit
Browse files

Debug prints vergessen

parent ac0817b4
Branches
No related tags found
No related merge requests found
......@@ -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)
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment