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

# Inicializa los pines Trig y Echo
Trig = Pin(27, Pin.OUT)
Echo = Pin(26, Pin.IN)

# Inicializa la pantalla OLED
i2c = SoftI2C(scl=Pin(5), sda=Pin(4))
oled = ssd1306.SSD1306_I2C(128,64,i2c)

def medirDistancia():
    Trig.low()
    sleep_us(2)
    # Envia un pulso de 10us
    Trig.high()
    sleep_us(10)
    Trig.low()
    # Mide la duración del pulso en us
    duracion = time_pulse_us(Echo, Pin.high)
    # Calcula la distancia en cm
    Distancia = duracion/58.2
    return Distancia

while True:
    # Mide la distancia e imprime su valor en el monitor serie
    Distancia = medirDistancia()
    print("Distancia:", Distancia)
    # Muestra la distancia en la pantalla OLED
    oled.fill(0)
    oled.text("Distancia:",20,20)
    oled.text(str(Distancia)+" cm",20,30)
    oled.show()
    sleep(0.1)