path: root/src/common/libc/printf.c

#include <stdarg.h>
#include <stdbool.h>

#include <kogata/printf.h>

int snprintf(char * buff, size_t len, const char *format, ...) {
	va_list ap;

	va_start(ap, format);
	len = vsnprintf(buff, len, format, ap);
	va_end(ap);

	return len;
}

int vsnprintf(char *buff, size_t len, const char* format, va_list ap){
	size_t i, result;

	if (!buff || !format)
		return -1;

#define PUTCHAR(thechar) \
	do { \
		if (result < len-1) \
		*buff++ = (thechar);  \
		result++; \
	} while (0)

	result = 0;
	for(i = 0; format[i] != '\0' ; i++) {
		if (format[i] == '%') {
			i++;
			int u = 0;
			int l = 0;
			bool spec = true;
			while (spec) {
				switch(format[i]) {
					case 'l': {
						l++;
						i++;
						break;
					}
					case 'u': {
						u = 1;
						i++;
						break;
					}
					default:
						spec = false;
				}
			}
			switch(format[i]) {
				case '%':
					PUTCHAR('%');
					break;
				case 'i':;
				case 'd': {
					if (u) {
						// TODO
					} else {
						long long int integer;
						if (l == 0) integer = va_arg(ap, int);
						if (l == 1) integer = va_arg(ap, long int);
						if (l == 2) integer = va_arg(ap, long long int);

						int cpt2 = 0;
						char buff_int[32];

						if (integer<0)
							PUTCHAR('-');

						do {
							int m10 = integer%10;
							m10 = (m10 < 0)? -m10:m10;
							buff_int[cpt2++] = (char)('0'+ m10);
							integer = integer/10;
						} while(integer != 0);

						for(cpt2 = cpt2 - 1; cpt2 >= 0; cpt2--)
							PUTCHAR(buff_int[cpt2]);
					}
					break;
				}
				case 'c': {
					 int value = va_arg(ap,int);
					 PUTCHAR((char)value);
					 break;
				}
				case 's': {
					 char *string = va_arg(ap,char *);
					 if (!string)
						 string = "(null)";
					 for(; *string != '\0' ; string++)
						 PUTCHAR(*string);
					 break;
				}
				case 'x': {
					 unsigned int hexa = va_arg(ap,int);
					 int had_nonzero = 0;
					 for(int j = 0; j < 8; j++) {
						 unsigned int nb = (unsigned int)(hexa << (j*4));
						 nb = (nb >> 28) & 0xf;
						 // Skip the leading zeros
						 if (nb == 0) {
							 if (had_nonzero)
								 PUTCHAR('0');
						 } else {
							 had_nonzero = 1;
							 if (nb < 10)
								 PUTCHAR('0'+nb);
							 else
								 PUTCHAR('a'+(nb-10));
						 }
					 }
					 if (!had_nonzero)
						 PUTCHAR('0');
					 break;
				}
				case 'p': {
					 unsigned int hexa = va_arg(ap,int);
					 for (int j = 0; j < 8; j++) {
						 unsigned int nb = (unsigned int)(hexa << (j*4));
						 nb = (nb >> 28) & 0xf;
						 if (nb < 10)
							 PUTCHAR('0'+nb);
						 else
							 PUTCHAR('a'+(nb-10));
					 }
					 break;
				}
				default:
					 PUTCHAR('%');
					 PUTCHAR(format[i]);
			}
		} else {
			PUTCHAR(format[i]);
		}
	}

	*buff = '\0';
	return result;
}

/* vim: set ts=4 sw=4 tw=0 noet :*/