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