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

#define SCREEN_WIDTH 128 // Ancho de la pantalla OLED en píxeles
#define SCREEN_HEIGHT 64 // Alto de la pantalla OLED en píxeles
#define OLED_RESET     -1 // Reset pin (o -1 si comparte el pin de reset del Arduino)

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

long readUltrasonicDistance(int triggerPin, int echoPin)
{
  pinMode(triggerPin, OUTPUT);  // Borra el trigger
  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);
  // Coloca el pin de trigger a HIGH por 10 microsegundos
  digitalWrite(triggerPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(triggerPin, LOW);
  pinMode(echoPin, INPUT);
  // Lee el pin de ECHO 
  return pulseIn(echoPin, HIGH);
}

void setup()
{
  pinMode(2, OUTPUT);
  
  // Inicializar la pantalla OLED
  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) { 
    // Dirección 0x3C para 128x64
    for(;;); // Atrapa aquí si la inicialización falla
  }
  
  display.display();
  delay(2000); // Pausa por 2 segundos
  display.clearDisplay();
}

void loop()
{
  // Leer la distancia
  float distance = 0.01723 * readUltrasonicDistance(9, 10);
  
  // Limpiar la pantalla
  display.clearDisplay();
  
  // Configurar el texto
  display.setTextSize(2);
  display.setTextColor(WHITE);
  display.setCursor(0,0);
  display.print("Distancia:");
  
  display.setTextSize(3);
  display.setCursor(0,30);
  display.print(distance);
  display.print(" cm");
  
  // Mostrar en pantalla
  display.display();
  
  // Lógica del buzzer
  if (distance < 315) {
    tone(2, 523, 1000); // toca a una tonalidad de 60 (C5 = 523 Hz)
  } else {
    noTone(2);
  }
  
  delay(100); // Pequeño retardo para estabilidad
}