closed_loop_fuel_cell.cpp

Go to the documentation of this file.

#include "pch.h"
 
#include "closed_loop_fuel_cell.h"
 
#if EFI_ENGINE_CONTROL
 
constexpr float integrator_dt = FAST_CALLBACK_PERIOD_MS * 0.001f;
 
void ClosedLoopFuelCellBase::update(float lambdaDeadband, bool ignoreErrorMagnitude)
{
    // Compute how far off target we are
    float lambdaError = getLambdaError();
 
    // If we're within the deadband, make no adjustment.
    if (std::abs(lambdaError) < lambdaDeadband) {
        return;
    }
 
    // Fixed magnitude - runs in constant adjustment rate mode
    if (ignoreErrorMagnitude) {
        if (lambdaError > 0) {
            lambdaError = 0.1f;
        } else {
            lambdaError = -0.1f;
        }
    }
 
    // Integrate
    float adjust = getIntegratorGain() * lambdaError * integrator_dt
                    + m_adjustment;
 
    // Clamp to bounds and save
    m_adjustment = clampF(getMinAdjustment(), adjust, getMaxAdjustment());
}
 
float ClosedLoopFuelCellBase::getAdjustment() const {
    return 1.0f + m_adjustment;
}
 
float ClosedLoopFuelCellImpl::getLambdaError() const {
    auto lambda = Sensor::get(m_lambdaSensor);
 
    // Failed sensor -> no error
    if (!lambda) {
        return 0;
    }
 
    return lambda.Value - engine->fuelComputer.targetLambda;
}
 
#define MAX_ADJ (0.25f)
 
float ClosedLoopFuelCellImpl::getMaxAdjustment() const {
    if (!m_config) {
        // If no config, disallow adjustment.
        return 0;
    }
 
    float raw = 0.01 * m_config->maxAdd;
    // Don't allow maximum less than 0, or more than maximum adjustment
    return clampF(0, raw, MAX_ADJ);
}
 
float ClosedLoopFuelCellImpl::getMinAdjustment() const {
    if (!m_config) {
        // If no config, disallow adjustment.
        return 0;
    }
 
    float raw = -0.01f * m_config->maxRemove;
    // Don't allow minimum more than 0, or more than maximum adjustment
    return clampF(-MAX_ADJ, raw, 0);
}
 
float ClosedLoopFuelCellImpl::getIntegratorGain() const {
    if (!m_config) {
        // If no config, disallow adjustment.
        return 0.0f;
    }
 
    // Clamp to reasonable limits - 100ms to 100s
    float timeConstant = clampF(0.1f, m_config->timeConstant, 100);
 
    return 1 / timeConstant;
}
 
#endif // EFI_ENGINE_CONTROL