from hcrs04 import HCSR04
from time import sleep
from machine import Pin, PWM

sensor = HCSR04(trigger_pin=27, echo_pin=26)
led = Pin(11, Pin.OUT)
led. value(0)
# Inicializuje PWM na pinu GP16 (GPIO 16), který bude ovládat servo motor.
servo = PWM(Pin(15))        
# Nastavuje frekvenci PWM na 50 Hz – běžná frekvence pro servomotory.
servo.freq(50)
servo.duty_u16(1802)


while True:
    distance = sensor.distance_cm()
    dis = int(distance)
    if(dis < 20):
        servo.duty_u16(1802)
        led.value(1)
    else:
        servo.duty_u16(7864)
        led.value(0)
    print('Distance:', dis, 'cm') 
    sleep(1)