App.cpp

#include "App.h"
#include <esp_task_wdt.h>

App::App()
  : commandExecutor(nullptr),
    gestureManager(nullptr),
    lastBatteryUpdate(0),
    wasConnected(false),
    connectionTime(0) {
  ctx.currentState = STATE_STARTUP;
  ctx.lastInteractionTime = 0;
}

void App::setup() {
  Serial.begin(115200);
  delay(100);

  Serial.println("\n╔══════════════════════════════════════════════════╗");
  Serial.println("║   ПРОШИВКА AMULET v1.0 - ИНИЦИАЛИЗАЦИЯ...       ║");
  Serial.println("╚══════════════════════════════════════════════════╝");

  Serial.print("Версия железа: ");
  Serial.println(HARDWARE_VERSION);
  Serial.print("Версия прошивки: ");
  Serial.println(FIRMWARE_VERSION);
  Serial.print("Серийный номер: ");
  Serial.println(SERIAL_NUMBER);
  Serial.println();

  DEBUG_PRINTLN("→ Инициализация сторожевого таймера...");
  esp_task_wdt_config_t twdt_config = {
    .timeout_ms = WDT_TIMEOUT_S * 1000,
    .trigger_panic = false,
  };
  esp_task_wdt_init(&twdt_config);
  esp_task_wdt_add(NULL);
  DEBUG_PRINTLN("✓ Сторожевой таймер активен");

  DEBUG_PRINTLN("→ Инициализация хранилища...");
  if (storageManager.begin()) {
    uint8_t savedBrightness = storageManager.getBrightness();
    uint8_t savedVibStrength = storageManager.getVibrationStrength();
    (void)savedBrightness;
    (void)savedVibStrength;
    DEBUG_PRINTLN("✓ Хранилище готово, настройки загружены");
  }

  DEBUG_PRINTLN("→ Инициализация контроллера LED...");
  ledController.begin();
  uint8_t initialBrightness = storageManager.getBrightness(LED_BRIGHTNESS);
  ledController.setBrightness(initialBrightness);
  ledController.setAll(COLOR_OFF);
  DEBUG_PRINTLN("✓ Контроллер LED готов");

  DEBUG_PRINTLN("→ Инициализация вибромотора...");
  vibrationMotor.begin();
  uint8_t initialVibStrength = storageManager.getVibrationStrength(MOTOR_DEFAULT_STRENGTH);
  vibrationMotor.setStrength(initialVibStrength);
  vibrationMotor.pulseShort();
  DEBUG_PRINTLN("✓ Вибромотор готов");

  DEBUG_PRINTLN("→ Инициализация BLE...");
  bleManager.begin();
  DEBUG_PRINTLN("✓ BLE готов");

  DEBUG_PRINTLN("→ Инициализация менеджера батареи...");
  batteryManager.begin();
  uint8_t batteryLevel = batteryManager.readBatteryLevel();
  bleManager.updateBatteryLevel(batteryLevel);
  DEBUG_PRINTLN("✓ Менеджер батареи готов");

  DEBUG_PRINTLN("→ Инициализация менеджера питания...");
  powerManager.begin();
  powerManager.printStatus();
  DEBUG_PRINTLN("✓ Менеджер питания готов");

  DEBUG_PRINTLN("→ Инициализация исполнителя команд...");
  commandExecutor = new CommandExecutor(&ledController, &bleManager, &storageManager, &vibrationMotor);
  DEBUG_PRINTLN("✓ Исполнитель команд готов");

  gestureManager = new GestureManager(&bleManager,
                                      &ledController,
                                      &vibrationMotor,
                                      &powerManager,
                                      commandExecutor,
                                      &ctx.currentState,
                                      &ctx.lastInteractionTime);
  gestureManager->begin();

  DEBUG_PRINTLN("→ Воспроизведение стартовой анимации...");
  playStartupAnimation();

  ctx.currentState = STATE_IDLE;
  ctx.lastInteractionTime = millis();

  storageManager.printStatus();

  Serial.println("\n╔══════════════════════════════════════════════════╗");
  Serial.println("║      AMULET v1.0 ГОТОВ - РЕЖИМ ОЖИДАНИЯ         ║");
  Serial.println("╚══════════════════════════════════════════════════╝\n");

  bleManager.notifyStatus("READY");
}

void App::loop() {
  esp_task_wdt_reset();

  bleManager.update();

  // При подключении клиента - отправить батарею с задержкой 3 сек
  bool connected = bleManager.isConnected();
  if (!wasConnected && connected) {
    connectionTime = millis();
  }
  if (wasConnected && !connected) {
    connectionTime = 0;
  }
  if (connected && connectionTime > 0 && millis() - connectionTime >= 3000) {
    uint8_t level = batteryManager.getCurrentLevel();
    bleManager.updateBatteryLevel(level);
    connectionTime = 0;
  }
  wasConnected = connected;

  while (bleManager.hasCommand()) {
    String command = bleManager.getCommand();
    if (command.length() == 0) {
      break;
    }
    if (commandExecutor) {
      commandExecutor->executeCommand(command);
    }
    ctx.lastInteractionTime = millis();
    powerManager.updateActivity();
  }

  ledController.update();
  if (commandExecutor) {
    commandExecutor->update();
  }
  if (gestureManager) {
    gestureManager->update();
  }

  vibrationMotor.update();
  batteryManager.update();

  if (millis() - lastBatteryUpdate >= BATTERY_CHECK_INTERVAL) {
    uint8_t level = batteryManager.getCurrentLevel();
    bool charging = batteryManager.getChargingStatus();
    bleManager.updateBatteryLevel(level);

    if (charging) {
      int activeLeds = map(level, 0, 100, 0, NUM_LEDS);
      if (level > 0 && activeLeds == 0) {
        activeLeds = 1;
      }
      ledController.showProgress(COLOR_CHARGING, activeLeds);
      bleManager.notifyStatus("CHARGING");
    } else if (level <= BATTERY_LOW_PERCENT) {
      ledController.setAll(COLOR_LOW_BATTERY);
      vibrationMotor.patternLowBattery();
      DEBUG_PRINTLN("⚠ Низкий заряд батареи!");
      bleManager.notifyStatus("LOW_BATTERY");
    }

    lastBatteryUpdate = millis();
  }

  powerManager.update();

  delay(1);
}

void App::playStartupAnimation() {
  for (int i = 0; i < NUM_LEDS; i++) {
    ledController.clear();
    ledController.setLED(i, CRGB(255, 0, 255));
    delay(50);
  }

  for (int j = 0; j < 2; j++) {
    ledController.setAll(COLOR_SUCCESS);
    delay(100);
    ledController.clear();
    delay(100);
  }

  vibrationMotor.patternSuccess();
  ledController.setAll(COLOR_OFF);
}

void App::checkIdleTimeout() {
  if (ctx.currentState == STATE_IDLE) {
    unsigned long idleTime = millis() - ctx.lastInteractionTime;
    if (idleTime >= IDLE_TIMEOUT_MS) {
      DEBUG_PRINTLN("Idle timeout reached");
      ledController.setBrightness(32);
    }
  }
}