[net-next-2.6.git] / arch / cris / arch-v10 / kernel / debugport.c

/* Serialport functions for debugging
 *
 * Copyright (c) 2000-2007 Axis Communications AB
 *
 * Authors:  Bjorn Wesen
 *
 * Exports:
 *    console_print_etrax(char *buf)
 *    int getDebugChar()
 *    putDebugChar(int)
 *    enableDebugIRQ()
 *    init_etrax_debug()
 *
 */

#include <linux/console.h>
#include <linux/init.h>
#include <linux/major.h>
#include <linux/delay.h>
#include <linux/tty.h>
#include <asm/system.h>
#include <arch/svinto.h>
#include <asm/io.h>             /* Get SIMCOUT. */

extern void reset_watchdog(void);

struct dbg_port
{
  unsigned int index;
  const volatile unsigned* read;
  volatile char* write;
  volatile unsigned* xoff;
  volatile char* baud;
  volatile char* tr_ctrl;
  volatile char* rec_ctrl;
  unsigned long irq;
  unsigned int started;
  unsigned long baudrate;
  unsigned char parity;
  unsigned int bits;
};

struct dbg_port ports[]=
{
  {
    0,
    R_SERIAL0_READ,
    R_SERIAL0_TR_DATA,
    R_SERIAL0_XOFF,
    R_SERIAL0_BAUD,
    R_SERIAL0_TR_CTRL,
    R_SERIAL0_REC_CTRL,
    IO_STATE(R_IRQ_MASK1_SET, ser0_data, set),
    0,
    115200,
    'N',
    8
  },
  {
    1,
    R_SERIAL1_READ,
    R_SERIAL1_TR_DATA,
    R_SERIAL1_XOFF,
    R_SERIAL1_BAUD,
    R_SERIAL1_TR_CTRL,
    R_SERIAL1_REC_CTRL,
    IO_STATE(R_IRQ_MASK1_SET, ser1_data, set),
    0,
    115200,
    'N',
    8
  },
  {
    2,
    R_SERIAL2_READ,
    R_SERIAL2_TR_DATA,
    R_SERIAL2_XOFF,
    R_SERIAL2_BAUD,
    R_SERIAL2_TR_CTRL,
    R_SERIAL2_REC_CTRL,
    IO_STATE(R_IRQ_MASK1_SET, ser2_data, set),
    0,
    115200,
    'N',
    8
  },
  {
    3,
    R_SERIAL3_READ,
    R_SERIAL3_TR_DATA,
    R_SERIAL3_XOFF,
    R_SERIAL3_BAUD,
    R_SERIAL3_TR_CTRL,
    R_SERIAL3_REC_CTRL,
    IO_STATE(R_IRQ_MASK1_SET, ser3_data, set),
    0,
    115200,
    'N',
    8
  }
};

#ifdef CONFIG_ETRAX_SERIAL
extern struct tty_driver *serial_driver;
#endif

struct dbg_port* port =
#if defined(CONFIG_ETRAX_DEBUG_PORT0)
  &ports[0];
#elif defined(CONFIG_ETRAX_DEBUG_PORT1)
  &ports[1];
#elif defined(CONFIG_ETRAX_DEBUG_PORT2)
  &ports[2];
#elif defined(CONFIG_ETRAX_DEBUG_PORT3)
  &ports[3];
#else
  NULL;
#endif

static struct dbg_port* kgdb_port =
#if defined(CONFIG_ETRAX_KGDB_PORT0)
  &ports[0];
#elif defined(CONFIG_ETRAX_KGDB_PORT1)
  &ports[1];
#elif defined(CONFIG_ETRAX_KGDB_PORT2)
  &ports[2];
#elif defined(CONFIG_ETRAX_KGDB_PORT3)
  &ports[3];
#else
  NULL;
#endif

