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
80
81
82
83
84
|
#include <kernel/io.h>
#include <kernel/framebuffer.h>
#include <kernel/data/ringbuf.h>
#include <kernel/string.h>
static int ringbuf_init = 0;
static struct ringbuf rb;
char* convert(unsigned int num, int base) {
static char rep[] = "0123456789ABCDEF";
static char buffer[50];
char *ptr;
ptr = &buffer[49];
*ptr = '\0';
do {
*--ptr = rep[num%base];
num /= base;
} while (num != 0);
return ptr;
}
int vkprintf(const char *fmt, va_list args) {
if (ringbuf_init == 0) {
rb_init(&rb, 1024, 4096);
ringbuf_init = 1;
}
char *s;
int i;
char buffer[4096];
for (size_t n = 0; n < strlen(fmt); n++) {
if (fmt[n] != '%') {
buffer[strlen(buffer)] = fmt[n];
continue;
} else {
n++;
}
switch (fmt[n]) {
case 'c':
i = va_arg(args, int);
buffer[strlen(buffer)] = i;
break;
case 's':
s = va_arg(args, char*);
strcat(buffer, s);
break;
case 'd':
i = va_arg(args, int);
if (i < 0) {
i = -i;
strcat(buffer, "-");
}
strcat(buffer, convert(i, 10));
break;
case 'o':
i = va_arg(args, unsigned int);
strcat(buffer, convert(i, 10));
break;
case 'x':
i = va_arg(args, unsigned int);
strcat(buffer, convert(i, 16));
break;
}
}
rb_push_back(&rb, buffer, strlen(buffer));
memset(buffer, 0, 4096);
return 0;
}
int kprintf(const char *fmt, ...) {
va_list args;
int done;
va_start(args, fmt);
done = vkprintf(fmt, args);
va_end(args);
return done;
}
|
