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: