mirror of
https://github.com/mudita/MuditaOS.git
synced 2026-07-04 13:17:08 -04:00
0079a845c7
* Logging from IRQ and hard fault handler * *logging from assert * assert instead of while(1) in hard fault handler * added log in _exit(); + no abort instead of assert in hardfaulthandler * disable scheduler in _exit()
276 lines
7.6 KiB
C++
276 lines
7.6 KiB
C++
//
|
|
// Created by mati on 08.05.19.
|
|
//
|
|
|
|
#include "../../log/log.hpp"
|
|
#include "../../log/segger/SEGGER_RTT.h"
|
|
#include <ticks.hpp>
|
|
extern "C" {
|
|
#include "FreeRTOS.h"
|
|
}
|
|
#include "semphr.h"
|
|
#include <assert.h>
|
|
#include <board.h>
|
|
#include <critical.hpp>
|
|
|
|
/*
|
|
* TODO: M.P
|
|
* Redictering log output to serial console in this form need be considered as quick&dirty solution.
|
|
* It should be refactored i.e serial terminal BSP created and used here instead of using RT1051's low-level routines directly.
|
|
*/
|
|
#if LOG_REDIRECT_TO_SERIAL == 1
|
|
#include "fsl_lpuart.h"
|
|
#endif
|
|
|
|
|
|
#define LOGGER_BUFFER_SIZE 4096
|
|
|
|
#define CONSOLE_ESCAPE_COLOR_BLACK "\x1b[30m"
|
|
#define CONSOLE_ESCAPE_COLOR_RED "\x1b[31m"
|
|
#define CONSOLE_ESCAPE_COLOR_GREEN "\x1b[32m"
|
|
#define CONSOLE_ESCAPE_COLOR_YELLOW "\x1b[33m"
|
|
#define CONSOLE_ESCAPE_COLOR_BLUE "\x1b[34m"
|
|
#define CONSOLE_ESCAPE_COLOR_MAGENTA "\x1b[35m"
|
|
#define CONSOLE_ESCAPE_COLOR_CYAN "\x1b[36m"
|
|
#define CONSOLE_ESCAPE_COLOR_WHITE "\x1b[37m"
|
|
#define CONSOLE_ESCAPE_COLOR_RESET "\x1b[0m"
|
|
|
|
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_BLACK "\x1b[40m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_RED "\x1b[41m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_GREEN "\x1b[42m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_YELLOW "\x1b[43m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_BLUE "\x1b[44m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_MAGENTA "\x1b[45m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_CYAN "\x1b[46m"
|
|
#define CONSOLE_ESCAPE_COLOR_BACKGROUND_WHITE "\x1b[47m"
|
|
|
|
const char *level_names[] = {
|
|
"TRACE", "DEBUG", "INFO", "WARN", "ERROR", "FATAL"
|
|
};
|
|
|
|
#if LOG_USE_COLOR == 1
|
|
static const char *level_colors[] = {
|
|
"\x1b[94m", "\x1b[36m", "\x1b[32m", "\x1b[33m", "\x1b[31m", "\x1b[35m"
|
|
};
|
|
#endif
|
|
|
|
struct Logger{
|
|
Logger( logger_level level = LOGTRACE ) : level{ level } {
|
|
|
|
lock = xSemaphoreCreateMutex();
|
|
|
|
assert(lock != NULL);
|
|
|
|
/* Acquire lock */
|
|
if(xSemaphoreTake(lock,100) != pdPASS){
|
|
return;
|
|
}
|
|
|
|
level = level;
|
|
|
|
/* Release lock */
|
|
xSemaphoreGive(lock);
|
|
|
|
}
|
|
|
|
bool logLock()
|
|
{
|
|
// if called from the ISR use DI/EI. In all other cases use semaphore.
|
|
if (SCB->ICSR & SCB_ICSR_VECTACTIVE_Msk)
|
|
{
|
|
bt = cpp_freertos::CriticalSection::EnterFromISR();
|
|
}
|
|
else if (xSemaphoreTake(lock, 100) != pdPASS)
|
|
{
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
void logUnlock()
|
|
{
|
|
// if called from the ISR use DI/EI. In all other cases use semaphore.
|
|
if (SCB->ICSR & SCB_ICSR_VECTACTIVE_Msk)
|
|
{
|
|
cpp_freertos::CriticalSection::ExitFromISR(bt);
|
|
}
|
|
else
|
|
{
|
|
xSemaphoreGive(lock);
|
|
}
|
|
}
|
|
|
|
xSemaphoreHandle lock;
|
|
logger_level level;
|
|
BaseType_t bt;
|
|
};
|
|
|
|
static Logger logger;
|
|
static char loggerBuffer[LOGGER_BUFFER_SIZE] = {0};
|
|
|
|
void log_Printf(const char *fmt, ...)
|
|
{
|
|
if (!logger.logLock())
|
|
{
|
|
return;
|
|
}
|
|
|
|
char* ptr = loggerBuffer;
|
|
va_list args;
|
|
|
|
va_start(args, fmt);
|
|
ptr += vsnprintf(ptr,&loggerBuffer[LOGGER_BUFFER_SIZE]-ptr, fmt, args);
|
|
va_end(args);
|
|
|
|
#if LOG_REDIRECT_TO_SERIAL == 1
|
|
LPUART_WriteBlocking(LPUART3, (uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#else
|
|
SEGGER_RTT_Write(0,(uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#endif
|
|
|
|
logger.logUnlock();
|
|
}
|
|
|
|
static void _log_Log(logger_level level, const char *file, int line,const char *function, const char *fmt, va_list args)
|
|
{
|
|
if (!logger.logLock())
|
|
{
|
|
return;
|
|
}
|
|
|
|
char* ptr = loggerBuffer;
|
|
|
|
ptr += sprintf(ptr, "%d ms ", cpp_freertos::Ticks::TicksToMs(cpp_freertos::Ticks::GetTicks()));
|
|
|
|
#if LOG_USE_COLOR == 1
|
|
|
|
ptr += sprintf(ptr,"%s%-5s " CONSOLE_ESCAPE_COLOR_MAGENTA "[%-10s] \x1b[90m%s:%d:" CONSOLE_ESCAPE_COLOR_RESET,
|
|
level_colors[level],
|
|
level_names[level],
|
|
xTaskGetCurrentTaskHandle()==NULL?"CRIT":xPortIsInsideInterrupt()?"IRQ": pcTaskGetName(xTaskGetCurrentTaskHandle()),
|
|
file, line);
|
|
#else
|
|
ptr += sprintf(ptr,"%-5s %s:%s:%d: ", level_names[level], file, function, line);
|
|
#endif
|
|
ptr += vsnprintf(ptr,&loggerBuffer[LOGGER_BUFFER_SIZE]-ptr, fmt, args);
|
|
ptr += sprintf(ptr,"\r\n");
|
|
|
|
#if LOG_REDIRECT_TO_SERIAL == 1
|
|
LPUART_WriteBlocking(LPUART3, (uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#else
|
|
SEGGER_RTT_Write(0,(uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#endif
|
|
|
|
/* Release lock */
|
|
logger.logUnlock();
|
|
}
|
|
|
|
void log_Log(logger_level level, const char *file, int line,const char *function, const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_Log(level, file,line, function, fmt, args);
|
|
va_end(args);
|
|
}
|
|
|
|
/**
|
|
* Update log level
|
|
* @param level [in] - new log level
|
|
*/
|
|
void log_SetLevel(logger_level level) {
|
|
logger.level = level;
|
|
}
|
|
|
|
extern "C" {
|
|
|
|
void bt_log_custom(const char* file , int line, const char* foo, const char *fmt, ...) {
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_Log( LOGTRACE, file, line, foo, fmt, args);
|
|
va_end(args);
|
|
}
|
|
|
|
int printf (__const char *__restrict __format, ...)
|
|
{
|
|
/* Acquire lock */
|
|
if (!logger.logLock())
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
char* ptr = loggerBuffer;
|
|
va_list args;
|
|
|
|
va_start(args, __format);
|
|
ptr += vsnprintf(ptr,&loggerBuffer[LOGGER_BUFFER_SIZE]-ptr, __format, args);
|
|
va_end(args);
|
|
|
|
unsigned int numBytes = ptr - loggerBuffer;
|
|
SEGGER_RTT_Write(0,(uint8_t*)loggerBuffer,numBytes);
|
|
|
|
/* Release lock */
|
|
logger.logUnlock();
|
|
|
|
return numBytes;
|
|
}
|
|
|
|
int vprintf (const char *__restrict __format, va_list __arg) {
|
|
/* Acquire lock */
|
|
if (!logger.logLock())
|
|
{
|
|
return -1;
|
|
}
|
|
char* ptr = loggerBuffer;
|
|
ptr += vsnprintf(ptr,&loggerBuffer[LOGGER_BUFFER_SIZE]-ptr, __format, __arg);
|
|
|
|
unsigned int numBytes = ptr - loggerBuffer;
|
|
SEGGER_RTT_Write(0, (uint8_t *)loggerBuffer, numBytes);
|
|
|
|
/* Release lock */
|
|
logger.logUnlock();
|
|
|
|
return numBytes;
|
|
}
|
|
|
|
int log_assert(__const char *__restrict __format, ...)
|
|
{
|
|
/* Acquire lock */
|
|
if (!logger.logLock())
|
|
{
|
|
return -1;
|
|
}
|
|
|
|
char *ptr = loggerBuffer;
|
|
ptr += sprintf(ptr, "%d ms ", cpp_freertos::Ticks::TicksToMs(cpp_freertos::Ticks::GetTicks()));
|
|
logger_level level = LOGFATAL;
|
|
ptr += sprintf(ptr, "%s%-5s " CONSOLE_ESCAPE_COLOR_MAGENTA "[%-10s] \x1b[31mASSERTION " CONSOLE_ESCAPE_COLOR_RESET, level_colors[level], level_names[level],
|
|
xTaskGetCurrentTaskHandle() == NULL ? "CRIT" : xPortIsInsideInterrupt() ? "IRQ" : pcTaskGetName(xTaskGetCurrentTaskHandle()));
|
|
|
|
va_list args;
|
|
va_start(args, __format);
|
|
ptr += vsnprintf(ptr, &loggerBuffer[LOGGER_BUFFER_SIZE] - ptr, __format, args);
|
|
va_end(args);
|
|
|
|
unsigned int numBytes = ptr - loggerBuffer;
|
|
#if LOG_REDIRECT_TO_SERIAL == 1
|
|
LPUART_WriteBlocking(LPUART3, (uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#else
|
|
SEGGER_RTT_Write(0,(uint8_t*)loggerBuffer,ptr-loggerBuffer);
|
|
#endif
|
|
|
|
/* Release lock */
|
|
logger.logUnlock();
|
|
|
|
return numBytes;
|
|
}
|
|
|
|
void __assert_func(const char *file, int line, const char *func, const char *failedexpr)
|
|
{
|
|
log_assert("\"%s\" failed: file \"%s\", line %d%s%s\n", failedexpr, file, line, func ? ", function: " : "", func ? func : "");
|
|
|
|
abort();
|
|
/* NOTREACHED */
|
|
}
|
|
};
|