mirror of https://github.com/rusefi/wideband.git
37 lines
815 B
C++
37 lines
815 B
C++
|
#include "pump_control.h"
|
||
|
|
#include "wideband_config.h"
|
||
|
|
#include "heater_control.h"
|
||
|
|
#include "sampling.h"
|
||
|
|
#include "pump_dac.h"
|
||
|
|
#include "pid.h"
|
||
|
|
|
||
|
|
#include "ch.h"
|
||
|
|
|
||
|
|
static Pid pumpPid(0, 0.01f, 2);
|
||
|
|
|
||
|
|
static THD_WORKING_AREA(waPumpThread, 256);
|
||
|
|
static void PumpThread(void*)
|
||
|
|
{
|
||
|
|
while(true)
|
||
|
|
{
|
||
|
|
// Only actuate pump when running closed loop!
|
||
|
|
if (IsRunningClosedLoop())
|
||
|
|
{
|
||
|
|
float nernstVoltage = GetNernstDc();
|
||
|
|
|
||
|
|
float result = pumpPid.GetOutput(NERNST_TARGET, nernstVoltage);
|
||
|
|
|
||
|
|
// result is in mA
|
||
|
|
SetPumpCurrentTarget(result / 1000.0f);
|
||
|
|
|
||
|
|
// Run at 500hz
|
||
|
|
chThdSleepMilliseconds(2);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void StartPumpControl()
|
||
|
|
{
|
||
|
|
chThdCreateStatic(waPumpThread, sizeof(waPumpThread), NORMALPRIO + 4, PumpThread, nullptr);
|
||
|
|
}
|