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