Dual-Server Drone Monitoring

#include <Arduino.h>
#include <WiFi.h>
#include <WiFiUdp.h>
#include <BLEDevice.h>
#include <SPI.h>
#include <Adafruit_GFX.h>
#include <Adafruit_ILI9341.h>
#include <XPT2046_Touchscreen.h>
#include <Keypad.h>
#include <Adafruit_Fingerprint.h>
#include <TinyGPS++.h>
#include "fleet_protocol.h"


// Struktur data perangkat yang terhubung
struct Device {
  char id[20];
  bool drone;
  bool online;
  int rssi;
  float lat, lon;
  bool camera, audio;
  uint32_t lastSeen;
};


// Deklarasi fungsi
void writeLedBits(uint16_t bits);
uint8_t onlineDrones();
void setIndicators();
void header(const char *text);
void loginScreen();
void dashboard();
IPAddress broadcastIP();
void broadcast(const char *message);
void callAll();
void morseAll();
void updateDevice(char *message);
void receivePackets();
void handleKeys();
void scanFinger();
void handleTouch();

constexpr int TFT_CS = 14;
constexpr int TFT_DC = 15;
constexpr int TFT_RST = 16;
constexpr int TOUCH_CS = 17;
constexpr int GPS_RX_PIN = 21;
constexpr int GPS_TX_PIN = 18;
constexpr int FINGER_RX_PIN = 38;
constexpr int FINGER_TX_PIN = 39;
constexpr int LED_SHIFT_DATA = 41;
constexpr int LED_SHIFT_CLOCK = 42;
constexpr int LED_SHIFT_LATCH = 47;
constexpr uint32_t AUTO_LOCK_MS = 15UL * 60UL * 1000UL;
constexpr char SERVER_ID[] = "SERVER_1";
constexpr char WIFI_SSID[] = "CONTROL_CENTER_WIFI";
constexpr char WIFI_PASSWORD[] = "CHANGE_THIS_WIFI_PASSWORD";
constexpr char LOGIN_PASSWORD[] = "2468";



Device devices[24];
uint8_t deviceCount = 0;
Adafruit_ILI9341 tft(TFT_CS, TFT_DC, TFT_RST);
XPT2046_Touchscreen touch(TOUCH_CS);
HardwareSerial gpsSerial(1), fingerSerial(2);
TinyGPSPlus gps;
Adafruit_Fingerprint finger(&fingerSerial);
WiFiUDP udp;
const byte ROWS = 4, COLS = 4;
byte rows[ROWS] = {1, 2, 3, 4};
byte cols[COLS] = {5, 6, 7, 40};
char keymap[ROWS][COLS] = {{'1','2','3','A'}, {'4','5','6','B'}, {'7','8','9','C'}, {'*','0','#','D'}};
Keypad keypad = Keypad(makeKeymap(keymap), rows, cols, ROWS, COLS);
bool passwordOK = false, fingerOK = false, open = false;
String entered;
uint32_t lastActivity = 0, lastBeacon = 0;

void writeLedBits(uint16_t bits) {
  digitalWrite(LED_SHIFT_LATCH, LOW);
  // IC kedua menerima byte tinggi lebih dulu; Q0 IC kedua adalah LED drone ke-6.
  shiftOut(LED_SHIFT_DATA, LED_SHIFT_CLOCK, MSBFIRST, (uint8_t)(bits >> 8));
  shiftOut(LED_SHIFT_DATA, LED_SHIFT_CLOCK, MSBFIRST, (uint8_t)(bits & 0xFF));
  digitalWrite(LED_SHIFT_LATCH, HIGH);
}

uint8_t onlineDrones() {
  uint8_t count = 0;
  for (uint8_t i = 0; i < deviceCount; i++) if (devices[i].online && devices[i].drone) count++;
  return count;
}

void setIndicators() {
  uint16_t bits = 0;
  // Bit 0=merah, 1=kuning, 2=hijau; bit 3 sampai 8=drone 1 sampai 6.
  if (WiFi.isConnected()) bits |= (1U << 2);
  else bits |= (1U << 1);
  uint8_t drones = onlineDrones();
  for (uint8_t i = 0; i < drones && i < 6; i++) bits |= (1U << (3 + i));
  writeLedBits(bits);
}

