#include "Consts.h"
#ifdef EnableSensorPzem
#include "items/vSensorPzem.h"

#include "BufferExecute.h"
#include "Class/LineParsing.h"
#include "Global.h"
#include "SoftUART.h"

SensorPzem::SensorPzem(const paramsPzem& paramsV, const paramsPzem& paramsA, const paramsPzem& paramsWatt, const paramsPzem& paramsWattHrs, const paramsPzem& paramsHz) {
    _paramsV = paramsPzem(paramsV);
    _paramsA = paramsPzem(paramsA);
    _paramsWatt = paramsPzem(paramsWatt);
    _paramsWattHrs = paramsPzem(paramsWattHrs);
    _paramsHz = paramsPzem(paramsHz);

    pzem = new PZEMSensor(myUART, hexStringToUint8(_paramsHz.addr));
}

SensorPzem::~SensorPzem() {}

void SensorPzem::loop() {
    difference = millis() - prevMillis;
    if (difference >= _paramsHz.interval) {
        prevMillis = millis();
        read();
    }
}

void SensorPzem::read() {
    if (myUART) {
        float voltage = (pzem->values()->voltage * _paramsV.c) + _paramsV.k;
        float current = (pzem->values()->current * _paramsA.c) + _paramsA.k;
        float power = (pzem->values()->power * _paramsWatt.c) + _paramsWatt.k;
        float energy = (pzem->values()->energy * _paramsWattHrs.c) + _paramsWattHrs.k;
        float freq = (pzem->values()->freq * _paramsHz.c) + _paramsHz.k;

        eventGen2(_paramsV.key, String(voltage));
        jsonWriteStr(configLiveJson, _paramsV.key, String(voltage));
        publishStatus(_paramsV.key, String(voltage));
          String path = mqttRootDevice + "/" +_paramsV.key + "/status";
    String json = "{}";
    jsonWriteStr(json, "status", String(voltage));
    String MyJson = json; 
    jsonWriteStr(MyJson, "topic", path); 
    ws.textAll(MyJson);
        SerialPrint("I", "Sensor", "'" + _paramsV.key + "' data: " + String(voltage));

        eventGen2(_paramsA.key, String(current));
        jsonWriteStr(configLiveJson, _paramsA.key, String(current));
        publishStatus(_paramsA.key, String(current));
            path = mqttRootDevice + "/" +_paramsA.key + "/status";
     json = "{}";
    jsonWriteStr(json, "status",  String(current));
     MyJson = json; 
    jsonWriteStr(MyJson, "topic", path); 
    ws.textAll(MyJson);
        SerialPrint("I", "Sensor", "'" + _paramsA.key + "' data: " + String(current));

        eventGen2(_paramsWatt.key, String(power));
        jsonWriteStr(configLiveJson, _paramsWatt.key, String(power));
        publishStatus(_paramsWatt.key, String(power));
           path = mqttRootDevice + "/" +_paramsWatt.key + "/status";
     json = "{}";
    jsonWriteStr(json, "status", String(power));
     MyJson = json; 
    jsonWriteStr(MyJson, "topic", path); 
    ws.textAll(MyJson);
        SerialPrint("I", "Sensor", "'" + _paramsWatt.key + "' data: " + String(power));

        eventGen2(_paramsWattHrs.key, String(energy));
        jsonWriteStr(configLiveJson, _paramsWattHrs.key, String(energy));
        publishStatus(_paramsWattHrs.key, String(energy));
              path = mqttRootDevice + "/" +_paramsWattHrs.key + "/status";
     json = "{}";
    jsonWriteStr(json, "status", String(energy));
     MyJson = json; 
    jsonWriteStr(MyJson, "topic", path); 
    ws.textAll(MyJson);
        SerialPrint("I", "Sensor", "'" + _paramsWattHrs.key + "' data: " + String(energy));

        eventGen2(_paramsHz.key, String(freq));
        jsonWriteStr(configLiveJson, _paramsHz.key, String(freq));
        publishStatus(_paramsHz.key, String(freq));
               path = mqttRootDevice + "/" +_paramsHz.key + "/status";
     json = "{}";
    jsonWriteStr(json, "status", String(freq));
     MyJson = json; 
    jsonWriteStr(MyJson, "topic", path); 
    ws.textAll(MyJson);
        SerialPrint("I", "Sensor", "'" + _paramsHz.key + "' data: " + String(freq));
    } else {
        SerialPrint("E", "Sensor PZEM", "Error, UART switched off");
    }
}

MySensorPzemVector* mySensorPzem = nullptr;

void pzemSensor() {
    if (myUART) {
        myLineParsing.update();
        String key = myLineParsing.gkey();
        String addr = myLineParsing.gaddr();
        String interval = myLineParsing.gint();
        String c = myLineParsing.gc();
        String k = myLineParsing.gk();
        myLineParsing.clear();

        static int enterCnt = -1;
        enterCnt++;

        static paramsPzem paramsV;
        static paramsPzem paramsA;
        static paramsPzem paramsWatt;
        static paramsPzem paramsWattHrs;
        static paramsPzem paramsHz;

        if (enterCnt == 0) {
            paramsV.key = key;
            paramsV.c = c.toFloat();
            paramsV.k = k.toFloat();
        }

        if (enterCnt == 1) {
            paramsA.key = key;
            paramsA.c = c.toFloat();
            paramsA.k = k.toFloat();
        }

        if (enterCnt == 2) {
            paramsWatt.key = key;
            paramsWatt.c = c.toFloat();
            paramsWatt.k = k.toFloat();
        }

        if (enterCnt == 3) {
            paramsWattHrs.key = key;
            paramsWattHrs.c = c.toFloat();
            paramsWattHrs.k = k.toFloat();
        }

        if (enterCnt == 4) {
            paramsHz.key = key;
            paramsHz.c = c.toFloat();
            paramsHz.k = k.toFloat();
            paramsHz.addr = addr;
            paramsHz.interval = interval.toInt() * 1000;

            static bool firstTime = true;
            if (firstTime) mySensorPzem = new MySensorPzemVector();
            firstTime = false;
            mySensorPzem->push_back(SensorPzem(paramsV, paramsA, paramsWatt, paramsWattHrs, paramsHz));

            enterCnt = -1;
        }
    } else {
        SerialPrint("E", "Sensor PZEM", "Error, UART switched off");
    }
}
#endif