m68k: atari - Rename "mfp" to "st_mfp"
[linux-2.6.git] / arch / m68k / atari / debug.c
index 4ae0100..28efdc3 100644 (file)
 #include <linux/console.h>
 #include <linux/init.h>
 #include <linux/delay.h>
+#include <linux/module.h>
 
 #include <asm/atarihw.h>
 #include <asm/atariints.h>
 
-extern char m68k_debug_device[];
-
-/* Flag that Modem1 port is already initialized and used */
-int atari_MFP_init_done;
-/* Flag that Modem1 port is already initialized and used */
-int atari_SCC_init_done;
 /* Can be set somewhere, if a SCC master reset has already be done and should
  * not be repeated; used by kgdb */
 int atari_SCC_reset_done;
+EXPORT_SYMBOL(atari_SCC_reset_done);
 
 static struct console atari_console_driver = {
-       .name =         "debug",
-       .flags =        CON_PRINTBUFFER,
-       .index =        -1,
+       .name   = "debug",
+       .flags  = CON_PRINTBUFFER,
+       .index  = -1,
 };
 
 
-static inline void ata_mfp_out (char c)
+static inline void ata_mfp_out(char c)
 {
-    while (!(mfp.trn_stat & 0x80)) /* wait for tx buf empty */
-       barrier ();
-    mfp.usart_dta = c;
+       while (!(st_mfp.trn_stat & 0x80))       /* wait for tx buf empty */
+               barrier();
+       st_mfp.usart_dta = c;
 }
 
-void atari_mfp_console_write (struct console *co, const char *str,
-                             unsigned int count)
+static void atari_mfp_console_write(struct console *co, const char *str,
+                                   unsigned int count)
 {
-    while (count--) {
-       if (*str == '\n')
-           ata_mfp_out( '\r' );
-       ata_mfp_out( *str++ );
-    }
+       while (count--) {
+               if (*str == '\n')
+                       ata_mfp_out('\r');
+               ata_mfp_out(*str++);
+       }
 }
 
-static inline void ata_scc_out (char c)
+static inline void ata_scc_out(char c)
 {
-    do {
+       do {
+               MFPDELAY();
+       } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
        MFPDELAY();
-    } while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
-    MFPDELAY();
-    scc.cha_b_data = c;
+       scc.cha_b_data = c;
 }
 
-void atari_scc_console_write (struct console *co, const char *str,
-                             unsigned int count)
+static void atari_scc_console_write(struct console *co, const char *str,
+                                   unsigned int count)
 {
-    while (count--) {
-       if (*str == '\n')
-           ata_scc_out( '\r' );
-       ata_scc_out( *str++ );
-    }
+       while (count--) {
+               if (*str == '\n')
+                       ata_scc_out('\r');
+               ata_scc_out(*str++);
+       }
 }
 
-static inline void ata_midi_out (char c)
+static inline void ata_midi_out(char c)
 {
-    while (!(acia.mid_ctrl & ACIA_TDRE)) /* wait for tx buf empty */
-       barrier ();
-    acia.mid_data = c;
+       while (!(acia.mid_ctrl & ACIA_TDRE))    /* wait for tx buf empty */
+               barrier();
+       acia.mid_data = c;
 }
 
-void atari_midi_console_write (struct console *co, const char *str,
-                              unsigned int count)
+static void atari_midi_console_write(struct console *co, const char *str,
+                                    unsigned int count)
 {
-    while (count--) {
-       if (*str == '\n')
-           ata_midi_out( '\r' );
-       ata_midi_out( *str++ );
-    }
+       while (count--) {
+               if (*str == '\n')
+                       ata_midi_out('\r');
+               ata_midi_out(*str++);
+       }
 }
 
