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

#define mySerial              Serial2
#define RXD2                  16
#define TXD2                  17
#define relay                 2
#define doorSensor            4
#define keypad_detection_pin  18
#define face_detection_pin    19
#define buzzer                21

#define WIFI_SSID "Fadi1"
#define WIFI_PASSWORD "Dingdong"
// Telegram BOT Token (Get from Botfather)
#define BOT_TOKEN "5923908776:AAGcEbtVx-BygoVmAw8-xiqbWY1L1ltuyto"
const unsigned long BOT_MTBS = 1000;
WiFiClientSecure secured_client;
UniversalTelegramBot bot(BOT_TOKEN, secured_client);
unsigned long bot_lasttime;
bool Start = false;

int fingerprint_detection, keypad_detection, face_detection;
int flag_door_opened = 0;
int flag_door_state = 0;
int state;
String text;
String chat_id;
String chat_id_1 = "-840276109";//"146756548";

Adafruit_Fingerprint finger = Adafruit_Fingerprint(&mySerial);

void setup()
{
  Serial.begin(9600);
  pinMode(keypad_detection_pin, INPUT);
  pinMode(face_detection_pin, INPUT);
  pinMode(doorSensor, INPUT_PULLUP);//if door open sensor pin HIGH 3.3V !!
  pinMode(relay, OUTPUT);
  pinMode(buzzer,OUTPUT);
  digitalWrite(buzzer, 0);
  digitalWrite(relay, 0);
  initWiFi_and_Time_For_Telegram();
  initFingerPrint();
  bot.sendMessage(chat_id_1, "Project ONLINE");
}

void loop() {
  //fingerprint_detection
  //keypad_detection
  //face_detection
  readSensors();
  if (state == 0 && flag_door_state == 1 && flag_door_opened == 1) {
    flag_door_state = 0;
    flag_door_opened = 0;
    bot.sendMessage(chat_id_1, "Door Closed");
  }
  if (state == 0){
    flag_door_opened = 0;
  }
  if (state == 1) {
    flag_door_opened = 1;
    if (flag_door_state == 1) {
      bot.sendMessage(chat_id_1, "Door Open");
      delay(5000);
    }
    else {
      if (keypad_detection == 0 || face_detection == 0 || int(getFingerprintID) == -1) {
        //send Telegram Notification Introder Alert!!
        bot.sendMessage(chat_id_1, "Door Open - [Introder Alert!!]");
        digitalWrite(buzzer, 1);
        delay(3000);
        digitalWrite(buzzer, 0);
      }
    }
  }
  if (keypad_detection == 1) {
    //send Telegram Notification Access Granted - [Passcode OK]
    bot.sendMessage(chat_id_1, "Access Granted - [Passcode OK]");
    flag_door_state = 1;
    delay(5000);
  }
  if (face_detection == 1) {
    digitalWrite(relay, 1);
    //send Telegram Notification Access Granted - [Facecode OK]
    bot.sendMessage(chat_id_1, "Access Granted - [Facecode OK]");
    flag_door_state = 1;
    delay(5000);
    digitalWrite(relay, 0);
  }
  delay(100);
}

void readSensors() {
  state = digitalRead(doorSensor);
  keypad_detection = digitalRead(keypad_detection_pin);
  face_detection = digitalRead(face_detection_pin);
  getFingerprintID();
}

uint8_t getFingerprintID() {
  uint8_t p = finger.getImage();
  switch (p) {
    case FINGERPRINT_OK:
      Serial.println("Image taken");
      break;
    case FINGERPRINT_NOFINGER:
      //Serial.println("No finger detected");
      return 0;
    case FINGERPRINT_PACKETRECIEVEERR:
      Serial.println("Communication error");
      return -1;
    case FINGERPRINT_IMAGEFAIL:
      Serial.println("Imaging error");
      return -1;
    default:
      Serial.println("Unknown error");
      return -1;
  }

  // OK success!

  p = finger.image2Tz();
  switch (p) {
    case FINGERPRINT_OK:
      Serial.println("Image converted");
      break;
    case FINGERPRINT_IMAGEMESS:
      Serial.println("Image too messy");
      return -1;
    case FINGERPRINT_PACKETRECIEVEERR:
      Serial.println("Communication error");
      return -1;
    case FINGERPRINT_FEATUREFAIL:
      Serial.println("Could not find fingerprint features");
      return -1;
    case FINGERPRINT_INVALIDIMAGE:
      Serial.println("Could not find fingerprint features");
      return -1;
    default:
      Serial.println("Unknown error");
      return -1;
  }

  // OK converted!
  p = finger.fingerSearch();
  if (p == FINGERPRINT_OK) {
    Serial.println("Found a print match!");
    digitalWrite(relay, 1);
    bot.sendMessage(chat_id_1, "Access Granted - [Fingerprint OK]");
    flag_door_state = 1;
    delay(5000);
    digitalWrite(relay, 0);
  } else if (p == FINGERPRINT_PACKETRECIEVEERR) {
    Serial.println("Communication error");
    return -1;
  } else if (p == FINGERPRINT_NOTFOUND) {
    Serial.println("Did not find a match");
    bot.sendMessage(chat_id_1, "Access Denied - [Fingerprint Not Found!!]");
    return -1;
  } else {
    Serial.println("Unknown error");
    return -1;
  }

  // found a match!
  Serial.print("Found ID #"); Serial.print(finger.fingerID);
  Serial.print(" with confidence of "); Serial.println(finger.confidence);
  return finger.fingerID;
}

