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


i2c = SoftI2C(scl=Pin(22), sda=Pin(21))


oled_addr = 0x3c
oled_width = 128
oled_height = 64
oled = SSD1306_I2C(oled_width, oled_height, i2c, oled_addr)

Trigger = Pin(5, Pin.OUT)
Echo = Pin(18, Pin.IN)

while True:
  
    Trigger.value(0)
    time.sleep_us(2)
    Trigger.value(1)
    time.sleep_us(10)
    Trigger.value(0)
    
    
    TT = machine.time_pulse_us(Echo, 1)
    distance = (TT * 0.034) / 2
    
    
    oled.fill(0)
    oled.text('Distance in cm', 0, 0, 1)
    oled.text(str(distance), 0, 14, 1)
    oled.show()
    
    print("Distance in cm:", distance)
    time.sleep(2)