from machine import Pin, I2C
import time
import ssd1306
import hcsr04

# Khai báo chân GPIO cho cảm biến khoảng cách
trigger_pin = 4  # Chân GPIO kết nối với chân Trigger của cảm biến
echo_pin = 5     # Chân GPIO kết nối với chân Echo của cảm biến

# Khai báo chân SDA, SCL cho màn hình OLED
sda_pin = 21     # Chân GPIO kết nối với chân SDA của màn hình OLED
scl_pin = 22     # Chân GPIO kết nối với chân SCL của màn hình OLED
# Thiết lập giao tiếp I2C cho màn hình OLED
i2c = I2C(scl=Pin(scl_pin), sda=Pin(sda_pin))
oled = ssd1306.SSD1306_I2C(128, 64, i2c)

# Khởi tạo cảm biến khoảng cách
sensor = hcsr04.HCSR04(trigger_pin, echo_pin)

try:
    while True:
        # Đo khoảng cách
        distance = sensor.distance_cm()

        # Xóa màn hình OLED
        oled.fill(0)

        # Hiển thị kết quả lên màn hình OLED
        oled.text("Distance:", 0, 0)
        oled.text(str(distance) + " cm", 0, 16)
        oled.show()

        # Đợi một khoảng thời gian trước khi đo lại
        time.sleep(1)

except KeyboardInterrupt:
    pass