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

#define SCREEN_WIDTH 128  // Lebar layar OLED
#define SCREEN_HEIGHT 64  // Tinggi layar OLED

// Inisialisasi display OLED menggunakan I2C
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

const int trigPin = 5;    // Pin trig untuk sensor ultrasonik
const int echoPin = 18;   // Pin echo untuk sensor ultrasonik

#define SOUND_SPEED 0.034  // Kecepatan suara dalam cm/us

long duration;
float distanceCm;

void setup() {
  // Inisialisasi komunikasi serial dan OLED
  Serial.begin(115200);
  Serial.println("Mengukur Jarak...");

  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("OLED tidak ditemukan"));
    for (;;);  // Berhenti jika OLED gagal diinisialisasi
  }

  display.clearDisplay();  // Bersihkan layar OLED
  display.setTextSize(2);   // Set ukuran teks
  display.setTextColor(WHITE);  // Set warna teks putih

  pinMode(trigPin, OUTPUT);  // Atur trigPin sebagai OUTPUT
  pinMode(echoPin, INPUT);   // Atur echoPin sebagai INPUT
}

void loop() {
  // Bersihkan trigPin
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  // Aktifkan trigPin selama 10 microseconds
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Baca durasi pantulan dari echoPin
  duration = pulseIn(echoPin, HIGH);

  // Hitung jarak dalam cm
  distanceCm = duration * SOUND_SPEED / 2;

  // Tampilkan jarak di OLED
  display.clearDisplay();
  display.setCursor(0, 0);
  display.print("Jarak: ");
  display.print(distanceCm);
  display.println(" cm");

  display.display();  // Tampilkan konten di layar OLED

  // Tampilkan juga di Serial Monitor
  Serial.print("Jarak (cm): ");
  Serial.println(distanceCm);

  delay(1000);  // Tunggu 1 detik sebelum pengukuran berikutnya
}