mirror of https://github.com/FOME-Tech/fome-fw.git
56 lines
1.4 KiB
C++
56 lines
1.4 KiB
C++
/*
|
|
* @file tachometer.cpp
|
|
* @brief This is about driving external analog tachometers
|
|
*
|
|
* This implementation produces one pulse per engine cycle
|
|
*
|
|
* todo: these is a bit of duplication with dizzySparkOutputPin
|
|
*
|
|
* @date Aug 18, 2015
|
|
* @author Andrey Belomutskiy, (c) 2012-2020
|
|
*/
|
|
|
|
#include "tachometer.h"
|
|
#include "trigger_central.h"
|
|
|
|
#if !EFI_UNIT_TEST
|
|
|
|
EXTERN_ENGINE;
|
|
|
|
static scheduling_s tachTurnSignalOff;
|
|
|
|
static void turnTachPinLow(void *) {
|
|
enginePins.tachOut.setLow();
|
|
}
|
|
|
|
static void tachSignalCallback(trigger_event_e ckpSignalType,
|
|
uint32_t index, efitick_t edgeTimestamp DECLARE_ENGINE_PARAMETER_SUFFIX) {
|
|
UNUSED(ckpSignalType);
|
|
if (index != (uint32_t)engineConfiguration->tachPulseTriggerIndex) {
|
|
return;
|
|
}
|
|
enginePins.tachOut.setHigh();
|
|
float durationMs;
|
|
if (engineConfiguration->tachPulseDurationAsDutyCycle) {
|
|
// todo: implement tachPulseDurationAsDutyCycle
|
|
durationMs = engineConfiguration->tachPulseDuractionMs;
|
|
} else {
|
|
durationMs = engineConfiguration->tachPulseDuractionMs;
|
|
}
|
|
engine->executor.scheduleForLater(&tachTurnSignalOff, (int)MS2US(durationMs), &turnTachPinLow);
|
|
}
|
|
|
|
void initTachometer(void) {
|
|
if (CONFIG(tachOutputPin) == GPIO_UNASSIGNED) {
|
|
return;
|
|
}
|
|
|
|
enginePins.tachOut.initPin("analog tach output", CONFIG(tachOutputPin), &CONFIG(tachOutputPinMode));
|
|
|
|
#if EFI_SHAFT_POSITION_INPUT
|
|
addTriggerEventListener(tachSignalCallback, "tach", engine);
|
|
#endif /* EFI_SHAFT_POSITION_INPUT */
|
|
}
|
|
|
|
#endif /* EFI_UNIT_TEST */
|