mirror of https://github.com/rusefi/rusefi-1.git
106 lines
2.6 KiB
C++
106 lines
2.6 KiB
C++
/*
|
|
* @file engine_controller_misc.cpp
|
|
*
|
|
* @date Mar 22, 2020
|
|
* @author Andrey Belomutskiy, (c) 2012-2020
|
|
*/
|
|
|
|
#include "pch.h"
|
|
#include "os_access.h"
|
|
|
|
extern ButtonDebounce startStopButtonDebounce;
|
|
|
|
static uint8_t nextThreadId = 0;
|
|
void threadInitHook(void* vtp) {
|
|
// No lock required, this is already under lock
|
|
auto tp = reinterpret_cast<thread_t*>(vtp);
|
|
tp->threadId = ++nextThreadId;
|
|
}
|
|
|
|
#if ENABLE_PERF_TRACE
|
|
void irqEnterHook() {
|
|
perfEventBegin(PE::ISR);
|
|
}
|
|
|
|
void irqExitHook() {
|
|
perfEventEnd(PE::ISR);
|
|
}
|
|
|
|
void contextSwitchHook() {
|
|
perfEventInstantGlobal(PE::ContextSwitch);
|
|
}
|
|
|
|
#else
|
|
void irqEnterHook() {}
|
|
void irqExitHook() {}
|
|
void contextSwitchHook() {}
|
|
#endif /* ENABLE_PERF_TRACE */
|
|
|
|
#if !EFI_UNIT_TEST
|
|
/**
|
|
* 64-bit result would not overflow, but that's complex stuff for our 32-bit MCU
|
|
*/
|
|
efitimeus_t getTimeNowUs() {
|
|
ScopePerf perf(PE::GetTimeNowUs);
|
|
return NT2US(getTimeNowNt());
|
|
}
|
|
|
|
|
|
static WrapAround62 timeNt;
|
|
|
|
efitick_t getTimeNowNt() {
|
|
return timeNt.update(getTimeNowLowerNt());
|
|
}
|
|
#endif /* !EFI_UNIT_TEST */
|
|
|
|
static void onStartStopButtonToggle() {
|
|
engine->startStopStateToggleCounter++;
|
|
|
|
if (engine->rpmCalculator.isStopped()) {
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(1);
|
|
if (!wasStarterEngaged) {
|
|
engine->startStopStateLastPushTime = getTimeNowNt();
|
|
efiPrintf("Let's crank this engine for up to %d seconds via %s!",
|
|
engineConfiguration->startCrankingDuration,
|
|
hwPortname(engineConfiguration->starterControlPin));
|
|
}
|
|
} else if (engine->rpmCalculator.isRunning()) {
|
|
efiPrintf("Let's stop this engine!");
|
|
doScheduleStopEngine();
|
|
}
|
|
}
|
|
|
|
|
|
void slowStartStopButtonCallback() {
|
|
bool startStopState = startStopButtonDebounce.readPinEvent();
|
|
|
|
if (startStopState && !engine->startStopState) {
|
|
// we are here on transition from 0 to 1
|
|
onStartStopButtonToggle();
|
|
}
|
|
engine->startStopState = startStopState;
|
|
|
|
if (engine->startStopStateLastPushTime == 0) {
|
|
// nothing is going on with startStop button
|
|
return;
|
|
}
|
|
|
|
// todo: should this be simply FSIO?
|
|
if (engine->rpmCalculator.isRunning()) {
|
|
// turn starter off once engine is running
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(0);
|
|
if (wasStarterEngaged) {
|
|
efiPrintf("Engine runs we can disengage the starter");
|
|
engine->startStopStateLastPushTime = 0;
|
|
}
|
|
}
|
|
|
|
if (getTimeNowNt() - engine->startStopStateLastPushTime > NT_PER_SECOND * engineConfiguration->startCrankingDuration) {
|
|
bool wasStarterEngaged = enginePins.starterControl.getAndSet(0);
|
|
if (wasStarterEngaged) {
|
|
efiPrintf("Cranking timeout %d seconds", engineConfiguration->startCrankingDuration);
|
|
engine->startStopStateLastPushTime = 0;
|
|
}
|
|
}
|
|
}
|