static void
start_port(struct dbg_port* p)
{
	unsigned long rec_ctrl = 0;
	unsigned long tr_ctrl = 0;

	if (!p)
		return;

	if (p->started)
		return;
	p->started = 1;

	if (p->index == 0)
	{
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma6);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma6, unused);
	}
	else if (p->index == 1)
	{
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma8);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma8, usb);
	}
	else if (p->index == 2)
	{
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma2);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma2, par0);
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma3);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma3, par0);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, ser2, select);
	}
	else
	{
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma4);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma4, par1);
		genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma5);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, dma5, par1);
		genconfig_shadow |= IO_STATE(R_GEN_CONFIG, ser3, select);
	}

	*R_GEN_CONFIG = genconfig_shadow;

	*p->xoff =
		IO_STATE(R_SERIAL0_XOFF, tx_stop, enable) |
		IO_STATE(R_SERIAL0_XOFF, auto_xoff, disable) |
		IO_FIELD(R_SERIAL0_XOFF, xoff_char, 0);

	switch (p->baudrate)
	{
	case 0:
	case 115200:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c115k2Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c115k2Hz);
		break;
	case 1200:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c1200Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c1200Hz);
		break;
	case 2400:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c2400Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c2400Hz);
		break;
	case 4800:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c4800Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c4800Hz);
		break;
	case 9600:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c9600Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c9600Hz);
		  break;
	case 19200:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c19k2Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c19k2Hz);
		 break;
	case 38400:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c38k4Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c38k4Hz);
		break;
	case 57600:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c57k6Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c57k6Hz);
		break;
	default:
		*p->baud =
		  IO_STATE(R_SERIAL0_BAUD, tr_baud, c115k2Hz) |
		  IO_STATE(R_SERIAL0_BAUD, rec_baud, c115k2Hz);
		  break;
        }

	if (p->parity == 'E') {
		rec_ctrl =
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par, even) |
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, enable);
		tr_ctrl =
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par, even) |
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, enable);
	} else if (p->parity == 'O') {
		rec_ctrl =
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par, odd) |
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, enable);
		tr_ctrl =
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par, odd) |
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, enable);
	} else {
		rec_ctrl =
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par, even) |
		  IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, disable);
		tr_ctrl =
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par, even) |
		  IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, disable);
	}
	if (p->bits == 7)
	{
		rec_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_bitnr, rec_7bit);
		tr_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_bitnr, tr_7bit);
	}
	else
	{
		rec_ctrl |= IO_STATE(R_SERIAL0_REC_CTRL, rec_bitnr, rec_8bit);
		tr_ctrl |= IO_STATE(R_SERIAL0_TR_CTRL, tr_bitnr, tr_8bit);
	}

	*p->rec_ctrl =
		IO_STATE(R_SERIAL0_REC_CTRL, dma_err, stop) |
		IO_STATE(R_SERIAL0_REC_CTRL, rec_enable, enable) |
		IO_STATE(R_SERIAL0_REC_CTRL, rts_, active) |
		IO_STATE(R_SERIAL0_REC_CTRL, sampling, middle) |
		IO_STATE(R_SERIAL0_REC_CTRL, rec_stick_par, normal) |
		rec_ctrl;

	*p->tr_ctrl =
		IO_FIELD(R_SERIAL0_TR_CTRL, txd, 0) |
		IO_STATE(R_SERIAL0_TR_CTRL, tr_enable, enable) |
		IO_STATE(R_SERIAL0_TR_CTRL, auto_cts, disabled) |
		IO_STATE(R_SERIAL0_TR_CTRL, stop_bits, one_bit) |
		IO_STATE(R_SERIAL0_TR_CTRL, tr_stick_par, normal) |
		tr_ctrl;
}

