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

#define Echo 16
#define Trig 17
#define Merah 14
#define Kuning 12
#define Hijau 13
#define pin_led2 27
#define buzzer 26

#define CHAT_ID "1564703747"
String token = "7296431491:AAGAAeuY6DpM3b_nK3rkF4_aitYEjfE25tk";
#define bot_id "1564703747"

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

WiFiClientSecure client;
UniversalTelegramBot bot(token, client);

int botRequestDelay = 10;
unsigned long lastTimeBotRan;

float jarak = 0;
int nada;
bool ledState;

void handleNewMessages(int numNewMessages) {
  Serial.println("handleNewMessages");
  Serial.println(String(numNewMessages));

  for (int i=0; i<numNewMessages; i++) {
    // Chat id of the requester
    String chat_id = String(bot.messages[i].chat_id);
    if (chat_id != CHAT_ID){
      bot.sendMessage(chat_id, "Unauthorized user", "");
      continue;
    }
    
    String text = bot.messages[i].text;
    Serial.println(text);

    String from_name = bot.messages[i].from_name;

    if (text == "/buka") {
      bot.sendMessage(chat_id, "Pintu di buka", "");
      ledState = HIGH;
      digitalWrite(pin_led2, ledState);
    }
    
    if (text == "/tutup") {
      bot.sendMessage(chat_id, "Pintu di tutup", "");
      ledState = LOW;
      digitalWrite(pin_led2, ledState);
    }
    
    if (text == "/status") {
      if (digitalRead(pin_led2)){
        bot.sendMessage(chat_id, "Pintu terbuka", "");
      }
      else{
        bot.sendMessage(chat_id, "Pintu tertutup", "");
      }
    }
  }
}


void ukur_jarak(){
  digitalWrite(Trig, LOW);
  delay(10);
  digitalWrite(Trig, HIGH);
  delay(10);
  digitalWrite(Trig, LOW);

  int duration = pulseIn(Echo, HIGH);
  jarak = duration * 0.034 / 2 + 1;

  Serial.print("Jarak: ");
  Serial.print(jarak);
  Serial.println(" cm");
}

void output_jarak(){
  if(jarak > 300) {
    Serial.println("Aman");
    digitalWrite(Merah, LOW);
    digitalWrite(Kuning, LOW);
    digitalWrite(Hijau, HIGH);
    digitalWrite(buzzer, LOW);
  }
  else if((jarak >= 200) && (jarak <= 300)) {
    Serial.println("Ada Orang Mendekat!");
    digitalWrite(Merah, LOW);
    digitalWrite(Kuning, HIGH);
    digitalWrite(Hijau, LOW);
    digitalWrite(buzzer, LOW);
  }
  else if(jarak < 200) {
    Serial.println("Ada Orang kurang dari 2m");
    digitalWrite(Merah, HIGH);
    digitalWrite(Kuning, LOW);
    digitalWrite(Hijau, LOW);
    digitalWrite(buzzer, HIGH);
    tone(8, 262, 250);
    bot.sendMessage(bot_id, "Ada Orang Kurang dari 2 meter!", "");
  }
}

void tunggu_pesan(){
  if (millis() > lastTimeBotRan + botRequestDelay)  {
    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);
    }
    lastTimeBotRan = millis();
  }
}

void setup() {
  Serial.begin(115200);
  
  pinMode(Trig, OUTPUT);
  pinMode(Echo, INPUT);
  pinMode(Merah, OUTPUT);
  pinMode(Kuning, OUTPUT);
  pinMode(Hijau, OUTPUT);
  pinMode(buzzer, OUTPUT);
  pinMode(pin_led2, OUTPUT);

  Serial.println("Memulai Telegram Bot");
  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, pass);
  client.setCACert(TELEGRAM_CERTIFICATE_ROOT); // Add root certificate for api.telegram.org
  while (WiFi.status() != WL_CONNECTED) {
    delay(1000);
    Serial.println("Connecting to WiFi..");
  }
  Serial.println(WiFi.localIP());
  Serial.println("Koneksi Berhasil");
  digitalWrite(Merah, LOW);
  digitalWrite(Kuning, LOW);
  digitalWrite(Hijau, LOW);
  digitalWrite(buzzer, LOW);

}

void loop() {
  
  ukur_jarak();

  output_jarak();

  tunggu_pesan();

  //delay(500);

}