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

Debug prints vergessen

parent ac0817b4
Branches
Tags
No related merge requests found
...@@ -22,13 +22,10 @@ class RobotUtils(): ...@@ -22,13 +22,10 @@ class RobotUtils():
raise RobotError(f"Invalid move({tcv})") raise RobotError(f"Invalid move({tcv})")
def pick_place(self, start, finish) -> None: def pick_place(self, start, finish) -> None:
print("A")
start.extend([LIFT_HIGHT, 0, 0, -1]) start.extend([LIFT_HIGHT, 0, 0, -1])
self.move_to_pose(start, GRIP_OPEN, 1000) self.move_to_pose(start, GRIP_OPEN, 1000)
print("B")
start[2] = PICK_HIGHT start[2] = PICK_HIGHT
self.move_to_pose(start, GRIP_OPEN, 1000) self.move_to_pose(start, GRIP_OPEN, 1000)
print("C")
self.move_to_pose(start, GRIP_CLOSED, 1000) self.move_to_pose(start, GRIP_CLOSED, 1000)
start[2] = LIFT_HIGHT start[2] = LIFT_HIGHT
self.move_to_pose(start, GRIP_CLOSED, 1000) 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