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

# ESP32 Pin assignment 
i2c = I2C(scl=Pin(5), sda=Pin(4), freq=100000)
lcd=ssd1306.SSD1306_I2C(128,64,i2c)

sensor = HCSR04(trigger_pin=13, echo_pin=12, echo_timeout_us=100000)

led1 = machine.Pin(23, machine.Pin.OUT)
while True:
    distance = sensor.distance_cm()
    print(distance)
    if distance<20:
        led1.value(1)
    else:
        led1.value(0)
    lcd.fill(0)
    lcd.text("Distance:" ,30,20)
    lcd.text(str(distance),30,40)
    lcd.show()