from machine import Pin, ADC, I2C
from machine import time_pulse_us
from time import sleep_us, sleep
from math import log
import ssd1306

#configurazione led e bottone
led = Pin(22, Pin.OUT)
button = Pin(12, Pin.IN, Pin.PULL_DOWN)

#configurazione dei pin del sensore a ultrasuoni
trig = Pin(33, Pin.OUT)
echo = Pin(32, Pin.IN)

#configurazione display
i2c = I2C(0)
display = ssd1306.SSD1306_I2C(128, 64, i2c)

print('hi!')

while True:
    if button.value()==1:
        display.text('Indagine', 30, 0, 1)
        display.text('Ad Ultrasuoni', 10, 10, 1)
        display.text('_______________________', 1, 20, 1)
    
        trig.value(0)
        sleep_us(1)
        trig.value(1)
        sleep_us(10)
        trig.value(0)
        high_level_time = time_pulse_us(echo, 1)
        distance = (high_level_time*340)/2
        distance = distance/10000

        print('Distanza dal sensore: ', str(round(distance,2)), ' cm')
        
        display.text('Dist='+str(round(distance,2))+'cm', 15, 32, 1)
        display.show()

        if distance<=20:
            led.value(1)
            display.text('Oggetto Rilevato', 0, 43, 1)
            display.show()
            display.fill(0)
        else:
            led.value(0)
            display.text('Nessun Oggetto', 8, 40, 1)
            display.text('Rilevato', 30, 50, 1)
            display.show()
            display.fill(0)
        sleep(1)
    else:
        display.fill(0)