from machine import SoftI2C, Pin
from machine import Pin, time_pulse_us
import time

add = 0x27
rows = 2
columns = 16

a = SoftI2C(sda=Pin(21), scl=Pin(22), freq = 9600)
lcd = I2cLcd(a, add, rows, columns)

speed = 343

trig = Pin(12,Pin.OUT)
echo = Pin(13,Pin.IN)

while True:
    trig.value(0)
    time.sleep_us(5)
    trig.value(1)
    time.sleep_us(10)
    trig.value(0)

    dur = time_pulse_us(echo, 1, 30000)
    dist = speed * dur / 20000

    print(dist)
    
    
    lcd.move_to(5,0)
    lcd.putstr(str(dist))
    time.sleep_ms(500)