-static int ata_par_out (char c)
+static int ata_par_out(char c)
 {
-    unsigned char tmp;
-    /* This a some-seconds timeout in case no printer is connected */
-    unsigned long i = loops_per_jiffy > 1 ? loops_per_jiffy : 10000000/HZ;
-
-    while( (mfp.par_dt_reg & 1) && --i ) /* wait for BUSY == L */
-       ;
-    if (!i) return( 0 );
-
-    sound_ym.rd_data_reg_sel = 15;  /* select port B */
-    sound_ym.wd_data = c;           /* put char onto port */
-    sound_ym.rd_data_reg_sel = 14;  /* select port A */
-    tmp = sound_ym.rd_data_reg_sel;
-    sound_ym.wd_data = tmp & ~0x20; /* set strobe L */
-    MFPDELAY();                     /* wait a bit */
-    sound_ym.wd_data = tmp | 0x20;  /* set strobe H */
-    return( 1 );
+       unsigned char tmp;
+       /* This a some-seconds timeout in case no printer is connected */
+       unsigned long i = loops_per_jiffy > 1 ? loops_per_jiffy : 10000000/HZ;
+
+       while ((st_mfp.par_dt_reg & 1) && --i) /* wait for BUSY == L */
+               ;
+       if (!i)
+               return 0;
+
+       sound_ym.rd_data_reg_sel = 15;  /* select port B */
+       sound_ym.wd_data = c;           /* put char onto port */
+       sound_ym.rd_data_reg_sel = 14;  /* select port A */
+       tmp = sound_ym.rd_data_reg_sel;
+       sound_ym.wd_data = tmp & ~0x20; /* set strobe L */
+       MFPDELAY();                     /* wait a bit */
+       sound_ym.wd_data = tmp | 0x20;  /* set strobe H */
+       return 1;
 }
 
