2 files changed, 114 insertions, 0 deletions
diff --git a/src/stdio.c b/src/stdio.c
new file mode 100644
index 0000000..b389e26
--- /dev/null
+++ b/src/stdio.c
@@ -0,0 +1,94 @@
+#include "stdio.h"
+#include "stddef.h"
+#include "stdlib.h"
+#include "string.h"
+
+console_t *global_console = NULL;
+
+int puts( const char *s )
+{
+	if( global_console == NULL ) {
+		return EOF;
+	}
+	
+	console_put_string( global_console, s );
+	console_put_newline( global_console );
+	
+	return 1;
+}
+
+int printf( const char *format, ... )
+{
+	va_list args;
+	
+	va_start( args, format );
+	int res = vprintf( format, args );
+	va_end( args );
+	
+	return res;
+}
+
+int vprintf( const char *format, va_list args )
+{
+	const char *s = format;
+	int n = 0;
+
+	if( global_console == NULL ) {
+		return -1;
+	}
+	
+	while( *s != '\0' ) {
+		switch( *s ) {
+			case '\n':
+				console_put_newline( global_console );
+				n++;
+				break;
+			
+			case '%':
+				s++;
+				if( *s == '\0' ) {
+					console_put_string( global_console, "<truncated % found at end of format string>" );
+					console_put_newline( global_console );
+					return -1;
+				}
+				
+				switch( *s ) {
+					case '%':
+						console_put_char( global_console, '%' );
+						break;
+						
+					case 'X': {
+						char buf[19];
+						itoa( va_arg( args, int ), (char *)buf, 16 );
+						console_put_string( global_console, buf );
+						n += strlen( buf );
+						}
+						break;
+						
+					case 's':
+						console_put_string( global_console, va_arg( args, const char * ) );
+						break;
+
+					default:
+						console_put_string( global_console, "<illegal format string %" );
+						console_put_char( global_console, *s );
+						console_put_string( global_console, ">" );
+						console_put_newline( global_console );
+				}
+				
+				break;				
+			
+			default:
+				console_put_char( global_console, *s );
+				n++;
+		}
+		s++;
+	}
+	
+	return n;
+}
+
+void stdio_set_console( console_t *console )
+{
+	global_console = console;
+}
diff --git a/src/stdio.h b/src/stdio.h
new file mode 100644
index 0000000..bc7fac0
--- /dev/null
+++ b/src/stdio.h
@@ -0,0 +1,20 @@
+#ifndef STDIO_H
+#define STDIO_H
+
+#include <stdarg.h>
+
+#include "stddef.h"
+
+#include "console.h"
+
+#define EOF (-1)
+
+extern console_t *global_console;
+
+int puts( const char *s );
+int printf( const char *format, ... );
+int vprintf( const char *format, va_list args );
+
+void stdio_set_console( console_t *console );
+
+#endif //STDIO_H