Add kolibrios/ dir : Step 1 towards porting this to Kolibri OS

1 files changed, 28 insertions, 0 deletions

diff --git a/frontends/kolibrios/kolibri_debug.c b/frontends/kolibrios/kolibri_debug.c
new file mode 100644
index 000000000..5e97d40e0
--- /dev/null
+++ b/frontends/kolibrios/kolibri_debug.c
@@ -0,0 +1,28 @@
+#include "kolibrios/kolibri_debug.h"
+#include <stdarg.h>
+
+/* Write a printf() like function (variable argument list) for 
+   writing to debug board TODO*/
+
+void debug_board_write_byte(const char ch){
+    __asm__ __volatile__(
+    "int $0x40"
+    :
+    :"a"(63), "b"(1), "c"(ch));
+}
+
+void debug_board_write_str(const char* str){
+  while(*str)
+    debug_board_write_byte(*str++);
+}
+
+void debug_board_printf(const char *format,...)
+{
+	va_list ap;
+	char log_board[300];
+	
+	va_start (ap, format);
+	vsprintf(log_board, format, ap);
+	va_end(ap);
+	debug_board_write_str(log_board);
+}