void header(const char *text) {
  tft.fillRect(0, 0, 320, 28, ILI9341_DARKCYAN);
  tft.setTextSize(2); tft.setTextColor(ILI9341_WHITE); tft.setCursor(6, 6); tft.print(text);
}

void loginScreen() {
  tft.fillScreen(ILI9341_BLACK); header("SERVER TERKUNCI");
  tft.setTextSize(2); tft.setTextColor(ILI9341_WHITE); tft.setCursor(12, 48); tft.print("PASSWORD + SIDIK JARI");
  tft.setTextSize(1); tft.setCursor(12, 84); tft.print("PIN: ");
  for (uint8_t i = 0; i < entered.length(); i++) tft.print('*');
  tft.setCursor(12, 108); tft.printf("Password: %s", passwordOK ? "OK" : "menunggu");
  tft.setCursor(12, 124); tft.printf("Sidik jari: %s", fingerOK ? "OK" : "tempelkan jari");
}

void dashboard() {
  tft.fillScreen(ILI9341_BLACK); header("SERVER UTAMA");
  tft.setTextSize(1); tft.setTextColor(ILI9341_CYAN); tft.setCursor(8, 34);
  tft.printf("Wi-Fi:%s  Drone:%u", WiFi.isConnected() ? "OK" : "PUTUS", onlineDrones());
  tft.setCursor(8, 48);
  if (gps.location.isValid()) tft.printf("GPS %.4f, %.4f", gps.location.lat(), gps.location.lng());
  else tft.print("GPS: menunggu sinyal satelit");
  tft.fillRoundRect(8, 62, 190, 34, 5, ILI9341_RED); tft.setTextSize(2); tft.setTextColor(ILI9341_WHITE); tft.setCursor(18, 72); tft.print("PANGGIL SEMUA");
  tft.fillRoundRect(210, 62, 100, 34, 5, ILI9341_DARKGREY); tft.setTextSize(1); tft.setCursor(235, 75); tft.print("LOGOUT");
  tft.setTextColor(ILI9341_YELLOW); tft.setCursor(8, 108); tft.print("Tombol A: kirim kode Morse SOS");
  tft.setTextColor(ILI9341_WHITE);
  for (uint8_t i = 0; i < deviceCount && i < 8; i++) {
    tft.setCursor(8, 123 + i * 13);
    tft.printf("%s %s %ddBm KAM:%s MIK:%s", devices[i].id, devices[i].online ? "ONLINE" : "OFFLINE", devices[i].rssi, devices[i].camera ? "YA" : "-", devices[i].audio ? "YA" : "-");
  }
  setIndicators();
}

IPAddress broadcastIP() {
  IPAddress ip = WiFi.localIP(), mask = WiFi.subnetMask();
  return IPAddress(ip[0] | ~mask[0], ip[1] | ~mask[1], ip[2] | ~mask[2], ip[3] | ~mask[3]);
}

void broadcast(const char *message) {
  if (!WiFi.isConnected()) return;
  udp.beginPacket(broadcastIP(), FLEET_PORT); udp.print(message); udp.endPacket();
}

// Perintah jaringan dipertahankan dalam bahasa teknis agar firmware drone cocok.
void callAll() { char message[80]; snprintf(message, sizeof(message), "CALL_ALL|%s|%lu", SERVER_ID, (unsigned long)millis()); broadcast(message); }
void morseAll() { broadcast("MORSE_ALL|SERVER_1|...---..."); }

void updateDevice(char *message) {
  char *tag = strtok(message, "|");
  if (!tag || strcmp(tag, "HELLO")) return;
  char *id = strtok(nullptr, "|"), *kind = strtok(nullptr, "|"), *lat = strtok(nullptr, "|"), *lon = strtok(nullptr, "|");
  char *cam = strtok(nullptr, "|"), *mic = strtok(nullptr, "|");
  if (!id || !kind || !lat || !lon || !cam || !mic) return;
  uint8_t index = deviceCount;
  for (uint8_t i = 0; i < deviceCount; i++) if (!strcmp(devices[i].id, id)) { index = i; break; }
  if (index == deviceCount && deviceCount < 24) deviceCount++;
  if (index >= 24) return;
  strncpy(devices[index].id, id, 19); devices[index].id[19] = 0;
  devices[index].drone = !strcmp(kind, "DRONE"); devices[index].online = true; devices[index].rssi = WiFi.RSSI();
  devices[index].lat = atof(lat); devices[index].lon = atof(lon); devices[index].camera = atoi(cam); devices[index].audio = atoi(mic); devices[index].lastSeen = millis();
}

