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
|
#include "io.h"
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#define BOCHS_PUTCHAR(ch) (outb(0xe9, ch))
void log_putchar(int ch)
{
BOCHS_PUTCHAR(ch);
}
void log_puts(const char* str)
{
while(*str)
log_putchar(*str++);
}
static char hex_table[16] = { '0', '1', '2', '3', '4', '5', '6', '7',
'8', '9', 'A', 'B', 'C', 'D', 'E', 'F' };
static void log_print_hex(unsigned int n)
{
unsigned mask = 0xF0000000;
unsigned shift = 28;
while(mask)
{
log_putchar(hex_table[(n & mask) >> shift]);
mask >>= 4;
shift -= 4;
}
}
int log(const char *fmt, ...)
{
va_list ap;
va_start(ap, fmt);
while(*fmt)
{
char ch = *fmt++;
switch(ch)
{
case '%':
{
switch(*fmt++)
{
case 'c':
log_putchar(va_arg(ap, int));
break;
case 's':
log_puts(va_arg(ap, const char*));
break;
case 'x':
log_print_hex(va_arg(ap, unsigned));
break;
case 'd':
log_puts(itoa(va_arg(ap, unsigned), 10));
break;
default:
log_puts("klog: unknown format\n");
break;
}
break;
}
default:
log_putchar(ch);
break;
}
}
va_end(ap);
return 0;
}
|
