| // SPDX-License-Identifier: GPL-2.0 | 
 | /* 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 (of_node_name_eq(uart_dp, "rsc") || | 
 | 	    of_node_name_eq(uart_dp, "rsc-console") || | 
 | 	    of_node_name_eq(uart_dp, "rsc-control")) { | 
 | 		mode = of_get_property(uart_dp, | 
 | 				       "ssp-console-modes", NULL); | 
 | 		if (!mode) | 
 | 			mode = "115200,8,n,1,-"; | 
 | 	} else if (of_node_name_eq(uart_dp, "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,-"; | 
 | 		of_node_put(dp); | 
 | 	} | 
 |  | 
 | 	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 |