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

trig =Pin(27,Pin.OUT)
echo =Pin(26,Pin.IN)
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=ticks_us()
        while echo.value()==1:
            pass

        te=ticks_us()
        tc=te -ts
        distance=(tc*170)/10000
    oled = SSD1306_I2C(128, 64, I2C, addr=0x3c)
    text=str(round(distance,1))+' CM'
    oled.text(text,35,28)
    oled.show()
    sleep_us(1)