[linux-2.6-block.git] / drivers / tty / serial / suncore.c

/* suncore.c
 *
 * Common SUN serial routines.  Based entirely
 * upon drivers/sbus/char/sunserial.c which is:
 *
 * Copyright (C) 1997  Eddie C. Dost  (ecd@skynet.be)
 *
 * Adaptation to new UART layer is:
 *
 * Copyright (C) 2002 David S. Miller (davem@redhat.com)
 */

#include <linux/kernel.h>
#include <linux/console.h>
#include <linux/tty.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/serial_core.h>
#include <linux/sunserialcore.h>
#include <linux/init.h>

#include <asm/prom.h>


static int sunserial_current_minor = 64;

int sunserial_register_minors(struct uart_driver *drv, int count)
{
	int err = 0;

	drv->minor = sunserial_current_minor;
	drv->nr += count;
	/* Register the driver on the first call */
	if (drv->nr == count)
		err = uart_register_driver(drv);
	if (err == 0) {
		sunserial_current_minor += count;
		drv->tty_driver->name_base = drv->minor - 64;
	}
	return err;
}
EXPORT_SYMBOL(sunserial_register_minors);

void sunserial_unregister_minors(struct uart_driver *drv, int count)
{
	drv->nr -= count;
	sunserial_current_minor -= count;

	if (drv->nr == 0)
		uart_unregister_driver(drv);
}
EXPORT_SYMBOL(sunserial_unregister_minors);

int sunserial_console_match(struct console *con, struct device_node *dp,
			    struct uart_driver *drv, int line, bool ignore_line)
{
	if (!con)
		return 0;

	drv->cons = con;

	if (of_console_device != dp)
		return 0;

	if (!ignore_line) {
		int off = 0;

		if (of_console_options &&
		    *of_console_options == 'b')
			off = 1;

		if ((line & 1) != off)
			return 0;
	}

	if (!console_set_on_cmdline) {
		con->index = line;
		add_preferred_console(con->name, line, NULL);
	}
	return 1;
}
EXPORT_SYMBOL(sunserial_console_match);

void sunserial_console_termios(struct console *con, struct device_node *uart_dp)
{
	const char *mode, *s;
	char mode_prop[] = "ttyX-mode";
	int baud, bits, stop, cflag;
	char parity;

	if (!strcmp(uart_dp->name, "rsc") ||
	    !strcmp(uart_dp->name, "rsc-console") ||
	    !strcmp(uart_dp->name, "rsc-control")) {
		mode = of_get_property(uart_dp,
				       "ssp-console-modes", NULL);
		if (!mode)
			mode = "115200,8,n,1,-";
	} else if (!strcmp(uart_dp->name, "lom-console")) {
		mode = "9600,8,n,1,-";
	} else {
		struct device_node *dp;
		char c;

		c = 'a';
		if (of_console_options)
			c = *of_console_options;

		mode_prop[3] = c;

		dp = of_find_node_by_path("/options");
		mode = of_get_property(dp, mode_prop, NULL);
		if (!mode)
			mode = "9600,8,n,1,-";
	}

	cflag = CREAD | HUPCL | CLOCAL;

	s = mode;
	baud = simple_strtoul(s, NULL, 0);
	s = strchr(s, ',');
	bits = simple_strtoul(++s, NULL, 0);
	s = strchr(s, ',');
	parity = *(++s);
	s = strchr(s, ',');
	stop = simple_strtoul(++s, NULL, 0);
	s = strchr(s, ',');
	/* XXX handshake is not handled here. */

	switch (baud) {
		case 150: cflag |= B150; break;
		case 300: cflag |= B300; break;
		case 600: cflag |= B600; break;
		case 1200: cflag |= B1200; break;
		case 2400: cflag |= B2400; break;
		case 4800: cflag |= B4800; break;
		case 9600: cflag |= B9600; break;
		case 19200: cflag |= B19200; break;
		case 38400: cflag |= B38400; break;
		case 57600: cflag |= B57600; break;
		case 115200: cflag |= B115200; break;
		case 230400: cflag |= B230400; break;
		case 460800: cflag |= B460800; break;
		default: baud = 9600; cflag |= B9600; break;
	}

	switch (bits) {
		case 5: cflag |= CS5; break;
		case 6: cflag |= CS6; break;
		case 7: cflag |= CS7; break;
		case 8: cflag |= CS8; break;
		default: cflag |= CS8; break;
	}

	switch (parity) {
		case 'o': cflag |= (PARENB | PARODD); break;
		case 'e': cflag |= PARENB; break;
		case 'n': default: break;
	}

	switch (stop) {
		case 2: cflag |= CSTOPB; break;
		case 1: default: break;
	}

	con->cflag = cflag;
}

