Creacion de cola y recoger lista de movimientos

main.py

 #!/usr/bin/env pybricks-micropython
 #!/usr/bin/env pybricks-micropython
 from robot import Robot
 from robot import Robot
 
 
-robot = Robot()
+robot = Robot()
\ No newline at end of file

robot.py

@@ -4,6 +4,7 @@ from pybricks.parameters import Port, Stop, Direction, Button, Color
 from pybricks.tools import wait, StopWatch, DataLog
 from pybricks.tools import wait, StopWatch, DataLog
 from pybricks.robotics import DriveBase
 from pybricks.robotics import DriveBase
 from pybricks.media.ev3dev import SoundFile, ImageFile
 from pybricks.media.ev3dev import SoundFile, ImageFile
+from queue import Queue
 
 
 class Robot:
 class Robot:
     green_rgb = (35, 55, 39)
     green_rgb = (35, 55, 39)
@@ -19,6 +20,7 @@ class Robot:
         self.giroSensor = GyroSensor(Port.S1)
         self.giroSensor = GyroSensor(Port.S1)
         self.colorSensor = ColorSensor(Port.S4)
         self.colorSensor = ColorSensor(Port.S4)
         self.robot = DriveBase(left_motor, right_motor, wheel_diameter=55.5, axle_track=124)
         self.robot = DriveBase(left_motor, right_motor, wheel_diameter=55.5, axle_track=124)
+        self.colaMovimientos = Queue()
 
 
     #Metodos gestion negros
     #Metodos gestion negros
     def queNegroEs(self):
     def queNegroEs(self):
@@ -89,8 +91,9 @@ class Robot:
             else:
             else:
                 self.robot.drive(0,50)
                 self.robot.drive(0,50)
 
 
-
-
-
+    # Recogemos la lista de movimientos del algoritmo
+    def recogeListaMovimientosPedido(self,lMovimientos):
+        for movimiento in lMovimientos:
+            self.colaMovimientos.put(movimiento)