static void
console_write_direct(struct console *co, const char *buf, unsigned int len)
{
	int i;
	unsigned long flags;

        if (!port)
		return;

	local_irq_save(flags);

	/* Send data */
	for (i = 0; i < len; i++) {
		/* LF -> CRLF */
		if (buf[i] == '\n') {
			while (!(*port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
			;
			*port->write = '\r';
		}
		/* Wait until transmitter is ready and send.*/
		while (!(*port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
			;
		*port->write = buf[i];
	}

	/*
	 * Feed the watchdog, otherwise it will reset the chip during boot.
	 * The time to send an ordinary boot message line (10-90 chars)
	 * varies between 1-8ms at 115200. What makes up for the additional
	 * 90ms that allows the watchdog to bite?
	*/
	reset_watchdog();

	local_irq_restore(flags);
}

static void
console_write(struct console *co, const char *buf, unsigned int len)
{
	if (!port)
		return;

#ifdef CONFIG_SVINTO_SIM
	/* no use to simulate the serial debug output */
	SIMCOUT(buf, len);
	return;
#endif

        console_write_direct(co, buf, len);
}

/* legacy function */

void
console_print_etrax(const char *buf)
{
	console_write(NULL, buf, strlen(buf));
}

/* Use polling to get a single character FROM the debug port */

int
getDebugChar(void)
{
	unsigned long readval;

	if (!kgdb_port)
		return 0;

	do {
		readval = *kgdb_port->read;
	} while (!(readval & IO_MASK(R_SERIAL0_READ, data_avail)));

	return (readval & IO_MASK(R_SERIAL0_READ, data_in));
}

/* Use polling to put a single character to the debug port */

void
putDebugChar(int val)
{
	if (!kgdb_port)
		return;

	while (!(*kgdb_port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
		;
	*kgdb_port->write = val;
}

/* Enable irq for receiving chars on the debug port, used by kgdb */

void
enableDebugIRQ(void)
{
	if (!kgdb_port)
		return;

	*R_IRQ_MASK1_SET = kgdb_port->irq;
	/* use R_VECT_MASK directly, since we really bypass Linux normal
	 * IRQ handling in kgdb anyway, we don't need to use enable_irq
	 */
	*R_VECT_MASK_SET = IO_STATE(R_VECT_MASK_SET, serial, set);

	*kgdb_port->rec_ctrl = IO_STATE(R_SERIAL0_REC_CTRL, rec_enable, enable);
}

static int __init
console_setup(struct console *co, char *options)
{
	char* s;

	if (options) {
		port = &ports[co->index];
		port->baudrate = 115200;
                port->parity = 'N';
                port->bits = 8;
		port->baudrate = simple_strtoul(options, NULL, 10);
		s = options;
		while(*s >= '0' && *s <= '9')
			s++;
		if (*s) port->parity = *s++;
		if (*s) port->bits   = *s++ - '0';
		port->started = 0;
		start_port(0);
	}
	return 0;
}


/* This is a dummy serial device that throws away anything written to it.
 * This is used when no debug output is wanted.
 */
static struct tty_driver dummy_driver;

static int dummy_open(struct tty_struct *tty, struct file * filp)
{
	return 0;
}

static void dummy_close(struct tty_struct *tty, struct file * filp)
{
}

static int dummy_write(struct tty_struct * tty,
                       const unsigned char *buf, int count)
{
	return count;
}

static int dummy_write_room(struct tty_struct *tty)
{
	return 8192;
}

static const struct tty_operations dummy_ops = {
	.open = dummy_open,
	.close = dummy_close,
	.write = dummy_write,
	.write_room = dummy_write_room,
};

void __init
init_dummy_console(void)
{
	memset(&dummy_driver, 0, sizeof(struct tty_driver));
	dummy_driver.driver_name = "serial";
	dummy_driver.name = "ttyS";
	dummy_driver.major = TTY_MAJOR;
	dummy_driver.minor_start = 68;
	dummy_driver.num = 1;       /* etrax100 has 4 serial ports */
	dummy_driver.type = TTY_DRIVER_TYPE_SERIAL;
	dummy_driver.subtype = SERIAL_TYPE_NORMAL;
	dummy_driver.init_termios = tty_std_termios;
	/* Normally B9600 default... */
	dummy_driver.init_termios.c_cflag =
		B115200 | CS8 | CREAD | HUPCL | CLOCAL;
	dummy_driver.flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
	dummy_driver.init_termios.c_ispeed = 115200;
	dummy_driver.init_termios.c_ospeed = 115200;

	dummy_driver.ops = &dummy_ops;
	if (tty_register_driver(&dummy_driver))
		panic("Couldn't register dummy serial driver\n");
}

static struct tty_driver*
etrax_console_device(struct console* co, int *index)
{
	if (port)
		*index = port->index;
	else
		*index = 0;
#ifdef CONFIG_ETRAX_SERIAL
        return port ? serial_driver : &dummy_driver;
#else
	return &dummy_driver;
#endif
}

static struct console sercons = {
	name : "ttyS",
	write: console_write,
	read : NULL,
	device : etrax_console_device,
	unblank : NULL,
	setup : console_setup,
	flags : CON_PRINTBUFFER,
	index : -1,
	cflag : 0,
	next : NULL
};
static struct console sercons0 = {
	name : "ttyS",
	write: console_write,
	read : NULL,
	device : etrax_console_device,
	unblank : NULL,
	setup : console_setup,
	flags : CON_PRINTBUFFER,
	index : 0,
	cflag : 0,
	next : NULL
};

static struct console sercons1 = {
	name : "ttyS",
	write: console_write,
	read : NULL,
	device : etrax_console_device,
	unblank : NULL,
	setup : console_setup,
	flags : CON_PRINTBUFFER,
	index : 1,
	cflag : 0,
	next : NULL
};
static struct console sercons2 = {
	name : "ttyS",
	write: console_write,
	read : NULL,
	device : etrax_console_device,
	unblank : NULL,
	setup : console_setup,
	flags : CON_PRINTBUFFER,
	index : 2,
	cflag : 0,
	next : NULL
};
static struct console sercons3 = {
	name : "ttyS",
	write: console_write,
	read : NULL,
	device : etrax_console_device,
	unblank : NULL,
	setup : console_setup,
	flags : CON_PRINTBUFFER,
	index : 3,
	cflag : 0,
	next : NULL
};
/*
 *      Register console (for printk's etc)
 */

int __init
init_etrax_debug(void)
{
	static int first = 1;

	if (!first) {
		unregister_console(&sercons);
		register_console(&sercons0);
		register_console(&sercons1);
		register_console(&sercons2);
		register_console(&sercons3);
                init_dummy_console();
		return 0;
	}

	first = 0;
	register_console(&sercons);
	start_port(port);
#ifdef CONFIG_ETRAX_KGDB
	start_port(kgdb_port);
#endif
	return 0;
}
__initcall(init_etrax_debug);
Commit	Line	Data
1da177e4 LT	1	/* Serialport functions for debugging
1da177e4 LT	2	*
18b0f346	3	* Copyright (c) 2000-2007 Axis Communications AB
1da177e4 LT	4	*
	5	* Authors: Bjorn Wesen
	6	*
	7	* Exports:
	8	* console_print_etrax(char *buf)
	9	* int getDebugChar()
	10	* putDebugChar(int)
	11	* enableDebugIRQ()
	12	* init_etrax_debug()
	13	*
1da177e4 LT	14	*/
1da177e4 LT	15
1da177e4 LT	16	#include <linux/console.h>
	17	#include <linux/init.h>
	18	#include <linux/major.h>
	19	#include <linux/delay.h>
	20	#include <linux/tty.h>
	21	#include <asm/system.h>
556dcee7	22	#include <arch/svinto.h>
1da177e4 LT	23	#include <asm/io.h> /* Get SIMCOUT. */
1da177e4 LT	24
18b0f346 JN	25	extern void reset_watchdog(void);
18b0f346 JN	26
1da177e4 LT	27	struct dbg_port
	28	{
	29	unsigned int index;
	30	const volatile unsigned* read;
	31	volatile char* write;
	32	volatile unsigned* xoff;
	33	volatile char* baud;
	34	volatile char* tr_ctrl;
	35	volatile char* rec_ctrl;
	36	unsigned long irq;
	37	unsigned int started;
	38	unsigned long baudrate;
	39	unsigned char parity;
	40	unsigned int bits;
	41	};
	42
	43	struct dbg_port ports[]=
	44	{
	45	{
	46	0,
	47	R_SERIAL0_READ,
	48	R_SERIAL0_TR_DATA,
	49	R_SERIAL0_XOFF,
	50	R_SERIAL0_BAUD,
	51	R_SERIAL0_TR_CTRL,
	52	R_SERIAL0_REC_CTRL,
05b4c28c MS	53	IO_STATE(R_IRQ_MASK1_SET, ser0_data, set),
	54	0,
	55	115200,
	56	'N',
	57	8
1da177e4 LT	58	},
	59	{
	60	1,
	61	R_SERIAL1_READ,
	62	R_SERIAL1_TR_DATA,
	63	R_SERIAL1_XOFF,
	64	R_SERIAL1_BAUD,
	65	R_SERIAL1_TR_CTRL,
	66	R_SERIAL1_REC_CTRL,
05b4c28c MS	67	IO_STATE(R_IRQ_MASK1_SET, ser1_data, set),
	68	0,
	69	115200,
	70	'N',
	71	8
1da177e4 LT	72	},
	73	{
	74	2,
	75	R_SERIAL2_READ,
	76	R_SERIAL2_TR_DATA,
	77	R_SERIAL2_XOFF,
	78	R_SERIAL2_BAUD,
	79	R_SERIAL2_TR_CTRL,
	80	R_SERIAL2_REC_CTRL,
05b4c28c MS	81	IO_STATE(R_IRQ_MASK1_SET, ser2_data, set),
	82	0,
	83	115200,
	84	'N',
	85	8
1da177e4 LT	86	},
	87	{
	88	3,
	89	R_SERIAL3_READ,
	90	R_SERIAL3_TR_DATA,
	91	R_SERIAL3_XOFF,
	92	R_SERIAL3_BAUD,
	93	R_SERIAL3_TR_CTRL,
	94	R_SERIAL3_REC_CTRL,
05b4c28c MS	95	IO_STATE(R_IRQ_MASK1_SET, ser3_data, set),
	96	0,
	97	115200,
	98	'N',
	99	8
1da177e4 LT	100	}
	101	};
	102
18b0f346	103	#ifdef CONFIG_ETRAX_SERIAL
05b4c28c	104	extern struct tty_driver *serial_driver;
18b0f346	105	#endif
1da177e4 LT	106
	107	struct dbg_port* port =
	108	#if defined(CONFIG_ETRAX_DEBUG_PORT0)
	109	&ports[0];
	110	#elif defined(CONFIG_ETRAX_DEBUG_PORT1)
	111	&ports[1];
	112	#elif defined(CONFIG_ETRAX_DEBUG_PORT2)
	113	&ports[2];
	114	#elif defined(CONFIG_ETRAX_DEBUG_PORT3)
	115	&ports[3];
	116	#else
	117	NULL;
	118	#endif
1da177e4	119
05b4c28c MS	120	static struct dbg_port* kgdb_port =
	121	#if defined(CONFIG_ETRAX_KGDB_PORT0)
	122	&ports[0];
	123	#elif defined(CONFIG_ETRAX_KGDB_PORT1)
	124	&ports[1];
	125	#elif defined(CONFIG_ETRAX_KGDB_PORT2)
	126	&ports[2];
	127	#elif defined(CONFIG_ETRAX_KGDB_PORT3)
	128	&ports[3];
	129	#else
	130	NULL;
	131	#endif
1da177e4 LT	132
1da177e4 LT	133	static void
05b4c28c	134	start_port(struct dbg_port* p)
1da177e4 LT	135	{
	136	unsigned long rec_ctrl = 0;
	137	unsigned long tr_ctrl = 0;
	138
05b4c28c	139	if (!p)
1da177e4 LT	140	return;
1da177e4 LT	141
05b4c28c	142	if (p->started)
1da177e4	143	return;
05b4c28c	144	p->started = 1;
1da177e4	145
05b4c28c	146	if (p->index == 0)
1da177e4 LT	147	{
	148	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma6);
	149	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma6, unused);
	150	}
05b4c28c	151	else if (p->index == 1)
1da177e4 LT	152	{
	153	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma8);
	154	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma8, usb);
	155	}
05b4c28c	156	else if (p->index == 2)
1da177e4 LT	157	{
	158	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma2);
	159	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma2, par0);
	160	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma3);
	161	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma3, par0);
	162	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, ser2, select);
	163	}
	164	else
	165	{
	166	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma4);
	167	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma4, par1);
	168	genconfig_shadow &= ~IO_MASK(R_GEN_CONFIG, dma5);
	169	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, dma5, par1);
	170	genconfig_shadow \|= IO_STATE(R_GEN_CONFIG, ser3, select);
	171	}
	172
	173	*R_GEN_CONFIG = genconfig_shadow;
	174
