11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/*
21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * linux/arch/m68k/atari/debug.c
31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Atari debugging and serial console stuff
51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek
71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This file is subject to the terms and conditions of the GNU General Public
91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * License.  See the file COPYING in the main directory of this archive
101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for more details.
111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */
121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h>
141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/tty.h>
151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/console.h>
161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h>
171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h>
18a3b2004a2671455ee7aef1d9aee5a24381999ddbAdrian Bunk#include <linux/module.h>
191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/atarihw.h>
211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/atariints.h>
221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Can be set somewhere, if a SCC master reset has already be done and should
241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * not be repeated; used by kgdb */
251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint atari_SCC_reset_done;
26a3b2004a2671455ee7aef1d9aee5a24381999ddbAdrian BunkEXPORT_SYMBOL(atari_SCC_reset_done);
271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct console atari_console_driver = {
296ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	.name	= "debug",
306ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	.flags	= CON_PRINTBUFFER,
316ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	.index	= -1,
321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds};
331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
356ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic inline void ata_mfp_out(char c)
361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
373d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	while (!(st_mfp.trn_stat & 0x80))	/* wait for tx buf empty */
386ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		barrier();
393d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.usart_dta = c;
401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
425575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunkstatic void atari_mfp_console_write(struct console *co, const char *str,
435575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunk				    unsigned int count)
441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
456ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (count--) {
466ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		if (*str == '\n')
476ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			ata_mfp_out('\r');
486ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		ata_mfp_out(*str++);
496ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	}
501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
526ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic inline void ata_scc_out(char c)
531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
546ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	do {
556ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		MFPDELAY();
56de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven	} while (!(atari_scc.cha_b_ctrl & 0x04)); /* wait for tx buf empty */
571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	MFPDELAY();
58de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven	atari_scc.cha_b_data = c;
591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
615575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunkstatic void atari_scc_console_write(struct console *co, const char *str,
625575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunk				    unsigned int count)
631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
646ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (count--) {
656ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		if (*str == '\n')
666ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			ata_scc_out('\r');
676ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		ata_scc_out(*str++);
686ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	}
691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
716ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic inline void ata_midi_out(char c)
721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
736ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (!(acia.mid_ctrl & ACIA_TDRE))	/* wait for tx buf empty */
746ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		barrier();
756ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	acia.mid_data = c;
761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
785575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunkstatic void atari_midi_console_write(struct console *co, const char *str,
795575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunk				     unsigned int count)
801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
816ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (count--) {
826ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		if (*str == '\n')
836ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			ata_midi_out('\r');
846ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		ata_midi_out(*str++);
856ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	}
861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
886ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic int ata_par_out(char c)
891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
906ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	unsigned char tmp;
916ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	/* This a some-seconds timeout in case no printer is connected */
926ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	unsigned long i = loops_per_jiffy > 1 ? loops_per_jiffy : 10000000/HZ;
936ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
943d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	while ((st_mfp.par_dt_reg & 1) && --i) /* wait for BUSY == L */
956ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		;
966ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (!i)
976ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		return 0;
986ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
996ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	sound_ym.rd_data_reg_sel = 15;	/* select port B */
1006ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	sound_ym.wd_data = c;		/* put char onto port */
1016ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	sound_ym.rd_data_reg_sel = 14;	/* select port A */
1026ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	tmp = sound_ym.rd_data_reg_sel;
1036ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	sound_ym.wd_data = tmp & ~0x20;	/* set strobe L */
1046ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	MFPDELAY();			/* wait a bit */
1056ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	sound_ym.wd_data = tmp | 0x20;	/* set strobe H */
1066ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	return 1;
1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1096ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic void atari_par_console_write(struct console *co, const char *str,
1106ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel				    unsigned int count)
1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1126ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int printer_present = 1;
1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1146ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (!printer_present)
1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		return;
1166ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
1176ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (count--) {
1186ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		if (*str == '\n') {
1196ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			if (!ata_par_out('\r')) {
1206ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel				printer_present = 0;
1216ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel				return;
1226ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			}
1236ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		}
1246ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		if (!ata_par_out(*str++)) {
1256ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			printer_present = 0;
1266ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			return;
1276ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		}
1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1315575d0a3c9676b2886adad67dd4b2ac126a49f1fAdrian Bunk#if 0
1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint atari_mfp_console_wait_key(struct console *co)
1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1343d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	while (!(st_mfp.rcv_stat & 0x80))	/* wait for rx buf filled */
1356ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		barrier();
1363d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	return st_mfp.usart_dta;
1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint atari_scc_console_wait_key(struct console *co)
1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1416ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	do {
1426ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		MFPDELAY();
143de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven	} while (!(atari_scc.cha_b_ctrl & 0x01)); /* wait for rx buf filled */
1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	MFPDELAY();
145de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven	return atari_scc.cha_b_data;
1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint atari_midi_console_wait_key(struct console *co)
1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1506ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	while (!(acia.mid_ctrl & ACIA_RDRF)) /* wait for rx buf filled */
1516ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		barrier();
1526ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	return acia.mid_data;
1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif
1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1566ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel/*
1576ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel * The following two functions do a quick'n'dirty initialization of the MFP or
1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * SCC serial ports. They're used by the debugging interface, kgdb, and the
1596ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel * serial console code.
1606ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel */
1616ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic void __init atari_init_mfp_port(int cflag)
1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1636ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	/*
1646ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	 * timer values for 1200...115200 bps; > 38400 select 110, 134, or 150
1656ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	 * bps, resp., and work only correct if there's a RSVE or RSSPEED
1666ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	 */
1676ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int baud_table[9] = { 16, 11, 8, 4, 2, 1, 175, 143, 128 };
1686ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int baud = cflag & CBAUD;
1696ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x04 : 0x06) : 0;
1706ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int csize = ((cflag & CSIZE) == CS7) ? 0x20 : 0x00;
1716ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
1726ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (cflag & CBAUDEX)
1736ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		baud += B38400;
1746ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (baud < B1200 || baud > B38400+2)
1756ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		baud = B9600;		/* use default 9600bps for non-implemented rates */
1766ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	baud -= B1200;			/* baud_table[] starts at 1200bps */
1776ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
1783d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.trn_stat &= ~0x01;	/* disable TX */
1793d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.usart_ctr = parity | csize | 0x88; /* 1:16 clk mode, 1 stop bit */
1803d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.tim_ct_cd &= 0x70;	/* stop timer D */
1813d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.tim_dt_d = baud_table[baud];
1823d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.tim_ct_cd |= 0x01;	/* start timer D, 1:4 */
1833d92e8f3ae9ba21cac30370eb254ed9dc20df043Geert Uytterhoeven	st_mfp.trn_stat |= 0x01;	/* enable TX */
1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1866ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel#define SCC_WRITE(reg, val)				\
1876ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	do {						\
188de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven		atari_scc.cha_b_ctrl = (reg);		\
1896ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		MFPDELAY();				\
190de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven		atari_scc.cha_b_ctrl = (val);		\
1916ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		MFPDELAY();				\
1926ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	} while (0)
1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* loops_per_jiffy isn't initialized yet, so we can't use udelay(). This does a
1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * delay of ~ 60us. */
1966ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel#define LONG_DELAY()					\
1976ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	do {						\
1986ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		int i;					\
1996ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		for (i = 100; i > 0; --i)		\
2006ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			MFPDELAY();			\
2016ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	} while (0)
2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2036ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic void __init atari_init_scc_port(int cflag)
2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2056ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int clksrc_table[9] =
2066ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* reg 11: 0x50 = BRG, 0x00 = RTxC, 0x28 = TRxC */
2076ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		{ 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x50, 0x00, 0x00 };
2086ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int brgsrc_table[9] =
2096ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* reg 14: 0 = RTxC, 2 = PCLK */
2106ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		{ 2, 2, 2, 2, 2, 2, 0, 2, 2 };
2116ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int clkmode_table[9] =
2126ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* reg 4: 0x40 = x16, 0x80 = x32, 0xc0 = x64 */
2136ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		{ 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0xc0, 0x80 };
2146ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	static int div_table[9] =
2156ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* reg12 (BRG low) */
2166ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		{ 208, 138, 103, 50, 24, 11, 1, 0, 0 };
2176ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2186ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int baud = cflag & CBAUD;
2196ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int clksrc, clkmode, div, reg3, reg5;
2206ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2216ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (cflag & CBAUDEX)
2226ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		baud += B38400;
2236ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (baud < B1200 || baud > B38400+2)
2246ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		baud = B9600;		/* use default 9600bps for non-implemented rates */
2256ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	baud -= B1200;			/* tables starts at 1200bps */
2266ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2276ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	clksrc  = clksrc_table[baud];
2286ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	clkmode = clkmode_table[baud];
2296ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	div     = div_table[baud];
2306ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (ATARIHW_PRESENT(TT_MFP) && baud >= 6) {
2316ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* special treatment for TT, where rates >= 38400 are done via TRxC */
2326ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		clksrc = 0x28;		/* TRxC */
2336ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		clkmode = baud == 6 ? 0xc0 :
2346ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel			  baud == 7 ? 0x80 : /* really 76800bps */
2356ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel				      0x40;  /* really 153600bps */
2366ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		div = 0;
2376ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	}
2386ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2396ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	reg3 = (cflag & CSIZE) == CS8 ? 0xc0 : 0x40;
2406ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	reg5 = (cflag & CSIZE) == CS8 ? 0x60 : 0x20 | 0x82 /* assert DTR/RTS */;
2416ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
242de339e4b792aed799bec23251e83f594ac44ae04Geert Uytterhoeven	(void)atari_scc.cha_b_ctrl;	/* reset reg pointer */
2436ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(9, 0xc0);		/* reset */
2446ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	LONG_DELAY();			/* extra delay after WR9 access */
2456ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(4, (cflag & PARENB) ? ((cflag & PARODD) ? 0x01 : 0x03)
2466ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel				      : 0 | 0x04 /* 1 stopbit */ | clkmode);
2476ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(3, reg3);
2486ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(5, reg5);
2496ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(9, 0);		/* no interrupts */
2506ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	LONG_DELAY();			/* extra delay after WR9 access */
2516ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(10, 0);		/* NRZ mode */
2526ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(11, clksrc);		/* main clock source */
2536ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(12, div);		/* BRG value */
2546ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(13, 0);		/* BRG high byte */
2556ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(14, brgsrc_table[baud]);
2566ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(14, brgsrc_table[baud] | (div ? 1 : 0));
2576ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(3, reg3 | 1);
2586ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	SCC_WRITE(5, reg5 | 8);
2596ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2606ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	atari_SCC_reset_done = 1;
2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
2636ff5801acbb643e81d3420ac0f37c96089309063Roman Zippelstatic void __init atari_init_midi_port(int cflag)
2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
2656ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int baud = cflag & CBAUD;
2666ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int csize = ((cflag & CSIZE) == CS8) ? 0x10 : 0x00;
2676ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	/* warning 7N1 isn't possible! (instead 7O2 is used...) */
2686ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int parity = (cflag & PARENB) ? ((cflag & PARODD) ? 0x0c : 0x08) : 0x04;
2696ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	int div;
2706ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2716ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	/* 4800 selects 7812.5, 115200 selects 500000, all other (incl. 9600 as
2726ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	 * default) the standard MIDI speed 31250. */
2736ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (cflag & CBAUDEX)
2746ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		baud += B38400;
2756ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (baud == B4800)
2766ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		div = ACIA_DIV64;	/* really 7812.5 bps */
2776ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	else if (baud == B38400+2 /* 115200 */)
2786ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		div = ACIA_DIV1;	/* really 500 kbps (does that work??) */
2796ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	else
2806ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		div = ACIA_DIV16;	/* 31250 bps, standard for MIDI */
2816ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel
2826ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	/* RTS low, ints disabled */
2836ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	acia.mid_ctrl = div | csize | parity |
2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		    ((atari_switches & ATARI_SWITCH_MIDI) ?
2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		     ACIA_RHTID : ACIA_RLTID);
2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
288d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippelstatic int __init atari_debug_setup(char *arg)
2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
290d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	if (!MACH_IS_ATARI)
291d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel		return 0;
292d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel
293d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	if (!strcmp(arg, "ser"))
2946ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* defaults to ser2 for a Falcon and ser1 otherwise */
295d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel		arg = MACH_IS_FALCON ? "ser2" : "ser1";
2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
297d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	if (!strcmp(arg, "ser1")) {
2986ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* ST-MFP Modem1 serial port */
2996ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_init_mfp_port(B9600|CS8);
3006ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_console_driver.write = atari_mfp_console_write;
301d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	} else if (!strcmp(arg, "ser2")) {
3026ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* SCC Modem2 serial port */
3036ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_init_scc_port(B9600|CS8);
3046ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_console_driver.write = atari_scc_console_write;
305d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	} else if (!strcmp(arg, "midi")) {
3066ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* MIDI port */
3076ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_init_midi_port(B9600|CS8);
3086ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_console_driver.write = atari_midi_console_write;
309d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	} else if (!strcmp(arg, "par")) {
3106ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		/* parallel printer */
3116ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_turnoff_irq(IRQ_MFP_BUSY); /* avoid ints */
3126ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.rd_data_reg_sel = 7;	/* select mixer control */
3136ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.wd_data = 0xff;	/* sound off, ports are output */
3146ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.rd_data_reg_sel = 15;	/* select port B */
3156ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.wd_data = 0;		/* no char */
3166ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.rd_data_reg_sel = 14;	/* select port A */
3176ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x20; /* strobe H */
3186ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		atari_console_driver.write = atari_par_console_write;
3196ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	}
3206ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel	if (atari_console_driver.write)
3216ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel		register_console(&atari_console_driver);
322d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel
323d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel	return 0;
3246ff5801acbb643e81d3420ac0f37c96089309063Roman Zippel}
325d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippel
326d6713b4091a99fa2af2fabdcd2f3fb97f32ecf2eRoman Zippelearly_param("debug", atari_debug_setup);
327