kernel/io.c


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 <kernel/io.h>
#include <kernel/string.h>
#include <kernel/tty.h>

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) {
        char *s;
        int i;

        for (size_t n = 0; n < strlen(fmt); n++) {
                if (fmt[n] != '%') {
                        tty_putchar(fmt[n]);
                        continue;
                } else {
                        n++;
                }

                switch (fmt[n]) {
                        case 'c':
                                i = va_arg(args, int);
                                tty_putchar(i);
                                break;
                        case 'd':
                                i = va_arg(args, int);
                                if (i < 0) {
                                        i = -i;
                                        tty_putchar('-');
                                }
                                tty_writestring(convert(i, 10));
                                break;
                        case 'o':
                                i = va_arg(args, unsigned int);
                                tty_writestring(convert(i, 8));
                                break;
                        case 's':
                                s = va_arg(args, char*);
                                tty_writestring(s);
                                break;
                        case 'x':
                                i = va_arg(args, unsigned int);
                                tty_writestring(convert(i, 16));
                                break;
                }
        }
        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;
}