agrobot_base/Firmware/Modulos/SensorTemperaturaModel.h

115 lines
3.0 KiB
C++

#include "SerialService.h"
#include "Pinout.h"
#include "Utils.h"
#include <SimpleKalmanFilter.h>
#ifndef SensorTemperaturaModel
#define SensorTemperaturaModel
class SensorTemperatura {
public:
static void InicializarLista(std::vector<SensorTemperatura*>& lista, const String& parametros, const String& Mod_ID);
SensorTemperatura(String _modID, String _id) {
Mod_ID = _modID;
_ID = _id;
}
// Definições
String Mod_ID = "";
String _ID;
PinoModel _pino;
double leitura = 0;
//SimpleKalmanFilter filtro = SimpleKalmanFilter(5, 15, 0.01);
bool Iniciado = false;
bool Checando = false;
void Inicializar() {
if (Iniciado) {
PrintTela(_ID + " ja inicializado");
return;
}
leitura = 0;
_pino.Conectar(); // Conecta o pino antes de criar a tarefa
Iniciado = true;
PrintTela(_ID + " iniciado");
}
void Desligar() {
if (!Iniciado) {
PrintTela(_ID + " nao esta inicializado");
return;
}
_pino.Desconectar(); // Desconecta o pino
PrintTela(_ID + " Desligado");
Iniciado = false;
}
void AferirTemperatura() {
leitura = _pino.get(5);
//leitura = filtro.updateEstimate(leitura);
}
void RequisitarDados() {
AferirTemperatura();
}
};
// Função para inicializar os sensores de temperatura com IDs e pinos específicos
void SensorTemperatura::InicializarLista(std::vector<SensorTemperatura*>& lista, const String& parametros, const String& Mod_ID) {
// Verifica se há sensores já na lista
if (!lista.empty()) {
PrintTela("Limpando lista de sensores de temperatura existente...");
for (auto* sensor : lista) {
sensor->Desligar(); // Desliga cada sensor antes de remover
PrintTela("Sensor de Temperatura " + 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() >= 4) {
String id = partes[0];
bool conectar = partes[1] == "1";
TiposBarramentos pinoB = (TiposBarramentos)partes[2].toInt();
int pino = partes[3].toInt();
if (conectar) {
SensorTemperatura* sensor = new SensorTemperatura(Mod_ID, id);
sensor->_pino = PinoModel(pino, pinoB, _INPUT, ANALOGICO);
sensor->Inicializar();
lista.push_back(sensor);
PrintTela("Sensor de temperatura " + id + " inicializado no pino " + String(pino));
}
} else {
PrintTela("Configuração inválida para sensor de temperatura: " + config);
}
}
} else {
PrintTela("Configuração de sensor de temperatura não encontrada.");
}
}
#endif