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-25 20:40:06 +00:00
parent 8f368d94be
commit e01228e565
1 changed files with 9 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
new_main.py
View File

@ -102,7 +102,7 @@ class PickAndPlace(object):
print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@') print('@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@')
return limb_joints return limb_joints
if simulation:
brick_ids = ['b1','b2','b3','b4','b5','b6','b7','b8','b9'] 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', '') 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?') x = raw_input('Close?')
if x == 'n':exit(0) if x == 'n':exit(0)
left_pnp.gripper_close() left_pnp.gripper_close()
time.sleep(0.5)
left_pnp.send(ta.V_approach) left_pnp.send(ta.V_approach)
@ -216,6 +217,7 @@ def H_Routine():
x = raw_input('Close?') x = raw_input('Close?')
if x == 'n':exit(0) if x == 'n':exit(0)
left_pnp.gripper_close() left_pnp.gripper_close()
time.sleep(0.5)
left_pnp.send(ta.H_approach) left_pnp.send(ta.H_approach)