from machine import Pin, PWM #Potencia modulada
import utime

#Configurar los pines para el sensor ultrasonico y servo
servo=machine.PWM(machine.Pin(13))
servo.freq(50)#freq=frecuencia de 50 Hz

trigg=Pin(14,Pin.OUT)
echo=Pin(15,Pin.IN)
led=machine.Pin(25,machine.Pin.OUT)#Led interno

def medir_distancia():
    trigg=machine.Pin(14, machine.Pin.OUT)
    echo=machine.Pin(15, machine.Pin.IN)

#MEDIR TIEMPO
while echo.value()==0:
    signaloff=utime.ticks_us()

while echo.value()==1:
    signalon=utime.ticks_us()


def medir_distancia():
    tiempo=utime.ticks_diff(signalon,signaloff)
    distancia=(tiempo * 0.0343)/2
    return distancia

#////////////////////////////////////////#
#Medir el tiempo que tarda en recibir el pulso de vuelta

#Función abrir la pluma
def abrir_servo():
    servo.duty.u16=(8000)
    utime.sleep(2)
    led.value(1)
    print("Bienvenido")

#Función cerrar la pluma
def cerrar_servo():
    servo.duty.u16(2000)
    led.value(0)
    utime.sleep(2)

#Bucle principal
cerrar_servo()#Asegurar que esta cerrada la pluma

while True:
    distancia=medir_distancia()
    print('Distancia = {:.2f} cm'.format(distance_cm))
    utime.sleep(0.5)

    if distancia <=50:
        abrir_servo()
        utime.sleep(5)
        cerrar_servo()
    else:
        print("AAAAAAAAAA")
    
    utime.sleep(1)