05b4c28c	175	*p->xoff =
1da177e4 LT	176	IO_STATE(R_SERIAL0_XOFF, tx_stop, enable) \|
	177	IO_STATE(R_SERIAL0_XOFF, auto_xoff, disable) \|
	178	IO_FIELD(R_SERIAL0_XOFF, xoff_char, 0);
	179
05b4c28c	180	switch (p->baudrate)
1da177e4 LT	181	{
	182	case 0:
	183	case 115200:
05b4c28c	184	*p->baud =
1da177e4 LT	185	IO_STATE(R_SERIAL0_BAUD, tr_baud, c115k2Hz) \|
	186	IO_STATE(R_SERIAL0_BAUD, rec_baud, c115k2Hz);
	187	break;
	188	case 1200:
05b4c28c	189	*p->baud =
1da177e4 LT	190	IO_STATE(R_SERIAL0_BAUD, tr_baud, c1200Hz) \|
	191	IO_STATE(R_SERIAL0_BAUD, rec_baud, c1200Hz);
	192	break;
	193	case 2400:
05b4c28c	194	*p->baud =
1da177e4 LT	195	IO_STATE(R_SERIAL0_BAUD, tr_baud, c2400Hz) \|
	196	IO_STATE(R_SERIAL0_BAUD, rec_baud, c2400Hz);
	197	break;
	198	case 4800:
05b4c28c	199	*p->baud =
1da177e4 LT	200	IO_STATE(R_SERIAL0_BAUD, tr_baud, c4800Hz) \|
	201	IO_STATE(R_SERIAL0_BAUD, rec_baud, c4800Hz);
	202	break;
	203	case 9600:
05b4c28c	204	*p->baud =
1da177e4 LT	205	IO_STATE(R_SERIAL0_BAUD, tr_baud, c9600Hz) \|
	206	IO_STATE(R_SERIAL0_BAUD, rec_baud, c9600Hz);
	207	break;
	208	case 19200:
05b4c28c	209	*p->baud =
1da177e4 LT	210	IO_STATE(R_SERIAL0_BAUD, tr_baud, c19k2Hz) \|
	211	IO_STATE(R_SERIAL0_BAUD, rec_baud, c19k2Hz);
	212	break;
	213	case 38400:
05b4c28c	214	*p->baud =
1da177e4 LT	215	IO_STATE(R_SERIAL0_BAUD, tr_baud, c38k4Hz) \|
	216	IO_STATE(R_SERIAL0_BAUD, rec_baud, c38k4Hz);
	217	break;
	218	case 57600:
05b4c28c	219	*p->baud =
1da177e4 LT	220	IO_STATE(R_SERIAL0_BAUD, tr_baud, c57k6Hz) \|
	221	IO_STATE(R_SERIAL0_BAUD, rec_baud, c57k6Hz);
	222	break;
	223	default:
05b4c28c	224	*p->baud =
1da177e4 LT	225	IO_STATE(R_SERIAL0_BAUD, tr_baud, c115k2Hz) \|
	226	IO_STATE(R_SERIAL0_BAUD, rec_baud, c115k2Hz);
	227	break;
	228	}
	229
