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

// Use the appropriate I2C address for your display
#define OLED_RESET -1
Adafruit_SSD1306 display(OLED_RESET, 0x3C);

const int trigPin = GPIO_NUM_6;
const int echoPin = GPIO_NUM_5;

// Define the sound speed in cm/uS
#define SOUND_SPEED 0.034
// Define the conversion factor from cm to inch
#define CM_TO_INCH 0.393701

long duration;
int distanceCm;
int distanceInch;

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

  // Configure trigger and echo pins
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);

  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("SSD1306 allocation failed"));
    for (;;) {}
  }
 delay(500);
  display.clearDisplay();
  display.setTextSize(1);
   display.setTextColor(WHITE);
}

void loop() {
  // Clear the trigger pin
  digitalWrite(trigPin, LOW);
  delayMicroseconds(10);
  // Trigger the ultrasonic sensor
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Read the echo pulse
  duration = pulseIn(echoPin, HIGH);

  // Calculate the distance
  distanceCm = duration * SOUND_SPEED / 2;

  // Convert to inches
  distanceInch = distanceCm * CM_TO_INCH;

   // Prints the distance in the Serial Monitor
  Serial.print("Distance (cm): ");
  Serial.println(distanceCm);
  Serial.print("Distance (inch): ");
  Serial.println(distanceInch);


  display.setCursor(10, 15);
  display.print(distanceCm);
  display.display();

  // Set cursor positions
  display.setCursor(10, 2);
  display.print(" Distance");
  display.setCursor(10, 15);
  display.print(distanceCm);
  display.print(" cm");
  display.setCursor(10, 23);
  display.print(distanceInch);
  display.print(" inCh");
  display.display();

  delay(500);
}