from time import sleep_us, sleep
from machine import Pin, time_pulse_us

trigger = Pin(16, Pin.OUT)
x = Pin(17, Pin.IN)
buzzer = Pin(28, Pin.OUT)

verde1 = Pin(18, Pin.OUT)
verde2 = Pin(19, Pin.OUT)
giallo1 = Pin(20, Pin.OUT)
giallo2 = Pin(21, Pin.OUT)
rosso1 = Pin(4, Pin.OUT)
rosso2 = Pin(5, Pin.OUT)

while True:
    trigger.value(0)
    sleep_us(2)
    trigger.value(1)
    sleep_us(10)
    trigger.value(0)
    tempo = time_pulse_us(17, Pin.high)
    distance = ((tempo/1000000*340)/2)*100
    print("Distanza"+str(distance)+"cm")

    verde1.off()
    verde2.off()
    giallo1.off()
    giallo2.off()
    rosso1.off()
    rosso2.off()
    sleep(0.1)

    if distance <= 50:
        buzzer.on()
    else:
        buzzer.off()

    if distance <= 10 :
        rosso1.on()
        rosso2.on()
        giallo1.on()
        giallo2.on()
        verde1.on()
        verde2.on()
        sleep(0.1)

    elif distance <= 15 :
        rosso2.on()

    elif distance <= 30 :
        rosso1.on()

    elif distance <= 50 :
        giallo2.on()

    elif distance <= 100 :
        giallo1.on()

    elif distance <= 150 :
        verde2.on()

    elif distance <= 200 :
        verde1.on()