import time
import board
import adafruit_hcsr04
import pwmio

#inicializa el sensor hcsr04
trig_pin=board.GP22
echo_pin=board.GP21
sonar=adafruit_hcsr04.HCSR04(trig_pin,echo_pin)


ledR = pwmio.PWMOut(board.GP2,frequency=1000)
ledG = pwmio.PWMOut(board.GP3,frequency=1000)
ledB = pwmio.PWMOut(board.GP4,frequency=1000)
buzzer=pwmio.PWMOut(board.GP0,variable_frequency=True)


while True:
    try:
        #medir distancia
        distance=sonar.distance
        print("Distancia: {:.1f}cm".format(distance))
        if sonar.distance<20.0:
            ledR.duty_cycle=65535
            ledG.duty_cycle=0
            ledB.duty_cycle=0
            buzzer.frequency=5000
            buzzer.duty_cycle=32763

        elif 21<sonar.distance<50 : 
            ledR.duty_cycle=65535
            ledG.duty_cycle=65535
            ledB.duty_cycle=0
            buzzer.frequency=2500
            buzzer.duty_cycle=32763
        elif 51<sonar.distance<100:
            ledR.duty_cycle=0
            ledG.duty_cycle=65535  
            ledB.duty_cycle=0         
            buzzer.frequency=1000
            buzzer.duty_cycle=32763

        else: 
            ledR.duty_cycle=65535
            ledG.duty_cycle=65535
            ledB.duty_cycle=65535
            buzzer.frequency=22000
            buzzer.duty_cycle=32763
        

        time.sleep(0.1)
    except RuntimeError:
        print("Recargando...")
        pass