/* Sun serial MOUSE auto baud rate detection.  */
static struct mouse_baud_cflag {
	int baud;
	unsigned int cflag;
} mouse_baud_table[] = {
	{ 1200, B1200 },
	{ 2400, B2400 },
	{ 4800, B4800 },
	{ 9600, B9600 },
	{ -1, ~0 },
	{ -1, ~0 },
};

unsigned int suncore_mouse_baud_cflag_next(unsigned int cflag, int *new_baud)
{
	int i;

	for (i = 0; mouse_baud_table[i].baud != -1; i++)
		if (mouse_baud_table[i].cflag == (cflag & CBAUD))
			break;

	i += 1;
	if (mouse_baud_table[i].baud == -1)
		i = 0;

	*new_baud = mouse_baud_table[i].baud;
	return mouse_baud_table[i].cflag;
}

EXPORT_SYMBOL(suncore_mouse_baud_cflag_next);

/* Basically, when the baud rate is wrong the mouse spits out
 * breaks to us.
 */
int suncore_mouse_baud_detection(unsigned char ch, int is_break)
{
	static int mouse_got_break = 0;
	static int ctr = 0;

	if (is_break) {
		/* Let a few normal bytes go by before we jump the gun
		 * and say we need to try another baud rate.
		 */
		if (mouse_got_break && ctr < 8)
			return 1;

		/* Ok, we need to try another baud. */
		ctr = 0;
		mouse_got_break = 1;
		return 2;
	}
	if (mouse_got_break) {
		ctr++;
		if (ch == 0x87) {
			/* Correct baud rate determined. */
			mouse_got_break = 0;
		}
		return 1;
	}
	return 0;
}

EXPORT_SYMBOL(suncore_mouse_baud_detection);

static int __init suncore_init(void)
{
	return 0;
}
device_initcall(suncore_init);

#if 0 /* ..def MODULE ; never supported as such */
MODULE_AUTHOR("Eddie C. Dost, David S. Miller");
MODULE_DESCRIPTION("Sun serial common layer");
MODULE_LICENSE("GPL");
#endif
Commit	Line	Data
1da177e4 LT	1	/* suncore.c
	2	*
	3	* Common SUN serial routines. Based entirely
	4	* upon drivers/sbus/char/sunserial.c which is:
	5	*
	6	* Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be)
	7	*
	8	* Adaptation to new UART layer is:
	9	*
	10	* Copyright (C) 2002 David S. Miller (davem@redhat.com)
	11	*/
	12
1da177e4 LT	13	#include <linux/kernel.h>
	14	#include <linux/console.h>
	15	#include <linux/tty.h>
	16	#include <linux/errno.h>
	17	#include <linux/string.h>
