from machine import I2C, Pin
from time import sleep
from picozero import DistanceSensor

ds = DistanceSensor(echo=27, trigger=28, max_distance=4)


from pico_i2c_lcd import I2cLcd

i2c = I2C(0, sda=Pin(0), scl=Pin(1), freq=400000)

# getting I2C address
I2C_ADDR = i2c.scan()[0]

lcd = I2cLcd(i2c, I2C_ADDR, 2, 16)  #khai bao



while True:
    distance_cm = round(ds.distance * 100, 1)
    
    print(f"Distance: {distance_cm} cm")

    lcd.move_to(0,0)
    lcd.putstr(f"Distance:{distance_cm}cm")
    sleep(1)