from machine import Pin,PWM,Timer
from time import sleep_ms
from HCSR04 import HCSR04
trig=Pin(14,Pin.OUT)
echo=Pin(12,Pin.IN)
HC=HCSR04(trig,echo)

S1=PWM(Pin(19), freq=50, duty=128)

def rotate(servo,degvee):
    servo.duty(int(degvee*0.54+25.6))
t=10
def fun(tim):
    distance=HC.getDistance()
    if distance >2 and distance<=100:
        rotate(S1,distance)
    else:
        rotate(S1,180)
tim=Timer(1)
tim.init(period=500,mode=Timer.PERIODIC,callback=fun)