Delete regionals/bioglow_missions_6_7_13_14_experimental.py
El Cleanup.
This commit is contained in:
@@ -1,92 +0,0 @@
|
|||||||
#####################################
|
|
||||||
# Solution for BioGlow Mission 6,7,13,14
|
|
||||||
#####################################
|
|
||||||
|
|
||||||
import robot # drive base, arms, sensors and moves all come from robot.py
|
|
||||||
|
|
||||||
# UNITS used in this file -----------------------------------------------------
|
|
||||||
# robot.move(cm) distance in cm (+ forward, - backward)
|
|
||||||
# robot.turn(degrees) degrees (+ right / clockwise, - left)
|
|
||||||
# robot.arc(radius_cm, ...) radius in cm (+ circle on the right, - on the left),
|
|
||||||
# then degrees= around the circle or cm= along it (+ forward, - backward)
|
|
||||||
# speed= % of top speed, 1-100 (normal: 80% drive, 72% turn)
|
|
||||||
# acceleration= how fast it speeds up and slows down:
|
|
||||||
# mm/s² for move/arc (normal 500), °/s² for turn (normal 200)
|
|
||||||
# (² means "per second": 200 mm/s² = 200 mm/s faster every second)
|
|
||||||
# arm.move_by(degrees, speed=) arm turn in degrees, speed in % of the arm's top speed
|
|
||||||
# ------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
async def solve_missions(): # Leaf cutter frenzy, humungous fungus, etc
|
|
||||||
|
|
||||||
# --- ARM HOMING (optional) -------------------------------------------
|
|
||||||
# Uncomment the next line to push both arms gently against their hard stops
|
|
||||||
# and call that spot 0, so every arm move starts from the same place each run.
|
|
||||||
# Before using it: set home_backward for each arm in robot.py (run arm_calibrate.py).
|
|
||||||
# await robot.home_arms()
|
|
||||||
|
|
||||||
# --- LET THE GYRO SETTLE ----------------------------------------------
|
|
||||||
# Wait half a second (and until the hub is perfectly still) before moving,
|
|
||||||
# so turns are measured from a steady heading.
|
|
||||||
await robot.settle_gyro()
|
|
||||||
|
|
||||||
robot.reset() # always reset drivebase for heading reset especially with turns
|
|
||||||
|
|
||||||
# Forward while raising arms
|
|
||||||
await robot.multitask(
|
|
||||||
robot.move(50), # 50 cm forward
|
|
||||||
robot.right_arm.move_by(20, speed=100), # right arm 20°, 100% arm speed
|
|
||||||
robot.left_arm.move_by(-10, speed=100) # left arm -10°, 100% arm speed
|
|
||||||
|
|
||||||
)
|
|
||||||
# Turn left and lower right arm
|
|
||||||
await robot.multitask(
|
|
||||||
robot.turn(-45, speed=48, acceleration=100), # 45° left, 48% turn speed, 100 °/s² turn accel
|
|
||||||
robot.right_arm.move_by(-70, speed=100) # right arm -70°, 100% arm speed
|
|
||||||
)
|
|
||||||
# approach leaf cutter mission
|
|
||||||
await robot.multitask(
|
|
||||||
robot.move(35, speed=100, acceleration=200), # 35 cm forward, 100% speed, 200 mm/s² accel
|
|
||||||
robot.right_arm.move_by(65, speed=100) # right arm 65°, 100% arm speed
|
|
||||||
)
|
|
||||||
await robot.turn(45, speed=48, acceleration=100) # 45° right, 48% turn speed, 100 °/s² turn accel
|
|
||||||
await robot.move(10, speed=100, acceleration=200) # 10 cm forward, 100% speed, 200 mm/s² accel
|
|
||||||
|
|
||||||
# solving mycelium
|
|
||||||
# await multitask(
|
|
||||||
# right_arm.run_angle(800,70),
|
|
||||||
# drive_base.straight(10)
|
|
||||||
# )
|
|
||||||
await robot.right_arm.move_by(70, speed=100) # right arm 70°, 100% arm speed
|
|
||||||
|
|
||||||
print('Moving back')
|
|
||||||
await robot.move(-26) # 26 cm backward
|
|
||||||
await robot.move(4) # 4 cm forward
|
|
||||||
await robot.multitask(
|
|
||||||
robot.turn(55), # 55° right
|
|
||||||
robot.right_arm.move_by(-200, speed=100) # right arm -200°, 100% arm speed
|
|
||||||
)
|
|
||||||
|
|
||||||
#approach Elder tree
|
|
||||||
await robot.move(22) # 22 cm forward
|
|
||||||
#await drive_base.turn(-40)
|
|
||||||
#await drive_base.straight(140)
|
|
||||||
|
|
||||||
#attemp to raise cane
|
|
||||||
await robot.multitask(
|
|
||||||
#drive_base.turn(5),
|
|
||||||
robot.right_arm.move_by(200, speed=100), # right arm 200°, 100% arm speed
|
|
||||||
robot.move(3), # 3 cm forward
|
|
||||||
)
|
|
||||||
await robot.move(6) # 6 cm forward
|
|
||||||
await robot.left_arm.move_by(200, speed=100) # left arm 200°, 100% arm speed
|
|
||||||
|
|
||||||
await robot.move(-5) # 5 cm backward
|
|
||||||
await robot.turn(-45) # 45° left
|
|
||||||
await robot.move(-60) # 60 cm backward
|
|
||||||
|
|
||||||
#helper.reset_arms()
|
|
||||||
|
|
||||||
robot.stop()
|
|
||||||
|
|
||||||
if __name__ == "__main__": # This run this mission stand-alone when not called from bioglow_main.py
|
|
||||||
robot.run_task(solve_missions())
|
|
||||||
Reference in New Issue
Block a user