from machine import Pin, PWM
from time import sleep
from hcsr04 import HCSR04
cap = HCSR04(trigger_pin=5, echo_pin=18)
servo = PWM(Pin(22), freq = 50)
while True :
    d = cap.distance_cm()
    print('Distance:', d, 'cm')
    sleep(2)
    if d < 200 :
        servo.duty(75)   # bas
    else:
        servo.duty(25)    # haut