1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
|
#define FOOLOS_MODULE_NAME "log"
#include "lib/logger/log.h"
#include <stdarg.h>
#include "log.h"
#include "lib/int/stdint.h"
#include "kernel/time.h"
#define BUF_SIZE 4069
static char buffer[BUF_SIZE];
static int first;
static int last;
void PutConsole(char *str, int color);
void log(char *module_name, int log_level, char *format_string, ...)
{
if(log_level<FOOLOS_LOG_INFO)return;
char buf_info[256];
char buf_log[256];
char buf_time[20];
uint32_t t=task_system_clock;
uint32_t s=t/25;
uint32_t ms=t*1000/25-1000*s;
tfp_sprintf(buf_time,"[%6d.%05d] ",s,ms);
va_list va;
va_start(va,format_string);
tfp_vsprintf(buf_info,format_string,va);
va_end(va);
PutConsole(buf_time,0b0111101111101111);
PutConsole(module_name,0b1111100000000000);
PutConsole(": ",0b0000011111100000);
PutConsole(buf_info, 0b0111101111111111);
PutConsoleNL();
tfp_sprintf(buf_log,"%s %s: %s\n",buf_time,module_name,buf_info);
for(int i=0;buf_log[i]!=0;i++)
{
buffer[last]=buf_log[i];
last=(last+1)%BUF_SIZE;
if(first<last)if(last-first>=BUF_SIZE)first=(first+1)%BUF_SIZE;
if(last>first)if(BUF_SIZE-last+first>=BUF_SIZE)first=(first+1)%BUF_SIZE;
}
}
void panic(char *module_name, char *format_string)
{
PutConsole("!! KERNEL PANIC !! ",0b1111100000000000);
PutConsole(module_name,0b1111100000000000);
PutConsole(" : ",0b0000011111100000);
PutConsole(format_string,0b1111100000000000);
while(1); // halt
}
void log_init()
{
first=last=0;
}
void log_log()
{
log(FOOLOS_MODULE_NAME,FOOLOS_LOG_INFO,"init buffer at: 0x%08X, first=%08X, last=%08X",buffer,&first,&last);
}
|
