mirror of https://github.com/rusefi/rusefi-1.git
155 lines
4.5 KiB
C++
155 lines
4.5 KiB
C++
/**
|
|
* @file microsecond_timer.cpp
|
|
*
|
|
* Here we have a 1MHz timer dedicated to event scheduling. We are using one of the 32-bit timers here,
|
|
* so this timer can schedule events up to 4B/100M ~ 4000 seconds ~ 1 hour from current time.
|
|
*
|
|
* GPT5 timer clock: 84000000Hz
|
|
* If only it was a better multiplier of 2 (84000000 = 328125 * 256)
|
|
*
|
|
* @date Apr 14, 2014
|
|
* @author Andrey Belomutskiy, (c) 2012-2018
|
|
*/
|
|
|
|
#include "global.h"
|
|
#include "microsecond_timer.h"
|
|
#include "scheduler.h"
|
|
#include "rfiutil.h"
|
|
|
|
// https://my.st.com/public/STe2ecommunities/mcu/Lists/cortex_mx_stm32/Flat.aspx?RootFolder=https%3a%2f%2fmy.st.com%2fpublic%2fSTe2ecommunities%2fmcu%2fLists%2fcortex_mx_stm32%2fInterrupt%20on%20CEN%20bit%20setting%20in%20TIM7&FolderCTID=0x01200200770978C69A1141439FE559EB459D7580009C4E14902C3CDE46A77F0FFD06506F5B¤tviews=474
|
|
|
|
#if EFI_PROD_CODE && HAL_USE_GPT
|
|
|
|
#include "periodic_controller.h"
|
|
|
|
/**
|
|
* Maximum duration of complete timer callback, all pending events together
|
|
* See also 'maxEventCallbackDuration' for maximum duration of one event
|
|
*/
|
|
uint32_t maxPrecisionCallbackDuration = 0;
|
|
|
|
// must be one of 32 bit times
|
|
#ifndef GPTDEVICE
|
|
#define GPTDEVICE GPTD5
|
|
#endif /* GPTDEVICE */
|
|
|
|
static volatile efitick_t lastSetTimerTimeNt;
|
|
static int lastSetTimerValue;
|
|
static volatile bool isTimerPending = FALSE;
|
|
|
|
static volatile int timerCallbackCounter = 0;
|
|
static volatile int timerRestartCounter = 0;
|
|
|
|
schfunc_t globalTimerCallback;
|
|
|
|
static const char * msg;
|
|
|
|
static char buff[32];
|
|
|
|
static int timerFreezeCounter = 0;
|
|
static volatile int setHwTimerCounter = 0;
|
|
static volatile bool hwStarted = false;
|
|
|
|
extern bool hasFirmwareErrorFlag;
|
|
|
|
/**
|
|
* sets the alarm to the specified number of microseconds from now.
|
|
* This function should be invoked under kernel lock which would disable interrupts.
|
|
*/
|
|
void setHardwareUsTimer(int32_t timeUs) {
|
|
efiAssertVoid(OBD_PCM_Processor_Fault, hwStarted, "HW.started");
|
|
setHwTimerCounter++;
|
|
/**
|
|
* #259 BUG error: not positive timeUs
|
|
* Once in a while we night get an interrupt where we do not expect it
|
|
*/
|
|
if (timeUs <= 0) {
|
|
timerFreezeCounter++;
|
|
warning(CUSTOM_OBD_LOCAL_FREEZE, "local freeze cnt=%d", timerFreezeCounter);
|
|
}
|
|
if (timeUs < 2)
|
|
timeUs = 2; // for some reason '1' does not really work
|
|
efiAssertVoid(CUSTOM_ERR_6681, timeUs > 0, "not positive timeUs");
|
|
if (timeUs >= 10 * US_PER_SECOND) {
|
|
firmwareError(CUSTOM_ERR_TIMER_OVERFLOW, "setHardwareUsTimer() too long: %d", timeUs);
|
|
return;
|
|
}
|
|
|
|
if (GPTDEVICE.state == GPT_ONESHOT) {
|
|
gptStopTimerI(&GPTDEVICE);
|
|
}
|
|
if (GPTDEVICE.state != GPT_READY) {
|
|
firmwareError(CUSTOM_HW_TIMER, "HW timer state %d/%d", GPTDEVICE.state, setHwTimerCounter);
|
|
return;
|
|
}
|
|
if (hasFirmwareError())
|
|
return;
|
|
gptStartOneShotI(&GPTDEVICE, timeUs);
|
|
|
|
lastSetTimerTimeNt = getTimeNowNt();
|
|
lastSetTimerValue = timeUs;
|
|
isTimerPending = TRUE;
|
|
timerRestartCounter++;
|
|
}
|
|
|
|
static void hwTimerCallback(GPTDriver *gptp) {
|
|
(void)gptp;
|
|
timerCallbackCounter++;
|
|
if (globalTimerCallback == NULL) {
|
|
firmwareError(CUSTOM_ERR_NULL_TIMER_CALLBACK, "NULL globalTimerCallback");
|
|
return;
|
|
}
|
|
isTimerPending = false;
|
|
|
|
uint32_t before = getTimeNowLowerNt();
|
|
globalTimerCallback(NULL);
|
|
uint32_t precisionCallbackDuration = getTimeNowLowerNt() - before;
|
|
if (precisionCallbackDuration > maxPrecisionCallbackDuration) {
|
|
maxPrecisionCallbackDuration = precisionCallbackDuration;
|
|
}
|
|
}
|
|
|
|
class MicrosecondTimerWatchdogController : public PeriodicController<UTILITY_THREAD_STACK_SIZE>
|
|
{
|
|
public:
|
|
MicrosecondTimerWatchdogController()
|
|
: PeriodicController("timer watchdog", NORMALPRIO, 1.0f)
|
|
{
|
|
}
|
|
|
|
private:
|
|
void PeriodicTask(efitime_t nowNt) override
|
|
{
|
|
if (nowNt >= lastSetTimerTimeNt + 2 * CORE_CLOCK) {
|
|
strcpy(buff, "no_event");
|
|
itoa10(&buff[8], lastSetTimerValue);
|
|
firmwareError(CUSTOM_ERR_SCHEDULING_ERROR, buff);
|
|
return;
|
|
}
|
|
|
|
msg = isTimerPending ? "No_cb too long" : "Timer not awhile";
|
|
// 2 seconds of inactivity would not look right
|
|
efiAssertVoid(CUSTOM_ERR_6682, nowNt < lastSetTimerTimeNt + 2 * CORE_CLOCK, msg);
|
|
}
|
|
};
|
|
|
|
static MicrosecondTimerWatchdogController watchdogControllerInstance;
|
|
|
|
static constexpr GPTConfig gpt5cfg = { 1000000, /* 1 MHz timer clock.*/
|
|
hwTimerCallback, /* Timer callback.*/
|
|
0, 0 };
|
|
|
|
void initMicrosecondTimer(void) {
|
|
|
|
gptStart(&GPTDEVICE, &gpt5cfg);
|
|
efiAssertVoid(CUSTOM_ERR_TIMER_STATE, GPTDEVICE.state == GPT_READY, "hw state");
|
|
hwStarted = true;
|
|
|
|
lastSetTimerTimeNt = getTimeNowNt();
|
|
#if EFI_EMULATE_POSITION_SENSORS
|
|
watchdogControllerInstance.Start();
|
|
#endif /* EFI_ENGINE_EMULATOR */
|
|
}
|
|
|
|
#endif /* EFI_PROD_CODE */
|