from machine import Pin
import utime
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)
led25=machine.Pin(16,machine.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
    if distancecm >=15:
        led25.on()
        utime.sleep(2)
    else:
        led25.off()
        utime.sleep(2)
    lcd.clear()
    lcd.move_to(1,0)
    lcd.putstr('Dist= '+str(distancecm)[:6]+"cm " 
    "Tarea 2")
    utime.sleep(2)