mirror of https://github.com/rusefi/rusefi-1.git
44 lines
932 B
C++
44 lines
932 B
C++
/**
|
|
* @file frequency_sensor.cpp
|
|
*/
|
|
|
|
#include "pch.h"
|
|
|
|
#include "frequency_sensor.h"
|
|
|
|
#include "digital_input_exti.h"
|
|
|
|
// 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);
|
|
}
|
|
|
|
void FrequencySensor::init(brain_pin_e pin) {
|
|
m_pin = pin;
|
|
|
|
#if EFI_PROD_CODE
|
|
// todo: refactor https://github.com/rusefi/rusefi/issues/2123
|
|
efiExtiEnablePin(getSensorName(), pin,
|
|
PAL_EVENT_MODE_FALLING_EDGE,
|
|
freqSensorExtiCallback, reinterpret_cast<void*>(this));
|
|
#endif // EFI_PROD_CODE
|
|
}
|
|
|
|
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) {
|
|
float frequency = 1 / m_edgeTimer.getElapsedSecondsAndReset(nowNt);
|
|
|
|
postRawValue(frequency, nowNt);
|
|
}
|