#include "logger.h" #include "console.h" #include "stdlib.h" #define LEVELS_COUNT 4 static const char *const level_text[LEVELS_COUNT] = { "DBUG", "INFO", "WARN", "FAIL", }; static void print_prefix(unsigned char level, const char *source); void logger_log(unsigned char level, const char *const source, const char *format, ...) { if (level >= LEVELS_COUNT) { level = LEVELS_COUNT - 1; } print_prefix(level, source); char **arg = (char **) &format; int c; char buf[20]; arg++; while ((c = *format++) != 0) { if (c == '\n') { console_putc('\n'); print_prefix(level, source); } else if (c != '%') { console_putc(c); } else { char *p, *p2; int pad0 = 0, pad = 0; c = *format++; if (c == '0') { pad0 = 1; c = *format++; } if (c >= '0' && c <= '9') { pad = c - '0'; c = *format++; } switch (c) { case 'd': case 'u': case 'x': kitoa (buf, c, *((int *) arg++)); p = buf; goto string; break; case 's': p = *arg++; if (! p) p = "(null)"; string: for (p2 = p; *p2; p2++); for (; p2 < p + pad; p2++) console_putc(pad0 ? '0' : ' '); while (*p) console_putc(*p++); break; default: console_putc(*((int *) arg++)); break; } } } console_putc('\n'); } void print_prefix(const unsigned char level, const char *const source) { console_putc('['); console_print(level_text[level]); console_putc(']'); console_putc(' '); if (source) { console_print(source); console_print(": "); } }