release/src-rt-6.x/linux/linux-2.6/arch/m68k/mac/debug.c

   1 /*
   2  * linux/arch/m68k/mac/debug.c
   3  *
   4  * Shamelessly stolen (SCC code and general framework) from:
   5  *
   6  * linux/arch/m68k/atari/debug.c
   7  *
   8  * Atari debugging and serial console stuff
   9  *
  10  * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
  11  *
  12  * This file is subject to the terms and conditions of the GNU General Public
  13  * License.  See the file COPYING in the main directory of this archive
  14  * for more details.
  15  */
  16
  17 #include <linux/types.h>
  18 #include <linux/sched.h>
  19 #include <linux/tty.h>
  20 #include <linux/console.h>
  21 #include <linux/init.h>
  22 #include <linux/delay.h>
  23
  24 #define BOOTINFO_COMPAT_1_0
  25 #include <asm/setup.h>
  26 #include <asm/bootinfo.h>
  27 #include <asm/machw.h>
  28 #include <asm/macints.h>
  29
  30 extern unsigned long mac_videobase;
  31 extern unsigned long mac_videodepth;
  32 extern unsigned long mac_rowbytes;
  33
  34 extern void mac_serial_print(const char *);
  35
  36 #define DEBUG_HEADS
  37 #undef DEBUG_SCREEN
  38 #define DEBUG_SERIAL
  39
  40 /*
  41  * These two auxiliary debug functions should go away ASAP. Only usage:
  42  * before the console output is up (after head.S come some other crucial
  43  * setup routines :-) it permits writing 'data' to the screen as bit patterns
  44  * (good luck reading those). Helped to figure that the bootinfo contained
  45  * garbage data on the amount and size of memory chunks ...
  46  *
  47  * The 'pos' argument now simply means 'linefeed after print' ...
  48  */
  49
  50 #ifdef DEBUG_SCREEN
  51 static int peng, line;
  52 #endif
  53
  54 void mac_debugging_short(int pos, short num)
  55 {
  56 #ifdef DEBUG_SCREEN
  57         unsigned char *pengoffset;
  58         unsigned char *pptr;
  59         int i;
  60 #endif
  61
  62 #ifdef DEBUG_SERIAL
  63         printk("debug: %d !\n", num);
  64 #endif
  65
  66 #ifdef DEBUG_SCREEN
  67         if (!MACH_IS_MAC) {
  68                 /* printk("debug: %d !\n", num); */
  69                 return;
  70         }
  71
  72         /* calculate current offset */
  73         pengoffset = (unsigned char *)mac_videobase +
  74                 (150+line*2) * mac_rowbytes + 80 * peng;
  75
  76         pptr = pengoffset;
  77
  78         for (i = 0; i < 8 * sizeof(short); i++) { /* # of bits */
  79                 /*        value        mask for bit i, reverse order */
  80                 *pptr++ = (num & (1 << (8*sizeof(short)-i-1)) ? 0xFF : 0x00);
  81         }
  82
  83         peng++;
  84
  85         if (pos) {
  86                 line++;
  87                 peng = 0;
  88         }
  89 #endif
  90 }
  91
  92 void mac_debugging_long(int pos, long addr)
  93 {
  94 #ifdef DEBUG_SCREEN
  95         unsigned char *pengoffset;
  96         unsigned char *pptr;
  97         int i;
  98 #endif
  99
 100 #ifdef DEBUG_SERIAL
 101         printk("debug: #%ld !\n", addr);
 102 #endif
 103
 104 #ifdef DEBUG_SCREEN
 105         if (!MACH_IS_MAC) {
 106                 /* printk("debug: #%ld !\n", addr); */
 107                 return;
 108         }
 109
 110         pengoffset=(unsigned char *)(mac_videobase+(150+line*2)*mac_rowbytes)
 111                     +80*peng;
 112
 113         pptr = pengoffset;
 114
 115         for (i = 0; i < 8 * sizeof(long); i++) { /* # of bits */
 116                 *pptr++ = (addr & (1 << (8*sizeof(long)-i-1)) ? 0xFF : 0x00);
 117         }
 118
 119         peng++;
 120
 121         if (pos) {
 122                 line++;
 123                 peng = 0;
 124         }
 125 #endif
 126 }
 127
 128 #ifdef DEBUG_SERIAL
 129 /*
 130  * TODO: serial debug code
 131  */
 132
 133 struct mac_SCC {
 134         u_char cha_b_ctrl;
 135         u_char char_dummy1;
 136         u_char cha_a_ctrl;
 137         u_char char_dummy2;
 138         u_char cha_b_data;
 139         u_char char_dummy3;
 140         u_char cha_a_data;
 141 };
 142
 143 # define scc (*((volatile struct mac_SCC*)mac_bi_data.sccbase))
 144
 145 /* Flag that serial port is already initialized and used */
 146 int mac_SCC_init_done;
 147 /* Can be set somewhere, if a SCC master reset has already be done and should
 148  * not be repeated; used by kgdb */
 149 int mac_SCC_reset_done;
 150
 151 static int scc_port = -1;
 152
 153 static struct console mac_console_driver = {
 154         .name   = "debug",
 155         .flags  = CON_PRINTBUFFER,
 156         .index  = -1,
 157 };
 158
 159 /*
 160  * Crude hack to get console output to the screen before the framebuffer
 161  * is initialized (happens a lot later in 2.1!).
 162  * We just use the console routines declared in head.S, this will interfere
 163  * with regular framebuffer console output and should be used exclusively
 164  * to debug kernel problems manifesting before framebuffer init (aka WSOD)
 165  *
 166  * To keep this hack from interfering with the regular console driver, either
 167  * deregister this driver before/on framebuffer console init, or silence this
 168  * function after the fbcon driver is running (will lose console messages!?).
 169  * To debug real early bugs, need to write a 'mac_register_console_hack()'
 170  * that is called from start_kernel() before setup_arch() and just registers
 171  * this driver if Mac.
 172  */
 173
 174 void mac_debug_console_write(struct console *co, const char *str,
 175                              unsigned int count)
 176 {
 177         mac_serial_print(str);
 178 }
 179
 180
 181
 182 /* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/
 183
 184 #define uSEC 1
 185
 186 static inline void mac_sccb_out(char c)
 187 {
 188         int i;
 189
 190         do {
 191                 for (i = uSEC; i > 0; --i)
 192                         barrier();
 193         } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
 194         for (i = uSEC; i > 0; --i)
 195                 barrier();
 196         scc.cha_b_data = c;
 197 }
 198
 199 static inline void mac_scca_out(char c)
 200 {
 201         int i;
 202
 203         do {
 204                 for (i = uSEC; i > 0; --i)
 205                         barrier();
 206         } while (!(scc.cha_a_ctrl & 0x04)); /* wait for tx buf empty */
 207         for (i = uSEC; i > 0; --i)
 208                 barrier();
 209         scc.cha_a_data = c;
 210 }
 211
 212 void mac_sccb_console_write(struct console *co, const char *str,
 213                             unsigned int count)
 214 {
 215         while (count--) {
 216                 if (*str == '\n')
 217                         mac_sccb_out('\r');
 218                 mac_sccb_out(*str++);
 219         }
 220 }
 221
 222 void mac_scca_console_write(struct console *co, const char *str,
 223                             unsigned int count)
 224 {
 225         while (count--) {
 226                 if (*str == '\n')
 227                         mac_scca_out('\r');
 228                 mac_scca_out(*str++);
 229         }
 230 }
 231
 232
 233 /* The following two functions do a quick'n'dirty initialization of the MFP or
 234  * SCC serial ports. They're used by the debugging interface, kgdb, and the
 235  * serial console code. */
 236 #define SCCB_WRITE(reg,val)                             \
 237         do {                                            \
 238                 int i;                                  \
 239                 scc.cha_b_ctrl = (reg);                 \
 240                 for (i = uSEC; i > 0; --i)              \
 241                         barrier();                      \
 242                 scc.cha_b_ctrl = (val);                 \
 243                 for (i = uSEC; i > 0; --i)              \
 244                         barrier();                      \
 245         } while(0)
 246
 247 #define SCCA_WRITE(reg,val)                             \
 248         do {                                            \
 249                 int i;                                  \
 250                 scc.cha_a_ctrl = (reg);                 \
 251                 for (i = uSEC; i > 0; --i)              \
 252                         barrier();                      \
 253                 scc.cha_a_ctrl = (val);                 \
 254                 for (i = uSEC; i > 0; --i)              \
 255                         barrier();                      \
 256         } while(0)
 257
 258 /* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
 259  * delay of ~ 60us. */
 260 /* Mac: loops_per_jiffy min. 19000 ^= .5 us; MFPDELAY was 0.6 us*/
 261 #define LONG_DELAY()                                    \
 262         do {                                            \
 263                 int i;                                  \
 264                 for (i = 60*uSEC; i > 0; --i)           \
 265                     barrier();                          \
 266         } while(0)
 267
 268 #ifndef CONFIG_SERIAL_CONSOLE
 269 static void __init mac_init_scc_port(int cflag, int port)
 270 #else
 271 void mac_init_scc_port(int cflag, int port)
 272 #endif
 273 {
 274         extern int mac_SCC_reset_done;
 275
 276         /*
 277          * baud rates: 1200, 1800, 2400, 4800, 9600, 19.2k, 38.4k, 57.6k, 115.2k
 278          */
 279
 280         static int clksrc_table[9] =
 281                 /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
 282                 { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
 283         static int clkmode_table[9] =
 284                 /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
 285                 { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
 286         static int div_table[9] =
 287                 /* reg12 (BRG low) */
 288                 { 94, 62, 46, 22, 10, 4, 1, 0, 0 };
 289
 290         int baud = cflag & CBAUD;
 291         int clksrc, clkmode, div, reg3, reg5;
 292
 293         if (cflag & CBAUDEX)
 294                 baud += B38400;
 295         if (baud < B1200 || baud > B38400+2)
 296                 baud = B9600; /* use default 9600bps for non-implemented rates */
 297         baud -= B1200; /* tables starts at 1200bps */
 298
 299         clksrc  = clksrc_table[baud];
 300         clkmode = clkmode_table[baud];
 301         div     = div_table[baud];
 302
 303         reg3 = (((cflag & CSIZE) == CS8) ? 0xc0 : 0x40);
 304         reg5 = (((cflag & CSIZE) == CS8) ? 0x60 : 0x20) | 0x82 /* assert DTR/RTS */;
 305
 306         if (port == 1) {
 307                 (void)scc.cha_b_ctrl;   /* reset reg pointer */
 308                 SCCB_WRITE(9, 0xc0);    /* reset */
 309                 LONG_DELAY();           /* extra delay after WR9 access */
 310                 SCCB_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
 311                            0x04 /* 1 stopbit */ |
 312                            clkmode);
 313                 SCCB_WRITE(3, reg3);
 314                 SCCB_WRITE(5, reg5);
 315                 SCCB_WRITE(9, 0);       /* no interrupts */
 316                 LONG_DELAY();           /* extra delay after WR9 access */
 317                 SCCB_WRITE(10, 0);      /* NRZ mode */
 318                 SCCB_WRITE(11, clksrc); /* main clock source */
 319                 SCCB_WRITE(12, div);    /* BRG value */
 320                 SCCB_WRITE(13, 0);      /* BRG high byte */
 321                 SCCB_WRITE(14, 1);
 322                 SCCB_WRITE(3, reg3 | 1);
 323                 SCCB_WRITE(5, reg5 | 8);
 324         } else if (port == 0) {
 325                 (void)scc.cha_a_ctrl;   /* reset reg pointer */
 326                 SCCA_WRITE(9, 0xc0);    /* reset */
 327                 LONG_DELAY();           /* extra delay after WR9 access */
 328                 SCCA_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
 329                           0x04 /* 1 stopbit */ |
 330                           clkmode);
 331                 SCCA_WRITE(3, reg3);
 332                 SCCA_WRITE(5, reg5);
 333                 SCCA_WRITE(9, 0);       /* no interrupts */
 334                 LONG_DELAY();           /* extra delay after WR9 access */
 335                 SCCA_WRITE(10, 0);      /* NRZ mode */
 336                 SCCA_WRITE(11, clksrc); /* main clock source */
 337                 SCCA_WRITE(12, div);    /* BRG value */
 338                 SCCA_WRITE(13, 0);      /* BRG high byte */
 339                 SCCA_WRITE(14, 1);
 340                 SCCA_WRITE(3, reg3 | 1);
 341                 SCCA_WRITE(5, reg5 | 8);
 342         }
 343
 344         mac_SCC_reset_done = 1;
 345         mac_SCC_init_done = 1;
 346 }
 347 #endif /* DEBUG_SERIAL */
 348
 349 void mac_init_scca_port(int cflag)
 350 {
 351         mac_init_scc_port(cflag, 0);
 352 }
 353
 354 void mac_init_sccb_port(int cflag)
 355 {
 356         mac_init_scc_port(cflag, 1);
 357 }
 358
 359 static int __init mac_debug_setup(char *arg)
 360 {
 361         if (!MACH_IS_MAC)
 362                 return 0;
 363
 364 #ifdef DEBUG_SERIAL
 365         if (!strcmp(arg, "ser") || !strcmp(arg, "ser1")) {
 366                 /* Mac modem port */
 367                 mac_init_scc_port(B9600|CS8, 0);
 368                 mac_console_driver.write = mac_scca_console_write;
 369                 scc_port = 0;
 370         } else if (!strcmp(arg, "ser2")) {
 371                 /* Mac printer port */
 372                 mac_init_scc_port(B9600|CS8, 1);
 373                 mac_console_driver.write = mac_sccb_console_write;
 374                 scc_port = 1;
 375         }
 376 #endif
 377 #ifdef DEBUG_HEADS
 378         if (!strcmp(arg, "scn") || !strcmp(arg, "con")) {
 379                 /* display, using head.S console routines */
 380                 mac_console_driver.write = mac_debug_console_write;
 381         }
 382 #endif
 383         if (mac_console_driver.write)
 384                 register_console(&mac_console_driver);
 385         return 0;
 386 }
 387
 388 early_param("debug", mac_debug_setup);