75 lines
1.9 KiB
C
75 lines
1.9 KiB
C
#include "log.h"
|
|
#include <string.h>
|
|
#include "FreeRTOS.h"
|
|
#include "task.h"
|
|
#include "semphr.h"
|
|
|
|
static LogLevel current_level = LOG_DEBUG; // LOG_WARN;//LOG_DEBUG;
|
|
|
|
/* 日志输出互斥锁：多任务并发打印时防止日志交织（调度器启动前为空操作） */
|
|
static SemaphoreHandle_t s_log_mutex = NULL;
|
|
|
|
void log_lock_init(void)
|
|
{
|
|
s_log_mutex = xSemaphoreCreateMutex();
|
|
}
|
|
|
|
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);
|
|
uint8_t locked = 0;
|
|
if (s_log_mutex && xTaskGetSchedulerState() == taskSCHEDULER_RUNNING) {
|
|
xSemaphoreTake(s_log_mutex, portMAX_DELAY);
|
|
locked = 1;
|
|
}
|
|
/* 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);
|
|
if (locked) xSemaphoreGive(s_log_mutex);
|
|
}
|
|
}
|
|
|
|
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);
|
|
}
|