-static void atari_par_console_write (struct console *co, const char *str,
-                                    unsigned int count)
+static void atari_par_console_write(struct console *co, const char *str,
+                                   unsigned int count)
 {
-    static int printer_present = 1;
-
-    if (!printer_present)
-       return;
+       static int printer_present = 1;
 
-    while (count--) {
-       if (*str == '\n')
-           if (!ata_par_out( '\r' )) {
-               printer_present = 0;
+       if (!printer_present)
                return;
-           }
-       if (!ata_par_out( *str++ )) {
-           printer_present = 0;
-           return;
+
+       while (count--) {
+               if (*str == '\n') {
+                       if (!ata_par_out('\r')) {
+                               printer_present = 0;
+                               return;
+                       }
+               }
+               if (!ata_par_out(*str++)) {
+                       printer_present = 0;
+                       return;
+               }
        }
-    }
 }
 
-#ifdef CONFIG_SERIAL_CONSOLE
+#if 0
 int atari_mfp_console_wait_key(struct console *co)
 {
-    while( !(mfp.rcv_stat & 0x80) ) /* wait for rx buf filled */
-       barrier();
-    return( mfp.usart_dta );
+       while (!(st_mfp.rcv_stat & 0x80))       /* wait for rx buf filled */
+               barrier();
+       return st_mfp.usart_dta;
 }
 
 int atari_scc_console_wait_key(struct console *co)
 {
-    do {
+       do {
+               MFPDELAY();
+       } while (!(scc.cha_b_ctrl & 0x01)); /* wait for rx buf filled */
        MFPDELAY();
-    } while( !(scc.cha_b_ctrl & 0x01) ); /* wait for rx buf filled */
-    MFPDELAY();
-    return( scc.cha_b_data );
+       return scc.cha_b_data;
 }
 
 int atari_midi_console_wait_key(struct console *co)
 {
-    while( !(acia.mid_ctrl & ACIA_RDRF) ) /* wait for rx buf filled */
-       barrier();
-    return( acia.mid_data );
+       while (!(acia.mid_ctrl & ACIA_RDRF)) /* wait for rx buf filled */
+               barrier();
+       return acia.mid_data;
 }
 #endif
 
-/* The following two functions do a quick'n'dirty initialization of the MFP or
+/*
+ * The following two functions do a quick'n'dirty initialization of the MFP or
  * SCC serial ports. They're used by the debugging interface, kgdb, and the
- * serial console code. */
-#ifndef CONFIG_SERIAL_CONSOLE
-static void __init atari_init_mfp_port( int cflag )
-#else
-void atari_init_mfp_port( int cflag )
-#endif
+ * serial console code.
+ */
+static void __init atari_init_mfp_port(int cflag)
 {
-    /* timer values for 1200...115200 bps; > 38400 select 110, 134, or 150
-     * bps, resp., and work only correct if there's a RSVE or RSSPEED */
-    static int baud_table[9] = { 16, 11, 8, 4, 2, 1, 175, 143, 128 };
-    int baud = cflag & CBAUD;
-    int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x04 : 0x06) : 0;
-    int csize = ((cflag & CSIZE) == CS7) ? 0x20 : 0x00;
-
-    if (cflag & CBAUDEX)
-       baud += B38400;
-    if (baud < B1200 || baud > B38400+2)
-       baud = B9600; /* use default 9600bps for non-implemented rates */
-    baud -= B1200; /* baud_table[] starts at 1200bps */
-
-    mfp.trn_stat &= ~0x01; /* disable TX */
-    mfp.usart_ctr = parity | csize | 0x88; /* 1:16 clk mode, 1 stop bit */
-    mfp.tim_ct_cd &= 0x70;  /* stop timer D */
-    mfp.tim_dt_d = baud_table[baud];
-    mfp.tim_ct_cd |= 0x01;  /* start timer D, 1:4 */
-    mfp.trn_stat |= 0x01;  /* enable TX */
-
-    atari_MFP_init_done = 1;
+       /*
+        * timer values for 1200...115200 bps; > 38400 select 110, 134, or 150
+        * bps, resp., and work only correct if there's a RSVE or RSSPEED
+        */
+       static int baud_table[9] = { 16, 11, 8, 4, 2, 1, 175, 143, 128 };
+       int baud = cflag & CBAUD;
+       int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x04 : 0x06) : 0;
+       int csize = ((cflag & CSIZE) == CS7) ? 0x20 : 0x00;
+
+       if (cflag & CBAUDEX)
+               baud += B38400;
+       if (baud < B1200 || baud > B38400+2)
+               baud = B9600;           /* use default 9600bps for non-implemented rates */
+       baud -= B1200;                  /* baud_table[] starts at 1200bps */
+
+       st_mfp.trn_stat &= ~0x01;       /* disable TX */
+       st_mfp.usart_ctr = parity | csize | 0x88; /* 1:16 clk mode, 1 stop bit */
+       st_mfp.tim_ct_cd &= 0x70;       /* stop timer D */
+       st_mfp.tim_dt_d = baud_table[baud];
+       st_mfp.tim_ct_cd |= 0x01;       /* start timer D, 1:4 */
+       st_mfp.trn_stat |= 0x01;        /* enable TX */
 }
 
-#define SCC_WRITE(reg,val)                             \
-    do {                                               \
-       scc.cha_b_ctrl = (reg);                         \
-       MFPDELAY();                                     \
-       scc.cha_b_ctrl = (val);                         \
-       MFPDELAY();                                     \
-    } while(0)
+#define SCC_WRITE(reg, val)                            \
+       do {                                            \
+               scc.cha_b_ctrl = (reg);                 \
+               MFPDELAY();                             \
+               scc.cha_b_ctrl = (val);                 \
+               MFPDELAY();                             \
+       } while (0)
 
 /* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
  * delay of ~ 60us. */
