#define BLYNK_TEMPLATE_ID "TMPL6h3ofup7M"
#define BLYNK_TEMPLATE_NAME "apelgempa"
#define BLYNK_AUTH_TOKEN "EXXSD7PRvIQj53F3HkhaBCkhnP2z835p"
#define BLYNK_PRINT Serial

#include "CTBot.h";
#include <WiFi.h>
#include <WiFiClient.h>
#include <ArduinoJson.h>
#include <BlynkSimpleEsp32.h>
#include <Adafruit_MPU6050.h>
#include <Adafruit_Sensor.h>
#include <Wire.h>

#define Merah 14
#define Kuning 12
#define Hijau 13
#define buzzer 26

Adafruit_MPU6050 mpu;
String token = "6615261736:AAEQGpcZkXV8Z_dJWmbRxb-cOwJaS4ZfIew";
const int bot_id = 6242476867;

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

CTBot mybot;
BlynkTimer timer;

float jarak = 0;
int nada;


void ukur_jarak(){
  sensors_event_t a, g, temp;
  mpu.getEvent(&a, &g, &temp);
  int yKuadrat = a.acceleration.x * a.acceleration.x;
  int xKuadrat = a.acceleration.y * a.acceleration.y;
  int zKuadrat = a.acceleration.z * a.acceleration.z;
  jarak =  sqrt(yKuadrat + xKuadrat + zKuadrat) * 0.5;
  /* Print out the values */
  Serial.print("Magnitudo= ");
  Serial.print(jarak);
  Serial.println(" Scala Richter");
}

void output_jarak(){

  if(jarak > 0 && jarak <= 3){
    Serial.println("Aman");
    digitalWrite(Hijau, HIGH);
   
  }
  else if(jarak > 3 && jarak <= 5){
    Serial.println("Hama Mendekat!");
    digitalWrite(Kuning, HIGH);
  }
  else if(jarak > 5 && jarak <= 7){
    Serial.println("Ada Hama");
    digitalWrite(Merah, HIGH);
  }
}

void pesan(){
  TBMessage msg;
  if(jarak > 7) {
    tone(buzzer, nada);
    mybot.sendMessage(bot_id, "Ada Hama Kurang dari 2 meter!");
    if(mybot.getNewMessage(msg)) {
      Serial.println("Pesan masuk: " + msg.text);
      String pesan = msg.text;
      if(pesan == "on") {
        mybot.sendMessage(bot_id, "Alarm Dinyalakan");
      }
      if(pesan == "off") {
        noTone(buzzer);
        mybot.sendMessage(bot_id, "Alarm Dimatikan");
      }
    }
  }
  else {
    noTone(buzzer);
  }
}

BLYNK_WRITE(V4) {
  nada = param.asInt();
}

void kirim_blynk(){
  Blynk.virtualWrite(V0, jarak);
  if(jarak > 0 && jarak <= 3) {
    Blynk.virtualWrite(V1, 1);
    Blynk.virtualWrite(V2, 0);
    Blynk.virtualWrite(V3, 0);
  }
  else if(jarak > 3 && jarak <= 5) {
    Blynk.virtualWrite(V1, 0);
    Blynk.virtualWrite(V2, 1);
    Blynk.virtualWrite(V3, 0);
  }
  else if(jarak > 5 && jarak <= 7) {
    Blynk.virtualWrite(V1, 0);
    Blynk.virtualWrite(V2, 0);
    Blynk.virtualWrite(V3, 1);
  }
  Blynk.virtualWrite(V4, nada);
}

void setup() {
  Serial.begin(115200);
  Blynk.begin(auth, ssid, pass);
  pinMode(Merah, OUTPUT);
  pinMode(Hijau, OUTPUT);
  pinMode(buzzer, OUTPUT);
  timer.setInterval(2000L, kirim_blynk);

  Serial.println("Memulai Telegram Bot");
  mybot.wifiConnect(ssid, pass);
  mybot.setTelegramToken(token);

  if(mybot.testConnection()) {
    Serial.println("Koneksi Berhasil");
  }
  else {
    Serial.println("Koneksi Gagal");
  }
  while (!mpu.begin()){
    Serial.println("MPU6050 ready!");
    delay(1000);
    }
    
}

void loop() {
  digitalWrite(Merah, LOW);
  digitalWrite(Kuning, LOW);
  digitalWrite(Hijau, LOW);

  ukur_jarak();
  
  output_jarak();
  
  pesan();

  Blynk.run();
  timer.run();
  delay(1000);
}