from machine import Pin 
from utime import sleep_us, ticks_us, ticks_diff, sleep
from pico_i2c_lcd import I2cLcd 
from machine import I2C 

i2c = I2C(id=1,scl=Pin(27),sda=Pin(26),freq=100000) 
lcd = I2cLcd(i2c, 0x27, 2, 16)


trig = Pin(16, Pin.OUT)
echo = Pin(17, Pin.IN)

while True:
    trig.value(0)
    sleep_us(5)
    trig.value(1)
    sleep_us(10)
    trig.value(0)
    while echo.value() == 0:
        pass
    Tmrinicio = ticks_us()
    while echo.value() == 1:
        pass
    Tmrfin = ticks_us() 
    Duration = ticks_diff(Tmrfin, Tmrinicio) 
    distancecm = Duration * 0.0171
    lcd.clear()
    lcd.move_to(0,0)
    lcd.putstr('Dist= '+str(distancecm)[:6]+" cm") 
    sleep(1)