c73fcc84	18	#include <linux/serial_core.h>
6816383a	19	#include <linux/sunserialcore.h>
1da177e4 LT	20	#include <linux/init.h>
1da177e4 LT	21
c73fcc84	22	#include <asm/prom.h>
1da177e4	23
1da177e4	24
58d784a5	25	static int sunserial_current_minor = 64;
1da177e4	26
58d784a5 MH	27	int sunserial_register_minors(struct uart_driver *drv, int count)
	28	{
	29	int err = 0;
	30
	31	drv->minor = sunserial_current_minor;
	32	drv->nr += count;
	33	/* Register the driver on the first call */
	34	if (drv->nr == count)
	35	err = uart_register_driver(drv);
	36	if (err == 0) {
	37	sunserial_current_minor += count;
	38	drv->tty_driver->name_base = drv->minor - 64;
	39	}
	40	return err;
	41	}
	42	EXPORT_SYMBOL(sunserial_register_minors);
	43
	44	void sunserial_unregister_minors(struct uart_driver *drv, int count)
	45	{
	46	drv->nr -= count;
	47	sunserial_current_minor -= count;
	48
	49	if (drv->nr == 0)
	50	uart_unregister_driver(drv);
	51	}
	52	EXPORT_SYMBOL(sunserial_unregister_minors);
1da177e4	53
fb445ee5	54	int sunserial_console_match(struct console con, struct device_node dp,
4e3533d0	55	struct uart_driver *drv, int line, bool ignore_line)
1da177e4	56	{
0a492896 DM	57	if (!con)
	58	return 0;
	59
	60	drv->cons = con;
	61
	62	if (of_console_device != dp)
c73fcc84	63	return 0;
1da177e4	64
4e3533d0 DM	65	if (!ignore_line) {
4e3533d0 DM	66	int off = 0;
1da177e4	67
4e3533d0 DM	68	if (of_console_options &&
	69	*of_console_options == 'b')
	70	off = 1;
	71
	72	if ((line & 1) != off)
	73	return 0;
	74	}
1da177e4	75
0a492896 DM	76	if (!console_set_on_cmdline) {
0a492896 DM	77	con->index = line;
7c1f6afc	78	add_preferred_console(con->name, line, NULL);
0a492896	79	}
c73fcc84 DM	80	return 1;
	81	}
	82	EXPORT_SYMBOL(sunserial_console_match);
1da177e4	83
457931de	84	void sunserial_console_termios(struct console con, struct device_node uart_dp)
c73fcc84	85	{
457931de	86	const char mode, s;
c73fcc84 DM	87	char mode_prop[] = "ttyX-mode";
	88	int baud, bits, stop, cflag;
	89	char parity;
1da177e4	90
457931de DM	91	if (!strcmp(uart_dp->name, "rsc") \|\|
	92	!strcmp(uart_dp->name, "rsc-console") \|\|
	93	!strcmp(uart_dp->name, "rsc-control")) {
	94	mode = of_get_property(uart_dp,
c73fcc84 DM	95	"ssp-console-modes", NULL);
	96	if (!mode)
	97	mode = "115200,8,n,1,-";
457931de DM	98	} else if (!strcmp(uart_dp->name, "lom-console")) {
457931de DM	99	mode = "9600,8,n,1,-";
c73fcc84	100	} else {
457931de	101	struct device_node *dp;
c73fcc84 DM	102	char c;
	103
	104	c = 'a';
	105	if (of_console_options)
	106	c = *of_console_options;
	107
	108	mode_prop[3] = c;
	109
457931de	110	dp = of_find_node_by_path("/options");
c73fcc84 DM	111	mode = of_get_property(dp, mode_prop, NULL);
	112	if (!mode)
	113	mode = "9600,8,n,1,-";
1da177e4 LT	114	}
1da177e4 LT	115
1da177e4 LT	116	cflag = CREAD \| HUPCL \| CLOCAL;
	117
	118	s = mode;
	119	baud = simple_strtoul(s, NULL, 0);
	120	s = strchr(s, ',');
	121	bits = simple_strtoul(++s, NULL, 0);
	122	s = strchr(s, ',');
	123	parity = *(++s);
	124	s = strchr(s, ',');
	125	stop = simple_strtoul(++s, NULL, 0);
	126	s = strchr(s, ',');
	127	/* XXX handshake is not handled here. */
	128
	129	switch (baud) {
	130	case 150: cflag \|= B150; break;
	131	case 300: cflag \|= B300; break;
	132	case 600: cflag \|= B600; break;
	133	case 1200: cflag \|= B1200; break;
	134	case 2400: cflag \|= B2400; break;
	135	case 4800: cflag \|= B4800; break;
	136	case 9600: cflag \|= B9600; break;
	137	case 19200: cflag \|= B19200; break;
	138	case 38400: cflag \|= B38400; break;
c126cf80 ED	139	case 57600: cflag \|= B57600; break;
	140	case 115200: cflag \|= B115200; break;
	141	case 230400: cflag \|= B230400; break;
	142	case 460800: cflag \|= B460800; break;
1da177e4 LT	143	default: baud = 9600; cflag \|= B9600; break;
	144	}
	145
	146	switch (bits) {
	147	case 5: cflag \|= CS5; break;
	148	case 6: cflag \|= CS6; break;
	149	case 7: cflag \|= CS7; break;
	150	case 8: cflag \|= CS8; break;
	151	default: cflag \|= CS8; break;
	152	}
	153
	154	switch (parity) {
	155	case 'o': cflag \|= (PARENB \| PARODD); break;
	156	case 'e': cflag \|= PARENB; break;
	157	case 'n': default: break;
	158	}
	159
	160	switch (stop) {
	161	case 2: cflag \|= CSTOPB; break;
	162	case 1: default: break;
	163	}
	164
	165	con->cflag = cflag;
	166	}
	167
