120 lines
2.6 KiB
C
120 lines
2.6 KiB
C
/*
|
|
* AsterOS Kernel
|
|
* Autor: Pavel Kalaš
|
|
* Rok: 2026
|
|
*
|
|
*/
|
|
|
|
/*
|
|
* Tento modul implementuje tiskovou vrstvu kernelu nad VGA vystupem.
|
|
* Obsahuje podporu zakladnich formatovacich specifikatoru pro ladeni
|
|
* a jednotne API, ktere pouzivaji ostatni casti jadra pri logovani.
|
|
*/
|
|
|
|
#include <stdarg.h>
|
|
|
|
#include "display.h"
|
|
#include "printk.h"
|
|
#include "serial.h"
|
|
|
|
static void printk_putc(char c) {
|
|
display_putc(c);
|
|
serial_write_char(c);
|
|
}
|
|
|
|
static void printk_puts(const char *s) {
|
|
if (!s) {
|
|
s = "(null)";
|
|
}
|
|
|
|
while (*s) {
|
|
printk_putc(*s++);
|
|
}
|
|
}
|
|
|
|
static void print_u64(unsigned long long value, unsigned int base) {
|
|
char buf[32];
|
|
const char *digits = "0123456789abcdef";
|
|
int i = 0;
|
|
|
|
if (value == 0) {
|
|
printk_putc('0');
|
|
return;
|
|
}
|
|
|
|
while (value > 0 && i < (int)sizeof(buf)) {
|
|
buf[i++] = digits[value % base];
|
|
value /= base;
|
|
}
|
|
|
|
while (i > 0) {
|
|
printk_putc(buf[--i]);
|
|
}
|
|
}
|
|
|
|
void aster_print(const char *text) {
|
|
printk_puts(text);
|
|
}
|
|
|
|
void printk(const char *fmt, ...) {
|
|
va_list args;
|
|
|
|
va_start(args, fmt);
|
|
|
|
while (*fmt) {
|
|
if (*fmt != '%') {
|
|
printk_putc(*fmt++);
|
|
continue;
|
|
}
|
|
|
|
++fmt;
|
|
switch (*fmt) {
|
|
case '%':
|
|
printk_putc('%');
|
|
break;
|
|
case 'c': {
|
|
int c = va_arg(args, int);
|
|
printk_putc((char)c);
|
|
break;
|
|
}
|
|
case 's': {
|
|
const char *s = va_arg(args, const char *);
|
|
printk_puts(s);
|
|
break;
|
|
}
|
|
case 'd': {
|
|
long v = va_arg(args, int);
|
|
if (v < 0) {
|
|
printk_putc('-');
|
|
print_u64((unsigned long long)(-v), 10);
|
|
} else {
|
|
print_u64((unsigned long long)v, 10);
|
|
}
|
|
break;
|
|
}
|
|
case 'u': {
|
|
unsigned int v = va_arg(args, unsigned int);
|
|
print_u64(v, 10);
|
|
break;
|
|
}
|
|
case 'x': {
|
|
unsigned int v = va_arg(args, unsigned int);
|
|
print_u64(v, 16);
|
|
break;
|
|
}
|
|
case 'p': {
|
|
unsigned long long v = (unsigned long long)va_arg(args, void *);
|
|
printk_puts("0x");
|
|
print_u64(v, 16);
|
|
break;
|
|
}
|
|
default:
|
|
printk_putc('?');
|
|
break;
|
|
}
|
|
++fmt;
|
|
}
|
|
|
|
va_end(args);
|
|
}
|