#include "SerialService.h"
#include "Pinout.h"
#include "Utils.h"
#include <ESP32Servo.h>

#ifndef ServoFreioModel
#define ServoFreioModel

class ServoFreio {
  public:

    static void InicializarLista(std::vector<ServoFreio*>& lista, const String& parametros, const String& Mod_ID);

    ServoFreio(String _modID, String _id) {
      Mod_ID = _modID;
      _ID = _id;
    }

    String Mod_ID;
    String _ID;
    PinoModel _pino;

    bool Incremental = true;

    bool Iniciado = false;

    int _Angulo = 0;

    Servo _Servo;

    void Inicializar() {
      if (Iniciado) {
        PrintTela(_ID + " ja inicializado");
        return;
      }
      
      if (_pino.Definido()) {
        _Servo.attach(_pino.num);
        _Servo.write(Incremental ? 0 : 180);\

        Iniciado = true;

        PrintTela(_ID + " iniciado");
      }
    }

    void Desligar() {
      if (!Iniciado) {
        PrintTela(_ID + " nao esta inicializado");
        return;
      }

      // Redefinir as configurações para os valores iniciais
      if (_pino.Definido()) {
        _Servo.detach();
      }

      PrintTela(_ID + " Desligado");

      Iniciado = false;
    }

    void AtualizarAngulo(int novoAngulo) {
      _Angulo = novoAngulo;
      
      _Servo.write(_Angulo);
    }

    void RequisitarDados() {
      
    }

};


// Função para inicializar os servo freios com IDs e pinos específicos
void ServoFreio::InicializarLista(std::vector<ServoFreio*>& lista, const String& parametros, const String& Mod_ID) {
  // Verifica se há sensores já na lista
  if (!lista.empty()) {
    PrintTela("Limpando lista de servo freios existente...");

    for (auto* sensor : lista) {
      sensor->Desligar();  // Desliga cada sensor antes de remover
      PrintTela("Servo Freio " + sensor->_ID + " desligado.");
      delete sensor;
    }

    lista.clear();  // Limpa a lista após desligar todos os itens
  }

  if (parametros.length() > 0) {
    std::vector<String> _config = SplitString(parametros, SplitConfig);  // Divide a configuração por vírgulas

    for (const String& config : _config) {
      std::vector<String> partes = SplitString(config, SplitSubParams);  // Divide cada configuração pelo '-'

      if (partes.size() == 5) {
        String id = partes[0];
        bool conectar = partes[1] == "1";
        bool inc = partes[2] == "1";
        TiposBarramentos pinoB = (TiposBarramentos)partes[3].toInt();
        int pino = partes[4].toInt();

        if (conectar) {
          ServoFreio* sensor = new ServoFreio(Mod_ID, id);
          sensor->Incremental = inc;
          sensor->_pino = PinoModel(pino, pinoB, _OUTPUT);
          sensor->Inicializar();
          lista.push_back(sensor);
          PrintTela("Servo Freio " + id + " inicializado no pino " + String(pino));
        }
      } else {
        PrintTela("Configuração inválida para servo freio: " + config);
      }
    }
  } else {
    PrintTela("Configuração de servo freio não encontrada.");
  }
}

#endif