Add hazmat_scrimmage/bioglow_missions_6_7_experimental.py
This commit is contained in:
58
hazmat_scrimmage/bioglow_missions_6_7_experimental.py
Normal file
58
hazmat_scrimmage/bioglow_missions_6_7_experimental.py
Normal 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())
|
||||||
Reference in New Issue
Block a user