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
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
|
#include <log.h>
#include <types.h>
__attribute__((section(".ringbuf"), aligned(64)))
volatile char log_ring[RINGBUF_SIZE];
static int pos = 0;
void stub(char c) {
(void)c;
return;
}
console_callback_t callback = stub;
void put_char(char c) {
log_ring[pos++] = c;
if (pos >= RINGBUF_SIZE)
pos = 0;
callback(c);
}
void put_string(const char *s) {
while (*s)
put_char(*s++);
}
void put_uint(unsigned int value, unsigned int radix) {
char tmp[16];
const char digits[] = "0123456789abcdef";
int i = 0;
if (value == 0) {
put_char('0');
return;
}
while (value) {
tmp[i++] = digits[value % radix];
value /= radix;
}
while (i--)
put_char(tmp[i]);
}
void put_int(int value) {
if (value < 0) {
put_char('-');
put_uint((unsigned int)(-value), 10);
} else {
put_uint((unsigned int)value, 10);
}
}
void vprintk(const char *fmt, __builtin_va_list args) {
while (*fmt) {
if (*fmt != '%') {
put_char(*fmt++);
continue;
}
fmt++;
switch (*fmt) {
case '%':
put_char('%');
break;
case 'c':
put_char((char)__builtin_va_arg(args, int));
break;
case 's':
put_string(__builtin_va_arg(args, const char *));
break;
case 'd':
case 'i':
put_int(__builtin_va_arg(args, int));
break;
case 'u':
put_uint(__builtin_va_arg(args, unsigned int), 10);
break;
case 'x':
put_uint(__builtin_va_arg(args, unsigned int), 16);
break;
default:
put_char('%');
put_char(*fmt);
break;
}
fmt++;
}
}
void printk(const char *fmt, ...) {
__builtin_va_list args;
__builtin_va_start(args, fmt);
vprintk(fmt, args);
__builtin_va_end(args);
}
|
