58 lines
1.4 KiB
C
58 lines
1.4 KiB
C
#include "log.h"
|
|
#include <string.h>
|
|
|
|
static LogLevel current_level = LOG_DEBUG;
|
|
|
|
void log_set_level(LogLevel level)
|
|
{
|
|
current_level = level;
|
|
}
|
|
|
|
/* Output log message via USART1 (HAL) */
|
|
static void _log_print(LogLevel level, const char *tag, const char *fmt, va_list args)
|
|
{
|
|
if (current_level <= level) {
|
|
char buf[256];
|
|
int len = vsnprintf(buf, sizeof(buf) - 2, fmt, args);
|
|
/* USART1 already inited when log is called */
|
|
extern UART_HandleTypeDef huart1;
|
|
HAL_UART_Transmit(&huart1, (uint8_t *)"[", 1, 100);
|
|
HAL_UART_Transmit(&huart1, (uint8_t *)tag, strlen(tag), 100);
|
|
HAL_UART_Transmit(&huart1, (uint8_t *)"] ", 2, 100);
|
|
HAL_UART_Transmit(&huart1, (uint8_t *)buf, len, 500);
|
|
HAL_UART_Transmit(&huart1, (uint8_t *)"\r\n", 2, 100);
|
|
}
|
|
}
|
|
|
|
void log_debug(const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_print(LOG_DEBUG, "DEBUG", fmt, args);
|
|
va_end(args);
|
|
}
|
|
|
|
void log_info(const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_print(LOG_INFO, "INFO", fmt, args);
|
|
va_end(args);
|
|
}
|
|
|
|
void log_warn(const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_print(LOG_WARN, "WARN", fmt, args);
|
|
va_end(args);
|
|
}
|
|
|
|
void log_error(const char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
va_start(args, fmt);
|
|
_log_print(LOG_ERROR, "ERROR", fmt, args);
|
|
va_end(args);
|
|
}
|