arch/blackfin/cpu/jtag-console.c

   1 /*
   2  * jtag-console.c - console driver over Blackfin JTAG
   3  *
   4  * Copyright (c) 2008-2010 Analog Devices Inc.
   5  *
   6  * Licensed under the GPL-2 or later.
   7  */
   8
   9 #include <common.h>
  10 #include <stdio_dev.h>
  11 #include <asm/blackfin.h>
  12
  13 #ifdef DEBUG
  14 # define dprintf(...) serial_printf(__VA_ARGS__)
  15 #else
  16 # define dprintf(...) do { if (0) printf(__VA_ARGS__); } while (0)
  17 #endif
  18
  19 static inline void dprintf_decode(const char *s, uint32_t len)
  20 {
  21         uint32_t i;
  22         for (i = 0; i < len; ++i)
  23                 if (s[i] < 0x20 || s[i] >= 0x7f)
  24                         dprintf("\\%o", s[i]);
  25                 else
  26                         dprintf("%c", s[i]);
  27 }
  28
  29 static inline uint32_t bfin_write_emudat(uint32_t emudat)
  30 {
  31         __asm__ __volatile__("emudat = %0;" : : "d"(emudat));
  32         return emudat;
  33 }
  34
  35 static inline uint32_t bfin_read_emudat(void)
  36 {
  37         uint32_t emudat;
  38         __asm__ __volatile__("%0 = emudat;" : "=d"(emudat));
  39         return emudat;
  40 }
  41
  42 #ifndef CONFIG_JTAG_CONSOLE_TIMEOUT
  43 # define CONFIG_JTAG_CONSOLE_TIMEOUT 500
  44 #endif
  45
  46 /* The Blackfin tends to be much much faster than the JTAG hardware. */
  47 static bool jtag_write_emudat(uint32_t emudat)
  48 {
  49         static bool overflowed = false;
  50         ulong timeout = get_timer(0) + CONFIG_JTAG_CONSOLE_TIMEOUT;
  51         while (bfin_read_DBGSTAT() & 0x1) {
  52                 if (overflowed)
  53                         return overflowed;
  54                 if (timeout < get_timer(0))
  55                         overflowed = true;
  56         }
  57         overflowed = false;
  58         bfin_write_emudat(emudat);
  59         return overflowed;
  60 }
  61 /* Transmit a buffer.  The format is:
  62  * [32bit length][actual data]
  63  */
  64 static void jtag_send(const char *c, uint32_t len)
  65 {
  66         uint32_t i;
  67
  68         if (len == 0)
  69                 return;
  70
  71         dprintf("%s(\"", __func__);
  72         dprintf_decode(c, len);
  73         dprintf("\", %i)\n", len);
  74
  75         /* First send the length */
  76         if (jtag_write_emudat(len))
  77                 return;
  78
  79         /* Then send the data */
  80         for (i = 0; i < len; i += 4) {
  81                 uint32_t emudat =
  82                         (c[i + 0] <<  0) |
  83                         (c[i + 1] <<  8) |
  84                         (c[i + 2] << 16) |
  85                         (c[i + 3] << 24);
  86                 if (jtag_write_emudat(emudat)) {
  87                         bfin_write_emudat(0);
  88                         return;
  89                 }
  90         }
  91 }
  92 static void jtag_putc(const char c)
  93 {
  94         jtag_send(&c, 1);
  95 }
  96 static void jtag_puts(const char *s)
  97 {
  98         jtag_send(s, strlen(s));
  99 }
 100
 101 static size_t inbound_len, leftovers_len;
 102
 103 /* Lower layers want to know when jtag has data */
 104 static int jtag_tstc_dbg(void)
 105 {
 106         int ret = (bfin_read_DBGSTAT() & 0x2);
 107         if (ret)
 108                 dprintf("%s: ret:%i\n", __func__, ret);
 109         return ret;
 110 }
 111
 112 /* Higher layers want to know when any data is available */
 113 static int jtag_tstc(void)
 114 {
 115         return jtag_tstc_dbg() || leftovers_len;
 116 }
 117
 118 /* Receive a buffer.  The format is:
 119  * [32bit length][actual data]
 120  */
 121 static uint32_t leftovers;
 122 static int jtag_getc(void)
 123 {
 124         int ret;
 125         uint32_t emudat;
 126
 127         dprintf("%s: inlen:%zu leftlen:%zu left:%x\n", __func__,
 128                 inbound_len, leftovers_len, leftovers);
 129
 130         /* see if any data is left over */
 131         if (leftovers_len) {
 132                 --leftovers_len;
 133                 ret = leftovers & 0xff;
 134                 leftovers >>= 8;
 135                 return ret;
 136         }
 137
 138         /* wait for new data ! */
 139         while (!jtag_tstc_dbg())
 140                 continue;
 141         emudat = bfin_read_emudat();
 142
 143         if (inbound_len == 0) {
 144                 /* grab the length */
 145                 inbound_len = emudat;
 146         } else {
 147                 /* store the bytes */
 148                 leftovers_len = min(4, inbound_len);
 149                 inbound_len -= leftovers_len;
 150                 leftovers = emudat;
 151         }
 152
 153         return jtag_getc();
 154 }
 155
 156 int drv_jtag_console_init(void)
 157 {
 158         struct stdio_dev dev;
 159         int ret;
 160
 161         memset(&dev, 0x00, sizeof(dev));
 162         strcpy(dev.name, "jtag");
 163         dev.flags = DEV_FLAGS_OUTPUT | DEV_FLAGS_INPUT | DEV_FLAGS_SYSTEM;
 164         dev.putc = jtag_putc;
 165         dev.puts = jtag_puts;
 166         dev.tstc = jtag_tstc;
 167         dev.getc = jtag_getc;
 168
 169         ret = stdio_register(&dev);
 170         return (ret == 0 ? 1 : ret);
 171 }
 172
 173 #ifdef CONFIG_UART_CONSOLE_IS_JTAG
 174 /* Since the JTAG is always available (at power on), allow it to fake a UART */
 175 void serial_set_baud(uint32_t baud) {}
 176 void serial_setbrg(void)            {}
 177 int serial_init(void)               { return 0; }
 178 void serial_putc(const char c)      __attribute__((alias("jtag_putc")));
 179 void serial_puts(const char *s)     __attribute__((alias("jtag_puts")));
 180 int serial_tstc(void)               __attribute__((alias("jtag_tstc")));
 181 int serial_getc(void)               __attribute__((alias("jtag_getc")));
 182 #endif