#include <map>

#include <APRS-IS.h>
#include <BoardFinder.h>
#include <TaskManager.h>
#include <TimeLib.h>
#include <logger.h>
#include <power_management.h>

#include "TaskAprsIs.h"
#include "TaskDisplay.h"
#include "TaskEth.h"
#include "TaskFTP.h"
#include "TaskLora.h"
#include "TaskNTP.h"
#include "TaskOTA.h"
#include "TaskWifi.h"
#include "project_configuration.h"

#define VERSION "21.06.0-dev"

String create_lat_aprs(double lat);
String create_long_aprs(double lng);

std::shared_ptr<Configuration> userConfig;
std::shared_ptr<BoardConfig>   boardConfig;
HardwareSerial                 Serial(0);

// cppcheck-suppress unusedFunction
void setup() {
  Serial.begin(115200);
  Logger::instance().setSerial(&Serial);
  delay(500);
  logPrintlnW("LoRa APRS iGate by OE5BPA (Peter Buchegger)");
  logPrintlnW("Version: " VERSION);

  ProjectConfigurationManagement confmg;
  userConfig = confmg.readConfiguration();

  std::list<std::shared_ptr<BoardConfig>> boardConfigs;
  // clang-format off
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("TTGO_LORA32_V1",         eTTGO_LORA32_V1,          4, 15, 0x3C,  0,  5, 19, 27, 18, 14, 26)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("TTGO_LORA32_V2",         eTTGO_LORA32_V2,         21, 22, 0x3C,  0,  5, 19, 27, 18, 14, 26, true)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("TTGO_T_Beam_V0_7",       eTTGO_T_Beam_V0_7,       21, 22, 0x3C,  0,  5, 19, 27, 18, 14, 26, true)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("TTGO_T_Beam_V1_0",       eTTGO_T_Beam_V1_0,       21, 22, 0x3C,  0,  5, 19, 27, 18, 14, 26, true, true)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("ETH_BOARD",              eETH_BOARD,              33, 32, 0x3C,  0, 14,  2, 15, 12,  4, 36)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("TRACKERD",               eTRACKERD,                5,  4, 0x3C,  0, 18, 19, 23, 16, 14, 26)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("HELTEC_WIFI_LORA_32_V1", eHELTEC_WIFI_LORA_32_V1,  4, 15, 0x3C, 16,  5, 19, 27, 18, 14, 26)));
  boardConfigs.push_back(std::shared_ptr<BoardConfig>(new BoardConfig("HELTEC_WIFI_LORA_32_V2", eHELTEC_WIFI_LORA_32_V2,  4, 15, 0x3C, 16,  5, 19, 27, 18, 14, 26)));
  // clang-format on

  BoardFinder finder(boardConfigs);
  boardConfig = finder.getBoardConfig(userConfig->board);
  if (boardConfig == 0) {
    boardConfig = finder.searchBoardConfig();
    if (boardConfig == 0) {
      logPrintlnE("Board config not set and search failed!");
      while (true) {
      }
    }
    userConfig->board = boardConfig->Name;
    confmg.writeConfiguration(userConfig);
    logPrintlnI("will restart board now!");
    ESP.restart();
  }
  logPrintI("Board ");
  logPrintI(boardConfig->Name);
  logPrintlnI(" loaded.");

  if (boardConfig->Type == eTTGO_T_Beam_V1_0) {
    Wire.begin(boardConfig->OledSda, boardConfig->OledScl);
    std::shared_ptr<PowerManagement> powerManagement = std::shared_ptr<PowerManagement>(new PowerManagement);
    if (!powerManagement->begin(Wire)) {
      logPrintlnI("AXP192 init done!");
    } else {
      logPrintlnE("AXP192 init failed!");
    }
    powerManagement->activateLoRa();
    powerManagement->activateOLED();
    powerManagement->deactivateGPS();
  }

  load_config(boardConfig);

  TaskManager::instance().addTask(std::shared_ptr<Task>(new DisplayTask()));
  TaskManager::instance().addTask(std::shared_ptr<Task>(new LoraTask()));
  if (boardConfig->Type == eETH_BOARD) {
    TaskManager::instance().addTask(std::shared_ptr<Task>(new EthTask()));
  }
  TaskManager::instance().addTask(std::shared_ptr<Task>(new WifiTask()));
  TaskManager::instance().addTask(std::shared_ptr<Task>(new OTATask()));
  TaskManager::instance().addTask(std::shared_ptr<Task>(new NTPTask()));
  if (userConfig->ftp.active) {
    TaskManager::instance().addTask(std::shared_ptr<Task>(new FTPTask()));
  }
  TaskManager::instance().addTask(std::shared_ptr<Task>(new AprsIsTask()));

  TaskManager::instance().setup(userConfig, boardConfig);

  Display::instance().showSpashScreen("LoRa APRS iGate", VERSION);

  if (userConfig->display.overwritePin != 0) {
    pinMode(userConfig->display.overwritePin, INPUT);
    pinMode(userConfig->display.overwritePin, INPUT_PULLUP);
  }

  delay(5000);
  logPrintlnI("setup done...");
}

// cppcheck-suppress unusedFunction
void loop() {
  TaskManager::instance().loop(userConfig);
}

String create_lat_aprs(double lat) {
  char str[20];
  char n_s = 'N';
  if (lat < 0) {
    n_s = 'S';
  }
  lat = std::abs(lat);
  sprintf(str, "%02d%05.2f%c", (int)lat, (lat - (double)((int)lat)) * 60.0, n_s);
  String lat_str(str);
  return lat_str;
}

String create_long_aprs(double lng) {
  char str[20];
  char e_w = 'E';
  if (lng < 0) {
    e_w = 'W';
  }
  lng = std::abs(lng);
  sprintf(str, "%03d%05.2f%c", (int)lng, (lng - (double)((int)lng)) * 60.0, e_w);
  String lng_str(str);
  return lng_str;
}