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