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

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

const int trigPin = 9;
const int echoPin = 10;
const int ledPin = 13;
const int buzzerPin = 8;

long duration;
float distance;

void setup() {
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(ledPin, OUTPUT);
pinMode(buzzerPin, OUTPUT);

Serial.begin(9600);

Wire.begin();

if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
Serial.println("OLED nao encontrado");
while(true);
}

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

display.setCursor(15, 20);
display.println("Sensor HC-SR04");
display.display();

delay(2000);
}

void loop() {

digitalWrite(trigPin, LOW);
delayMicroseconds(2);

digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);

duration = pulseIn(echoPin, HIGH);

distance = duration * 0.034 / 2;

display.clearDisplay();

display.setCursor(0,0);
display.setTextSize(1);
display.println("Distancia:");

display.setTextSize(2);
display.setCursor(0,15);
display.print(distance,1);
display.print("cm");

display.setTextSize(1);
display.setCursor(0,50);

if(distance < 20){
digitalWrite(ledPin, HIGH);
tone(buzzerPin, 2000);
display.println("ALERTA ALTA");
}
else if(distance < 40){
digitalWrite(ledPin, HIGH);
tone(buzzerPin, 1200);
display.println("ALERTA MEDIA");
}
else if(distance < 60){
digitalWrite(ledPin, LOW);
tone(buzzerPin, 800);
display.println("ALERTA BAIXA SIGA");
}
else{
digitalWrite(ledPin, LOW);
noTone(buzzerPin);
display.println("STATUS OK");
}

display.display();

delay(300);
}