from machine import Pin , I2C
from time import sleep
from esp32_i2c_lcd import I2cLcd
from hcsr04 import HCSR04

lcdI2C = I2C(scl = Pin(22), sda = Pin(21))
#print(lcdI2C.scan())
lcd = I2cLcd(lcdI2C,0x27,2,16)
lcd.clear()

sensor = HCSR04(trigger_pin=4, echo_pin=2)
led_pin = Pin(5, Pin.OUT)

while True:
    distance_cm = sensor.distance_cm()
    distance_mm = sensor.distance_mm()
    lcd.clear()
    lcd.move_to(0, 0)
    lcd.putstr("Dist= {:.2f} cm".format(distance_cm))
    lcd.move_to(0, 1)
    lcd.putstr("Dist= {:.2f} mm".format(distance_mm))

    sleep(1)