diff --git a/hazmat_scrimmage/bioglow_missions_6_7_experimental.py b/hazmat_scrimmage/bioglow_missions_6_7_experimental.py new file mode 100644 index 0000000..27b0d3d --- /dev/null +++ b/hazmat_scrimmage/bioglow_missions_6_7_experimental.py @@ -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()) \ No newline at end of file