Kettenoeler/Software/src/lubeapp.cpp

#include "lubeapp.h"

uint32_t lubePulseTimestamp = 0;

void RunLubeApp(uint32_t add_milimeters)
{

    globals.TankPercentage = PersistenceData.tankRemain_µl / (LubeConfig.tankCapacity_ml * 1000);

    MaintainDTC(DTC_TANK_EMPTY, DTC_CRITICAL, (PersistenceData.tankRemain_µl < LubeConfig.amountPerDose_µl));
    MaintainDTC(DTC_TANK_LOW, DTC_WARN, (globals.TankPercentage < LubeConfig.TankRemindAtPercentage));

    static tSystem_Status preserverSysStatusError;

    if (getlastDTC(false) < DTC_LAST_DTC)
    {
        globals.hasDTC = true;
        if (getlastDTC_Severity(true, DTC_CRITICAL) < DTC_LAST_DTC)
        {
            if (globals.systemStatus != sysStat_Error)
            {
                preserverSysStatusError = globals.systemStatus;
            }
            globals.systemStatus = sysStat_Error;
        }
        else
        {
            if (globals.systemStatus == sysStat_Error)
            {
                globals.systemStatus = preserverSysStatusError;
            }
        }
    }
    else
    {
        globals.hasDTC = false;
    }

    // Add traveled Distance in mm
    PersistenceData.TravelDistance_highRes_mm += add_milimeters;
    PersistenceData.odometer_mm += add_milimeters;
    if (PersistenceData.odometer_mm >= 1000000)
    {
        PersistenceData.odometer++;
        PersistenceData.odometer_mm = 0;
    }

    switch (globals.systemStatus)
    {
    case sysStat_Startup:
        if (millis() > STARTUP_DELAY)
        {
            globals.systemStatus = sysStat_Normal;
            globals.resumeStatus = sysStat_Normal;
        }
        break;

    case sysStat_Normal:
        if (PersistenceData.TravelDistance_highRes_mm / 1000 > LubeConfig.DistancePerLube_Default)
        {
            LubePulse();
            PersistenceData.TravelDistance_highRes_mm = 0;
        }
        break;

    case sysStat_Rain:
        if (PersistenceData.TravelDistance_highRes_mm / 1000 > LubeConfig.DistancePerLube_Rain)
        {
            LubePulse();
            PersistenceData.TravelDistance_highRes_mm = 0;
        }
        break;
    case sysStat_Purge:
        if (globals.purgePulses > 0)
        {
            if (lubePulseTimestamp + LUBE_PULSE_PAUSE_MS < millis())
            {
                LubePulse();
                globals.purgePulses--;
            }
        }
        else
        {
            globals.systemStatus = globals.resumeStatus;
        }
        break;
    case sysStat_Error:
    case sysStat_Shutdown:
    default:
        break;
    }

    switch (globals.systemStatus)
    {
    case sysStat_Normal:
        strcpy_P(globals.systemStatustxt, PSTR("Normal"));
        break;
    case sysStat_Purge:
        strcpy_P(globals.systemStatustxt, PSTR("Purge"));
        break;
    case sysStat_Rain:
        strcpy_P(globals.systemStatustxt, PSTR("Rain"));
        break;
    case sysStat_Startup:
        strcpy_P(globals.systemStatustxt, PSTR("Startup"));
        break;
    case sysStat_Error:
        strcpy_P(globals.systemStatustxt, PSTR("Error"));
        break;
    case sysStat_Shutdown:
        strcpy_P(globals.systemStatustxt, PSTR("Shutdown"));
        break;
    }

    // maintain Pin-State of Lube-Pump
    if (lubePulseTimestamp > millis())
        digitalWrite(GPIO_PUMP, HIGH);
    else
        digitalWrite(GPIO_PUMP, LOW);
}

void LubePulse()
{
    if (PersistenceData.tankRemain_µl > 0) // Only Lube if theres Oil remaining!
    {
        lubePulseTimestamp = millis() + LUBE_PULSE_LENGHT_MS;

        if (PersistenceData.tankRemain_µl < LubeConfig.amountPerDose_µl) // Prevent underrun and shiftover
            PersistenceData.tankRemain_µl = 0;
        else
            PersistenceData.tankRemain_µl = PersistenceData.tankRemain_µl - LubeConfig.amountPerDose_µl;
    }
}