from machine import Pin, time_pulse_us, PWM, ADC
import time

ledP1=Pin(5,Pin.OUT)
trig=Pin(19,Pin.OUT)
echo=Pin(18,Pin.IN)
servo=PWM(Pin(17), freq=50)

adc=ADC(Pin(34))

adc.atten(ADC.ATTN_11DB)

led_pwm1=PWM(Pin(25))
led_pwm1.freq(1000)

led_pwm2=PWM(Pin(26))
led_pwm2.freq(1000)










while True:

    lectura=adc.read()

    valor_pwm=int(lectura/4)

    led_pwm1.duty(valor_pwm)
    led_pwm2.duty(valor_pwm)

    time.sleep(0.1)

    trig.value(1)
    time.sleep_us(10)
    trig.value(0)

    tiempo=time_pulse_us(echo, 1, 30000)

    distancia=tiempo/58

    if distancia >20:
        ledP1.value(1)
    else:
        ledP1.value(0)
    
    time.sleep(0.2)

    servo.duty(25) #0 Grados
    time.sleep(1)

    servo.duty(77) #Aproximadamente 90 Grados
    time.sleep(1)