/**
 * @file menuSensorData.cpp
 * @author Alexander Klein (alex@kleiax.de)
 * @brief
 * @version 0.1
 * @date 2023-09-04
 *
 * @copyright Copyright (c) 2023
 *
 */

#include "menuSensorData.h"

MenuSensorData::MenuSensorData(SensorData *sensorData) : MenuInformationSites(7), sensorData{sensorData}
{
    this->noEqualLeft = true;
}

void MenuSensorData::printPage() const
{
    const UBX_NAV_PVT_data_t *gpsData = this->sensorData->getGnssData();
    uint8_t fixType = 0;
    if (static_cast<bool>(gpsData))
    {
        fixType = gpsData->fixType;
    }

    String lineOne = "";
    String lineTwo = "";

    switch (this->getCurrentPage())
    {
    case 0:
        lineOne = " Y     P     R :";
        lineTwo.concat(this->sensorData->getGyroData()[0]);
        lineTwo.concat(" ");
        lineTwo.concat(this->sensorData->getGyroData()[1]);
        lineTwo.concat(" ");
        lineTwo.concat(this->sensorData->getGyroData()[2]);
        break;

    case 1:
        lineOne = "Real Azimuth:";
        lineTwo.concat(this->sensorData->getRealAzimuth());
        break;

    case 2:
        lineOne = "Calc Azimuth:";
        lineTwo.concat(this->sensorData->getCalcAzimuth());
        lineTwo.concat(" ");
        lineTwo.concat(CalcAzimuth::stateToString(this->sensorData->getCalcAzimuthState()));
        break;

    case 3:
    {
        lineOne = "Lat:";
        lineTwo = "Lon:";
        const Point pos = this->sensorData->getCurrentPos();
        lineOne.concat(pos.getLatitude());
        lineTwo.concat(pos.getLongitude());
    }
    break;

    case 4:
        lineOne = "Time: ";
        lineTwo = "";
        if (static_cast<bool>(fixType))
        {
            if (gpsData->hour < 10)
            {
                lineTwo.concat("0");
            }
            lineTwo.concat(gpsData->hour);
            lineTwo.concat(":");
            if (gpsData->min < 10)
            {
                lineTwo.concat("0");
            }
            lineTwo.concat(gpsData->min);
            lineTwo.concat(":");
            if (gpsData->sec < 10)
            {
                lineTwo.concat("0");
            }
            lineTwo.concat(gpsData->sec);
        }
        else
        {
            lineTwo = "00:00:00";
        }

        break;

    case 5:
    {
        lineOne = "CarSol: ";
        lineTwo = "Ntrip: ";
        const uint8_t carrSoln = gpsData->flags.bits.carrSoln;
        if (carrSoln == 0)
        {
            lineOne.concat("None");
        }
        else if (carrSoln == 1)
        {
            lineOne.concat("Floating");
        }
        else if (carrSoln == 2)
        {
            lineOne.concat("Fixed");
        }
        else
        {
            lineOne = "UNKNOWN";
        }
        const NTRIPClientStates status = this->sensorData->getNtripState();
        if (status == NTRIPClientStates::pushingData)
        {
            lineTwo.concat("enabled");
        }
        else if (status == NTRIPClientStates::notAvailable)
        {
            lineTwo.concat(" N/A");
        }
        else
        {
            lineTwo.concat("disabled");
        }
    }
    break;

    case 6:
        lineOne = "HAcc: ";
        lineTwo = "Sats: ";
        if (static_cast<bool>(fixType))
        {
            lineOne.concat(gpsData->hAcc);
            lineTwo.concat(gpsData->numSV);
        }
        else
        {
            lineOne.concat("-/-");
            lineTwo.concat("-/-");
        }
        break;

    default:
        this->printDefault();
        return;
    }

    this->print(lineOne, lineTwo);
}

void MenuSensorData::runCommand()
{
    switch (this->getCurrentPage())
    {
    case 5:
        {
            NTRIPClient* client = this->sensorData->getNtripClient();
            NTRIPClientStates state = client->getClientState();
            if (state == NTRIPClientStates::pushingData)
            {
                client->deactivate();
            }
            else if (state == NTRIPClientStates::waiting)
            {
                client->activate();
            }
        }
        break;
        
    default:
        
        break;
    }
}