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 11:12:28 +00:00
parent fc1363b5cc
commit 817fbd5ab9
1 changed files with 37 additions and 28 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

27
new_main.py
View File

@ -207,8 +207,6 @@ def V_Routine():
x = raw_input('Ready?') x = raw_input('Ready?')
if x == 'n':exit(0) if x == 'n':exit(0)
left_pnp.send(ta.V_pickup) left_pnp.send(ta.V_pickup)
x = raw_input('Close?')
if x == 'n':exit(0)
left_pnp.gripper_close() left_pnp.gripper_close()
gripper_state = left_pnp.gripperPosition() gripper_state = left_pnp.gripperPosition()
@ -244,8 +242,6 @@ def H_Routine():
x = raw_input('Ready?') x = raw_input('Ready?')
if x == 'n':exit(0) if x == 'n':exit(0)
left_pnp.send(ta.H_pickup) left_pnp.send(ta.H_pickup)
x = raw_input('Close?')
if x == 'n':exit(0)
left_pnp.gripper_close() left_pnp.gripper_close()
gripper_state = left_pnp.gripperPosition() gripper_state = left_pnp.gripperPosition()
@ -272,23 +268,22 @@ left_pnp.gripper_open()
V_Routine() V_Routine()
left_pnp.send(ta.B_1_A) left_pnp.send(ta.B_1_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_1_P) left_pnp.send(ta.B_1_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
print('GRIPPA POSITION+++')
print(left_pnp.gripperPosition())
print('GRIPPA POSITION+++')
print()
left_pnp.send(ta.B_1_A) left_pnp.send(ta.B_1_A)
V_Routine() V_Routine()
left_pnp.send(ta.B_2_A) left_pnp.send(ta.B_2_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_2_P) left_pnp.send(ta.B_2_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_2_A) left_pnp.send(ta.B_2_A)
@ -296,8 +291,10 @@ left_pnp.send(ta.B_2_A)
V_Routine() V_Routine()
left_pnp.send(ta.B_3_A) left_pnp.send(ta.B_3_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_3_P) left_pnp.send(ta.B_3_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_3_A) left_pnp.send(ta.B_3_A)
@ -305,16 +302,20 @@ left_pnp.send(ta.B_3_A)
H_Routine() H_Routine()
left_pnp.send(ta.B_4_A) left_pnp.send(ta.B_4_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_4_P) left_pnp.send(ta.B_4_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_4_A) left_pnp.send(ta.B_4_A)
H_Routine() H_Routine()
left_pnp.send(ta.B_5_A) left_pnp.send(ta.B_5_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_5_P) left_pnp.send(ta.B_5_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_5_A) left_pnp.send(ta.B_5_A)
@ -322,16 +323,20 @@ left_pnp.send(ta.B_5_A)
V_Routine() V_Routine()
left_pnp.send(ta.B_6_A) left_pnp.send(ta.B_6_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_6_P) left_pnp.send(ta.B_6_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_6_A) left_pnp.send(ta.B_6_A)
V_Routine() V_Routine()
left_pnp.send(ta.B_7_A) left_pnp.send(ta.B_7_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_7_P) left_pnp.send(ta.B_7_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_7_A) left_pnp.send(ta.B_7_A)
@ -339,8 +344,10 @@ left_pnp.send(ta.B_7_A)
H_Routine() H_Routine()
left_pnp.send(ta.B_8_A) left_pnp.send(ta.B_8_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_8_P) left_pnp.send(ta.B_8_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_8_A) left_pnp.send(ta.B_8_A)
@ -348,8 +355,10 @@ left_pnp.send(ta.B_8_A)
V_Routine() V_Routine()
left_pnp.send(ta.B_9_A) left_pnp.send(ta.B_9_A)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.send(ta.B_9_P) left_pnp.send(ta.B_9_P)
if debug:
x = raw_input('Continue?: ') x = raw_input('Continue?: ')
left_pnp.gripper_open() left_pnp.gripper_open()
left_pnp.send(ta.B_9_Z) left_pnp.send(ta.B_9_Z)