Prueba de siguelinea verde

parent 916c040a
Showing with 19 additions and 0 deletions
......@@ -33,3 +33,22 @@ def giro(grados):
if (ajuste < 0):
robot.turn(-1)
def sigue_linea_verde():
# Valores medios para los colores
green_threshold = (70 + 100) / 2 # Valor medio para el color verde claro
blue_threshold = (0 + 20) / 2 # Valor medio para el color azul oscuro
while True:
reflection = colorSensor.reflection()
if reflection > green_threshold: # Si está sobre la línea verde
desviacion = reflection - green_threshold
turn = 1.2 * desviacion # Correccion hacia la
elif reflection < blue_threshold: # Si está sobre la línea azul
desviacion = blue_threshold - reflection
turn = -1.2 * desviacion # Corrección hacia la izquierda
else: # Si está entre la línea verde y la azul
turn = 0 # Avanzar recto
robot.drive(100, turn)
wait(10)
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or sign in to comment