152 lines
4.2 KiB
C++
152 lines
4.2 KiB
C++
#ifndef SensorLuzUVModel
|
|
#define SensorLuzUVModel
|
|
|
|
#include "SerialService.h"
|
|
#include "Pinout.h"
|
|
#include "Utils.h"
|
|
|
|
class SensorLuzUV {
|
|
public:
|
|
|
|
SensorLuzUV(String _modID, String _id) {
|
|
Mod_ID = _modID;
|
|
_ID = _id;
|
|
}
|
|
|
|
String Mod_ID = "";
|
|
String _ID;
|
|
int ID_Num;
|
|
PinoModel _pino;
|
|
|
|
double tensao = 0;
|
|
double uv_index = -1;
|
|
|
|
bool Iniciado = false;
|
|
bool Checando = false;
|
|
|
|
void Inicializar() {
|
|
if (Iniciado) {
|
|
MostrarLog("Sensor já inicializado");
|
|
return;
|
|
}
|
|
|
|
_pino.Conectar();
|
|
Iniciado = _pino.Definido();
|
|
|
|
MostrarLog(Iniciado ? "Sensor iniciado" : "Sensor nao iniciado");
|
|
}
|
|
|
|
void Desligar() {
|
|
if (!Iniciado) {
|
|
MostrarLog("Sensor nao esta inicializado");
|
|
return;
|
|
}
|
|
|
|
_pino.Desconectar(); // Desconecta o pino
|
|
|
|
MostrarLog("Sensor Desligado");
|
|
|
|
Iniciado = false;
|
|
}
|
|
|
|
void RequisitarDados() {
|
|
AferirUV();
|
|
}
|
|
|
|
std::vector<uint8_t> MontarMensagemCAN(CanMessagePosicaoDados posicao) {
|
|
std::vector<uint8_t> data;
|
|
data.push_back(static_cast<uint8_t>(posicao));
|
|
data.push_back(ID_Num);
|
|
switch (posicao) {
|
|
case CanMessagePosicaoDados::Status: {
|
|
data.push_back(Iniciado ? 1 : 0);
|
|
break;
|
|
}
|
|
case CanMessagePosicaoDados::Dados1: {
|
|
int16_t uvInt = static_cast<int16_t>(round(uv_index * 100.0f));
|
|
data.push_back((uint8_t)(uvInt >> 8));
|
|
data.push_back((uint8_t)(uvInt & 0xFF));
|
|
break;
|
|
}
|
|
}
|
|
return data;
|
|
}
|
|
|
|
static std::vector<uint8_t> ConfigurarSensor(std::vector<SensorLuzUV*>& lista, std::vector<uint8_t>& data, const String& Mod_ID) {
|
|
std::vector<uint8_t> status;
|
|
if (data.size() < 2) return status;
|
|
CanMessagePosicaoDados posicao = (CanMessagePosicaoDados)data[0];
|
|
uint8_t idNum = data[1];
|
|
auto it = std::find_if(lista.begin(), lista.end(), [idNum](SensorLuzUV* s) { return s->ID_Num == idNum; });
|
|
bool jaExiste = it != lista.end();
|
|
SensorLuzUV* sensor;
|
|
|
|
switch (posicao) {
|
|
case CanMessagePosicaoDados::Config1: {
|
|
if (data.size() < 7) return status;
|
|
bool conectar = data[3] == 1;
|
|
TiposBarramentos tipoBarramento = (TiposBarramentos)data[4];
|
|
int pino = data[5];
|
|
int canalMux = (data[6] == 255) ? -1 : data[6];
|
|
|
|
if (conectar) {
|
|
if (!jaExiste) sensor = new SensorLuzUV(Mod_ID, "sIUV_" + String(idNum));
|
|
else sensor = *it;
|
|
|
|
if (!sensor->Iniciado) {
|
|
sensor->ID_Num = idNum;
|
|
sensor->_pino = PinoModel(pino, tipoBarramento, _INPUT, ANALOGICO, idNum, canalMux);
|
|
sensor->Inicializar();
|
|
if (!jaExiste) {
|
|
lista.push_back(sensor);
|
|
sensor->MostrarLog("Sensor de luz UV adicionado via CAN: sIUV_" + String(idNum));
|
|
}
|
|
}
|
|
status = sensor->MontarMensagemCAN(CanMessagePosicaoDados::Status);
|
|
} else {
|
|
if (jaExiste) {
|
|
sensor = *it;
|
|
sensor->Desligar();
|
|
status = sensor->MontarMensagemCAN(CanMessagePosicaoDados::Status);
|
|
delete sensor;
|
|
lista.erase(it);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
return status;
|
|
}
|
|
|
|
private:
|
|
|
|
bool DegugMode = true;
|
|
|
|
void MostrarLog(String mensagem) {
|
|
if (DegugMode) {
|
|
PrintTela("[IUV " + _ID + "] " + mensagem);
|
|
}
|
|
}
|
|
|
|
const float Vs = 5.0f; // Tensao de alimentacao do sensor = 5V
|
|
static constexpr float divisor = 10.0f / (10.0f + 5.6f); // R1 = 5K6, R2 = 10K
|
|
static constexpr float vOffset = (2.9f / 2.24f); // v real / v ads
|
|
|
|
void AferirUV() {
|
|
if (!Iniciado) return;
|
|
int leitura = _pino.get();
|
|
float Vadc = (float)leitura / 4095.0f * Vs;
|
|
Vadc = Vadc * divisor * vOffset;
|
|
|
|
// Exemplo: divisor de 2:1 (tipo R1 = 5k6 / R2 = 10k), logo divisor = 0.641
|
|
float Vout = Vadc / divisor;
|
|
|
|
uv_index = max(0.0f, (Vout - 0.99f) * 10.0f); // fórmula do datasheet
|
|
MostrarLog("Leitura UV: " + String(leitura) + ", Tensao: " + String(Vadc) + ", Indice UV: " + String(uv_index));
|
|
}
|
|
|
|
|
|
};
|
|
|
|
#endif
|