Add hazmat_scrimmage/bioglow_missions_6_7_experimental.py

This commit is contained in:
2026-10-23 18:30:34 +00:00
parent b81c7bab63
commit d85a427371

View File

@@ -0,0 +1,58 @@
#####################################
# Solution for BioGlow Mission 6,7
#####################################
import bioglow_helpers as helper
from bioglow_robot_settings import * # drive_base, left_arm, right_arm, ... all come from settings
async def solve_missions(): # Windows to the past
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)
)
helper.set_speed(500,200,200,100)
# Turn left and lower arms
await multitask(
drive_base.turn(-45),
right_arm.run_angle(800,-70)
)
#helper.set_default_speed()
# approach leaf cutter mission
await drive_base.straight(315)
await 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)
print('Moving back')
await drive_base.straight(-260)
await drive_base.straight(40)
await multitask(
drive_base.turn(90),
right_arm.run_angle(800,-200)
)
await drive_base.straight(100)
await drive_base.turn(-45)
await drive_base.straight(150)
await right_arm.run_angle(800,100)
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())