max/robotics
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Update

Browse Source
This commit is contained in:
Max Hunt 2020-02-26 10:52:15 +00:00
parent e01228e565
commit e56d30de3c
1 changed files with 12 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
new_main.py
View File

@ -102,6 +102,9 @@ class PickAndPlace(object):
print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@') print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@')
return limb_joints return limb_joints
def gripperPosition(self):
print(self._gripper.position)
if simulation: if simulation:
brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9'] brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9']
@ -189,7 +192,16 @@ tuck_arms.init_arms()
hover_distance = 0.2 hover_distance = 0.2
left_pnp = PickAndPlace('left', hover_distance) left_pnp = PickAndPlace('left', hover_distance)
print('GRIPPA POSITION+++')
left_pnp.gripperPosition()
print('GRIPPA POSITION+++')
print()
left_pnp.gripper_open() left_pnp.gripper_open()
print('GRIPPA POSITION+++')
left_pnp.gripperPosition()
print('GRIPPA POSITION+++')
print()
def V_Routine(): def V_Routine():
if simulation: if simulation: