98 lines
2.4 KiB
C
98 lines
2.4 KiB
C
#include "log.h"
|
||
#include "24c02.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();
|
||
}
|
||
|
||
/* 日志等级 EEPROM 偏移（160，避开其它占用） */
|
||
#define LOG_LEVEL_ADDR 160
|
||
|
||
/* 开机读取保存的日志等级（非法值回退 DEBUG 并落盘） */
|
||
void log_load_level(void)
|
||
{
|
||
uint8_t lv = LOG_DEBUG;
|
||
eepromReadData(LOG_LEVEL_ADDR, &lv, 1);
|
||
if (lv > LOG_FATAL) {
|
||
lv = LOG_DEBUG;
|
||
eepromWriteData(LOG_LEVEL_ADDR, &lv, 1);
|
||
}
|
||
current_level = (LogLevel)lv;
|
||
}
|
||
|
||
LogLevel log_get_level(void)
|
||
{
|
||
return current_level;
|
||
}
|
||
|
||
void log_set_level(LogLevel level)
|
||
{
|
||
current_level = level;
|
||
uint8_t lv = (uint8_t)level; /* 断电不丢 */
|
||
eepromWriteData(LOG_LEVEL_ADDR, &lv, 1);
|
||
}
|
||
|
||
/* 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);
|
||
}
|