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