#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>

//pin del sensore HC-SR04
#define PIN_TRIG 4
#define PIN_ECHO 2

//dimensioni del display OLED
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64 

//indirizzo I2C del display OLED
#define OLED_RESET -1
Adafruit_SSD1306 display(SCREEN_WIDTH,SCREEN_HEIGHT, &Wire, OLED_RESET); 
//dichiarazioni variabili misura
long duration, distCm, distInch;
void setup() {
  Serial.begin(115200);

  //configurazione dei pin del sensore
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);

  //inizializzazione del display OLED
  if (! display.begin(SSD1306_BLACK, 0x3C)) {
    Serial.println(F("errore nell'avvio del display OLED"));
    for(;;);
  }
  display.clearDisplay();
}

void loop() {


  //trigger del sensore
  digitalWrite(PIN_TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  //lettura dell'eco
  duration = pulseIn(PIN_ECHO,HIGH);
  distCm = duration * 0.034 / 2;
  distInch = duration /148;

  //  stampa della distanza sul serial monitor
  Serial.println("Misuratore della Distanza:");
  Serial.print(distCm);
  Serial.println(" CM");
  Serial.print(distInch);
  Serial.println(" INCH");


  // visualizzazione sul Monitor OLED
  display.clearDisplay();
  display.setTextSize(2);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(42, 2);
  display.print("Distanza: ");
  display.print(distCm);
  display.println(" CM");
  display.print(distInch);
  display.println(" INCH");
  display.display();

  delay(500);
}