summaryrefslogtreecommitdiff
path: root/kernel/src/print/print.c
blob: 46ec04772e4087d02cb2af7073bbfa0fd50c116b (plain)
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);
}