from machine import Pin,SoftI2C
from hcsr04 import HCSR04
from lib_lcd1602_2004_with_i2c import LCD
from time import sleep

sensor = HCSR04(trigger_pin=5, echo_pin=18, echo_timeout_us=100000)
lcd = LCD(SoftI2C(scl=Pin(22),sda=Pin(21),freq=100000))
l1 = Pin(17,Pin.OUT)
l2 = Pin(16,Pin.OUT)
l3 = Pin(4,Pin.OUT)

while True:
    distance_cm = sensor.distance_cm()
    lcd.clear()

    if distance_cm < 50 :
        lcd.puts("Distance:{:.0f} cm".format(distance_cm), 0, 0)
        lcd.puts("Close",1,0)
        l1.on()
        sleep(1)
        l1.off()
    elif 50 <= distance_cm <= 150 :
        lcd.puts("Distance:{:.0f} cm".format(distance_cm), 0, 0)
        lcd.puts("Normal",1,0)
        l3.on()
        sleep(1)
        l3.off()
    elif distance_cm > 150 :
        lcd.puts("Distance:{:.0f} cm".format(distance_cm), 0, 0)
        lcd.puts("Far",1,0)
        l2.on()
        sleep(1)
        l2.off()