added simple kick
This commit is contained in:
@@ -207,12 +207,21 @@ if __name__ == '__main__':
|
|||||||
and ball_in_lower[1] > 0.28):
|
and ball_in_lower[1] > 0.28):
|
||||||
|
|
||||||
print('Ball is in lower camera, go to align')
|
print('Ball is in lower camera, go to align')
|
||||||
striker.mover.stop_moving()
|
#striker.mover.stop_moving()
|
||||||
state = 'align'
|
#state = 'align'
|
||||||
|
state='simple_kick'
|
||||||
else:
|
else:
|
||||||
print('Continue running')
|
print('Continue running')
|
||||||
striker.run_to_ball()
|
striker.run_to_ball()
|
||||||
state = 'tracking'
|
state = 'tracking'
|
||||||
|
|
||||||
|
elif state == 'simple_kick':
|
||||||
|
#striker.mover.set_head_angles(0,0.25,0.3)
|
||||||
|
print('Doing the simple kick')
|
||||||
|
striker.mover.move_to(0.3,0,0)
|
||||||
|
striker.mover.wait()
|
||||||
|
state = 'tracking'
|
||||||
|
|
||||||
elif state == 'align':
|
elif state == 'align':
|
||||||
striker.mover.set_head_angles(0, 0.25, 0.3)
|
striker.mover.set_head_angles(0, 0.25, 0.3)
|
||||||
sleep(0.5)
|
sleep(0.5)
|
||||||
|
|||||||
Reference in New Issue
Block a user