1 files changed, 87 insertions, 0 deletions
diff --git a/target/linux/realtek/files/rtkload/prom_printf.c b/target/linux/realtek/files/rtkload/prom_printf.c
new file mode 100644
index 000000000..7bf58cdb3
--- /dev/null
+++ b/target/linux/realtek/files/rtkload/prom_printf.c
@@ -0,0 +1,87 @@
+/* 
+ * Borrowed from arch/mips/r39xx/prom/init.c
+ *
+ */
+
+/*
+ * init.c: early initialisation code for R39XX Class PDAs
+ *
+ * Copyright (C) 1999 Harald Koerfgen
+ *
+ * $Id: prom_printf.c,v 1.2 2008/08/04 08:54:44 michael Exp $
+ */
+
+
+
+#define CONFIG_SERIAL
+
+#include <stdarg.h>
+
+//#include <linux/config.h>
+#include <linux/autoconf.h>
+
+#ifdef CONFIG_RTL_EB8186
+#include <asm/rtl8181.h>
+#endif
+
+#if 1
+	//#define __KERNEL__
+
+	//#include <asm/types.h>		
+	//#include <asm/serial.h>
+	#include <asm/io.h>
+
+	#define UART_THR	0x2000	
+	#define UART_LSR	0x2014
+	
+	#define rtl_outb(port,val) outb(val,port) 	
+	#define rtl_inb(port) inb(port)
+#endif
+       
+void serial_outc(char c)
+{
+	int i=0;
+    while (1)
+    {
+          i++;
+                if (i >=0x6000)
+                        break;
+
+                if      (rtl_inb(UART_LSR) & 0x20)
+                        break;
+     }
+     rtl_outb(UART_THR, c);
+}
+ 
+
+/*
+ * Helpful for debugging :-)
+ */
+int prom_printf(const char * fmt, ...)
+{
+#ifdef CONFIG_SERIAL
+	//extern void serial_outc(char);
+	static char buf[1024];
+	va_list args;
+	char c;
+	int i = 0;
+
+	/*
+	 * Printing messages via serial port
+	 */
+	va_start(args, fmt);
+	vsprintf(buf, fmt, args);
+	va_end(args);
+
+	for (i = 0; buf[i] != '\0'; i++) {
+		c = buf[i];
+		if (c == '\n')
+			serial_outc('\r');
+		serial_outc(c);
+	}
+
+	return i;
+#else
+	return 0;
+#endif
+}