from machine import Pin
import utime
from pico_i2c_lcd import I2cLcd
from machine import I2C

i2c = I2C(0, scl=Pin(5), sda=Pin(4), freq=100000)
lcd = I2cLcd(i2c, 0x27, 2, 16)

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

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