-#define LONG_DELAY()                           \
-    do {                                       \
-       int i;                                  \
-       for( i = 100; i > 0; --i )              \
-           MFPDELAY();                         \
-    } while(0)
-
-#ifndef CONFIG_SERIAL_CONSOLE
-static void __init atari_init_scc_port( int cflag )
-#else
-void atari_init_scc_port( int cflag )
-#endif
+#define LONG_DELAY()                                   \
+       do {                                            \
+               int i;                                  \
+               for (i = 100; i > 0; --i)               \
+                       MFPDELAY();                     \
+       } while (0)
+
+static void __init atari_init_scc_port(int cflag)
 {
-    extern int atari_SCC_reset_done;
-    static int clksrc_table[9] =
-       /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
-       { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
-    static int brgsrc_table[9] =
-       /* reg 14: 0 = RTxC, 2 = PCLK */
-       { 2, 2, 2, 2, 2, 2, 0, 2, 2 };
-    static int clkmode_table[9] =
-       /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
-       { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
-    static int div_table[9] =
-       /* reg12 (BRG low) */
-       { 208, 138, 103, 50, 24, 11, 1, 0, 0 };
-
-    int baud = cflag & CBAUD;
-    int clksrc, clkmode, div, reg3, reg5;
-
-    if (cflag & CBAUDEX)
-       baud += B38400;
-    if (baud < B1200 || baud > B38400+2)
-       baud = B9600; /* use default 9600bps for non-implemented rates */
-    baud -= B1200; /* tables starts at 1200bps */
-
-    clksrc  = clksrc_table[baud];
-    clkmode = clkmode_table[baud];
-    div     = div_table[baud];
-    if (ATARIHW_PRESENT(TT_MFP) && baud >= 6) {
-       /* special treatment for TT, where rates >= 38400 are done via TRxC */
-       clksrc = 0x28; /* TRxC */
-       clkmode = baud == 6 ? 0xc0 :
-                 baud == 7 ? 0x80 : /* really 76800bps */
-                             0x40;  /* really 153600bps */
-       div = 0;
-    }
-
-    reg3 = (cflag & CSIZE) == CS8 ? 0xc0 : 0x40;
-    reg5 = (cflag & CSIZE) == CS8 ? 0x60 : 0x20 | 0x82 /* assert DTR/RTS */;
-
-    (void)scc.cha_b_ctrl;      /* reset reg pointer */
-    SCC_WRITE( 9, 0xc0 );      /* reset */
-    LONG_DELAY();              /* extra delay after WR9 access */
-    SCC_WRITE( 4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03) : 0 |
-                 0x04 /* 1 stopbit */ |
-                 clkmode );
-    SCC_WRITE( 3, reg3 );
-    SCC_WRITE( 5, reg5 );
-    SCC_WRITE( 9, 0 );         /* no interrupts */
-    LONG_DELAY();              /* extra delay after WR9 access */
-    SCC_WRITE( 10, 0 );                /* NRZ mode */
-    SCC_WRITE( 11, clksrc );   /* main clock source */
-    SCC_WRITE( 12, div );      /* BRG value */
-    SCC_WRITE( 13, 0 );                /* BRG high byte */
-    SCC_WRITE( 14, brgsrc_table[baud] );
-    SCC_WRITE( 14, brgsrc_table[baud] | (div ? 1 : 0) );
-    SCC_WRITE( 3, reg3 | 1 );
-    SCC_WRITE( 5, reg5 | 8 );
-
-    atari_SCC_reset_done = 1;
-    atari_SCC_init_done = 1;
+       extern int atari_SCC_reset_done;
+       static int clksrc_table[9] =
+               /* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
+               { 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
+       static int brgsrc_table[9] =
+               /* reg 14: 0 = RTxC, 2 = PCLK */
+               { 2, 2, 2, 2, 2, 2, 0, 2, 2 };
+       static int clkmode_table[9] =
+               /* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
+               { 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
+       static int div_table[9] =
+               /* reg12 (BRG low) */
+               { 208, 138, 103, 50, 24, 11, 1, 0, 0 };
+
+       int baud = cflag & CBAUD;
+       int clksrc, clkmode, div, reg3, reg5;
+
+       if (cflag & CBAUDEX)
+               baud += B38400;
+       if (baud < B1200 || baud > B38400+2)
+               baud = B9600;           /* use default 9600bps for non-implemented rates */
+       baud -= B1200;                  /* tables starts at 1200bps */
+
+       clksrc  = clksrc_table[baud];
+       clkmode = clkmode_table[baud];
+       div     = div_table[baud];
+       if (ATARIHW_PRESENT(TT_MFP) && baud >= 6) {
+               /* special treatment for TT, where rates >= 38400 are done via TRxC */
+               clksrc = 0x28;          /* TRxC */
+               clkmode = baud == 6 ? 0xc0 :
+                         baud == 7 ? 0x80 : /* really 76800bps */
+                                     0x40;  /* really 153600bps */
+               div = 0;
+       }
+
+       reg3 = (cflag & CSIZE) == CS8 ? 0xc0 : 0x40;
+       reg5 = (cflag & CSIZE) == CS8 ? 0x60 : 0x20 | 0x82 /* assert DTR/RTS */;
+
+       (void)scc.cha_b_ctrl;           /* reset reg pointer */
+       SCC_WRITE(9, 0xc0);             /* reset */
+       LONG_DELAY();                   /* extra delay after WR9 access */
+       SCC_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03)
+                                     : 0 | 0x04 /* 1 stopbit */ | clkmode);
+       SCC_WRITE(3, reg3);
+       SCC_WRITE(5, reg5);
+       SCC_WRITE(9, 0);                /* no interrupts */
+       LONG_DELAY();                   /* extra delay after WR9 access */
+       SCC_WRITE(10, 0);               /* NRZ mode */
+       SCC_WRITE(11, clksrc);          /* main clock source */
+       SCC_WRITE(12, div);             /* BRG value */
+       SCC_WRITE(13, 0);               /* BRG high byte */
+       SCC_WRITE(14, brgsrc_table[baud]);
+       SCC_WRITE(14, brgsrc_table[baud] | (div ? 1 : 0));
+       SCC_WRITE(3, reg3 | 1);
+       SCC_WRITE(5, reg5 | 8);
+
+       atari_SCC_reset_done = 1;
 }
 
