from machine import time_pulse_us, Pin, I2C
from time import sleep_us, sleep
import ssd1306

trigger=Pin(27, Pin.OUT)
#trigger è un pin di input per il sensore e di output per la scheda
echo=Pin(26, Pin.IN)
#echo è un pin di output per il sensore e di input per la scheda
led=Pin(32, Pin.OUT)

velocità=34000 #velocità del suono in cm/s
i2c=I2C(0)
display=ssd1306.SSD1306_I2C(128, 64, i2c)


while True:
    x_prec=0 
    y_prec=63
    display.fill(0)
    for x in range(128):
        trigger.value(1)
        sleep_us(10)
        trigger.value(0)
        hltime=time_pulse_us(echo, 1)
        distanza=((hltime/1e6)*velocità)/2
        print("La distanza misurata è:", distanza, "cm")

        if distanza>20: #oggetto non rilevato
            led.value(0)
            y=63
        else: #oggetto rilevato
            led.value(1)
            p_verticali=distanza*3
            y=round(63-p_verticali)

        display.line(x_prec, y_prec, x, y, 1)
        y_prec=y
        x_prec=x
        display.show()
    sleep(0.1)  # piccola pausa per permettere lo spostamento del sensore