void receivePackets() {
  int length;
  while ((length = udp.parsePacket()) > 0) {
    char buffer[192]; int readCount = udp.read(buffer, min(length, 191));
    if (readCount > 0) { buffer[readCount] = 0; updateDevice(buffer); }
  }
}

void handleKeys() {
  char key = keypad.getKey(); if (!key) return; lastActivity = millis();
  if (open) { if (key == 'A') { morseAll(); dashboard(); } return; }
  if (key >= '0' && key <= '9' && entered.length() < 12) entered += key;
  else if (key == '*') entered = "";
  else if (key == '#') { passwordOK = (entered == LOGIN_PASSWORD); entered = ""; }
  if (passwordOK && fingerOK) open = true;
  if (open) dashboard(); else loginScreen();
}

void scanFinger() {
  if (open || fingerOK || finger.getImage() != FINGERPRINT_OK) return;
  if (finger.image2Tz() == FINGERPRINT_OK && finger.fingerFastSearch() == FINGERPRINT_OK) {
    fingerOK = true; lastActivity = millis(); if (passwordOK) open = true;
    if (open) dashboard(); else loginScreen();
  }
}

void handleTouch() {
  if (!open || !touch.touched()) return;
  TS_Point point = touch.getPoint(); int x = map(point.y, 380, 3700, 0, 320), y = map(point.x, 250, 3800, 0, 240);
  lastActivity = millis();
  if (y >= 62 && y <= 96 && x >= 8 && x <= 198) callAll();
  if (y >= 62 && y <= 96 && x >= 210) { passwordOK = false; fingerOK = false; open = false; entered = ""; loginScreen(); }
  delay(180);
}

void setup() {
  Serial.begin(115200);
  pinMode(LED_SHIFT_DATA, OUTPUT); pinMode(LED_SHIFT_CLOCK, OUTPUT); pinMode(LED_SHIFT_LATCH, OUTPUT); writeLedBits(0);
  SPI.begin(12, 13, 11); tft.begin(); tft.setRotation(1); touch.begin(); touch.setRotation(1);
  gpsSerial.begin(9600, SERIAL_8N1, GPS_RX_PIN, GPS_TX_PIN);
  fingerSerial.begin(57600, SERIAL_8N1, FINGER_RX_PIN, FINGER_TX_PIN); finger.verifyPassword();
  WiFi.mode(WIFI_STA); WiFi.begin(WIFI_SSID, WIFI_PASSWORD); udp.begin(FLEET_PORT);
  // Bluetooth hanya menyiarkan ID server; telemetri utama memakai Wi-Fi.
  BLEDevice::init(SERVER_ID); BLEDevice::getAdvertising()->start();
  lastActivity = millis(); loginScreen(); setIndicators();
}

void loop() {
  while (gpsSerial.available()) gps.encode(gpsSerial.read());
  receivePackets(); handleKeys(); scanFinger(); handleTouch();
  bool changed = false;
  for (uint8_t i = 0; i < deviceCount; i++) if (devices[i].online && millis() - devices[i].lastSeen > DEVICE_TIMEOUT_MS) { devices[i].online = false; changed = true; }
  if (changed && open) dashboard();
  if (millis() - lastBeacon > 2000 && WiFi.isConnected()) { lastBeacon = millis(); broadcast("BEACON|SERVER_1"); }
  if (open && millis() - lastActivity > AUTO_LOCK_MS) { passwordOK = false; fingerOK = false; open = false; entered = ""; loginScreen(); }
  static uint32_t indicatorTick = 0;
  if (millis() - indicatorTick > 500) { indicatorTick = millis(); setIndicators(); }
}