from machine import Pin
from hcsr04 import HCSR04
import time

# Setup sensore e LED
sensore = HCSR04(trigger_pin=4, echo_pin=5)

# Setup 3 LED
led1 = Pin(8, Pin.OUT)   # Verde: si accende entro 100cm
led2 = Pin(7, Pin.OUT)   # Giallo: si accende entro 50cm
led3 = Pin(6, Pin.OUT)  # Rosso: si accende entro 25cm

# Lista LED
leds = [led1, led2, led3]

# Spegne tutti i LED
def spegni_led():
    for led in leds:
        led.value(0)

while True:
    distanza = sensore.measure_distance_cm()
    spegni_led()
    
    # Accensione LED in base alla distanza
    if distanza < 100:
        led1.value(1)         # Oggetto rilevato (LED verde)
        if distanza < 50:
            led2.value(1)     # Oggetto vicino (LED giallo)
            if distanza < 25:
                led3.value(1) # Oggetto molto vicino (LED rosso)
    
    time.sleep(0.1)