76 lines
1.3 KiB
C
76 lines
1.3 KiB
C
|
// See LICENSE for license details.
|
||
|
|
#include <stdarg.h>
|
||
|
|
#include <stdint.h>
|
||
|
|
#include <stdbool.h>
|
||
|
|
|
||
|
|
#include "kprintf.h"
|
||
|
|
|
||
|
|
static inline void _kputs(const char *s)
|
||
|
|
{
|
||
|
|
char c;
|
||
|
|
for (; (c = *s) != '\0'; s++)
|
||
|
|
kputc(c);
|
||
|
|
}
|
||
|
|
|
||
|
|
void kputs(const char *s)
|
||
|
|
{
|
||
|
|
_kputs(s);
|
||
|
|
kputc('\r');
|
||
|
|
kputc('\n');
|
||
|
|
}
|
||
|
|
|
||
|
|
void kprintf(const char *fmt, ...)
|
||
|
|
{
|
||
|
|
va_list vl;
|
||
|
|
bool is_format, is_long, is_char;
|
||
|
|
char c;
|
||
|
|
|
||
|
|
va_start(vl, fmt);
|
||
|
|
is_format = false;
|
||
|
|
is_long = false;
|
||
|
|
is_char = false;
|
||
|
|
while ((c = *fmt++) != '\0') {
|
||
|
|
if (is_format) {
|
||
|
|
switch (c) {
|
||
|
|
case 'l':
|
||
|
|
is_long = true;
|
||
|
|
continue;
|
||
|
|
case 'h':
|
||
|
|
is_char = true;
|
||
|
|
continue;
|
||
|
|
case 'x': {
|
||
|
|
unsigned long n;
|
||
|
|
long i;
|
||
|
|
if (is_long) {
|
||
|
|
n = va_arg(vl, unsigned long);
|
||
|
|
i = (sizeof(unsigned long) << 3) - 4;
|
||
|
|
} else {
|
||
|
|
n = va_arg(vl, unsigned int);
|
||
|
|
i = is_char ? 4 : (sizeof(unsigned int) << 3) - 4;
|
||
|
|
}
|
||
|
|
for (; i >= 0; i -= 4) {
|
||
|
|
long d;
|
||
|
|
d = (n >> i) & 0xF;
|
||
|
|
kputc(d < 10 ? '0' + d : 'a' + d - 10);
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
case 's':
|
||
|
|
_kputs(va_arg(vl, const char *));
|
||
|
|
break;
|
||
|
|
case 'c':
|
||
|
|
kputc(va_arg(vl, int));
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
is_format = false;
|
||
|
|
is_long = false;
|
||
|
|
is_char = false;
|
||
|
|
} else if (c == '%') {
|
||
|
|
is_format = true;
|
||
|
|
} else {
|
||
|
|
kputc(c);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
va_end(vl);
|
||
|
|
}
|