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