omos-tcnj2024/sys/lib.c

97 lines
2.0 KiB
C
Raw Normal View History

2024-02-18 13:38:08 +01:00
#include <types.h>
2024-02-18 17:03:37 +01:00
static char strbuf[32];
2024-02-18 13:38:08 +01:00
u32
strlen(const char *str)
{
size_t i;
2024-02-18 14:40:09 +01:00
for (i = 0; str[i] != NULL; i++);
2024-02-18 13:38:08 +01:00
return i;
}
2024-02-18 15:14:47 +01:00
2024-02-18 17:03:37 +01:00
char*
itoa(s32 num, char *str, s32 base)
{
s32 i = 0;
if (num < 0 && base == 10) {
str[i++] = '-';
num = -num;
}
while (num != 0) {
s32 remainder = num % base;
str[i++] = (remainder < 10) ? remainder + '0' : remainder + 'a' - 10;
num/=base;
}
str[i] = '\0';
return str;
}
char*
utoa(u32 num, char *str, s32 base)
{
s32 i = 0;
while (num != 0) {
s32 remainder = num % base;
str[i++] = (remainder < 10) ? remainder + '0' : remainder + 'a' - 10;
num/=base;
}
str[i] = '\0';
return str;
}
s32
2024-02-18 15:14:47 +01:00
printf(const char *format, ...)
{
2024-02-18 17:03:37 +01:00
const u32 len = sizeof(format);
va_list list;
va_start(list, len);
2024-02-18 15:14:47 +01:00
2024-02-18 17:03:37 +01:00
for (u32 i = 0; i < len; i++) {
if (format[i] == '%') {
if (format[i + 1] == 'd' || format[i + 1] == 'i') {
//integer numbers
const s32 num = va_arg(list, s32);
2024-02-18 17:14:23 +01:00
const char* str = itoa(num, strbuf, 10);
vga_write(str, sizeof(str), 0x0f);
2024-02-18 17:03:37 +01:00
} else if (format[i + 1] == 'o') {
//octal numbers
const s32 num = va_arg(list, s32);
2024-02-18 17:14:23 +01:00
const char *str = itoa(num, strbuf, 8);
vga_write(str, sizeof(str), 0x0f);
2024-02-18 17:03:37 +01:00
} else if (format[i + 1] == 'u') {
//unsigned integers
const u32 num = va_arg(list, u32);
2024-02-18 17:14:23 +01:00
const char *str = utoa(num, strbuf, 10);
vga_write(str, sizeof(str), 0x0f);
2024-02-18 17:03:37 +01:00
} else if (format[i + 1] == 'x') {
//hexadecimal numbers
const u32 num = va_arg(list, u32);
2024-02-18 17:14:23 +01:00
const char* str = utoa(num, strbuf, 16);
vga_write(str, sizeof(str), 0x0f);
2024-02-18 17:03:37 +01:00
} else if (format[i + 1] == 's') {
//strings
const char *str = va_arg(list, char*);
vga_write(str, strlen(str), 0x0f);
} else if (format[i + 1] == 'c') {
//one character
vga_write(va_arg(list, char), 1, 0x0f);
} else if (format[i + 1] == '%') {
vga_write('%', 1, 0x0f);
}
} else if (format[i] == '\\' && format[i + 1] == '%') {
vga_write('%', 1, 0x0f);
} else {
vga_write(format[i], 1, 0x0f);
}
}
2024-02-18 16:30:09 +01:00
}