From 4e2d265cbcdd849459e00f7d335785ffade04b6e Mon Sep 17 00:00:00 2001
From: leo <leo@latentspace.cloud>
Date: Sun, 9 Nov 2025 16:59:12 +0100
Subject: [PATCH] missione 1 e 2

---
 menu.py   |  9 +++++----
 run_01.py | 14 ++++++++++++++
 run_02.py | 44 ++++++++++++++++++++++++++++++++++++++++++++
 3 files changed, 63 insertions(+), 4 deletions(-)
 create mode 100644 run_01.py
 create mode 100644 run_02.py

diff --git a/menu.py b/menu.py
index afb6a88..a3eb202 100644
--- a/menu.py
+++ b/menu.py
@@ -3,12 +3,13 @@ import usys
 from pybricks.tools import hub_menu, wait
 
 import batteria
-from giro_leo_prova import main as run_L
-from guida_funzionante import main as run_G
-from guidaavantieindietro import main as run_A
+from giro_leo_prova import main as run_R
 from robot_local import robot
 
-PROGRAMMI = {"G": run_G, "A": run_A, "L": run_L}
+# from run_01 import main as run_1
+from run_02 import main as run_2
+
+PROGRAMMI = {"2": run_2, "R": run_R}
 
 
 def run_with_play(hub, fn, *args, **kwargs):
diff --git a/run_01.py b/run_01.py
new file mode 100644
index 0000000..e393ed6
--- /dev/null
+++ b/run_01.py
@@ -0,0 +1,14 @@
+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):
+    hub = robot.hub
+    db = robot.db
+
+    db.settings()
diff --git a/run_02.py b/run_02.py
new file mode 100644
index 0000000..7c35a0a
--- /dev/null
+++ b/run_02.py
@@ -0,0 +1,44 @@
+from pickle import STOP
+from threading import ThreadError
+
+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
+
+msu_R = Motor(Port.E)
+msu_L = Motor(Port.D)
+
+
+def main(robot: LazyRobot):
+    hub = robot.hub
+    db = robot.db
+
+    db.settings(864, 300, 100, 50)
+
+    db.straight(600)  # mission 1
+    msu_L.run_angle(1000, -720, Stop.HOLD, wait=True)  # abbassamento dell'asscenzore
+    db.straight(50)  # primo abbassamento del paletto rosso
+    db.straight(-120)  # secondo abbassamento
+    db.straight(40)
+    msu_L.run_angle(1000, -720, Stop.HOLD, wait=False)  # inalzamento ascensore
+
+    db.straight(50)  # missione 2
+    db.arc(500, 20, then=Stop.HOLD, wait=True)
+    msu_L.run_angle(1000, 360, Stop.HOLD, wait=True)
+
+    # db.straight(-150)  # mission 3      #Return Point start arc
+    # msu_L.run_angle(1000, -1440, Stop.COAST_SMART, wait=True)
+    # db.arc(275, 90, then=Stop.HOLD, wait=False)
+    # db.straight(130)
+    # msu_L.run_angle(1000, 1440, Stop.COAST_SMART, wait=True)  # inclinazione carrello
+
+
+if __name__ == "__main__":
+    import batteria
+    from robot_local import robot
+
+    main(robot)