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

#Definir el Pin del TRIGGER y del ECHO
trig = Pin(17, Pin.OUT)  #Es .OUT por que es salida de las ondas para el echo las regrese.
echo = Pin(16, Pin.IN)   #Es .IN por que es la entrada de las ondas que van a regresar y medir la distancia.
i2c = I2C(0, sda=Pin(14), scl=Pin(15), freq=400000)
oled_width = 128
oled_height = 64
oled = SSD1306_I2C(oled_width, oled_height, i2c)
#Se pone bajo el TRIGGER por 2 us, manda un pulso por 10 us y vuelve a estar en bajo.
while True:
    trig.value(0)
    sleep_us(2)
    trig.value(1)
    sleep_us(10)
    trig.value(0)

    pulse_time = ticks_us()
        while echo.value() == 1
        pulse_time = ticks_us()

    dist_cm = (pulse_time * 343) / 2
    oled.fill(0)
    oled.text('Distancia:', 0, 0)
    oled.text(dist_cm, 0, 10)