from machine import Pin, PWM
import utime
from time import sleep

led_red = Pin(15, Pin.OUT)  
led_green = Pin(14, Pin.OUT) 

pin_piezo = Pin(12)
glosnik = PWM(pin_piezo)

trigger = Pin(3, Pin.OUT)
echo = Pin(2, Pin.IN)

def ultra():
    trigger.low()
    utime.sleep_us(2)
    trigger.high()
    utime.sleep_us(5)
    trigger.low()
    while echo.value() == 0:
        signaloff = utime.ticks_us()
    while echo.value() == 1:
        signalon = utime.ticks_us()
    timepassed = signalon - signaloff
    distance = (timepassed * 0.0343) / 2
    print("The distance from object is ",distance,"cm")
    if distance >= 31:
        led_green.on()
        sleep(2)
        led_green.off()
    elif distance <= 30:
        led_red.on()
        glosnik.freq(350)
        glosnik.duty_u16(32_768)
        sleep(2)
        glosnik.deinit()
        led_red.off()
    elif distance <= 10:
        led_red.on()
        glosnik.freq(500)
        glosnik.duty_u16(32_768)
        sleep(2)
        glosnik.deinit()
        led_red.off()

while True:
    ultra()
    utime.sleep(1)