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
79
|
#define FOOLOS_MODULE_NAME "log"
#include <stdarg.h>
#include <stdbool.h>
#include "log.h"
#include "kernel/kernel.h"
#include "kernel/config.h"
#include "terminal/vt52.h"
#include "kernel/timer.h"
static char buffer[LOG_BUF_SIZE];
static int first=0;
static int last=0;
static bool init=true;//
static void log_string(char *str)
{
while(*str!=0)
{
fifo_put(&get_fool()->fifo_stdout,*(str++));
}
}
void log(char *module_name, int log_level, char *format_string, ...)
{
#ifdef FOOLOS_LOG_OFF
return;
#endif
if(log_level<FOOLOS_LOG_INFO)return;
char buf_info[256];
char buf_log[256];
char buf_time[20];
uint32_t t=timer_get_ticks();
uint32_t s=t/25;
uint32_t ms=t*1000/25-1000*s;
tfp_sprintf(buf_time,"[%3d.%05d]",s,ms);
va_list va;
va_start(va,format_string);
tfp_vsprintf(buf_info,format_string,va);
va_end(va);
tfp_sprintf(buf_log,"%s %s: %s\n",buf_time,module_name,buf_info);
if(init)log_string(buf_log);
for(int i=0;buf_log[i]!=0;i++)
{
buffer[last]=buf_log[i];
last=(last+1)%LOG_BUF_SIZE;
if(first<last)if(last-first>=LOG_BUF_SIZE)first=(first+1)%LOG_BUF_SIZE;
if(last>first)if(LOG_BUF_SIZE-last+first>=LOG_BUF_SIZE)first=(first+1)%LOG_BUF_SIZE;
}
}
void panic(char *module_name, char *message)
{
char buf_log[256];
tfp_sprintf(buf_log,"KERNEL PANIC !! %s: %s\n",module_name,message);
log_string(buf_log);
while(1)
{
asm volatile("cli");
asm volatile("hlt");
}
}
|
