import time
from machine import Pin, PWM

trig_pin = Pin(14, Pin.OUT)
echo_pin = Pin(12, Pin.IN)

led_pin1 =  Pin(19, Pin.OUT)
led_pin2 =  Pin(5, Pin.OUT)
led_pin3 =  Pin(16, Pin.OUT)
led_pin4 =  Pin(0, Pin.OUT)
led_pin5 =  Pin(15, Pin.OUT)

led_pin1.value(0)
led_pin2.value(0)
led_pin3.value(0)
led_pin4.value(0)
led_pin5.value(0)

rele = Pin(13, Pin.OUT)


while True:

    time.sleep(1)
    trig_pin.value(0)

    time.sleep_us(2)
    trig_pin.value(1)

    time.sleep_us(10)
    trig_pin.value(0)

    pulse_start = time.ticks_us()
    while echo_pin.value() == 0:
        pulse_start = time.ticks_us()
    
    pulse_end = time.ticks_us()
    while echo_pin.value() == 1:
        pulse_end = time.ticks_us()
        
    duration = time.ticks_diff(pulse_end, pulse_start)

    distance = (duration * 0.0343) / 2

    print("Distance: {:.2f} cm".format(distance))

    if distance >= 400:
        led_pin1.value(1)

        led_pin2.value(0)
        led_pin3.value(0)
        led_pin4.value(0)
        led_pin5.value(0)

        rele.off()

    elif distance >= 300 and distance < 400:
        led_pin1.value(1)
        led_pin2.value(1)
        
        led_pin3.value(0)
        led_pin4.value(0)
        led_pin5.value(0)

        rele.off()

    elif distance >= 200 and distance < 300:
        led_pin1.value(1)
        led_pin2.value(1)
        led_pin3.value(1)
        
        led_pin4.value(0)
        led_pin5.value(0)

        rele.off()
        
    elif distance >= 100 and distance < 200:
        led_pin1.value(1)
        led_pin2.value(1)
        led_pin3.value(1)
        led_pin4.value(1)

        led_pin5.value(0)

        rele.on()

    elif distance < 100: 
        led_pin1.value(1)
        led_pin2.value(1)
        led_pin3.value(1)
        led_pin4.value(1)
        led_pin5.value(1)

        rele.on()