103 lines
3.3 KiB
C++
103 lines
3.3 KiB
C++
#include "pch.h"
|
|
|
|
/**
|
|
* See test_start_stop.cpp
|
|
*/
|
|
|
|
#include "start_stop.h"
|
|
#include "ignition_controller.h"
|
|
|
|
#if EFI_SHAFT_POSITION_INPUT
|
|
void initStartStopButton() {
|
|
/* startCrankingDuration is efitimesec_t, so we need to multiply it by 1000 to get milliseconds*/
|
|
engine->startStopState.startStopButtonDebounce.init((engineConfiguration->startCrankingDuration*1000),
|
|
engineConfiguration->startStopButtonPin,
|
|
engineConfiguration->startStopButtonMode,
|
|
engineConfiguration->startRequestPinInverted);
|
|
}
|
|
|
|
void doStartCranking() {
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(1);
|
|
if (!wasStarterEngaged) {
|
|
engine->startStopState.startStopStateLastPush.reset();
|
|
efiPrintf("Let's crank this engine for up to %d seconds via %s!",
|
|
engineConfiguration->startCrankingDuration,
|
|
hwPortname(engineConfiguration->starterControlPin));
|
|
}
|
|
}
|
|
|
|
static void onStartStopButtonToggle() {
|
|
engine->engineState.startStopStateToggleCounter++;
|
|
|
|
if (engine->rpmCalculator.isStopped()) {
|
|
doStartCranking();
|
|
} else if (engine->rpmCalculator.isRunning()) {
|
|
doScheduleStopEngine();
|
|
}
|
|
}
|
|
|
|
static void disengageStarterIfNeeded() {
|
|
if (engine->rpmCalculator.isRunning()) {
|
|
// turn starter off once engine is now running!
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(0);
|
|
if (wasStarterEngaged) {
|
|
efiPrintf("Engine runs we can disengage the starter");
|
|
}
|
|
} else {
|
|
if (engine->startStopState.startStopStateLastPush.hasElapsedSec(engineConfiguration->startCrankingDuration)) {
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(0);
|
|
if (wasStarterEngaged) {
|
|
efiPrintf("Cranking timeout %d seconds", engineConfiguration->startCrankingDuration);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
PUBLIC_API_WEAK bool isCrankingSuppressed() {
|
|
return false;
|
|
}
|
|
|
|
void slowStartStopButtonCallback() {
|
|
if (!isIgnVoltage()) {
|
|
// nothing to crank if we are powered only via USB
|
|
engine->startStopState.timeSinceIgnitionPower.reset();
|
|
return;
|
|
} else if (engine->startStopState.isFirstTime) {
|
|
// initialize when first time with proper power
|
|
engine->startStopState.timeSinceIgnitionPower.reset();
|
|
engine->startStopState.isFirstTime = false;
|
|
}
|
|
|
|
if (engine->startStopState.timeSinceIgnitionPower.getElapsedUs() < MS2US(engineConfiguration->startButtonSuppressOnStartUpMs)) {
|
|
// where are odd cases of start button combined with ECU power source button we do not want to crank right on start
|
|
return;
|
|
}
|
|
|
|
if (engine->rpmCalculator.isStopped()) {
|
|
if (engineConfiguration->requireFootOnBrakeToCrank && !engine->brakePedalSwitchedState) {
|
|
return;
|
|
}
|
|
|
|
if (isCrankingSuppressed()) {
|
|
return;
|
|
}
|
|
}
|
|
|
|
bool startStopState = engine->startStopState.startStopButtonDebounce.readPinEvent();
|
|
|
|
if (startStopState && !engine->engineState.startStopState) {
|
|
// we are here on transition from 0 to 1
|
|
onStartStopButtonToggle();
|
|
}
|
|
// todo: we shall extract start_stop.txt from engine_state.txt
|
|
engine->engineState.startStopState = startStopState;
|
|
engine->engineState.startStopPhysicalState = engine->startStopState.startStopButtonDebounce.getPhysicalState();
|
|
|
|
bool isStarterEngaged = enginePins.starterControl.getLogicValue();
|
|
|
|
if (isStarterEngaged) {
|
|
disengageStarterIfNeeded();
|
|
}
|
|
}
|
|
#endif // EFI_SHAFT_POSITION_INPUT
|