1da177e4 LT	168	/* Sun serial MOUSE auto baud rate detection. */
	169	static struct mouse_baud_cflag {
	170	int baud;
	171	unsigned int cflag;
	172	} mouse_baud_table[] = {
	173	{ 1200, B1200 },
	174	{ 2400, B2400 },
	175	{ 4800, B4800 },
	176	{ 9600, B9600 },
	177	{ -1, ~0 },
	178	{ -1, ~0 },
	179	};
	180
	181	unsigned int suncore_mouse_baud_cflag_next(unsigned int cflag, int *new_baud)
	182	{
	183	int i;
	184
	185	for (i = 0; mouse_baud_table[i].baud != -1; i++)
	186	if (mouse_baud_table[i].cflag == (cflag & CBAUD))
	187	break;
	188
	189	i += 1;
	190	if (mouse_baud_table[i].baud == -1)
	191	i = 0;
	192
	193	*new_baud = mouse_baud_table[i].baud;
	194	return mouse_baud_table[i].cflag;
	195	}
	196
	197	EXPORT_SYMBOL(suncore_mouse_baud_cflag_next);
	198
	199	/* Basically, when the baud rate is wrong the mouse spits out
	200	* breaks to us.
	201	*/
	202	int suncore_mouse_baud_detection(unsigned char ch, int is_break)
	203	{
	204	static int mouse_got_break = 0;
	205	static int ctr = 0;
	206
	207	if (is_break) {
	208	/* Let a few normal bytes go by before we jump the gun
	209	* and say we need to try another baud rate.
	210	*/
	211	if (mouse_got_break && ctr < 8)
	212	return 1;
	213
	214	/* Ok, we need to try another baud. */
	215	ctr = 0;
	216	mouse_got_break = 1;
	217	return 2;
	218	}
	219	if (mouse_got_break) {
	220	ctr++;
	221	if (ch == 0x87) {
	222	/* Correct baud rate determined. */
	223	mouse_got_break = 0;
	224	}
	225	return 1;
	226	}
	227	return 0;
	228	}
	229
	230	EXPORT_SYMBOL(suncore_mouse_baud_detection);
	231
232	static int __init suncore_init(void)
233	{
234	return 0;
235	}
37db2234	236	device_initcall(suncore_init);
1da177e4	237
37db2234	238	#if 0 /* ..def MODULE ; never supported as such */
1da177e4 LT	239	MODULE_AUTHOR("Eddie C. Dost, David S. Miller");
	240	MODULE_DESCRIPTION("Sun serial common layer");
	241	MODULE_LICENSE("GPL");
37db2234	242	#endif