Add shout-fll-scrimmage/bioglow_mission_3_4_5_experimental.py

experimental
This commit is contained in:
2026-10-20 22:05:29 +00:00
parent a11bd235a2
commit 88858f1d39

View 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())