1 files changed, 122 insertions, 0 deletions

diff --git a/arch/mips/au1000/common/dbg_io.c b/arch/mips/au1000/common/dbg_io.c
new file mode 100644
index 000000000000..7bc768e558db
--- /dev/null
+++ b/arch/mips/au1000/common/dbg_io.c
@@ -0,0 +1,122 @@
+
+#include <linux/config.h>
+#include <asm/io.h>
+#include <asm/mach-au1x00/au1000.h>
+
+#ifdef CONFIG_KGDB
+
+/*
+ * FIXME the user should be able to select the
+ * uart to be used for debugging.
+ */
+#define DEBUG_BASE  UART_DEBUG_BASE
+/**/
+
+/* we need uint32 uint8 */
+/* #include "types.h" */
+typedef         unsigned char uint8;
+typedef         unsigned int  uint32;
+
+#define         UART16550_BAUD_2400             2400
+#define         UART16550_BAUD_4800             4800
+#define         UART16550_BAUD_9600             9600
+#define         UART16550_BAUD_19200            19200
+#define         UART16550_BAUD_38400            38400
+#define         UART16550_BAUD_57600            57600
+#define         UART16550_BAUD_115200           115200
+
+#define         UART16550_PARITY_NONE           0
+#define         UART16550_PARITY_ODD            0x08
+#define         UART16550_PARITY_EVEN           0x18
+#define         UART16550_PARITY_MARK           0x28
+#define         UART16550_PARITY_SPACE          0x38
+
+#define         UART16550_DATA_5BIT             0x0
+#define         UART16550_DATA_6BIT             0x1
+#define         UART16550_DATA_7BIT             0x2
+#define         UART16550_DATA_8BIT             0x3
+
+#define         UART16550_STOP_1BIT             0x0
+#define         UART16550_STOP_2BIT             0x4
+
+
+#define UART_RX         0       /* Receive buffer */
+#define UART_TX         4       /* Transmit buffer */
+#define UART_IER        8       /* Interrupt Enable Register */
+#define UART_IIR        0xC     /* Interrupt ID Register */
+#define UART_FCR        0x10    /* FIFO Control Register */
+#define UART_LCR        0x14    /* Line Control Register */
+#define UART_MCR        0x18    /* Modem Control Register */
+#define UART_LSR        0x1C    /* Line Status Register */
+#define UART_MSR        0x20    /* Modem Status Register */
+#define UART_CLK        0x28    /* Baud Rat4e Clock Divider */
+#define UART_MOD_CNTRL  0x100   /* Module Control */
+
+/* memory-mapped read/write of the port */
+#define UART16550_READ(y)    (au_readl(DEBUG_BASE + y) & 0xff)
+#define UART16550_WRITE(y,z) (au_writel(z&0xff, DEBUG_BASE + y))
+
+extern unsigned long get_au1x00_uart_baud_base(void);
+extern unsigned long cal_r4koff(void);
+
+void debugInit(uint32 baud, uint8 data, uint8 parity, uint8 stop)
+{
+
+        if (UART16550_READ(UART_MOD_CNTRL) != 0x3) {
+                UART16550_WRITE(UART_MOD_CNTRL, 3);
+        }
+        cal_r4koff();
+
+        /* disable interrupts */
+        UART16550_WRITE(UART_IER, 0);
+
+        /* set up baud rate */
+        {
+                uint32 divisor;
+
+                /* set divisor */
+                divisor = get_au1x00_uart_baud_base() / baud;
+                UART16550_WRITE(UART_CLK, divisor & 0xffff);
+        }
+
+        /* set data format */
+        UART16550_WRITE(UART_LCR, (data | parity | stop));
+}
+
+static int remoteDebugInitialized = 0;
+
+uint8 getDebugChar(void)
+{
+        if (!remoteDebugInitialized) {
+                remoteDebugInitialized = 1;
+                debugInit(UART16550_BAUD_115200,
+                          UART16550_DATA_8BIT,
+                          UART16550_PARITY_NONE,
+                          UART16550_STOP_1BIT);
+        }
+
+        while((UART16550_READ(UART_LSR) & 0x1) == 0);
+        return UART16550_READ(UART_RX);
+}
+
+
+int putDebugChar(uint8 byte)
+{
+//      int i;
+
+        if (!remoteDebugInitialized) {
+                remoteDebugInitialized = 1;
+                debugInit(UART16550_BAUD_115200,
+                          UART16550_DATA_8BIT,
+                          UART16550_PARITY_NONE,
+                          UART16550_STOP_1BIT);
+        }
+
+        while ((UART16550_READ(UART_LSR)&0x40) == 0);
+        UART16550_WRITE(UART_TX, byte);
+        //for (i=0;i<0xfff;i++);
+
+        return 1;
+}
+
+#endif