import machine
import hcsr04
import time
from machine import Pin
from esp32_gpio_lcd import GpioLcd #thêm module giao tiếp với lcd
from utime import sleep_ms, ticks_ms
from machine import SoftI2C, Pin
from i2c_lcd import I2cLcd
led = Pin(4,Pin.OUT)
i2c = SoftI2C(scl=Pin(26), sda=Pin(32), freq=400000)
lcd = I2cLcd(i2c, 0x27, 4, 20)
ultrasonic=hcsr04.HCSR04(trigger_pin=22,echo_pin=21,echo_timeout_us=1000000)
ultrasonic = hcsr04.HCSR04(trigger_pin=22, echo_pin=21, echo_timeout_us=1000000)
led = machine.Pin(2, machine.Pin.OUT)

while True:
    distance = ultrasonic.distance_cm()
    print('Distance:', distance, 'cm', '|', distance/2, 'inch')
    if distance <=10:
        led.on()
    else:
        led.off()
    time.sleep_ms(1000)
    lcd.move_to(0,0)#cột hàng
    lcd.putstr('Minh')
    lcd.move_to(0,1)#cột hàng
    lcd.putstr('KC = ' + str(distance)+' cm' )
    time.sleep(2)
    lcd.clear()