-#ifndef CONFIG_SERIAL_CONSOLE
-static void __init atari_init_midi_port( int cflag )
-#else
-void atari_init_midi_port( int cflag )
-#endif
+static void __init atari_init_midi_port(int cflag)
 {
-    int baud = cflag & CBAUD;
-    int csize = ((cflag & CSIZE) == CS8) ? 0x10 : 0x00;
-    /* warning 7N1 isn't possible! (instead 7O2 is used...) */
-    int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x0c : 0x08) : 0x04;
-    int div;
-
-    /* 4800 selects 7812.5, 115200 selects 500000, all other (incl. 9600 as
-     * default) the standard MIDI speed 31250. */
-    if (cflag & CBAUDEX)
-       baud += B38400;
-    if (baud == B4800)
-       div = ACIA_DIV64; /* really 7812.5 bps */
-    else if (baud == B38400+2 /* 115200 */)
-       div = ACIA_DIV1; /* really 500 kbps (does that work??) */
-    else
-       div = ACIA_DIV16; /* 31250 bps, standard for MIDI */
-
-    /* RTS low, ints disabled */
-    acia.mid_ctrl = div | csize | parity |
+       int baud = cflag & CBAUD;
+       int csize = ((cflag & CSIZE) == CS8) ? 0x10 : 0x00;
+       /* warning 7N1 isn't possible! (instead 7O2 is used...) */
+       int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x0c : 0x08) : 0x04;
+       int div;
+
+       /* 4800 selects 7812.5, 115200 selects 500000, all other (incl. 9600 as
+        * default) the standard MIDI speed 31250. */
+       if (cflag & CBAUDEX)
+               baud += B38400;
+       if (baud == B4800)
+               div = ACIA_DIV64;       /* really 7812.5 bps */
+       else if (baud == B38400+2 /* 115200 */)
+               div = ACIA_DIV1;        /* really 500 kbps (does that work??) */
+       else
+               div = ACIA_DIV16;       /* 31250 bps, standard for MIDI */
+
+       /* RTS low, ints disabled */
+       acia.mid_ctrl = div | csize | parity |
                    ((atari_switches & ATARI_SWITCH_MIDI) ?
                     ACIA_RHTID : ACIA_RLTID);
 }
 
