init_lambda.cpp

Go to the documentation of this file.

#include "pch.h"
 
#include "init.h"
#include "adc_subscription.h"
#include "function_pointer_sensor.h"
#include "live_data.h"
 
struct GetAfrWrapper {
    float getLambda() {
        return getAfr(SensorType::Lambda1) / STOICH_RATIO;
    };
    float getLambda2() {
        return getAfr(SensorType::Lambda2) / STOICH_RATIO;
    }
};
 
static GetAfrWrapper afrWrapper;
 
static FunctionPointerSensor lambdaSensor(SensorType::Lambda1,
[]() {
    return afrWrapper.getLambda();
});
 
static FunctionPointerSensor lambdaSensor2(SensorType::Lambda2,
[]() {
    return afrWrapper.getLambda2();
});
 
#include "AemXSeriesLambda.h"
 
#if EFI_CAN_SUPPORT
static AemXSeriesWideband aem1(0, SensorType::Lambda1);
static AemXSeriesWideband aem2(1, SensorType::Lambda2);
#endif
 
template <>
const wideband_state_s* getLiveData(size_t idx) {
#if EFI_CAN_SUPPORT
    switch (idx) {
        case 0:
            aem1.refreshState();
            return &aem1;
        case 1:
            aem2.refreshState();
            return &aem2;
    }
#endif
 
    return nullptr;
}
 
void initLambda() {
    // first we register the smoothed sensors for the early return on the can wbo case
    smoothedLambda1Sensor.Register();
    smoothedLambda2Sensor.Register();
 
#if EFI_CAN_SUPPORT
    if (engineConfiguration->enableAemXSeries) {
        if (!engineConfiguration->canWriteEnabled || !engineConfiguration->canReadEnabled) {
            criticalError("CAN read and write are required to use CAN wideband.");
            return;
        }
 
        registerCanSensor(aem1);
        registerCanSensor(aem2);
 
        return;
    }
#endif
 
#if EFI_UNIT_TEST
  constexpr bool isUnitTest = true;
#else
  constexpr bool isUnitTest = false;
#endif
 
  // CANbus option is handled above, let's handle analog inputs conditionally to give Lua sensors a chance
  if (isAdcChannelValid(engineConfiguration->afr.hwChannel) || isUnitTest) {
      lambdaSensor.Register();
    }
    if (isAdcChannelValid(engineConfiguration->afr.hwChannel2) || isUnitTest) {
      lambdaSensor2.Register();
  }
}