import machine
import utime
from i2c_lcd import I2cLcd
from servo import Servo

i2c = machine.SoftI2C(sda=machine.Pin(21), scl=machine.Pin(22))
screen = I2cLcd(i2c, 0x27, 4, 20)

trigger = machine.Pin(13, machine.Pin.OUT)
echo = machine.Pin(12, machine.Pin.IN)

servo_1 = Servo(19)



def ultra():
    trigger.off()
    utime.sleep_us(2)
    trigger.on()
    utime.sleep_us(5)
    trigger.off()
    while echo.value() == 0:
        signal_off = utime.ticks_us()
    while echo.value() == 1:
        signal_on = utime.ticks_us()
    try:
        time_passed = signal_on - signal_off
    except NameError:
        return 0
    return time_passed/58

def text(words):
    screen.clear()
    screen.putstr(words)

def check_distance():
    dist = ultra()
    print(dist)
def servik():
    servo_1.write_angle(90)


text('My name is...')
check_distance()