#include <WiFi.h>
#include <WiFiClientSecure.h>
#include <UniversalTelegramBot.h>
#include <Adafruit_MPU6050.h>


#define Merah 14
#define Kuning 12
#define Hijau 13
#define buzzer 26
#define WIFI_SSID "Wokwi-GUEST"
#define WIFI_PASSWORD ""
#define BOT_TOKEN "6615261736:AAEQGpcZkXV8Z_dJWmbRxb-cOwJaS4ZfIew"
#define CHAT_ID "6242476867"

Adafruit_MPU6050 mpu;
WiFiClientSecure secured_client;
UniversalTelegramBot bot (BOT_TOKEN, secured_client);




const unsigned long BOT_MTBS = 1000;
unsigned long bot_lasttime;

float magnitude;
int kirim = 0;
float z = 0;
float richter;

void setup() {
  Serial.begin(115200);
  while (!mpu.begin()){
    Serial.println("MPU6050 ready!");
    delay(1000);
    }
    
  while (!Serial)
  delay(3000);
  Serial.print("CONNECTING TO: ");
  Serial.print(WIFI_SSID);
  WiFi.begin(WIFI_SSID, WIFI_PASSWORD);
  secured_client.setCACert(TELEGRAM_CERTIFICATE_ROOT);
  while (WiFi.status() != WL_CONNECTED)
  {
    Serial.print(".");
    delay(500);
  }
  Serial.println("");
  Serial.println("WIFI CONNECTED");
  pinMode(Hijau, OUTPUT);
  pinMode(Merah, OUTPUT);
  pinMode(Kuning, OUTPUT);
  pinMode(buzzer, OUTPUT);
}


void ukur_jarak(){
  sensors_event_t a, g, temp;
  mpu.getEvent(&a, &g, &temp);
  float yKuadrat = a.acceleration.x * a.acceleration.x;
  float xKuadrat = a.acceleration.y * a.acceleration.y;
  z =  sqrt(yKuadrat + xKuadrat);
  return;
}

void output_jarak(){

  if(z > 0 && z <= 0.017){
    magnitude = 1;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Hijau, HIGH);
  }
  else if(z > 0.017 && z <= 0.14){
    magnitude = 2;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    digitalWrite(Kuning, HIGH);
  }
  else if(z > 0.14 && z <= 0.39){
    magnitude = 3;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 0.39 && z <= 0.92){
    magnitude = 4;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 0.92 && z <= 1.8){
    magnitude = 5;
    kirim = 1;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
   
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 1.8 && z <= 3.4){
    magnitude = 6;
    kirim = 1;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
   
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 1.8 && z <= 3.4){
    kirim = 1;
    magnitude = 7;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 3.4 && z <= 6.5){
    kirim = 1;
    magnitude = 8;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
   else if(z > 6.5 && z <= 12.4){
    kirim = 1;
    magnitude = 9;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
    
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  else if(z > 12.4){
    kirim = 1;
    magnitude = 10;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
   
    digitalWrite(Merah, HIGH);
    digitalWrite(buzzer, HIGH);
  }
  if (kirim == 1)
    {
    Serial.print("Skala Richter British= " + String(richter) + "\n" + "Skala Richter MMI: " + int(magnitude));
    }
}



void loop() {

  output_jarak();
  ukur_jarak();

  if(kirim == 1){
    bot.sendMessage(CHAT_ID, "skalarichter= " + String(richter) + "\n" + "skalaMMI= " + int(magnitude));
    Serial.print("Gempa besar, evakuasi segera" );
    kirim = 0;
  }

  if (millis() - bot_lasttime > BOT_MTBS){
    int numNewMessages = bot.getUpdates(bot.last_message_received + 1);
    while (numNewMessages)
    {
      Serial.println("got response");
      handleNewMessages(numNewMessages);
      numNewMessages = bot.getUpdates(bot.last_message_received + 1);
    }
    bot_lasttime = millis();
    }
  
  delay(500);
}


void handleNewMessages(int numNewMessages)
{
  
    Serial.print("handleNewMessages ");
  Serial.println(numNewMessages);
  for (int i = 0; i < numNewMessages; i++)
  {
    String chat_id = String(bot.messages[i].chat_id);
    if (chat_id != CHAT_ID )
    {
      bot.sendMessage(chat_id, "Unauthorized user", "");
    }
    else
    {
      String text = bot.messages[i].text;
      String from_name = bot.messages[i].from_name;
      if (from_name == "")
        from_name = "Guest";
      if (text == "/WaterLevel")
      {   String msg = "Magnitudo: ";
          msg += msg.concat(richter);
          msg += " ScalaRichter";
          bot.sendMessage(chat_id,msg, ""); 
      }
      if (text == "/start")
      {
        String welcome = "Proyek Akhir RAFDAVEL OKTAMIRANDA   20066042\n";
        welcome += "Jika Ketinggian Air < 200 Cm, Tanki Hampir Kosong \n";
        welcome += "Jika Ketinggian Air < 100 Cm, Tanki Terisi Setengah \n";
        welcome += "Jika Ketinggian Air < 10 Cm, Tanki Penuh \n";
        welcome += "/WaterLevel : Cek Ketinggian Akhir Saat ini \n";
        bot.sendMessage(chat_id, welcome, "Markdown");
      }
    }
  }
}