from machine import Pin, PWM, time_pulse_us
import time

sensorA = Pin(13, Pin.IN)
sensorB = Pin(14, Pin.IN)
trigA = Pin(12, Pin.OUT)
trigB = Pin(25, Pin.OUT)
servo = PWM(Pin(23))
counter = 0
servo.init()
servo.freq(50)

def distA():
    sensorA.value(0)
    trigA.on()
    trigA.off()
    usec = time_pulse_us( sensorA, 1 )
    echoTime = usec/1000000
    distanceCm = (echoTime/2)*34300
    print(usec, distanceCm)
    return distanceCm
def distB():
    sensorB.value(0)
    trigB.on()
    trigB.off()
    usec = time_pulse_us( sensorB, 1 )
    echoTime = usec/1000000
    distanceCm = (echoTime/2)*34300
    print(usec, distanceCm)
    return distanceCm
def barrierOn():
    servo.duty(25)
def barrierOff():
    servo.duty(75)

#### RUN ####
while distA() > 200:
    pass
barrierOff
counter += 1
while distB() > 200:
    pass
barrierOn()
print(counter)