Kettenoeler/Software/src/lubeapp.cpp

133 lines
3.7 KiB
C++
Raw Normal View History

2022-01-08 03:14:26 +01:00
#include "lubeapp.h"
2022-01-07 23:36:02 +01:00
2022-01-10 00:55:04 +01:00
uint32_t lubePulseTimestamp = 0;
2022-01-09 20:51:16 +01:00
void RunLubeApp(uint32_t add_milimeters)
2022-01-07 23:36:02 +01:00
{
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)
{
2022-01-10 00:55:04 +01:00
case sysStat_Startup:
2022-01-14 15:36:17 +01:00
if (millis() > STARTUP_DELAY)
{
globals.systemStatus = sysStat_Normal;
globals.resumeStatus = sysStat_Normal;
}
2022-01-10 00:55:04 +01:00
break;
case sysStat_Normal:
if (PersistenceData.TravelDistance_highRes_mm / 1000 > LubeConfig.DistancePerLube_Default)
2022-01-10 00:55:04 +01:00
{
LubePulse();
PersistenceData.TravelDistance_highRes_mm = 0;
2022-01-10 00:55:04 +01:00
}
break;
2022-01-10 00:55:04 +01:00
case sysStat_Rain:
if (PersistenceData.TravelDistance_highRes_mm / 1000 > LubeConfig.DistancePerLube_Rain)
2022-01-10 00:55:04 +01:00
{
LubePulse();
PersistenceData.TravelDistance_highRes_mm = 0;
2022-01-10 00:55:04 +01:00
}
break;
case sysStat_Purge:
if (globals.purgePulses > 0)
{
2022-01-12 00:52:27 +01:00
if (lubePulseTimestamp + LUBE_PULSE_PAUSE_MS < millis())
2022-01-10 00:55:04 +01:00
{
LubePulse();
globals.purgePulses--;
}
}
else
{
globals.systemStatus = globals.resumeStatus;
}
break;
2022-01-12 00:52:27 +01:00
case sysStat_Error:
case sysStat_Shutdown:
2022-01-12 00:52:27 +01:00
default:
break;
}
2022-01-14 15:36:17 +01:00
switch (globals.systemStatus)
{
case sysStat_Normal:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Normal"));
2022-01-14 15:36:17 +01:00
break;
case sysStat_Purge:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Purge"));
2022-01-14 15:36:17 +01:00
break;
case sysStat_Rain:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Rain"));
2022-01-14 15:36:17 +01:00
break;
case sysStat_Startup:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Startup"));
2022-01-14 15:36:17 +01:00
break;
case sysStat_Error:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Error"));
break;
case sysStat_Shutdown:
2022-08-19 00:10:42 +02:00
strcpy_P(globals.systemStatustxt, PSTR("Shutdown"));
break;
2022-01-14 15:36:17 +01:00
}
2022-01-10 00:55:04 +01:00
// maintain Pin-State of Lube-Pump
if (lubePulseTimestamp > millis())
digitalWrite(GPIO_PUMP, HIGH);
else
digitalWrite(GPIO_PUMP, LOW);
}
2022-01-10 00:55:04 +01:00
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;
}
2022-01-10 00:55:04 +01:00
}