From e56d30de3c0a7bc7ffb440b4bd751e1a6944a2a1 Mon Sep 17 00:00:00 2001 From: Max Hunt Date: Wed, 26 Feb 2020 10:52:15 +0000 Subject: [PATCH] Update --- new_main.py | 12 ++++++++++++ 1 file changed, 12 insertions(+) diff --git a/new_main.py b/new_main.py index db3b42a..5dcf2fa 100644 --- a/new_main.py +++ b/new_main.py @@ -102,6 +102,9 @@ class PickAndPlace(object): print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@') return limb_joints + def gripperPosition(self): + print(self._gripper.position) + if simulation: brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9'] @@ -189,7 +192,16 @@ tuck_arms.init_arms() hover_distance = 0.2 left_pnp = PickAndPlace('left', hover_distance) + +print('GRIPPA POSITION+++') +left_pnp.gripperPosition() +print('GRIPPA POSITION+++') +print() left_pnp.gripper_open() +print('GRIPPA POSITION+++') +left_pnp.gripperPosition() +print('GRIPPA POSITION+++') +print() def V_Routine(): if simulation: