2020-11-28 03:04:04 -08:00
|
|
|
#include "lambda_conversion.h"
|
2020-11-01 01:17:13 -08:00
|
|
|
#include "sampling.h"
|
|
|
|
|
|
|
|
static float GetPhi(float pumpCurrent)
|
|
|
|
{
|
2020-12-12 00:29:48 -08:00
|
|
|
// Maximum lambda ~2
|
|
|
|
if (pumpCurrent > 1.11f)
|
|
|
|
{
|
|
|
|
return 0.5f;
|
|
|
|
}
|
|
|
|
|
2020-12-13 14:49:58 -08:00
|
|
|
// Minimum lambda ~0.5
|
|
|
|
if (pumpCurrent < -3.5f)
|
2020-12-12 00:29:48 -08:00
|
|
|
{
|
2020-12-13 14:49:58 -08:00
|
|
|
return 1 / 0.5f;
|
2020-12-12 00:29:48 -08:00
|
|
|
}
|
|
|
|
|
2020-11-01 01:17:13 -08:00
|
|
|
// This estimation is accurate within 0.5% from 0.8 to 1.0, and 0.01% from 1 to 1.2 lambda when compared to the lookup table in the Bosch datasheet
|
2020-11-01 01:26:02 -08:00
|
|
|
// This error is less than half of the claimed accuracy of the sensor itself
|
2020-11-02 01:28:30 -08:00
|
|
|
float gain = pumpCurrent < 0 ? -0.28299f : -0.44817f;
|
2020-11-01 01:17:13 -08:00
|
|
|
|
|
|
|
return gain * pumpCurrent + 0.99559f;
|
|
|
|
}
|
|
|
|
|
|
|
|
float GetLambda()
|
|
|
|
{
|
|
|
|
float pumpCurrent = GetPumpNominalCurrent();
|
|
|
|
|
|
|
|
// Lambda is reciprocal of phi
|
|
|
|
return 1 / GetPhi(pumpCurrent);
|
|
|
|
}
|