-void __init atari_debug_init(void)
+static int __init atari_debug_setup(char *arg)
 {
-    if (!strcmp( m68k_debug_device, "ser" )) {
-       /* defaults to ser2 for a Falcon and ser1 otherwise */
-       strcpy( m68k_debug_device, MACH_IS_FALCON ? "ser2" : "ser1" );
-
-    }
-
-    if (!strcmp( m68k_debug_device, "ser1" )) {
-       /* ST-MFP Modem1 serial port */
-       atari_init_mfp_port( B9600|CS8 );
-       atari_console_driver.write = atari_mfp_console_write;
-    }
-    else if (!strcmp( m68k_debug_device, "ser2" )) {
-       /* SCC Modem2 serial port */
-       atari_init_scc_port( B9600|CS8 );
-       atari_console_driver.write = atari_scc_console_write;
-    }
-    else if (!strcmp( m68k_debug_device, "midi" )) {
-       /* MIDI port */
-       atari_init_midi_port( B9600|CS8 );
-       atari_console_driver.write = atari_midi_console_write;
-    }
-    else if (!strcmp( m68k_debug_device, "par" )) {
-       /* parallel printer */
-       atari_turnoff_irq( IRQ_MFP_BUSY ); /* avoid ints */
-       sound_ym.rd_data_reg_sel = 7;  /* select mixer control */
-       sound_ym.wd_data = 0xff;       /* sound off, ports are output */
-       sound_ym.rd_data_reg_sel = 15; /* select port B */
-       sound_ym.wd_data = 0;          /* no char */
-       sound_ym.rd_data_reg_sel = 14; /* select port A */
-       sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x20; /* strobe H */
-       atari_console_driver.write = atari_par_console_write;
-    }
-    if (atari_console_driver.write)
-       register_console(&atari_console_driver);
+       if (!MACH_IS_ATARI)
+               return 0;
+
+       if (!strcmp(arg, "ser"))
+               /* defaults to ser2 for a Falcon and ser1 otherwise */
+               arg = MACH_IS_FALCON ? "ser2" : "ser1";
+
+       if (!strcmp(arg, "ser1")) {
+               /* ST-MFP Modem1 serial port */
+               atari_init_mfp_port(B9600|CS8);
+               atari_console_driver.write = atari_mfp_console_write;
+       } else if (!strcmp(arg, "ser2")) {
+               /* SCC Modem2 serial port */
+               atari_init_scc_port(B9600|CS8);
+               atari_console_driver.write = atari_scc_console_write;
+       } else if (!strcmp(arg, "midi")) {
+               /* MIDI port */
+               atari_init_midi_port(B9600|CS8);
+               atari_console_driver.write = atari_midi_console_write;
+       } else if (!strcmp(arg, "par")) {
+               /* parallel printer */
+               atari_turnoff_irq(IRQ_MFP_BUSY); /* avoid ints */
+               sound_ym.rd_data_reg_sel = 7;   /* select mixer control */
+               sound_ym.wd_data = 0xff;        /* sound off, ports are output */
+               sound_ym.rd_data_reg_sel = 15;  /* select port B */
+               sound_ym.wd_data = 0;           /* no char */
+               sound_ym.rd_data_reg_sel = 14;  /* select port A */
+               sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x20; /* strobe H */
+               atari_console_driver.write = atari_par_console_write;
+       }
+       if (atari_console_driver.write)
+               register_console(&atari_console_driver);
+
+       return 0;
 }
 
-/*
- * Local variables:
- *  c-indent-level: 4
- *  tab-width: 8
- * End:
- */
+early_param("debug", atari_debug_setup);