frequency_sensor.cpp

Go to the documentation of this file.

/**
 * @file frequency_sensor.cpp
 */
 
#include "pch.h"
 
#include "frequency_sensor.h"
 
#include "digital_input_exti.h"
 
#if EFI_PROD_CODE
// Callback adapter since we can't pass a member function to a callback
static void freqSensorExtiCallback(void* arg, efitick_t nowNt) {
    reinterpret_cast<FrequencySensor*>(arg)->onEdge(nowNt);
}
#endif // EFI_PROD_CODE
 
void FrequencySensor::initIfValid(brain_pin_e pin, SensorConverter &converter, float filterParameter) {
    if (!isBrainPinValid(pin)) {
        return;
    }
 
    // Filter parameter greater than or equal to 0.5 impossible as it causes filter instability, clamp
    // far under that value.
    if (filterParameter > 0.35f) {
        filterParameter = 0.35f;
    }
 
    m_filter.configureLowpass(1, filterParameter);
 
    setFunction(converter);
 
#if EFI_PROD_CODE
    if (efiExtiEnablePin(getSensorName(), pin, PAL_EVENT_MODE_FALLING_EDGE,
            freqSensorExtiCallback, reinterpret_cast<void*>(this)) < 0) {
        return;
    }
#endif // EFI_PROD_CODE
 
    m_pin = pin;
 
    Register();
}
 
void FrequencySensor::deInit() {
    if (!isBrainPinValid(m_pin)) {
        return;
    }
 
#if EFI_PROD_CODE
    efiExtiDisablePin(m_pin);
#endif
 
    m_pin = Gpio::Unassigned;
}
 
void FrequencySensor::onEdge(efitick_t nowNt) {
    // diagnostics
    eventCounter++;
    float frequency = 1 / m_edgeTimer.getElapsedSecondsAndReset(nowNt);
 
    if (useBiQuad) {
        frequency = m_filter.filter(frequency);
    }
 
    postRawValue(frequency, nowNt);
}