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
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
#include "tty/color.h"
#include "tty/term.h"
#include <stdbool.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <print.h>
void printk(const char *restrict format, ...) {
va_list args;
va_start(args, format);
vprintk(format, args);
va_end(args);
}
void vprintk(const char *restrict format, va_list args) {
char buf[80];
for (; *format; format++) {
if (*format == '%') {
bool l = false;
char c = *++format;
if (c == 'l') {
l = true;
c = *++format;
}
switch(c) {
case '%':
putchar('%');
break;
case 's':
puts(va_arg(args, char*));
break;
case 'c':
putchar(va_arg(args, int));
break;
case 'd':
if (l) ltoa(va_arg(args, long long), buf, 10);
else itoa(va_arg(args, int), buf, 10);
puts(buf);
break;
case 'u':
if (l) ultoa(va_arg(args, unsigned long long), buf, 10);
else utoa(va_arg(args, unsigned int), buf, 10);
puts(buf);
break;
case 'f':
case 'F':
ftoa(va_arg(args, double), buf);
puts(buf);
break;
case 'x':
case 'X':
utoa(va_arg(args, unsigned int), buf, 16);
puts(buf);
break;
case 'b':
va_arg(args, int) ? puts("true") : puts("false");
break;
case 'k': {
static char disp[] = {'B', 'K', 'M', 'G'};
uint32_t size = va_arg(args, unsigned int);
size_t i = 0;
while (size / 1024 > 0) {
size /= 1024;
i++;
}
utoa(size, buf, 10);
puts(buf);
putchar(disp[i]);
if (i > 0) putchar('B');
break;
}
default:
break;
}
} else {
putchar(*format);
}
}
}
void puts(const char *s) {
for(; *s; s++) putchar(*s);
}
void printl(enum VGAColor color, const char* msg) {
term_setbg(VGA_BLACK);
term_setfg(VGA_WHITE);
putchar('[');
term_setfg(color);
printk("%s", msg);
term_setfg(VGA_WHITE);
putchar(']');
putchar(' ');
}
void _debugk_impl(char *format, ...) {
uint16_t color = term_save_col();
printl(VGA_LIGHT_CYAN, "LOG");
va_list args;
va_start(args, format);
vprintk(format, args);
va_end(args);
if (!term_newline()) putchar('\n');
term_load_col(color);
}
void _succek_impl(char *format, ...) {
uint16_t color = term_save_col();
printl(VGA_LIGHT_GREEN, "OK");
va_list args;
va_start(args, format);
vprintk(format, args);
va_end(args);
if (!term_newline()) putchar('\n');
term_load_col(color);
}
void _errork_impl(char *format, ...) {
uint16_t color = term_save_col();
printl(VGA_LIGHT_RED, "ERR");
va_list args;
va_start(args, format);
vprintk(format, args);
va_end(args);
if (!term_newline()) putchar('\n');
term_load_col(color);
}
|
