/**
 * @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::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);

	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

	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) {
	eventCounter++;
	float frequency = 1 / m_edgeTimer.getElapsedSecondsAndReset(nowNt);

	frequency = m_filter.filter(frequency);

	postRawValue(frequency, nowNt);
}