mirror of https://github.com/FOME-Tech/fome-fw.git
90 lines
2.0 KiB
C
90 lines
2.0 KiB
C
|
/**
|
||
|
|
* @file error_handling.c
|
||
|
|
*
|
||
|
|
* @date Apr 1, 2014
|
||
|
|
* @author Andrey Belomutskiy, (c) 2012-2014
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "main.h"
|
||
|
|
#include "error_handling.h"
|
||
|
|
#include "io_pins.h"
|
||
|
|
#include "memstreams.h"
|
||
|
|
|
||
|
|
#if EFI_HD44780_LCD
|
||
|
|
#include "lcd_HD44780.h"
|
||
|
|
#endif /* EFI_HD44780_LCD */
|
||
|
|
|
||
|
|
static time_t timeOfPreviousWarning = -10;
|
||
|
|
static Logging logger;
|
||
|
|
|
||
|
|
#define WARNING_PREFIX "WARNING: "
|
||
|
|
|
||
|
|
extern int warningEnabled;
|
||
|
|
extern int 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
|
||
|
|
dbg_panic_msg = msg;
|
||
|
|
#endif /* CH_DBG_SYSTEM_STATE_CHECK */
|
||
|
|
|
||
|
|
/**
|
||
|
|
* low-level function is used here to reduce stack usage
|
||
|
|
*/
|
||
|
|
palWritePad(LED_ERROR_PORT, LED_ERROR_PIN, 1);
|
||
|
|
#if EFI_HD44780_LCD
|
||
|
|
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 MemoryStream warningStream;
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @returns TRUE in case there are too many warnings
|
||
|
|
*/
|
||
|
|
int warning(obd_code_e code, const char *fmt, ...) {
|
||
|
|
int now = getTimeNowSeconds();
|
||
|
|
if (absI(now - timeOfPreviousWarning) < 10 || !warningEnabled)
|
||
|
|
return TRUE; // we just had another warning, let's not spam
|
||
|
|
timeOfPreviousWarning = now;
|
||
|
|
|
||
|
|
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;
|
||
|
|
}
|
||
|
|
|
||
|
|
void initErrorHandling(void) {
|
||
|
|
initLogging(&logger, "error handling");
|
||
|
|
msObjectInit(&warningStream, (uint8_t *)warningBuffer, WARNING_BUFFER_SIZE, 0);
|
||
|
|
}
|