Add hazmat_scrimmage/bioglow_missions_6_7_13_14_experimental.py

This commit is contained in:
2026-10-23 18:32:07 +00:00
parent d85a427371
commit 1735e2bc34

View File

@@ -0,0 +1,73 @@
#####################################
# Solution for BioGlow Mission 6,7,13,14
#####################################
import bioglow_helpers as helper
from bioglow_robot_settings import * # drive_base, left_arm, right_arm, ... all come from settings
async def solve_missions(): # Leaf cutter frenzy, humungous fungus, etc
drive_base.reset(0,0) # always reset drivebase for heading reset especially with turns
# Forward while raising arms
await multitask(
drive_base.straight(500),
right_arm.run_angle(800,20),
left_arm.run_angle(800,-10)
)
helper.set_speed(600,200,200,100)
# Turn left and lower right arm
await multitask(
drive_base.turn(-45),
right_arm.run_angle(800,-70)
)
#helper.set_default_speed()
# approach leaf cutter mission
await multitask(
drive_base.straight(350),
right_arm.run_angle(800,65)
)
await drive_base.turn(45)
await drive_base.straight(100)
# solving mycelium
# await multitask(
# right_arm.run_angle(800,70),
# drive_base.straight(10)
# )
await right_arm.run_angle(800,70)
helper.set_default_speed()
print('Moving back')
await drive_base.straight(-260)
await drive_base.straight(40)
await multitask(
drive_base.turn(55),
right_arm.run_angle(800,-200)
)
#approach Elder tree
await drive_base.straight(220)
#await drive_base.turn(-40)
#await drive_base.straight(140)
#attemp to raise cane
await multitask(
#drive_base.turn(5),
right_arm.run_angle(500,200),
drive_base.straight(30),
)
await drive_base.straight(60)
await left_arm.run_angle(1000,200)
await drive_base.straight(-50)
await drive_base.turn(-45)
await drive_base.straight(-600)
#helper.reset_arms()
drive_base.stop()
if __name__ == "__main__": # This run this mission stand-alone when not called from bioglow_main.py
run_task(solve_missions())