from machine import Pin, time_pulse_us #importa le librerie necessarie
from time import sleep_us, sleep

trig = Pin(1, Pin.OUT) #imposta il pin 1 al pin trig del sensore a ultrasuoni
echo = Pin(2, Pin.IN) #imposta il pin 2 al pin echo del sensori a ultrasuoni

verde1 = Pin(10, Pin.OUT) #imposta il pin 10 al led corretto
verde2 = Pin(11, Pin.OUT) #imposta il pin 11 al led corretto
giallo1 = Pin(12, Pin.OUT) #imposta il pin 12 al led corretto
giallo2 = Pin(13, Pin.OUT) #imposta il pin 13 al led corretto
rosso1 = Pin(14, Pin.OUT) #imposta il pin 14 al led corretto
rosso2 = Pin(15, Pin.OUT) #imposta il pin 15 al led corretto

buzzer = Pin(4, Pin.OUT)

while(True):
    trig.value(0) #imposta a 0 il valore del trig
    sleep_us(2) 
    trig.value(1) #imposta a 1 il valore del trig
    sleep_us(10) #attende 10 millisecondi
    trig.value(0)
    tempo = time_pulse_us(2, Pin.high)
    distanza = ((340*tempo/1000000)/2)*100 #calcolo della distanza
    print(f"Distanza: {distanza} cm")

    #verifica la distanza e accende i led
    if(distanza<=200):
        verde1.value(1)
        buzzer.value(0)
    if(distanza<=150):
        verde2.value(1)
        buzzer.value(0)
    if(distanza<=100):
        giallo1.value(1)
        buzzer.value(0)
    if(distanza<=50):
        giallo2.value(1)
        buzzer.value(1)
    if(distanza<=30):
        rosso1.value(1)
        buzzer.value(1)
    if(distanza<=10):
        rosso2.value(1)
        buzzer.value(1)