05b4c28c	230	if (p->parity == 'E') {
1da177e4 LT	231	rec_ctrl =
	232	IO_STATE(R_SERIAL0_REC_CTRL, rec_par, even) \|
	233	IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, enable);
	234	tr_ctrl =
	235	IO_STATE(R_SERIAL0_TR_CTRL, tr_par, even) \|
	236	IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, enable);
05b4c28c	237	} else if (p->parity == 'O') {
1da177e4 LT	238	rec_ctrl =
	239	IO_STATE(R_SERIAL0_REC_CTRL, rec_par, odd) \|
	240	IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, enable);
	241	tr_ctrl =
	242	IO_STATE(R_SERIAL0_TR_CTRL, tr_par, odd) \|
	243	IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, enable);
	244	} else {
	245	rec_ctrl =
	246	IO_STATE(R_SERIAL0_REC_CTRL, rec_par, even) \|
	247	IO_STATE(R_SERIAL0_REC_CTRL, rec_par_en, disable);
	248	tr_ctrl =
	249	IO_STATE(R_SERIAL0_TR_CTRL, tr_par, even) \|
	250	IO_STATE(R_SERIAL0_TR_CTRL, tr_par_en, disable);
	251	}
05b4c28c	252	if (p->bits == 7)
1da177e4 LT	253	{
	254	rec_ctrl \|= IO_STATE(R_SERIAL0_REC_CTRL, rec_bitnr, rec_7bit);
	255	tr_ctrl \|= IO_STATE(R_SERIAL0_TR_CTRL, tr_bitnr, tr_7bit);
	256	}
	257	else
	258	{
	259	rec_ctrl \|= IO_STATE(R_SERIAL0_REC_CTRL, rec_bitnr, rec_8bit);
	260	tr_ctrl \|= IO_STATE(R_SERIAL0_TR_CTRL, tr_bitnr, tr_8bit);
	261	}
	262
