from pybricks.hubs import PrimeHub
from pybricks.parameters import Axis, Direction, Port, Stop
from pybricks.pupdevices import Motor
from pybricks.robotics import DriveBase

from assi import A
from robot_class import LazyRobot, Robot


def main(robot: LazyRobot):  # partenza robot a 1 nero e 1
    msu_L: Motor = robot.extra_L
    hub = robot.hub
    db = robot.db

    def db_settingsInizz():
        db.settings(864, 1000, 100, 50)

    db_settingsInizz()

    db.settings(432, 300, 100, 50)
    db.straight(460)
    msu_L.run_angle(1000, 180, Stop.HOLD, wait=True)
    db_settingsInizz()
    db.straight(-500)