#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;
float z = 0;
float richter = 0;




void setup() {
  Serial.begin(115200); 
  while (!Serial)
  delay(500);
  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");

    while (!mpu.begin()){
    Serial.println("MPU6050 ready!");
    delay(500);
    }

  pinMode(12, OUTPUT);
  pinMode(14, OUTPUT);
  pinMode(27, OUTPUT);
}


float apel_teknik(){
  sensors_event_t a, g, temp;
  mpu.getEvent(&a, &g, &temp);
  float yk = a.acceleration.x * a.acceleration.x;
  float xk = a.acceleration.y * a.acceleration.y;
  z = (yk + xk) * 0.075;
  return z;
}

void loop() {
  float z = apel_teknik();
  Serial.print("Skala Richter British= " + String(richter) + "\n" + "Skala Richter MMI: " + int(magnitude));
  delay(2000);
  if(z <= 0){
      tone(26, 0);
  }
  else if(z > 0 && z <= 0.017){
      tone(26, 0);
    magnitude = 1;
    kirim = 0;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
  }
  else if(z > 0.017 && z <= 0.14){
    magnitude = 2;
    kirim = 0;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(12, HIGH);//led hijau hidup
        delay(50);
        noTone(26);
        digitalWrite(12, LOW);
        delay(50);
  }
  else if(z > 0.14 && z <= 0.39){
    magnitude = 3;
    kirim = 0;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(12, HIGH);//led hijau hidup
        delay(50);
        noTone(26);
        digitalWrite(12, LOW);
        delay(50);
  }
  else if(z > 0.39 && z <= 0.92){
    magnitude = 4;
    kirim = 0;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(14, HIGH);//led kuning hidup
        delay(600);
        noTone(26);
        digitalWrite(14, LOW);
        delay(250);
  }
  else if(z > 0.92 && z <= 1.8){
    magnitude = 5;
    kirim = 1;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(27, HIGH);//led merah hidup
        delay(2000);
        noTone(26);
        digitalWrite(27, LOW);
        delay(100);
  }
  else if(z > 1.8 && z <= 3.4){
    magnitude = 6;
    kirim = 1;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(27, HIGH);//led merah hidup
        delay(2000);
        noTone(26);
        digitalWrite(27, LOW);
        delay(100);
  }
  else if(z > 3.4 && z <= 6.5){
    kirim = 1;
    magnitude = 7;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(27, HIGH);//led merah hidup
        delay(5000);
        noTone(26);
        digitalWrite(27, LOW);
        delay(100);
  }
   else if(z > 6.5 && z <= 12.4){
    kirim = 1;
    magnitude = 8;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(27, HIGH);//led merah hidup
        delay(5000);
        noTone(26);
        digitalWrite(27, LOW);
        delay(100);
  }
  else if(z > 12.4){
    kirim = 1;
    magnitude = 9;
    richter = ((log (z)) + 1.6 * (log (30)) - 0.15);
        tone(26, 500);
        digitalWrite(27, HIGH);//led merah hidup
        delay(5000);
        noTone(26);
        digitalWrite(27, LOW);
        delay(100);
  }

  if(kirim == 1){
    bot.sendMessage(CHAT_ID, "skalarichter= " + String(richter) + "\n" + "skalaMMI= " + int(magnitude));
    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();
    }
  
}


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(z);
          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");
      }
    }
  }
}