import machine
import time
import srf05

# Khởi tạo GPIO và SRF05
trig = machine.Pin(4, machine.Pin.OUT)
echo = machine.Pin(5, machine.Pin.IN)
srf = srf05.SRF05(trig, echo)

# Khởi tạo màn hình LCD1602 I2C
import Adafruit_CharLCD as LCD
lcd = LCD.Adafruit_CharLCDPlate(address=0x27)  # Địa chỉ I2C mặc định là 0x27

# Bật đèn nền và xóa màn hình
lcd.backlight = True
lcd.clear()

while True:
    # Đo khoảng cách
    distance = srf.read()

    # Hiển thị khoảng cách lên màn hình LCD
    lcd.set_cursor(0, 0)
    lcd.print("Khoảng cách: " + str(distance) + " cm")

    # Cảnh báo khi khoảng cách gần hơn 20cm
    if distance < 20:
        lcd.set_cursor(0, 1)
        lcd.print("Cảnh báo! Vật cản gần!")
        time.sleep(1)  # Hiển thị cảnh báo trong 1 giây
        lcd.set_cursor(0, 1)
        lcd.print("              ")  # Xóa cảnh báo
    else:
        time.sleep(0.5)  # Chờ 0.5 giây trước khi thực hiện phép đo tiếp theo