release/src-rt-6.x.4708/linux/linux-2.6.36/arch/m68k/atari/debug.c

   1 /*
   2  * linux/arch/m68k/atari/debug.c
   3  *
   4  * Atari debugging and serial console stuff
   5  *
   6  * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
   7  *
   8  * This file is subject to the terms and conditions of the GNU General Public
   9  * License.  See the file COPYING in the main directory of this archive
  10  * for more details.
  11  */
  12
  13 #include <linux/types.h>
  14 #include <linux/tty.h>
  15 #include <linux/console.h>
  16 #include <linux/init.h>
  17 #include <linux/delay.h>
  18 #include <linux/module.h>
  19
  20 #include <asm/atarihw.h>
  21 #include <asm/atariints.h>
  22
  23 /* Can be set somewhere, if a SCC master reset has already be done and should
  24  * not be repeated; used by kgdb */
  25 int atari_SCC_reset_done;
  26 EXPORT_SYMBOL(atari_SCC_reset_done);
  27
  28 static struct console atari_console_driver = {
  29         .name   = "debug",
  30         .flags  = CON_PRINTBUFFER,
  31         .index  = -1,
  32 };
  33
  34
  35 static inline void ata_mfp_out(char c)
  36 {
  37         while (!(st_mfp.trn_stat & 0x80))       /* wait for tx buf empty */
  38                 barrier();
  39         st_mfp.usart_dta = c;
  40 }
  41
  42 static void atari_mfp_console_write(struct console *co, const char *str,
  43                                     unsigned int count)
  44 {
  45         while (count--) {
  46                 if (*str == '\n')
  47                         ata_mfp_out('\r');
  48                 ata_mfp_out(*str++);
  49         }
  50 }
  51
  52 static inline void ata_scc_out(char c)
  53 {
  54         do {
  55                 MFPDELAY();
  56         } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
  57         MFPDELAY();
  58         scc.cha_b_data = c;
  59 }
  60
  61 static void atari_scc_console_write(struct console *co, const char *str,
  62                                     unsigned int count)
  63 {
  64         while (count--) {
  65                 if (*str == '\n')
  66                         ata_scc_out('\r');
  67                 ata_scc_out(*str++);
  68         }
  69 }
  70
  71 static inline void ata_midi_out(char c)
  72 {
  73         while (!(acia.mid_ctrl & ACIA_TDRE))    /* wait for tx buf empty */
  74                 barrier();
  75         acia.mid_data = c;
  76 }
  77
  78 static void atari_midi_console_write(struct console *co, const char *str,
  79                                      unsigned int count)
  80 {
  81         while (count--) {
  82                 if (*str == '\n')
  83                         ata_midi_out('\r');
  84                 ata_midi_out(*str++);
  85         }
  86 }
  87
  88 static int ata_par_out(char c)
  89 {
  90         unsigned char tmp;
  91         /* This a some-seconds timeout in case no printer is connected */
  92         unsigned long i = loops_per_jiffy > 1 ? loops_per_jiffy : 10000000/HZ;
  93
  94         while ((st_mfp.par_dt_reg & 1) && --i) /* wait for BUSY == L */
  95                 ;
  96         if (!i)
  97                 return 0;
  98
  99         sound_ym.rd_data_reg_sel = 15;  /* select port B */
 100         sound_ym.wd_data = c;           /* put char onto port */
 101         sound_ym.rd_data_reg_sel = 14;  /* select port A */
 102         tmp = sound_ym.rd_data_reg_sel;
 103         sound_ym.wd_data = tmp & ~0x20; /* set strobe L */
 104         MFPDELAY();                     /* wait a bit */
 105         sound_ym.wd_data = tmp | 0x20;  /* set strobe H */
 106         return 1;
 107 }
 108
 109 static void atari_par_console_write(struct console *co, const char *str,
 110                                     unsigned int count)
 111 {
 112         static int printer_present = 1;
 113
 114         if (!printer_present)
 115                 return;
 116
 117         while (count--) {
 118                 if (*str == '\n') {
 119                         if (!ata_par_out('\r')) {
 120                                 printer_present = 0;
 121                                 return;
 122                         }
 123                 }
 124                 if (!ata_par_out(*str++)) {
 125                         printer_present = 0;
 126                         return;
 127                 }
 128         }
 129 }
 130
 131
 132 /*
 133  * The following two functions do a quick'n'dirty initialization of the MFP or
 134  * SCC serial ports. They're used by the debugging interface, kgdb, and the
 135  * serial console code.
 136  */
 137 static void __init atari_init_mfp_port(int cflag)
 138 {
 139         /*
 140          * timer values for 1200...115200 bps; > 38400 select 110, 134, or 150
 141          * bps, resp., and work only correct if there's a RSVE or RSSPEED
 142          */
 143         static int baud_table[9] = { 16, 11, 8, 4, 2, 1, 175, 143, 128 };
 144         int baud = cflag & CBAUD;
 145         int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x04 : 0x06) : 0;
 146         int csize = ((cflag & CSIZE) == CS7) ? 0x20 : 0x00;
 147
 148         if (cflag & CBAUDEX)
 149                 baud += B38400;
 150         if (baud < B1200 || baud > B38400+2)
 151                 baud = B9600;           /* use default 9600bps for non-implemented rates */
 152         baud -= B1200;                  /* baud_table[] starts at 1200bps */
 153
 154         st_mfp.trn_stat &= ~0x01;       /* disable TX */
 155         st_mfp.usart_ctr = parity | csize | 0x88; /* 1:16 clk mode, 1 stop bit */
 156         st_mfp.tim_ct_cd &= 0x70;       /* stop timer D */
 157         st_mfp.tim_dt_d = baud_table[baud];
 158         st_mfp.tim_ct_cd |= 0x01;       /* start timer D, 1:4 */
 159         st_mfp.trn_stat |= 0x01;        /* enable TX */
 160 }
 161
 162 #define SCC_WRITE(reg, val)                             \
 163         do {                                            \
 164                 scc.cha_b_ctrl = (reg);                 \
 165                 MFPDELAY();                             \
 166                 scc.cha_b_ctrl = (val);                 \
 167                 MFPDELAY();                             \
 168         } while (0)
 169
 170 /* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
 171  * delay of ~ 60us. */
 172 #define LONG_DELAY()                                    \
 173         do {                                            \
 174                 int i;                                  \
 175                 for (i = 100; i > 0; --i)               \
 176                         MFPDELAY();                     \
 177         } while (0)
 178
 179 static void __init atari_init_scc_port(int cflag)
 180 {
 181         extern int atari_SCC_reset_done;
 182         static int clksrc_table[9] =
 183                 /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
 184                 { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
 185         static int brgsrc_table[9] =
 186                 /* reg 14: 0 = RTxC, 2 = PCLK */
 187                 { 2, 2, 2, 2, 2, 2, 0, 2, 2 };
 188         static int clkmode_table[9] =
 189                 /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
 190                 { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
 191         static int div_table[9] =
 192                 /* reg12 (BRG low) */
 193                 { 208, 138, 103, 50, 24, 11, 1, 0, 0 };
 194
 195         int baud = cflag & CBAUD;
 196         int clksrc, clkmode, div, reg3, reg5;
 197
 198         if (cflag & CBAUDEX)
 199                 baud += B38400;
 200         if (baud < B1200 || baud > B38400+2)
 201                 baud = B9600;           /* use default 9600bps for non-implemented rates */
 202         baud -= B1200;                  /* tables starts at 1200bps */
 203
 204         clksrc  = clksrc_table[baud];
 205         clkmode = clkmode_table[baud];
 206         div     = div_table[baud];
 207         if (ATARIHW_PRESENT(TT_MFP) && baud >= 6) {
 208                 /* special treatment for TT, where rates >= 38400 are done via TRxC */
 209                 clksrc = 0x28;          /* TRxC */
 210                 clkmode = baud == 6 ? 0xc0 :
 211                           baud == 7 ? 0x80 : /* really 76800bps */
 212                                       0x40;  /* really 153600bps */
 213                 div = 0;
 214         }
 215
 216         reg3 = (cflag & CSIZE) == CS8 ? 0xc0 : 0x40;
 217         reg5 = (cflag & CSIZE) == CS8 ? 0x60 : 0x20 | 0x82 /* assert DTR/RTS */;
 218
 219         (void)scc.cha_b_ctrl;           /* reset reg pointer */
 220         SCC_WRITE(9, 0xc0);             /* reset */
 221         LONG_DELAY();                   /* extra delay after WR9 access */
 222         SCC_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03)
 223                                       : 0 | 0x04 /* 1 stopbit */ | clkmode);
 224         SCC_WRITE(3, reg3);
 225         SCC_WRITE(5, reg5);
 226         SCC_WRITE(9, 0);                /* no interrupts */
 227         LONG_DELAY();                   /* extra delay after WR9 access */
 228         SCC_WRITE(10, 0);               /* NRZ mode */
 229         SCC_WRITE(11, clksrc);          /* main clock source */
 230         SCC_WRITE(12, div);             /* BRG value */
 231         SCC_WRITE(13, 0);               /* BRG high byte */
 232         SCC_WRITE(14, brgsrc_table[baud]);
 233         SCC_WRITE(14, brgsrc_table[baud] | (div ? 1 : 0));
 234         SCC_WRITE(3, reg3 | 1);
 235         SCC_WRITE(5, reg5 | 8);
 236
 237         atari_SCC_reset_done = 1;
 238 }
 239
 240 static void __init atari_init_midi_port(int cflag)
 241 {
 242         int baud = cflag & CBAUD;
 243         int csize = ((cflag & CSIZE) == CS8) ? 0x10 : 0x00;
 244         /* warning 7N1 isn't possible! (instead 7O2 is used...) */
 245         int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x0c : 0x08) : 0x04;
 246         int div;
 247
 248         /* 4800 selects 7812.5, 115200 selects 500000, all other (incl. 9600 as
 249          * default) the standard MIDI speed 31250. */
 250         if (cflag & CBAUDEX)
 251                 baud += B38400;
 252         if (baud == B4800)
 253                 div = ACIA_DIV64;       /* really 7812.5 bps */
 254         else if (baud == B38400+2 /* 115200 */)
 255                 div = ACIA_DIV1;        /* really 500 kbps (does that work??) */
 256         else
 257                 div = ACIA_DIV16;       /* 31250 bps, standard for MIDI */
 258
 259         /* RTS low, ints disabled */
 260         acia.mid_ctrl = div | csize | parity |
 261                     ((atari_switches & ATARI_SWITCH_MIDI) ?
 262                      ACIA_RHTID : ACIA_RLTID);
 263 }
 264
 265 static int __init atari_debug_setup(char *arg)
 266 {
 267         if (!MACH_IS_ATARI)
 268                 return 0;
 269
 270         if (!strcmp(arg, "ser"))
 271                 /* defaults to ser2 for a Falcon and ser1 otherwise */
 272                 arg = MACH_IS_FALCON ? "ser2" : "ser1";
 273
 274         if (!strcmp(arg, "ser1")) {
 275                 /* ST-MFP Modem1 serial port */
 276                 atari_init_mfp_port(B9600|CS8);
 277                 atari_console_driver.write = atari_mfp_console_write;
 278         } else if (!strcmp(arg, "ser2")) {
 279                 /* SCC Modem2 serial port */
 280                 atari_init_scc_port(B9600|CS8);
 281                 atari_console_driver.write = atari_scc_console_write;
 282         } else if (!strcmp(arg, "midi")) {
 283                 /* MIDI port */
 284                 atari_init_midi_port(B9600|CS8);
 285                 atari_console_driver.write = atari_midi_console_write;
 286         } else if (!strcmp(arg, "par")) {
 287                 /* parallel printer */
 288                 atari_turnoff_irq(IRQ_MFP_BUSY); /* avoid ints */
 289                 sound_ym.rd_data_reg_sel = 7;   /* select mixer control */
 290                 sound_ym.wd_data = 0xff;        /* sound off, ports are output */
 291                 sound_ym.rd_data_reg_sel = 15;  /* select port B */
 292                 sound_ym.wd_data = 0;           /* no char */
 293                 sound_ym.rd_data_reg_sel = 14;  /* select port A */
 294                 sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x20; /* strobe H */
 295                 atari_console_driver.write = atari_par_console_write;
 296         }
 297         if (atari_console_driver.write)
 298                 register_console(&atari_console_driver);
 299
 300         return 0;
 301 }
 302
 303 early_param("debug", atari_debug_setup);