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/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> | |
c73fcc84 | 19 | #include <linux/serial_core.h> |
1da177e4 LT |
20 | #include <linux/init.h> |
21 | ||
c73fcc84 | 22 | #include <asm/prom.h> |
1da177e4 LT |
23 | |
24 | #include "suncore.h" | |
25 | ||
58d784a5 | 26 | static int sunserial_current_minor = 64; |
1da177e4 | 27 | |
58d784a5 MH |
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); | |
1da177e4 | 54 | |
fb445ee5 | 55 | int sunserial_console_match(struct console *con, struct device_node *dp, |
4e3533d0 | 56 | struct uart_driver *drv, int line, bool ignore_line) |
1da177e4 | 57 | { |
0a492896 DM |
58 | if (!con) |
59 | return 0; | |
60 | ||
61 | drv->cons = con; | |
62 | ||
63 | if (of_console_device != dp) | |
c73fcc84 | 64 | return 0; |
1da177e4 | 65 | |
4e3533d0 DM |
66 | if (!ignore_line) { |
67 | int off = 0; | |
1da177e4 | 68 | |
4e3533d0 DM |
69 | if (of_console_options && |
70 | *of_console_options == 'b') | |
71 | off = 1; | |
72 | ||
73 | if ((line & 1) != off) | |
74 | return 0; | |
75 | } | |
1da177e4 | 76 | |
0a492896 DM |
77 | if (!console_set_on_cmdline) { |
78 | con->index = line; | |
7c1f6afc | 79 | add_preferred_console(con->name, line, NULL); |
0a492896 | 80 | } |
c73fcc84 DM |
81 | return 1; |
82 | } | |
83 | EXPORT_SYMBOL(sunserial_console_match); | |
1da177e4 | 84 | |
457931de | 85 | void sunserial_console_termios(struct console *con, struct device_node *uart_dp) |
c73fcc84 | 86 | { |
457931de | 87 | const char *mode, *s; |
c73fcc84 DM |
88 | char mode_prop[] = "ttyX-mode"; |
89 | int baud, bits, stop, cflag; | |
90 | char parity; | |
1da177e4 | 91 | |
457931de DM |
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, | |
c73fcc84 DM |
96 | "ssp-console-modes", NULL); |
97 | if (!mode) | |
98 | mode = "115200,8,n,1,-"; | |
457931de DM |
99 | } else if (!strcmp(uart_dp->name, "lom-console")) { |
100 | mode = "9600,8,n,1,-"; | |
c73fcc84 | 101 | } else { |
457931de | 102 | struct device_node *dp; |
c73fcc84 DM |
103 | char c; |
104 | ||
105 | c = 'a'; | |
106 | if (of_console_options) | |
107 | c = *of_console_options; | |
108 | ||
109 | mode_prop[3] = c; | |
110 | ||
457931de | 111 | dp = of_find_node_by_path("/options"); |
c73fcc84 DM |
112 | mode = of_get_property(dp, mode_prop, NULL); |
113 | if (!mode) | |
114 | mode = "9600,8,n,1,-"; | |
1da177e4 LT |
115 | } |
116 | ||
1da177e4 LT |
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; | |
c126cf80 ED |
140 | case 57600: cflag |= B57600; break; |
141 | case 115200: cflag |= B115200; break; | |
142 | case 230400: cflag |= B230400; break; | |
143 | case 460800: cflag |= B460800; break; | |
1da177e4 LT |
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 | ||
1da177e4 LT |
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"); |