Add shout-fll-scrimmage/bioglow_mission_3_4_5_experimental.py
experimental
This commit is contained in:
37
shout-fll-scrimmage/bioglow_mission_3_4_5_experimental.py
Normal file
37
shout-fll-scrimmage/bioglow_mission_3_4_5_experimental.py
Normal file
@@ -0,0 +1,37 @@
|
|||||||
|
#####################################
|
||||||
|
# Solution for BioGlow Mission 3,4,5
|
||||||
|
#####################################
|
||||||
|
|
||||||
|
import bioglow_helpers as helper
|
||||||
|
from bioglow_robot_settings import * # drive_base, left_arm, right_arm, ... all come from settings
|
||||||
|
|
||||||
|
async def solve_missions(): # Flip the rock,etc
|
||||||
|
|
||||||
|
drive_base.reset(0,0) # always reset drivebase for heading reset especially with turns
|
||||||
|
|
||||||
|
print (left_arm.angle(),right_arm.angle())
|
||||||
|
helper.set_speed(600,200,300,300)
|
||||||
|
await drive_base.straight(400,Stop.COAST)
|
||||||
|
|
||||||
|
helper.set_speed(800,300,300,300)
|
||||||
|
await drive_base.straight(100)
|
||||||
|
|
||||||
|
helper.set_speed(100,100,100,100)
|
||||||
|
await multitask(
|
||||||
|
right_arm.run_angle(100,-60),
|
||||||
|
left_arm.run_angle(100,60),
|
||||||
|
drive_base.straight(-60)
|
||||||
|
)
|
||||||
|
|
||||||
|
await multitask(
|
||||||
|
right_arm.run_angle(50,50),
|
||||||
|
left_arm.run_angle(50,-50),
|
||||||
|
drive_base.straight(-40)
|
||||||
|
)
|
||||||
|
helper.set_default_speed()
|
||||||
|
await drive_base.straight(-300)
|
||||||
|
await drive_base.straight(-100)
|
||||||
|
|
||||||
|
drive_base.stop()
|
||||||
|
if __name__ == "__main__": # This run this mission stand-alone when not called from bioglow_main.py
|
||||||
|
run_task(solve_missions())
|
||||||
Reference in New Issue
Block a user