from machine import Pin, PWM
import utime 


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

trig = Pin(1, Pin.OUT)
echo = Pin(2, Pin.IN)

trig.low()
utime.sleep_us(2)
trig.high()
utime.sleep_us(5)
trig.low

def get_distance():
    while echo.value() == 0:
        pass
    start = utime.ticks_us()

    while echo.value() == 1:
        pass
    end = utime.ticks_us()

    distance = ((end - start) * 0.0343) / 2

    return distance
    

def set_servo_angle(angle):
    duty = int(angle * 8000 / 180 + 1000)
    servo.duty_u16(duty)
    print(f"Servo Angle : {angle}")


while True:
    servo.angle(distance)


if distance<179:
    servo.angle(179)