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> |
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) { |
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) { |
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")) { |
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 | } |
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 |