run 2 aggiornata 16/11/25

This commit is contained in:
elisa 2025-11-17 08:12:25 +01:00
parent fae290eef5
commit 117c170d27

View file

@ -2,6 +2,7 @@ from pybricks.hubs import PrimeHub
from pybricks.parameters import Axis, Direction, Port, Stop from pybricks.parameters import Axis, Direction, Port, Stop
from pybricks.pupdevices import Motor from pybricks.pupdevices import Motor
from pybricks.robotics import DriveBase from pybricks.robotics import DriveBase
from pybricks.tools import wait
from assi import A from assi import A
from robot_class import LazyRobot, Robot from robot_class import LazyRobot, Robot
@ -16,16 +17,23 @@ def main(robot: LazyRobot):
db.settings(864, 300, 100, 50) db.settings(864, 300, 100, 50)
db.straight(610) # mission 1 db.straight(608) # mission 1
msu_L.run_angle(1000, -570, Stop.HOLD, wait=True) # abbassamento dell'asscenzore msu_L.run_angle(1000, -570, Stop.HOLD, wait=True) # abbassamento dell'asscenzore
db.straight(50) # primo abbassamento del paletto rosso db.settings(864, 1000, 100, 50)
db.straight(-100) # secondo abbassamento db.straight(40) # primo abbassamento del paletto rosso
db.straight(50) db.straight(-80) # secondo abbassamento
msu_L.run_angle(1000, 420, Stop.HOLD, wait=False) # inalzamento ascensore db.straight(40)
db.straight(50) # missione 2 msu_L.run_angle(1000, 420, Stop.HOLD, wait=False) # inalzamento ascensore
db.arc(500, 20, then=Stop.HOLD, wait=True) # db.settings(864, 300, 100, 50)
msu_L.run_angle(1000, 180, Stop.HOLD, wait=True)
db.straight(20) # missione 2
wait(2000)
msu_L.run_angle(1000, -300, Stop.HOLD, wait=False) # abbassamento dell'asscenzore
db.arc(250, angle=30, then=Stop.HOLD, wait=True)
msu_L.run_angle(1000, 90, Stop.HOLD, wait=True)
db.straight(10)
# db.straight(-150) # mission 3 #Return Point start arc # db.straight(-150) # mission 3 #Return Point start arc
# msu_L.run_angle(1000, -1440, Stop.COAST_SMART, wait=True) # msu_L.run_angle(1000, -1440, Stop.COAST_SMART, wait=True)