Added object oriented version of codes
This commit is contained in:
53
regionals/bioglow_mission_1.py
Normal file
53
regionals/bioglow_mission_1.py
Normal file
@@ -0,0 +1,53 @@
|
||||
#####################################
|
||||
# Solution for BioGlow Mission 1
|
||||
#####################################
|
||||
|
||||
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(): # Drone Survey - Johannes
|
||||
|
||||
# --- 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()
|
||||
|
||||
await robot.multitask(
|
||||
robot.left_arm.move_by(-300, speed=93), # left arm -300°, 93% arm speed
|
||||
robot.right_arm.move_by(100, speed=93), # right arm 100°, 93% arm speed
|
||||
robot.move(90) # 90 cm forward
|
||||
)
|
||||
await robot.turn(-25) # 25° left
|
||||
await robot.move(11) # 11 cm forward
|
||||
await robot.turn(-35) # 35° left
|
||||
await robot.turn(35) # 35° right
|
||||
await robot.move(-3) # 3 cm backward
|
||||
await robot.turn(25) # 25° right
|
||||
await robot.move(-20) # 20 cm backward
|
||||
await robot.turn(-45) # 45° left
|
||||
await robot.move(50) # 50 cm forward
|
||||
await robot.turn(75) # 75° right
|
||||
await robot.move(70) # 70 cm forward
|
||||
robot.stop() # FIXED: was `await drive_base.stop` (crashed)
|
||||
|
||||
|
||||
|
||||
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