import machine
import utime, math
from time import sleep
from machine import I2C, Pin, ADC, PWM
from i2c_lcd import I2cLcd
from hcsr04 import HCSR04
ultrasonic = HCSR04(trigger_pin=13, echo_pin=12, echo_timeout_us=1000000)
AddressOfLcd = 0x27
i2c = I2C(0, scl=Pin(19), sda=Pin(18), freq=400000)
lcd = I2cLcd(i2c, AddressOfLcd, 2, 16)
led1 = Pin(4,Pin.OUT)
led2 = Pin(5,Pin.OUT)
pwm = PWM(Pin(2), freq=50, duty=0)
def Servo(servo, angle):
    pwm.duty(int(((angle)/180*2+0.5)/20*1023))
while True:
    distance = ultrasonic.distance_cm()
    print('Distance', 'cm', '|', distance/2.54, 'Inch')
    lcd.clear()
    lcd.putstr('Distance: {:.2f} cm'.format(distance))
    if distance<= 350:
        led1.on()
        led2.off()
        servo(2, 90)
        sleep(1)
    elif distance<= 350:
        led1.off()
        led2.on()
        Servo(2, 180)
        sleep(1)
    elif distance >350:
        led1.off()
        led2.on()
        Servo(2, 0)
        sleep(1)
    else:
        led1.off
        led2.off

    sleep(5)