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

#define OLED_RESET    -1
Adafruit_SSD1306 display(OLED_RESET);

#define TRIGGER_PIN   13
#define ECHO_PIN      12
#define MAX_DISTANCE  200

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

void setup() {
  Serial.begin(9600);

  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { 
    Serial.println(F("SSD1306 allocation failed"));
    for(;;);
  }

  display.display();
  delay(2000);
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);
}

void loop() {
  delay(100);

  unsigned int distance = sonar.ping_cm();
  
  display.clearDisplay();
  display.setCursor(0,0);
  display.print(F("Distance: "));
  display.print(distance);
  display.println(F(" cm"));
  display.display();
}