import time
from machine import Pin, PWM

servo = PWM(Pin(0))
servo.freq(50)

trigger1 = Pin(2, Pin.OUT)
echo1 = Pin(3, Pin.IN)

trigger2 = Pin(4, Pin.OUT)
echo2 = Pin(5, Pin.IN)

def medird(trigger, echo);
    trigger.low()
    time.sleep_us(2)
    trigger.high()
    time.sleep_us(10)
    trigger.low()

    while echo.value() == 0:
        pulsoi = time.ticks_us()
    while echo.value() == 1:
        pulsof = time.ticks_us()

    dur = time.ticks_diff(pulsof, pulsoi)
    distancia_cm (dur / 2) / 29.1
    return distancia_cm

def abrir_p():
    print ("Clave correcta, Abriendo puerta")
    servo.duty_u16(8000)
    time.sleep(3)
    servo.duty_u16(2000)
    print("Puerta cerrada")

clave correcta =1234

while True:
    d1= medird(trigger1,echo1)
    print("Sensor 1 (entrada): {:.1f} cm".format(d1))
    
    if d1 < 15:
        clave = input("Ingrese la clave: ")
        if clave == clave_correcta:
            abrir_p()
        else:
            print("Clave incorrecta.")

        
        print("Esperando que el carro pase")
        while True:
            d2=medird(trigger2,echo2)
            print("Sensor 2(salida): {:.1f} cm".format(d2))
            if d2 < 15:
                print("Carro ha pasado")
                break
            time.sleep(0.5)
    time.sleep(1)