This commit is contained in:
Max Hunt 2020-02-25 20:40:06 +00:00
parent 8f368d94be
commit e01228e565

View File

@ -102,7 +102,7 @@ class PickAndPlace(object):
print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@')
return limb_joints
if simulation:
brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9']
with open ("brick/model.sdf", "r") as brick_file:brick_sdf=brick_file.read().replace('\n', '')
@ -202,6 +202,7 @@ def V_Routine():
x = raw_input('Close?')
if x == 'n':exit(0)
left_pnp.gripper_close()
time.sleep(0.5)
left_pnp.send(ta.V_approach)
@ -216,6 +217,7 @@ def H_Routine():
x = raw_input('Close?')
if x == 'n':exit(0)
left_pnp.gripper_close()
time.sleep(0.5)
left_pnp.send(ta.H_approach)