Files
bioglow_solutions/regionals/bioglow_mission_11_experimental.py

56 lines
2.7 KiB
Python

#####################################
# Solution for BioGlow Mission 11
#####################################
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(): # Windows to the past
# --- 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
await robot.multitask(
robot.right_arm.move_by(-90, speed=100), # right arm -90°, 100% arm speed
robot.move(10) # 10 cm forward
)
await robot.turn(-45) # 45° left
await robot.move(42) # 42 cm forward
await robot.multitask(
robot.left_arm.move_by(45, speed=100), # left arm 45°, 100% arm speed
robot.right_arm.move_by(140, speed=100) # right arm 140°, 100% arm speed
)
#return home
await robot.move(-50) # 50 cm backward
await robot.multitask(
robot.left_arm.move_by(-45, speed=23), # left arm -45°, 23% arm speed
robot.right_arm.move_by(-90, speed=100) # right arm -90°, 100% arm speed
)
#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())