from machine import Pin, PWM
from hcsr04 import HCSR04
import time
# Setup sensore e LED
sensore = HCSR04(trigger_pin=4, echo_pin=5)
#Led
led = PWM(Pin(6))           # Crea oggetto PWM sul pin 6
led.freq(1000)              # Frequenza PWM a 1000Hz

# Parametri
DIST_MAX = 200     # Distanza massima rilevamento (cm)
LUCE_MIN = 50      # Luminosità minima (sempre accesa)
LUCE_MAX = 65535    # Luminosità massima

while True:
    distanza = sensore.measure_distance_cm()
    
    if distanza is not None:
        if distanza <= DIST_MAX:
            # Calcola luminosità: più vicino = più luminoso
            luminosita = LUCE_MIN + (LUCE_MAX - LUCE_MIN) * (DIST_MAX - distanza) / DIST_MAX
            led.duty_u16(int(luminosita))
        else:
            # Mantiene una luce tenue quando nessuno è vicino
            led.duty_u16(LUCE_MIN)
    
    time.sleep(0.1)