65 lines
1.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
extern void LED_Process(tSystem_Status newStatus = sysStat_NOP);
uint32_t lubePulseTimestamp = 0;
2022-01-09 20:51:16 +01:00
void RunLubeApp(volatile uint32_t *wheelPulseCounter)
2022-01-07 23:36:02 +01:00
{
uint32_t LubeDistance = 0;
2022-01-10 00:55:04 +01:00
// Calculate traveled Distance in mm
2022-01-10 00:55:04 +01:00
TravelDistance_highRes += (*wheelPulseCounter * (LubeConfig.DistancePerRevolution_mm / LubeConfig.PulsePerRevolution));
*wheelPulseCounter = 0;
// check if we have to Lube!
switch (globals.systemStatus)
{
2022-01-10 00:55:04 +01:00
case sysStat_Startup:
globals.systemStatus = sysStat_Normal;
globals.resumeStatus = sysStat_Normal;
break;
case sysStat_Normal:
2022-01-10 00:55:04 +01:00
if (TravelDistance_highRes > LubeConfig.DistancePerLube_Default)
{
LubePulse();
TravelDistance_highRes = 0;
}
break;
2022-01-10 00:55:04 +01:00
case sysStat_Rain:
2022-01-10 00:55:04 +01:00
if (TravelDistance_highRes > LubeConfig.DistancePerLube_Rain)
{
LubePulse();
TravelDistance_highRes = 0;
}
break;
case sysStat_Purge:
if (globals.purgePulses > 0)
{
if (lubePulseTimestamp + LUBE_PULSE_LENGHT_MS + LUBE_PULSE_PAUSE_MS < millis())
{
LubePulse();
globals.purgePulses--;
}
}
else
{
globals.systemStatus = globals.resumeStatus;
}
break;
}
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()
{
lubePulseTimestamp = millis() + LUBE_PULSE_LENGHT_MS;
LubeConfig.tankRemain_µl = LubeConfig.tankRemain_µl - LubeConfig.amountPerDose_µl;
}