from machine import Pin, SoftI2C, time_pulse_us
import time
import ssd1306

i2c = softI2C(scl=Pin(22), sda=Pin(21))
display = ssd1306.SSD1306_I2C(128, 64, i2c)

trigger_pin = Pin(27, Pin.OUT)
echo_pin = Pin(26, Pin.IN)

def distance():

trigger_pin.on()
time.sleep_us(100)
trigger_pin.off()

pulse_time = time_pulse_us(echo_pin, 1, 10000)
distance = pulse_time / 58.0

return distance

while True:
   
   dist = distance()

    oled.fill(0)
    oled.text("Distance:", 0, 0)
    oled.text("{:.2f} cm".format(dist), 0, 20)
    oled.show()

    time.sleep(0.1)