Update regionals/bioglow_mission_3_4_5_experimental.py
This commit is contained in:
@@ -1,5 +1,5 @@
|
||||
#####################################
|
||||
# Solution for BioGlow Mission 3,4,5
|
||||
# Solution for BioGlow Missions 3,4,5
|
||||
#####################################
|
||||
|
||||
import robot # drive base, arms, sensors and moves all come from robot.py
|
||||
@@ -16,7 +16,7 @@ import robot # drive base, arms, sensors and moves all come from robot.py
|
||||
# arm.move_by(degrees, speed=) arm turn in degrees, speed in % of the arm's top speed
|
||||
# ------------------------------------------------------------------------------
|
||||
|
||||
async def solve_missions(): # Flip the rock,etc
|
||||
async def solve_missions(): # Flip The Rock, Lucky Leaves, Reaching Roots - Rishabh
|
||||
|
||||
# --- ARM HOMING (optional) -------------------------------------------
|
||||
# Uncomment the next line to push both arms gently against their hard stops
|
||||
@@ -28,28 +28,23 @@ async def solve_missions(): # Flip the rock,etc
|
||||
# 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
|
||||
|
||||
print (robot.left_arm.angle(),robot.right_arm.angle())
|
||||
await robot.move(40, speed=100, acceleration=200, then=robot.Stop.COAST) # 40 cm forward, 100% speed, 200 mm/s² accel
|
||||
|
||||
await robot.move(10, speed=100, acceleration=300) # 10 cm forward, 100% speed, 300 mm/s² accel
|
||||
|
||||
|
||||
await robot.move(45.5) # 45.5 cm forward
|
||||
await robot.move(-20) # 20 cm backward
|
||||
await robot.turn(45, then=robot.Stop.HOLD) # 45° right
|
||||
await robot.move(48) # 48 cm forward
|
||||
await robot.turn(-80, then=robot.Stop.HOLD) # 80° left
|
||||
await robot.multitask(
|
||||
robot.right_arm.move_by(-60, speed=23), # right arm -60°, 23% arm speed
|
||||
robot.left_arm.move_by(60, speed=23), # left arm 60°, 23% arm speed
|
||||
robot.move(-6, speed=18, acceleration=100) # 6 cm backward, 18% speed, 100 mm/s² accel
|
||||
robot.left_arm.move_by(100, speed=47), # left arm 100°, 47% arm speed
|
||||
robot.right_arm.move_by(-120, speed=47) # right arm -120°, 47% arm speed
|
||||
)
|
||||
|
||||
await robot.multitask(
|
||||
robot.right_arm.move_by(50, speed=12), # right arm 50°, 12% arm speed
|
||||
robot.left_arm.move_by(-50, speed=12), # left arm -50°, 12% arm speed
|
||||
robot.move(-4, speed=18, acceleration=100) # 4 cm backward, 18% speed, 100 mm/s² accel
|
||||
)
|
||||
await robot.move(-30) # 30 cm backward
|
||||
await robot.move(-10) # 10 cm backward
|
||||
|
||||
robot.stop()
|
||||
await robot.move(24, speed=30) # 24 cm forward
|
||||
await robot.left_arm.move_by(-300, speed=47) # left arm -300°, 47% arm speed
|
||||
await robot.move(-5) # 5 cm backward
|
||||
await robot.turn(35) # 35° right
|
||||
await robot.right_arm.move_by(120, speed=100) # right arm 120°, 100% arm speed | Was 5000
|
||||
await robot.arc(-70, degrees=-150) # arc: circle on the robot's LEFT (70 cm radius), BACKWARD 150° (back end swings left, nose turns right)
|
||||
|
||||
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