1 files changed, 117 insertions, 0 deletions
diff --git a/target/linux/realtek/files/arch/rlx/kernel/early_printk.c b/target/linux/realtek/files/arch/rlx/kernel/early_printk.c
new file mode 100644
index 000000000..b1983af9c
--- /dev/null
+++ b/target/linux/realtek/files/arch/rlx/kernel/early_printk.c
@@ -0,0 +1,117 @@
+/*
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file "COPYING" in the main directory of this archive
+ * for more details.
+ *
+ * Copyright (C) 2002, 2003, 06, 07 Ralf Baechle (ralf@linux-mips.org)
+ * Copyright (C) 2007 MIPS Technologies, Inc.
+ *   written by Ralf Baechle (ralf@linux-mips.org)
+ */
+#include <linux/console.h>
+#include <linux/init.h>
+
+#include <asm/setup.h>
+
+#ifdef CONFIG_SERIAL_SC16IS7X0_CONSOLE
+extern int __init early_sc16is7x0_init_i2c_and_check( void );
+extern int __init early_sc16is7x0_setup(struct console * console, char * option);
+static int early_sc16is7x0_workable = -1;
+#endif
+
+#include "bspchip.h"
+
+//extern void prom_putchar(char);
+int prom_putchar(char c)
+{
+#ifdef CONFIG_SERIAL_SC16IS7X0_CONSOLE
+   extern unsigned int sc16is7x0_serial_out_i2c(int offset, int value);
+   extern unsigned int sc16is7x0_serial_in_i2c(int offset);
+#endif
+
+#define UART0_BASE		0xB8002000
+#define UART0_THR		(UART0_BASE + 0x000)
+#define UART0_FCR		(UART0_BASE + 0x008)
+#define UART0_LSR       (UART0_BASE + 0x014)
+#define TXRST			0x04
+#define CHAR_TRIGGER_14	0xC0
+#define LSR_THRE		0x20
+#define TxCHAR_AVAIL	0x00
+#define TxCHAR_EMPTY	0x20
+   unsigned int busy_cnt = 0;
+
+#ifndef CONFIG_SERIAL_SC16IS7X0_CONSOLE
+   do
+   {
+      /* Prevent Hanging */
+      if (busy_cnt++ >= 30000)
+      {
+         /* Reset Tx FIFO */
+         REG8(UART0_FCR) = TXRST | CHAR_TRIGGER_14;
+         return 0;
+      }
+   } while ((REG8(UART0_LSR) & LSR_THRE) == TxCHAR_AVAIL);
+
+   /* Send Character */
+   REG8(UART0_THR) = c;
+#endif
+	
+   // -------------------------------------------------------
+   	
+#ifdef CONFIG_SERIAL_SC16IS7X0_CONSOLE
+   if( early_sc16is7x0_workable < 0 )
+      return 0;
+   
+   #define MEM2REG( x )		( ( x - UART0_BASE ) / 4 )
+   
+   do
+   {
+      /* Prevent Hanging */
+      if (busy_cnt++ >= 30000)
+      {
+         /* Reset Tx FIFO */
+         sc16is7x0_serial_out_i2c( MEM2REG(UART0_FCR), TXRST | CHAR_TRIGGER_14 );
+         
+         return 0;
+      }
+   } while ((sc16is7x0_serial_in_i2c( MEM2REG(UART0_LSR) ) & LSR_THRE) == TxCHAR_AVAIL);
+
+   /* Send Character */
+   sc16is7x0_serial_out_i2c( MEM2REG(UART0_THR), c );
+   
+   #undef MEM2REG
+#endif
+
+   return 1;
+}
+
+static void __init
+early_console_write(struct console *con, const char *s, unsigned n)
+{
+	while (n-- && *s) {
+		if (*s == '\n')
+			prom_putchar('\r');
+		prom_putchar(*s);
+		s++;
+	}
+}
+
+static struct console early_console __initdata = {
+	.name	= "early",
+	.write	= early_console_write,
+	.flags	= CON_PRINTBUFFER | CON_BOOT,
+	.index	= -1
+};
+
+static int early_console_initialized __initdata;
+
+void __init setup_early_printk(void)
+{
+	if (early_console_initialized)
+		return;
+	early_console_initialized = 1;
+
+#ifdef CONFIG_SERIAL_SC16IS7X0_CONSOLE
+	early_sc16is7x0_workable = early_sc16is7x0_setup( NULL, NULL );
+#endif
+	register_console(&early_console);
+}