void initFingerPrint() {
  Serial2.begin(57600, SERIAL_8N1, RXD2, TXD2);
  while (!Serial);
  delay(100);
  Serial.println("\n\nAdafruit finger detect test");
  delay(5);
  if (finger.verifyPassword()) {
    Serial.println("Found fingerprint sensor!");
  } else {
    Serial.println("Did not find fingerprint sensor :(");
    while (1) {
      delay(1);
    }
  }

  Serial.println(F("Reading sensor parameters"));
  finger.getParameters();
  Serial.print(F("Status: 0x")); Serial.println(finger.status_reg, HEX);
  Serial.print(F("Sys ID: 0x")); Serial.println(finger.system_id, HEX);
  Serial.print(F("Capacity: ")); Serial.println(finger.capacity);
  Serial.print(F("Security level: ")); Serial.println(finger.security_level);
  Serial.print(F("Device address: ")); Serial.println(finger.device_addr, HEX);
  Serial.print(F("Packet len: ")); Serial.println(finger.packet_len);
  Serial.print(F("Baud rate: ")); Serial.println(finger.baud_rate);

  finger.getTemplateCount();

  if (finger.templateCount == 0) {
    Serial.print("Sensor doesn't contain any fingerprint data. Please run the 'enroll' example.");
  }
  else {
    Serial.println("Waiting for valid finger...");
    Serial.print("Sensor contains "); Serial.print(finger.templateCount); Serial.println(" templates");
  }
}


void handel_Messages_Loop() {
  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 initWiFi_and_Time_For_Telegram() {
  Serial.println();

  // attempt to connect to Wifi network:
  Serial.print("Connecting to Wifi SSID ");
  Serial.print(WIFI_SSID);
  WiFi.begin(WIFI_SSID, WIFI_PASSWORD);
  secured_client.setCACert(TELEGRAM_CERTIFICATE_ROOT); // Add root certificate for api.telegram.org
  while (WiFi.status() != WL_CONNECTED)
  {
    Serial.print(".");
    delay(500);
  }
  Serial.print("\nWiFi connected. IP address: ");
  Serial.println(WiFi.localIP());

  Serial.print("Retrieving time: ");
  configTime(0, 0, "pool.ntp.org"); // get UTC time via NTP
  time_t now = time(nullptr);
  while (now < 24 * 3600)
  {
    Serial.print(".");
    delay(100);
    now = time(nullptr);
  }
  Serial.println(now);

}

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

  for (int i = 0; i < numNewMessages; i++)
  {
    chat_id = bot.messages[i].chat_id;
    text = bot.messages[i].text;

    String from_name = bot.messages[i].from_name;
    if (from_name == "")
      from_name = "Guest";

    if (text == "/send_test_action")
    {
      bot.sendChatAction(chat_id, "typing");
      delay(4000);
      bot.sendMessage(chat_id, "Did you see the action message?");

      // You can't use own message, just choose from one of bellow

      //typing for text messages
      //upload_photo for photos
      //record_video or upload_video for videos
      //record_audio or upload_audio for audio files
      //upload_document for general files
      //find_location for location data

      //more info here - https://core.telegram.org/bots/api#sendchataction
    }
    if (text == "/start")
    {
      String welcome = "Welcome to Universal Arduino Telegram Bot library, " + from_name + ".\n";
      welcome += "This is Chat Action Bot example.\n\n";
      welcome += "/send_test_action : to send test chat action message\n";
      bot.sendMessage(chat_id, welcome);
    }
  }
}