348 lines
9.7 KiB
C
348 lines
9.7 KiB
C
/*
|
|
* linux/arch/m68k/atari/debug.c
|
|
*
|
|
* Atari debugging and serial console stuff
|
|
*
|
|
* Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
|
|
*
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
* License. See the file COPYING in the main directory of this archive
|
|
* for more details.
|
|
*/
|
|
|
|
#include <linux/config.h>
|
|
#include <linux/types.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/console.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.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;
|
|
|
|
static struct console atari_console_driver = {
|
|
.name = "debug",
|
|
.flags = CON_PRINTBUFFER,
|
|
.index = -1,
|
|
};
|
|
|
|
|
|
static inline void ata_mfp_out (char c)
|
|
{
|
|
while (!(mfp.trn_stat & 0x80)) /* wait for tx buf empty */
|
|
barrier ();
|
|
mfp.usart_dta = c;
|
|
}
|
|
|
|
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++ );
|
|
}
|
|
}
|
|
|
|
static inline void ata_scc_out (char c)
|
|
{
|
|
do {
|
|
MFPDELAY();
|
|
} while (!(scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
|
|
MFPDELAY();
|
|
scc.cha_b_data = c;
|
|
}
|
|
|
|
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++ );
|
|
}
|
|
}
|
|
|
|
static inline void ata_midi_out (char 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)
|
|
{
|
|
while (count--) {
|
|
if (*str == '\n')
|
|
ata_midi_out( '\r' );
|
|
ata_midi_out( *str++ );
|
|
}
|
|
}
|
|
|
|
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 );
|
|
}
|
|
|
|
static void atari_par_console_write (struct console *co, const char *str,
|
|
unsigned int count)
|
|
{
|
|
static int printer_present = 1;
|
|
|
|
if (!printer_present)
|
|
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
|
|
int atari_mfp_console_wait_key(struct console *co)
|
|
{
|
|
while( !(mfp.rcv_stat & 0x80) ) /* wait for rx buf filled */
|
|
barrier();
|
|
return( mfp.usart_dta );
|
|
}
|
|
|
|
int atari_scc_console_wait_key(struct console *co)
|
|
{
|
|
do {
|
|
MFPDELAY();
|
|
} while( !(scc.cha_b_ctrl & 0x01) ); /* wait for rx buf filled */
|
|
MFPDELAY();
|
|
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 );
|
|
}
|
|
#endif
|
|
|
|
/* 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
|
|
{
|
|
/* 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;
|
|
}
|
|
|
|
#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
|
|
{
|
|
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;
|
|
}
|
|
|
|
#ifndef CONFIG_SERIAL_CONSOLE
|
|
static void __init atari_init_midi_port( int cflag )
|
|
#else
|
|
void atari_init_midi_port( int cflag )
|
|
#endif
|
|
{
|
|
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)
|
|
{
|
|
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);
|
|
}
|
|
|
|
/*
|
|
* Local variables:
|
|
* c-indent-level: 4
|
|
* tab-width: 8
|
|
* End:
|
|
*/
|