from machine import Pin, SoftI2C
from ssd1306 import SSD1306_I2C
from time import sleep_us, sleep, tick_us

trig =Pin(27,Pin.OUT)
echo =Pin(26,Pin.OUT)
I2C = SoftI2C(scl=Pin(33),sda=Pin(25))

while True:
    distance=0
    trig.value(1)
    sleep_us(10)
    trig.value(0)
    while echo.value()==0:
        pass
    if echo.value()==1:
        ts=tick_us
        while echo.value()==1:
            pass

        te=tick_us
        tc=ts-te
        distance=(tc*170)/10000
    text=str(round(distance,2))
    oled.text(text,50,28)
    oled.show()