1 files changed, 138 insertions, 0 deletions

diff --git a/arch/mips/galileo-boards/ev96100/puts.c b/arch/mips/galileo-boards/ev96100/puts.c
new file mode 100644
index 000000000000..49dc6d137b9c
--- /dev/null
+++ b/arch/mips/galileo-boards/ev96100/puts.c
@@ -0,0 +1,138 @@
+
+/*
+ * Debug routines which directly access the uart.
+ */
+
+#include <linux/types.h>
+#include <asm/gt64120.h>
+
+
+//#define SERIAL_BASE    EV96100_UART0_REGS_BASE
+#define SERIAL_BASE    0xBD000020
+#define NS16550_BASE   SERIAL_BASE
+
+#define SERA_CMD       0x0D
+#define SERA_DATA      0x08
+//#define SERB_CMD       0x05
+#define SERB_CMD       20
+#define SERB_DATA      0x00
+#define TX_BUSY        0x20
+
+#define TIMEOUT    0xffff
+#undef SLOW_DOWN
+
+static const char digits[16] = "0123456789abcdef";
+static volatile unsigned char *const com1 = (unsigned char *) SERIAL_BASE;
+
+
+#ifdef SLOW_DOWN
+static inline void slow_down()
+{
+        int k;
+        for (k = 0; k < 10000; k++);
+}
+#else
+#define slow_down()
+#endif
+
+void putch(const unsigned char c)
+{
+        unsigned char ch;
+        int i = 0;
+
+        do {
+                ch = com1[SERB_CMD];
+                slow_down();
+                i++;
+                if (i > TIMEOUT) {
+                        break;
+                }
+        } while (0 == (ch & TX_BUSY));
+        com1[SERB_DATA] = c;
+}
+
+void putchar(const unsigned char c)
+{
+        unsigned char ch;
+        int i = 0;
+
+        do {
+                ch = com1[SERB_CMD];
+                slow_down();
+                i++;
+                if (i > TIMEOUT) {
+                        break;
+                }
+        } while (0 == (ch & TX_BUSY));
+        com1[SERB_DATA] = c;
+}
+
+void puts(unsigned char *cp)
+{
+        unsigned char ch;
+        int i = 0;
+
+        while (*cp) {
+                do {
+                        ch = com1[SERB_CMD];
+                        slow_down();
+                        i++;
+                        if (i > TIMEOUT) {
+                                break;
+                        }
+                } while (0 == (ch & TX_BUSY));
+                com1[SERB_DATA] = *cp++;
+        }
+        putch('\r');
+        putch('\n');
+}
+
+void fputs(unsigned char *cp)
+{
+        unsigned char ch;
+        int i = 0;
+
+        while (*cp) {
+
+                do {
+                        ch = com1[SERB_CMD];
+                        slow_down();
+                        i++;
+                        if (i > TIMEOUT) {
+                                break;
+                        }
+                } while (0 == (ch & TX_BUSY));
+                com1[SERB_DATA] = *cp++;
+        }
+}
+
+
+void put64(uint64_t ul)
+{
+        int cnt;
+        unsigned ch;
+
+        cnt = 16;               /* 16 nibbles in a 64 bit long */
+        putch('0');
+        putch('x');
+        do {
+                cnt--;
+                ch = (unsigned char) (ul >> cnt * 4) & 0x0F;
+                putch(digits[ch]);
+        } while (cnt > 0);
+}
+
+void put32(unsigned u)
+{
+        int cnt;
+        unsigned ch;
+
+        cnt = 8;                /* 8 nibbles in a 32 bit long */
+        putch('0');
+        putch('x');
+        do {
+                cnt--;
+                ch = (unsigned char) (u >> cnt * 4) & 0x0F;
+                putch(digits[ch]);
+        } while (cnt > 0);
+}