mirror of https://github.com/FOME-Tech/fome-fw.git
31 lines
787 B
C++
31 lines
787 B
C++
/*
|
|
* @file init_aux_speed_sensor.cpp
|
|
*
|
|
*/
|
|
|
|
#include "pch.h"
|
|
#include "init.h"
|
|
#include "frequency_sensor.h"
|
|
|
|
static FrequencySensor auxSpeed1(SensorType::AuxSpeed1, MS2NT(500));
|
|
static FrequencySensor auxSpeed2(SensorType::AuxSpeed2, MS2NT(500));
|
|
|
|
static class : public SensorConverter {
|
|
public:
|
|
SensorResult convert(float frequency) const override {
|
|
return frequency;
|
|
}
|
|
} converter;
|
|
|
|
|
|
void initAuxSpeedSensors() {
|
|
auxSpeed1.useBiQuad = engineConfiguration->useBiQuadOnAuxSpeedSensors;
|
|
auxSpeed1.initIfValid(engineConfiguration->auxSpeedSensorInputPin[0], converter, engineConfiguration->auxFrequencyFilter);
|
|
auxSpeed2.initIfValid(engineConfiguration->auxSpeedSensorInputPin[1], converter, 0.05f);
|
|
}
|
|
|
|
void deinitAuxSpeedSensors() {
|
|
auxSpeed1.deInit();
|
|
auxSpeed2.deInit();
|
|
}
|