novaos/libc/stdio/printf.c

#include <limits.h>
#include <stdbool.h>
#include <stdarg.h>
#include <stdio.h>
#include <string.h>
#include <stdint.h>
#include <stdlib.h>


static bool print(const char* data, size_t length) {
	const unsigned char* bytes = (const unsigned char*) data;
	for (size_t i = 0; i < length; i++)
		if (putchar(bytes[i]) == EOF) return false;
	return true;
}

int printf(const char* restrict format, ...) {
	va_list parameters;
	va_start(parameters, format);

	int written = 0;

	char buffer[512];

	while (*format != '\0') {
		size_t maxrem = INT_MAX - written;

		if (format[0] != '%' || format[1] == '%') {
			if (format[0] == '%')
				format++;
			size_t amount = 1;
			while (format[amount] && format[amount] != '%')
				amount++;
			if (maxrem < amount) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(format, amount))
				return -1;
			format += amount;
			written += amount;
			continue;
		}

		const char* format_begun_at = format++;

		if (*format == 'c') {
			format++;
			char c = (char) va_arg(parameters, int /* char promotes to int */);
			if (!maxrem) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(&c, sizeof(c)))
				return -1;
			written++;
		} else if (*format == 's') {
			format++;
			const char* str = va_arg(parameters, const char*);
			size_t len = strlen(str);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(str, len))
				return -1;
			written += len;
		} else if (*format == 'd') {
			format++;
			int i = (int) va_arg(parameters, int);
			itoa(i, buffer, 10);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == 'f') {
			format++;
			double d = (double) va_arg(parameters, double);
			dtoa(d, buffer, 5);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == 'u') {
			format++;
			unsigned int i = (unsigned int) va_arg(parameters, unsigned int);
			utoa(i, buffer, 10);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == 'x') {
			format++;
			int i = (int) va_arg(parameters, int);
			itoa(i, buffer, 16);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == '1') {
			format++;
			int32_t i = (int32_t) va_arg(parameters, int32_t);
			s32toa(i, buffer, 10);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == '2') {
			format++;
			uint32_t i = (uint32_t) va_arg(parameters, uint32_t);
			u32toa(i, buffer, 16);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == '3') {
			format++;
			int64_t i = (int64_t) va_arg(parameters, int64_t);
			s64toa(i, buffer, 10);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == '4') {
			format++;
			uint64_t i = (uint64_t) va_arg(parameters, uint64_t);
			u64toa(i, buffer, 16);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else if (*format == 'b') {
			format++;
			uint32_t i = (uint32_t) va_arg(parameters, uint32_t);
			u32toa(i, buffer, 2);
			size_t len = strlen(buffer);
			if (maxrem < len) {
				return -1;
			}
			if (!print(buffer, len))
				return -1;
			written += len;
		} else {
			format = format_begun_at;
			size_t len = strlen(format);
			if (maxrem < len) {
				// TODO: Set errno to EOVERFLOW.
				return -1;
			}
			if (!print(format, len))
				return -1;
			written += len;
			format += len;
		}
	}

	va_end(parameters);
	return written;
}