48 lines
1.7 KiB
Python
48 lines
1.7 KiB
Python
#####################################
|
|
# Solution for BioGlow Mission 2
|
|
#####################################
|
|
|
|
import bioglow_helpers as helper
|
|
from bioglow_robot_settings import * # drive_base, left_arm, right_arm, ... all come from settings
|
|
|
|
async def solve_missions(): # Exploding Seeds - Johannes
|
|
|
|
drive_base.stop()
|
|
drive_base.reset(0,0)
|
|
helper.set_speed(800,400,200,100)
|
|
await drive_base.straight(20, then=Stop.NONE)
|
|
await drive_base.arc(150,None,115, then=Stop.NONE)
|
|
await drive_base.straight(270, then=Stop.HOLD)
|
|
await left_arm.run_angle(300,70)
|
|
await drive_base.straight(-30)
|
|
await left_arm.run_angle(100,20)
|
|
await drive_base.straight(-300, then=Stop.COAST),
|
|
await multitask(
|
|
right_arm.run_angle(500,-110),
|
|
left_arm.run_angle(500,-100),
|
|
drive_base.turn(-40, then=Stop.HOLD)
|
|
)
|
|
await drive_base.arc(610,70,None, then=Stop.HOLD)
|
|
await drive_base.turn(-78, then=Stop.HOLD)
|
|
helper.set_speed(100,200,300,200)
|
|
await drive_base.straight(120, then=Stop.COAST)
|
|
await right_arm.run_angle(1000,70)
|
|
await drive_base.straight(-130, then=Stop.COAST)
|
|
helper.set_speed(800,400,200,100)
|
|
await multitask(
|
|
drive_base.turn(95, then=Stop.HOLD),
|
|
right_arm.run_angle(500,-40)
|
|
)
|
|
await multitask(
|
|
drive_base.straight(160, then=Stop.COAST),
|
|
right_arm.run_angle(500,110)
|
|
)
|
|
await drive_base.straight(-400, then=Stop.COAST)
|
|
await drive_base.turn(100, then=Stop.NONE)
|
|
await drive_base.straight(700, then=Stop.COAST)
|
|
await drive_base.stop
|
|
|
|
|
|
|
|
if __name__ == "__main__": # This run this mission stand-alone when not called from bioglow_main.py
|
|
run_task(solve_missions()) |