from machine import Pin, SoftI2C, time_pulse_us, PWM
from ssd1306 import SSD1306_I2C
from i2c_lcd import I2cLcd
from time import sleep

TRIG_PIN = 16
ECHO_PIN = 17
SOUND_SPEED = 340.29
ledPin = 18

trig = Pin(TRIG_PIN, Pin.OUT)
echo = Pin(ECHO_PIN, Pin.IN)
led = PWM(Pin(ledPin))


i2c = SoftI2C(scl=Pin(22), sda=Pin(21), freq=100000)
I2C_ADDR_OLED = 0x3c
oled_width = 128
oled_height = 64
oled = SSD1306_I2C(oled_width, oled_height, i2c, I2C_ADDR_OLED)
oled.invert(True)


def measure_distance():
    trig.value(0)
    sleep(0.000002)
    trig.value(1)
    sleep(0.00001)
    trig.value(0)
    duration = time_pulse_us(echo, 1)
    distance = (duration * SOUND_SPEED) / (2 * 10000)
    return distance

def update_led(distance):
    intensity = int(1023 - distance)
    led.duty(intensity)

while True:
    distance = measure_distance()
    update_led(distance)
    oled.fill(0)  
    oled.text(f"Distance: {distance:.2f} cm", 0, 0)
    oled.show()
    print(f"Distance: {distance:.2f} cm")
    sleep(2)