- /*
- * Debug routines which directly access the uart.
- */
- #include <linux/types.h>
- #include <asm/galileo-boards/ev96100.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);
- }