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

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64
#define OLED_RESET     -1
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

// Pin sensor HC-SR04
#define TRIG_PIN PA5
#define ECHO_PIN PA6
Ultrasonic ultrasonic(TRIG_PIN, ECHO_PIN);

// Potensiometer
#define POT_PIN PA0

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

  // OLED init
  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("OLED gagal"));
    for (;;);
  }
  display.clearDisplay();
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);

  // Tampilkan layar awal
  display.setCursor(0, 0);
  display.println("Smart OOTD");
  display.display();
  delay(1000);
}

void loop() {
  // Baca jarak
  float distance = ultrasonic.read();
  // Baca potensiometer (simulasi batas)
  int potValue = analogRead(POT_PIN); // 0–4095
  float threshold = map(potValue, 0, 4095, 0, 100); // Simulasi batas 0–100 cm

  // Tampilkan di OLED
  display.clearDisplay();
  display.setCursor(0, 0);
  display.println("- HASIL JARAK -");
  display.setCursor(0, 16);
  display.print("Jarak: ");
  display.print(distance);
  display.println(" cm");

  display.setCursor(0, 32);
  if (distance > threshold) {
    display.println("OVERDIMENSION");
  } else {
    display.println("AMAN");
  }

  display.display();
  delay(1000);
}