import time
import utime
from machine import Pin
trigger= Pin(15, Pin.OUT)
echo= Pin(14, Pin.IN)
azul = Pin(0, Pin.OUT)
verde = Pin(1, Pin.OUT)
rojo = Pin(2, Pin.OUT)
time.sleep(0.1) # Wait for USB to become ready
distancia=0
def get_distancia():
    global distancia
    trigger.value(1)
    utime.sleep(0.00001)
    trigger.value(0)

    while echo.value() == 0:
        start = utime.ticks_us()
    while echo.value() == 1:
        stop = utime.ticks_us()
    duracion = stop - start
    distancia = (duracion * 0.0343) / 2
    #print("Distancia: ",distancia," cm")
    return distancia
while True:
  get_distancia()
  if (distancia > 0 and distancia <50): #rojo
    verde.value(0)
    rojo.value(1)
    azul.value(0)
  if (distancia > 50 and distancia < 150): #azul
    verde.value(0)
    rojo.value(0)
    azul.value(1)
  if (distancia > 150 and distancia < 250): #verde
    verde.value(1)
    rojo.value(0)
    azul.value(0)
  if (distancia > 250 and distancia < 350): #amarillo
    verde.value(1)
    rojo.value(1)
    azul.value(0)
  if (distancia > 350 and distancia <405): #blanco
    verde.value(1)
    rojo.value(1)
    azul.value(1)
  print(distancia)
  time.sleep(0.25)