05b4c28c	263	*p->rec_ctrl =
1da177e4 LT	264	IO_STATE(R_SERIAL0_REC_CTRL, dma_err, stop) \|
	265	IO_STATE(R_SERIAL0_REC_CTRL, rec_enable, enable) \|
	266	IO_STATE(R_SERIAL0_REC_CTRL, rts_, active) \|
	267	IO_STATE(R_SERIAL0_REC_CTRL, sampling, middle) \|
	268	IO_STATE(R_SERIAL0_REC_CTRL, rec_stick_par, normal) \|
	269	rec_ctrl;
	270
05b4c28c	271	*p->tr_ctrl =
1da177e4 LT	272	IO_FIELD(R_SERIAL0_TR_CTRL, txd, 0) \|
	273	IO_STATE(R_SERIAL0_TR_CTRL, tr_enable, enable) \|
	274	IO_STATE(R_SERIAL0_TR_CTRL, auto_cts, disabled) \|
	275	IO_STATE(R_SERIAL0_TR_CTRL, stop_bits, one_bit) \|
	276	IO_STATE(R_SERIAL0_TR_CTRL, tr_stick_par, normal) \|
	277	tr_ctrl;
	278	}
	279
	280	static void
	281	console_write_direct(struct console co, const char buf, unsigned int len)
	282	{
	283	int i;
	284	unsigned long flags;
05b4c28c MS	285
	286	if (!port)
	287	return;
	288
18b0f346 JN	289	local_irq_save(flags);
18b0f346 JN	290
1da177e4 LT	291	/* Send data */
1da177e4 LT	292	for (i = 0; i < len; i++) {
05b4c28c MS	293	/* LF -> CRLF */
	294	if (buf[i] == '\n') {
	295	while (!(*port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
	296	;
	297	*port->write = '\r';
	298	}
1da177e4 LT	299	/* Wait until transmitter is ready and send.*/
	300	while (!(*port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
	301	;
	302	*port->write = buf[i];
	303	}
1da177e4	304
18b0f346 JN	305	/*
	306	* Feed the watchdog, otherwise it will reset the chip during boot.
	307	* The time to send an ordinary boot message line (10-90 chars)
	308	* varies between 1-8ms at 115200. What makes up for the additional
	309	* 90ms that allows the watchdog to bite?
	310	*/
	311	reset_watchdog();
	312
	313	local_irq_restore(flags);
05b4c28c MS	314	}
05b4c28c MS	315
1da177e4 LT	316	static void
	317	console_write(struct console co, const char buf, unsigned int len)
	318	{
	319	if (!port)
	320	return;
	321
	322	#ifdef CONFIG_SVINTO_SIM
	323	/* no use to simulate the serial debug output */
	324	SIMCOUT(buf, len);
	325	return;
	326	#endif
	327
05b4c28c	328	console_write_direct(co, buf, len);
1da177e4 LT	329	}
	330
	331	/* legacy function */
	332
	333	void
	334	console_print_etrax(const char *buf)
	335	{
	336	console_write(NULL, buf, strlen(buf));
	337	}
	338
	339	/* Use polling to get a single character FROM the debug port */
	340
	341	int
	342	getDebugChar(void)
	343	{
	344	unsigned long readval;
	345
05b4c28c MS	346	if (!kgdb_port)
	347	return 0;
	348
1da177e4	349	do {
05b4c28c	350	readval = *kgdb_port->read;
1da177e4 LT	351	} while (!(readval & IO_MASK(R_SERIAL0_READ, data_avail)));
	352
	353	return (readval & IO_MASK(R_SERIAL0_READ, data_in));
	354	}
	355
	356	/* Use polling to put a single character to the debug port */
	357
	358	void
	359	putDebugChar(int val)
	360	{
05b4c28c MS	361	if (!kgdb_port)
	362	return;
	363
	364	while (!(*kgdb_port->read & IO_MASK(R_SERIAL0_READ, tr_ready)))
1da177e4	365	;
05b4c28c	366	*kgdb_port->write = val;
1da177e4 LT	367	}
	368
	369	/* Enable irq for receiving chars on the debug port, used by kgdb */
	370
	371	void
	372	enableDebugIRQ(void)
	373	{
05b4c28c MS	374	if (!kgdb_port)
	375	return;
	376
	377	*R_IRQ_MASK1_SET = kgdb_port->irq;
1da177e4 LT	378	/* use R_VECT_MASK directly, since we really bypass Linux normal
	379	* IRQ handling in kgdb anyway, we don't need to use enable_irq
	380	*/
	381	*R_VECT_MASK_SET = IO_STATE(R_VECT_MASK_SET, serial, set);
	382
05b4c28c	383	*kgdb_port->rec_ctrl = IO_STATE(R_SERIAL0_REC_CTRL, rec_enable, enable);
1da177e4 LT	384	}
	385
	386	static int __init
	387	console_setup(struct console co, char options)
	388	{
	389	char* s;
	390
	391	if (options) {
	392	port = &ports[co->index];
	393	port->baudrate = 115200;
	394	port->parity = 'N';
	395	port->bits = 8;
	396	port->baudrate = simple_strtoul(options, NULL, 10);
	397	s = options;
	398	while(s >= '0' && s <= '9')
	399	s++;
	400	if (s) port->parity = s++;
	401	if (s) port->bits = s++ - '0';
	402	port->started = 0;
05b4c28c	403	start_port(0);
1da177e4 LT	404	}
	405	return 0;
	406	}
	407
18b0f346	408
05b4c28c MS	409	/* This is a dummy serial device that throws away anything written to it.
	410	* This is used when no debug output is wanted.
	411	*/
	412	static struct tty_driver dummy_driver;
	413
	414	static int dummy_open(struct tty_struct tty, struct file filp)
	415	{
	416	return 0;
	417	}
	418
	419	static void dummy_close(struct tty_struct tty, struct file filp)
	420	{
	421	}
	422
	423	static int dummy_write(struct tty_struct * tty,
	424	const unsigned char *buf, int count)
	425	{
	426	return count;
	427	}
	428
3aa30df3	429	static int dummy_write_room(struct tty_struct *tty)
05b4c28c MS	430	{
	431	return 8192;
	432	}
	433
3aa30df3	434	static const struct tty_operations dummy_ops = {
bd451d5e JN	435	.open = dummy_open,
	436	.close = dummy_close,
	437	.write = dummy_write,
	438	.write_room = dummy_write_room,
3aa30df3 HK	439	};
3aa30df3 HK	440
05b4c28c MS	441	void __init
	442	init_dummy_console(void)
	443	{
	444	memset(&dummy_driver, 0, sizeof(struct tty_driver));
	445	dummy_driver.driver_name = "serial";
	446	dummy_driver.name = "ttyS";
	447	dummy_driver.major = TTY_MAJOR;
	448	dummy_driver.minor_start = 68;
	449	dummy_driver.num = 1; /* etrax100 has 4 serial ports */
	450	dummy_driver.type = TTY_DRIVER_TYPE_SERIAL;
	451	dummy_driver.subtype = SERIAL_TYPE_NORMAL;
	452	dummy_driver.init_termios = tty_std_termios;
3aa30df3	453	/* Normally B9600 default... */
05b4c28c	454	dummy_driver.init_termios.c_cflag =
3aa30df3	455	B115200 \| CS8 \| CREAD \| HUPCL \| CLOCAL;
331b8319	456	dummy_driver.flags = TTY_DRIVER_REAL_RAW \| TTY_DRIVER_DYNAMIC_DEV;
3aa30df3 HK	457	dummy_driver.init_termios.c_ispeed = 115200;
3aa30df3 HK	458	dummy_driver.init_termios.c_ospeed = 115200;
05b4c28c	459
3aa30df3	460	dummy_driver.ops = &dummy_ops;
05b4c28c MS	461	if (tty_register_driver(&dummy_driver))
	462	panic("Couldn't register dummy serial driver\n");
	463	}
	464
	465	static struct tty_driver*
	466	etrax_console_device(struct console* co, int *index)
	467	{
	468	if (port)
	469	*index = port->index;
18b0f346 JN	470	else
	471	*index = 0;
	472	#ifdef CONFIG_ETRAX_SERIAL
05b4c28c	473	return port ? serial_driver : &dummy_driver;
18b0f346 JN	474	#else
	475	return &dummy_driver;
	476	#endif
05b4c28c MS	477	}
05b4c28c MS	478
1da177e4 LT	479	static struct console sercons = {
	480	name : "ttyS",
	481	write: console_write,
	482	read : NULL,
	483	device : etrax_console_device,
	484	unblank : NULL,
	485	setup : console_setup,
	486	flags : CON_PRINTBUFFER,
	487	index : -1,
	488	cflag : 0,
	489	next : NULL
	490	};
	491	static struct console sercons0 = {
	492	name : "ttyS",
	493	write: console_write,
	494	read : NULL,
	495	device : etrax_console_device,
	496	unblank : NULL,
	497	setup : console_setup,
	498	flags : CON_PRINTBUFFER,
	499	index : 0,
	500	cflag : 0,
	501	next : NULL
	502	};
	503
	504	static struct console sercons1 = {
	505	name : "ttyS",
	506	write: console_write,
	507	read : NULL,
	508	device : etrax_console_device,
	509	unblank : NULL,
	510	setup : console_setup,
	511	flags : CON_PRINTBUFFER,
	512	index : 1,
	513	cflag : 0,
	514	next : NULL
	515	};
	516	static struct console sercons2 = {
	517	name : "ttyS",
	518	write: console_write,
	519	read : NULL,
	520	device : etrax_console_device,
	521	unblank : NULL,
	522	setup : console_setup,
	523	flags : CON_PRINTBUFFER,
	524	index : 2,
	525	cflag : 0,
	526	next : NULL
	527	};
	528	static struct console sercons3 = {
	529	name : "ttyS",
	530	write: console_write,
	531	read : NULL,
	532	device : etrax_console_device,
	533	unblank : NULL,
	534	setup : console_setup,
	535	flags : CON_PRINTBUFFER,
	536	index : 3,
	537	cflag : 0,
	538	next : NULL
	539	};
	540	/*
	541	* Register console (for printk's etc)
	542	*/
543
544	int __init
545	init_etrax_debug(void)
546	{
547	static int first = 1;
548
549	if (!first) {
05b4c28c MS	550	unregister_console(&sercons);
	551	register_console(&sercons0);
	552	register_console(&sercons1);
	553	register_console(&sercons2);
	554	register_console(&sercons3);
	555	init_dummy_console();
1da177e4 LT	556	return 0;
1da177e4 LT	557	}
1da177e4	558
05b4c28c MS	559	first = 0;
	560	register_console(&sercons);
	561	start_port(port);
	562	#ifdef CONFIG_ETRAX_KGDB
	563	start_port(kgdb_port);
	564	#endif
1da177e4 LT	565	return 0;
1da177e4 LT	566	}
1da177e4	567	__initcall(init_etrax_debug);