#Import Library Import HC-SR04
from hcsr04 import HCSR04
from time import sleep
from servo import Servo
import machine

pin_servo = machine.Pin(22)
my_servo = Servo(pin_servo)

sensor = HCSR04(trigger_pin=5, echo_pin=18)
while True:
    jarak = sensor.distance_cm()
    print(jarak, "cm")
    if jarak < 50:
        my_servo.write_angle(90)
    else:
        my_servo.write_angle(0)
    sleep(1)