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

// Ukuran layar OLED
#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

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

// Pin I2C untuk ESP32-S3 (Wokwi default = GPIO35 SDA, GPIO36 SCL)
#define I2C_SDA 35
#define I2C_SCL 36

// Pin sensor ultrasonik
#define TRIG_PIN 2
#define ECHO_PIN 3

void setup() {
  // Set pin I2C secara manual untuk ESP32-S3
    Wire.begin(I2C_SDA, I2C_SCL);

      // Mulai Serial
        Serial.begin(115200);

          // Inisialisasi layar OLED
            if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
                Serial.println(F("Gagal memulai OLED"));
                    while (1);
                      }

                        display.clearDisplay();
                          display.setTextSize(1);
                            display.setTextColor(SSD1306_WHITE);

                              // Set pin ultrasonik
                                pinMode(TRIG_PIN, OUTPUT);
                                  pinMode(ECHO_PIN, INPUT);
                                  }

                                  void loop() {
                                    // Kirim sinyal ultrasonik
                                      digitalWrite(TRIG_PIN, LOW);
                                        delayMicroseconds(2);
                                          digitalWrite(TRIG_PIN, HIGH);
                                            delayMicroseconds(10);
                                              digitalWrite(TRIG_PIN, LOW);

                                                // Hitung durasi pantulan
                                                  long duration = pulseIn(ECHO_PIN, HIGH);
                                                    // Hitung jarak dalam cm
                                                      float distance_cm = duration * 0.034 / 2;

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

                                                                // Tampilkan di OLED
                                                                  display.clearDisplay();
                                                                    display.setCursor(0, 10);
                                                                      display.setTextSize(1);
                                                                        display.print("Jarak: ");
                                                                          display.setTextSize(2);
                                                                            display.setCursor(0, 25);
                                                                              display.print(distance_cm, 1);
                                                                                display.print(" cm");
                                                                                  display.display();

                                                                                    delay(500);
                                                                                    }