//This code assumes the OLED display is connected using I2C (SDA to pin 21, SCL to pin 22 on ESP32) and the 
//ultrasonic sensor is connected with its trigger pin to pin 18 and its echo pin to pin 19 on the ESP32.
//Adjust the pin numbers and connections as needed for your setup.

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

const int smokeSensor = 4;
int sensorThres = 200;

#define BLYNK_TEMPLATE_ID "TMPL65qjgoYhU"
#define BLYNK_TEMPLATE_NAME "LEVEL NUT HOPPER"
#define BLYNK_AUTH_TOKEN "V3k_VFo73MStiFIf6r7Hnc8E5dRaqqtE"
#include <BlynkSimpleEsp32.h>

#define OLED_RESET -1
#define SCREEN_WIDTH 128 // OLED display width, in pixels
#define SCREEN_HEIGHT 64 // OLED display height, in pixels
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);

#define TRIGGER_PIN 18
#define ECHO_PIN    19

long duration;
int distance;

char auth[] = "V3k_VFo73MStiFIf6r7Hnc8E5dRaqqtE";
char ssid[] = "Wokwi-GUEST";  
char pass[] = ""; 

BlynkTimer timer;

#define GREEN_LED_PIN 16  // Arduino pin connected to the green LED
#define YELLOW_LED_PIN 15 // Arduino pin connected to the yellow LED
#define RED_LED_PIN 0    // Arduino pin connected to the red LED
#define BUZZER_PIN 5

void setup() {
  Serial.begin(9600);
  
  pinMode(TRIGGER_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  Blynk.begin(BLYNK_AUTH_TOKEN, ssid, pass);
  timer.setInterval(1000L, sendSensor);

  pinMode(GREEN_LED_PIN, OUTPUT);
  pinMode(YELLOW_LED_PIN, OUTPUT);
  pinMode(RED_LED_PIN, OUTPUT);
  pinMode(BUZZER_PIN, OUTPUT);

  // Initialize LEDs
  digitalWrite(GREEN_LED_PIN, LOW);
  digitalWrite(YELLOW_LED_PIN, LOW);
  digitalWrite(RED_LED_PIN, LOW);
  digitalWrite(BUZZER_PIN, LOW);

  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.display();
  delay(2000);
  display.clearDisplay();
  display.setTextSize(2);
  display.setTextColor(WHITE);
}

void loop() {
  long duration, distance;
  
  Blynk.run();
  timer.run();

  digitalWrite(TRIGGER_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGGER_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGGER_PIN, LOW);
  duration = pulseIn(ECHO_PIN, HIGH);
  distance = duration * 0.034 / 2;

  // Display distance on the serial monitor
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Control LEDs based on distance
  if (distance > 300) {
    // Distance > 150 cm
    digitalWrite(GREEN_LED_PIN, HIGH);
    digitalWrite(YELLOW_LED_PIN, LOW);
    digitalWrite(RED_LED_PIN, LOW);
  } else if (distance > 50 && distance <= 300) {
    // 50 cm < Distance <= 150 cm
    digitalWrite(GREEN_LED_PIN, LOW);
    digitalWrite(YELLOW_LED_PIN, HIGH);
    digitalWrite(RED_LED_PIN, LOW);
  } else {
    // Distance <= 50 cm
    digitalWrite(GREEN_LED_PIN, LOW);
    digitalWrite(YELLOW_LED_PIN, LOW);
    digitalWrite(RED_LED_PIN, HIGH);
  }
  
  display.clearDisplay();
  display.setCursor(0,0);
  display.setTextSize(1);
  display.print("Level Hopper ");
  display.setCursor(0,25);
  display.print(400-distance);
  display.print(" cm");
  display.display();

  int digitalNumber = analogRead(smokeSensor); // Generates a digital number from 0 to 4095
  Serial.println(digitalNumber);
  if (digitalNumber > sensorThres){
    Serial.print("Status: ");
    Serial.println("Terdeteksi Api");
    Blynk.logEvent("peringatan_kebakaran");
  } else {
    led1.off();
    Serial.print("Status: ");
    Serial.println("Aman");
  }
  delay(1000);
}

void sendSensor()
{
  digitalWrite(TRIGGER_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIGGER_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIGGER_PIN, LOW);
  duration = pulseIn(ECHO_PIN, HIGH);
  distance = duration * 0.034 / 2;

  // Display distance on the serial monitor
  Serial.print("Distance: ");
  Serial.print(distance);
  
  if(distance <= 5)
  {
    Blynk.logEvent("level_nut_hopper");
  }
  Blynk.virtualWrite(V0, 400-distance);
  delay(1000);                        //Pause for 3 seconds and start measuring distance again
}