mirror of https://github.com/rusefi/rusefi-1.git
162 lines
3.6 KiB
C++
162 lines
3.6 KiB
C++
/**
|
|
* @file error_handling.cpp
|
|
*
|
|
* @date Apr 1, 2014
|
|
* @author Andrey Belomutskiy, (c) 2012-2016
|
|
*/
|
|
|
|
#include "main.h"
|
|
#include "error_handling.h"
|
|
#include "io_pins.h"
|
|
#include "memstreams.h"
|
|
#include "efilib2.h"
|
|
#include "engine.h"
|
|
//todo: move into simulator global
|
|
#include <chprintf.h>
|
|
|
|
#if EFI_HD44780_LCD || defined(__DOXYGEN__)
|
|
#include "lcd_HD44780.h"
|
|
#endif /* EFI_HD44780_LCD */
|
|
|
|
static LoggingWithStorage logger("error handling");
|
|
|
|
EXTERN_ENGINE;
|
|
|
|
#define WARNING_PREFIX "WARNING: "
|
|
|
|
extern int warningEnabled;
|
|
extern bool main_loop_started;
|
|
|
|
const char *dbg_panic_file;
|
|
int dbg_panic_line;
|
|
|
|
void chDbgPanic3(const char *msg, const char * file, int line) {
|
|
if (hasFatalError())
|
|
return;
|
|
dbg_panic_file = file;
|
|
dbg_panic_line = line;
|
|
#if CH_DBG_SYSTEM_STATE_CHECK || defined(__DOXYGEN__)
|
|
dbg_panic_msg = msg;
|
|
#endif /* CH_DBG_SYSTEM_STATE_CHECK */
|
|
|
|
#if EFI_PROD_CODE || defined(__DOXYGEN__)
|
|
ON_FATAL_ERROR();
|
|
#else
|
|
printf("chDbgPanic3 %s %s%d", msg, file, line);
|
|
exit(-1);
|
|
#endif
|
|
|
|
#if EFI_HD44780_LCD || defined(__DOXYGEN__)
|
|
lcdShowFatalMessage((char *) msg);
|
|
#endif /* EFI_HD44780_LCD */
|
|
|
|
if (!main_loop_started) {
|
|
print("fatal %s %s:%d\r\n", msg, file, line);
|
|
chThdSleepSeconds(1);
|
|
chSysHalt();
|
|
}
|
|
}
|
|
|
|
#define WARNING_BUFFER_SIZE 80
|
|
static char warningBuffer[WARNING_BUFFER_SIZE];
|
|
static bool isWarningStreamInitialized = false;
|
|
static MemoryStream warningStream;
|
|
|
|
bool isWarningNow(efitimesec_t now) {
|
|
return absI(now - engine->engineState.timeOfPreviousWarning) < engineConfiguration->warningPeriod;
|
|
}
|
|
|
|
/**
|
|
* OBD_PCM_Processor_Fault is the general error code for now
|
|
*
|
|
* @returns TRUE in case there are too many warnings
|
|
*/
|
|
int warning(obd_code_e code, const char *fmt, ...) {
|
|
efiAssert(isWarningStreamInitialized, "warn stream not initialized", false);
|
|
UNUSED(code);
|
|
|
|
efitimesec_t now = getTimeNowSeconds();
|
|
if (isWarningNow(now) || !warningEnabled)
|
|
return true; // we just had another warning, let's not spam
|
|
engine->engineState.timeOfPreviousWarning = now;
|
|
|
|
engine->engineState.warningCounter++;
|
|
engine->engineState.lastErrorCode = code;
|
|
|
|
resetLogging(&logger); // todo: is 'reset' really needed here?
|
|
appendMsgPrefix(&logger);
|
|
|
|
va_list ap;
|
|
va_start(ap, fmt);
|
|
append(&logger, WARNING_PREFIX);
|
|
warningStream.eos = 0; // reset
|
|
chvprintf((BaseSequentialStream *) &warningStream, fmt, ap);
|
|
warningStream.buffer[warningStream.eos] = 0;
|
|
va_end(ap);
|
|
|
|
append(&logger, warningBuffer);
|
|
append(&logger, DELIMETER);
|
|
scheduleLogging(&logger);
|
|
|
|
return FALSE;
|
|
}
|
|
|
|
char *getWarninig(void) {
|
|
return warningBuffer;
|
|
}
|
|
|
|
uint32_t lastLockTime;
|
|
uint32_t maxLockTime = 0;
|
|
|
|
// todo: move this field to trigger_central?
|
|
bool isInsideTriggerHandler = false;
|
|
|
|
void onLockHook(void) {
|
|
lastLockTime = GET_TIMESTAMP();
|
|
}
|
|
|
|
void onUnlockHook(void) {
|
|
uint32_t t = GET_TIMESTAMP() - lastLockTime;
|
|
if (t > maxLockTime) {
|
|
maxLockTime = t;
|
|
}
|
|
// if (t > 2800) {
|
|
// // un-comment this if you want a nice stop for a breakpoint
|
|
// maxLockTime = t + 1;
|
|
// }
|
|
}
|
|
|
|
void initErrorHandling(void) {
|
|
msObjectInit(&warningStream, (uint8_t *) warningBuffer, WARNING_BUFFER_SIZE, 0);
|
|
isWarningStreamInitialized = true;
|
|
}
|
|
|
|
//todo: move into simulator global
|
|
typedef VTList virtual_timers_list_t;
|
|
|
|
extern virtual_timers_list_t vtlist;
|
|
extern bool main_loop_started;
|
|
|
|
int getVtSizeEstimate(void) {
|
|
virtual_timer_t *first = vtlist.vt_next;
|
|
virtual_timer_t *cur = first->vt_next;
|
|
int c = 0;
|
|
while (c++ < 20 && cur != first) {
|
|
cur = cur->vt_next;
|
|
}
|
|
return c;
|
|
}
|
|
|
|
int globalVt;
|
|
|
|
int allReady = 0;
|
|
void assertVtList(void) {
|
|
if (!main_loop_started)
|
|
return;
|
|
globalVt = getVtSizeEstimate();
|
|
//efiAssertVoid(globalVt > 3, "VT list?");
|
|
if(globalVt <=3 ) {
|
|
allReady++;
|
|
}
|
|
}
|