diff options
Diffstat (limited to 'drivers/tty/serial/serial_ks8695.c')
-rw-r--r-- | drivers/tty/serial/serial_ks8695.c | 705 |
1 files changed, 705 insertions, 0 deletions
diff --git a/drivers/tty/serial/serial_ks8695.c b/drivers/tty/serial/serial_ks8695.c new file mode 100644 index 000000000000..b1962025b1aa --- /dev/null +++ b/drivers/tty/serial/serial_ks8695.c | |||
@@ -0,0 +1,705 @@ | |||
1 | /* | ||
2 | * drivers/serial/serial_ks8695.c | ||
3 | * | ||
4 | * Driver for KS8695 serial ports | ||
5 | * | ||
6 | * Based on drivers/serial/serial_amba.c, by Kam Lee. | ||
7 | * | ||
8 | * Copyright 2002-2005 Micrel Inc. | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify | ||
11 | * it under the terms of the GNU General Public License as published by | ||
12 | * the Free Software Foundation; either version 2 of the License, or | ||
13 | * (at your option) any later version. | ||
14 | * | ||
15 | */ | ||
16 | #include <linux/module.h> | ||
17 | #include <linux/tty.h> | ||
18 | #include <linux/ioport.h> | ||
19 | #include <linux/init.h> | ||
20 | #include <linux/serial.h> | ||
21 | #include <linux/console.h> | ||
22 | #include <linux/sysrq.h> | ||
23 | #include <linux/device.h> | ||
24 | |||
25 | #include <asm/io.h> | ||
26 | #include <asm/irq.h> | ||
27 | #include <asm/mach/irq.h> | ||
28 | |||
29 | #include <mach/regs-uart.h> | ||
30 | #include <mach/regs-irq.h> | ||
31 | |||
32 | #if defined(CONFIG_SERIAL_KS8695_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) | ||
33 | #define SUPPORT_SYSRQ | ||
34 | #endif | ||
35 | |||
36 | #include <linux/serial_core.h> | ||
37 | |||
38 | |||
39 | #define SERIAL_KS8695_MAJOR 204 | ||
40 | #define SERIAL_KS8695_MINOR 16 | ||
41 | #define SERIAL_KS8695_DEVNAME "ttyAM" | ||
42 | |||
43 | #define SERIAL_KS8695_NR 1 | ||
44 | |||
45 | /* | ||
46 | * Access macros for the KS8695 UART | ||
47 | */ | ||
48 | #define UART_GET_CHAR(p) (__raw_readl((p)->membase + KS8695_URRB) & 0xFF) | ||
49 | #define UART_PUT_CHAR(p, c) __raw_writel((c), (p)->membase + KS8695_URTH) | ||
50 | #define UART_GET_FCR(p) __raw_readl((p)->membase + KS8695_URFC) | ||
51 | #define UART_PUT_FCR(p, c) __raw_writel((c), (p)->membase + KS8695_URFC) | ||
52 | #define UART_GET_MSR(p) __raw_readl((p)->membase + KS8695_URMS) | ||
53 | #define UART_GET_LSR(p) __raw_readl((p)->membase + KS8695_URLS) | ||
54 | #define UART_GET_LCR(p) __raw_readl((p)->membase + KS8695_URLC) | ||
55 | #define UART_PUT_LCR(p, c) __raw_writel((c), (p)->membase + KS8695_URLC) | ||
56 | #define UART_GET_MCR(p) __raw_readl((p)->membase + KS8695_URMC) | ||
57 | #define UART_PUT_MCR(p, c) __raw_writel((c), (p)->membase + KS8695_URMC) | ||
58 | #define UART_GET_BRDR(p) __raw_readl((p)->membase + KS8695_URBD) | ||
59 | #define UART_PUT_BRDR(p, c) __raw_writel((c), (p)->membase + KS8695_URBD) | ||
60 | |||
61 | #define KS8695_CLR_TX_INT() __raw_writel(1 << KS8695_IRQ_UART_TX, KS8695_IRQ_VA + KS8695_INTST) | ||
62 | |||
63 | #define UART_DUMMY_LSR_RX 0x100 | ||
64 | #define UART_PORT_SIZE (KS8695_USR - KS8695_URRB + 4) | ||
65 | |||
66 | static inline int tx_enabled(struct uart_port *port) | ||
67 | { | ||
68 | return port->unused[0] & 1; | ||
69 | } | ||
70 | |||
71 | static inline int rx_enabled(struct uart_port *port) | ||
72 | { | ||
73 | return port->unused[0] & 2; | ||
74 | } | ||
75 | |||
76 | static inline int ms_enabled(struct uart_port *port) | ||
77 | { | ||
78 | return port->unused[0] & 4; | ||
79 | } | ||
80 | |||
81 | static inline void ms_enable(struct uart_port *port, int enabled) | ||
82 | { | ||
83 | if(enabled) | ||
84 | port->unused[0] |= 4; | ||
85 | else | ||
86 | port->unused[0] &= ~4; | ||
87 | } | ||
88 | |||
89 | static inline void rx_enable(struct uart_port *port, int enabled) | ||
90 | { | ||
91 | if(enabled) | ||
92 | port->unused[0] |= 2; | ||
93 | else | ||
94 | port->unused[0] &= ~2; | ||
95 | } | ||
96 | |||
97 | static inline void tx_enable(struct uart_port *port, int enabled) | ||
98 | { | ||
99 | if(enabled) | ||
100 | port->unused[0] |= 1; | ||
101 | else | ||
102 | port->unused[0] &= ~1; | ||
103 | } | ||
104 | |||
105 | |||
106 | #ifdef SUPPORT_SYSRQ | ||
107 | static struct console ks8695_console; | ||
108 | #endif | ||
109 | |||
110 | static void ks8695uart_stop_tx(struct uart_port *port) | ||
111 | { | ||
112 | if (tx_enabled(port)) { | ||
113 | /* use disable_irq_nosync() and not disable_irq() to avoid self | ||
114 | * imposed deadlock by not waiting for irq handler to end, | ||
115 | * since this ks8695uart_stop_tx() is called from interrupt context. | ||
116 | */ | ||
117 | disable_irq_nosync(KS8695_IRQ_UART_TX); | ||
118 | tx_enable(port, 0); | ||
119 | } | ||
120 | } | ||
121 | |||
122 | static void ks8695uart_start_tx(struct uart_port *port) | ||
123 | { | ||
124 | if (!tx_enabled(port)) { | ||
125 | enable_irq(KS8695_IRQ_UART_TX); | ||
126 | tx_enable(port, 1); | ||
127 | } | ||
128 | } | ||
129 | |||
130 | static void ks8695uart_stop_rx(struct uart_port *port) | ||
131 | { | ||
132 | if (rx_enabled(port)) { | ||
133 | disable_irq(KS8695_IRQ_UART_RX); | ||
134 | rx_enable(port, 0); | ||
135 | } | ||
136 | } | ||
137 | |||
138 | static void ks8695uart_enable_ms(struct uart_port *port) | ||
139 | { | ||
140 | if (!ms_enabled(port)) { | ||
141 | enable_irq(KS8695_IRQ_UART_MODEM_STATUS); | ||
142 | ms_enable(port,1); | ||
143 | } | ||
144 | } | ||
145 | |||
146 | static void ks8695uart_disable_ms(struct uart_port *port) | ||
147 | { | ||
148 | if (ms_enabled(port)) { | ||
149 | disable_irq(KS8695_IRQ_UART_MODEM_STATUS); | ||
150 | ms_enable(port,0); | ||
151 | } | ||
152 | } | ||
153 | |||
154 | static irqreturn_t ks8695uart_rx_chars(int irq, void *dev_id) | ||
155 | { | ||
156 | struct uart_port *port = dev_id; | ||
157 | struct tty_struct *tty = port->state->port.tty; | ||
158 | unsigned int status, ch, lsr, flg, max_count = 256; | ||
159 | |||
160 | status = UART_GET_LSR(port); /* clears pending LSR interrupts */ | ||
161 | while ((status & URLS_URDR) && max_count--) { | ||
162 | ch = UART_GET_CHAR(port); | ||
163 | flg = TTY_NORMAL; | ||
164 | |||
165 | port->icount.rx++; | ||
166 | |||
167 | /* | ||
168 | * Note that the error handling code is | ||
169 | * out of the main execution path | ||
170 | */ | ||
171 | lsr = UART_GET_LSR(port) | UART_DUMMY_LSR_RX; | ||
172 | if (unlikely(lsr & (URLS_URBI | URLS_URPE | URLS_URFE | URLS_URROE))) { | ||
173 | if (lsr & URLS_URBI) { | ||
174 | lsr &= ~(URLS_URFE | URLS_URPE); | ||
175 | port->icount.brk++; | ||
176 | if (uart_handle_break(port)) | ||
177 | goto ignore_char; | ||
178 | } | ||
179 | if (lsr & URLS_URPE) | ||
180 | port->icount.parity++; | ||
181 | if (lsr & URLS_URFE) | ||
182 | port->icount.frame++; | ||
183 | if (lsr & URLS_URROE) | ||
184 | port->icount.overrun++; | ||
185 | |||
186 | lsr &= port->read_status_mask; | ||
187 | |||
188 | if (lsr & URLS_URBI) | ||
189 | flg = TTY_BREAK; | ||
190 | else if (lsr & URLS_URPE) | ||
191 | flg = TTY_PARITY; | ||
192 | else if (lsr & URLS_URFE) | ||
193 | flg = TTY_FRAME; | ||
194 | } | ||
195 | |||
196 | if (uart_handle_sysrq_char(port, ch)) | ||
197 | goto ignore_char; | ||
198 | |||
199 | uart_insert_char(port, lsr, URLS_URROE, ch, flg); | ||
200 | |||
201 | ignore_char: | ||
202 | status = UART_GET_LSR(port); | ||
203 | } | ||
204 | tty_flip_buffer_push(tty); | ||
205 | |||
206 | return IRQ_HANDLED; | ||
207 | } | ||
208 | |||
209 | |||
210 | static irqreturn_t ks8695uart_tx_chars(int irq, void *dev_id) | ||
211 | { | ||
212 | struct uart_port *port = dev_id; | ||
213 | struct circ_buf *xmit = &port->state->xmit; | ||
214 | unsigned int count; | ||
215 | |||
216 | if (port->x_char) { | ||
217 | KS8695_CLR_TX_INT(); | ||
218 | UART_PUT_CHAR(port, port->x_char); | ||
219 | port->icount.tx++; | ||
220 | port->x_char = 0; | ||
221 | return IRQ_HANDLED; | ||
222 | } | ||
223 | |||
224 | if (uart_tx_stopped(port) || uart_circ_empty(xmit)) { | ||
225 | ks8695uart_stop_tx(port); | ||
226 | return IRQ_HANDLED; | ||
227 | } | ||
228 | |||
229 | count = 16; /* fifo size */ | ||
230 | while (!uart_circ_empty(xmit) && (count-- > 0)) { | ||
231 | KS8695_CLR_TX_INT(); | ||
232 | UART_PUT_CHAR(port, xmit->buf[xmit->tail]); | ||
233 | |||
234 | xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); | ||
235 | port->icount.tx++; | ||
236 | } | ||
237 | |||
238 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | ||
239 | uart_write_wakeup(port); | ||
240 | |||
241 | if (uart_circ_empty(xmit)) | ||
242 | ks8695uart_stop_tx(port); | ||
243 | |||
244 | return IRQ_HANDLED; | ||
245 | } | ||
246 | |||
247 | static irqreturn_t ks8695uart_modem_status(int irq, void *dev_id) | ||
248 | { | ||
249 | struct uart_port *port = dev_id; | ||
250 | unsigned int status; | ||
251 | |||
252 | /* | ||
253 | * clear modem interrupt by reading MSR | ||
254 | */ | ||
255 | status = UART_GET_MSR(port); | ||
256 | |||
257 | if (status & URMS_URDDCD) | ||
258 | uart_handle_dcd_change(port, status & URMS_URDDCD); | ||
259 | |||
260 | if (status & URMS_URDDST) | ||
261 | port->icount.dsr++; | ||
262 | |||
263 | if (status & URMS_URDCTS) | ||
264 | uart_handle_cts_change(port, status & URMS_URDCTS); | ||
265 | |||
266 | if (status & URMS_URTERI) | ||
267 | port->icount.rng++; | ||
268 | |||
269 | wake_up_interruptible(&port->state->port.delta_msr_wait); | ||
270 | |||
271 | return IRQ_HANDLED; | ||
272 | } | ||
273 | |||
274 | static unsigned int ks8695uart_tx_empty(struct uart_port *port) | ||
275 | { | ||
276 | return (UART_GET_LSR(port) & URLS_URTE) ? TIOCSER_TEMT : 0; | ||
277 | } | ||
278 | |||
279 | static unsigned int ks8695uart_get_mctrl(struct uart_port *port) | ||
280 | { | ||
281 | unsigned int result = 0; | ||
282 | unsigned int status; | ||
283 | |||
284 | status = UART_GET_MSR(port); | ||
285 | if (status & URMS_URDCD) | ||
286 | result |= TIOCM_CAR; | ||
287 | if (status & URMS_URDSR) | ||
288 | result |= TIOCM_DSR; | ||
289 | if (status & URMS_URCTS) | ||
290 | result |= TIOCM_CTS; | ||
291 | if (status & URMS_URRI) | ||
292 | result |= TIOCM_RI; | ||
293 | |||
294 | return result; | ||
295 | } | ||
296 | |||
297 | static void ks8695uart_set_mctrl(struct uart_port *port, u_int mctrl) | ||
298 | { | ||
299 | unsigned int mcr; | ||
300 | |||
301 | mcr = UART_GET_MCR(port); | ||
302 | if (mctrl & TIOCM_RTS) | ||
303 | mcr |= URMC_URRTS; | ||
304 | else | ||
305 | mcr &= ~URMC_URRTS; | ||
306 | |||
307 | if (mctrl & TIOCM_DTR) | ||
308 | mcr |= URMC_URDTR; | ||
309 | else | ||
310 | mcr &= ~URMC_URDTR; | ||
311 | |||
312 | UART_PUT_MCR(port, mcr); | ||
313 | } | ||
314 | |||
315 | static void ks8695uart_break_ctl(struct uart_port *port, int break_state) | ||
316 | { | ||
317 | unsigned int lcr; | ||
318 | |||
319 | lcr = UART_GET_LCR(port); | ||
320 | |||
321 | if (break_state == -1) | ||
322 | lcr |= URLC_URSBC; | ||
323 | else | ||
324 | lcr &= ~URLC_URSBC; | ||
325 | |||
326 | UART_PUT_LCR(port, lcr); | ||
327 | } | ||
328 | |||
329 | static int ks8695uart_startup(struct uart_port *port) | ||
330 | { | ||
331 | int retval; | ||
332 | |||
333 | set_irq_flags(KS8695_IRQ_UART_TX, IRQF_VALID | IRQF_NOAUTOEN); | ||
334 | tx_enable(port, 0); | ||
335 | rx_enable(port, 1); | ||
336 | ms_enable(port, 1); | ||
337 | |||
338 | /* | ||
339 | * Allocate the IRQ | ||
340 | */ | ||
341 | retval = request_irq(KS8695_IRQ_UART_TX, ks8695uart_tx_chars, IRQF_DISABLED, "UART TX", port); | ||
342 | if (retval) | ||
343 | goto err_tx; | ||
344 | |||
345 | retval = request_irq(KS8695_IRQ_UART_RX, ks8695uart_rx_chars, IRQF_DISABLED, "UART RX", port); | ||
346 | if (retval) | ||
347 | goto err_rx; | ||
348 | |||
349 | retval = request_irq(KS8695_IRQ_UART_LINE_STATUS, ks8695uart_rx_chars, IRQF_DISABLED, "UART LineStatus", port); | ||
350 | if (retval) | ||
351 | goto err_ls; | ||
352 | |||
353 | retval = request_irq(KS8695_IRQ_UART_MODEM_STATUS, ks8695uart_modem_status, IRQF_DISABLED, "UART ModemStatus", port); | ||
354 | if (retval) | ||
355 | goto err_ms; | ||
356 | |||
357 | return 0; | ||
358 | |||
359 | err_ms: | ||
360 | free_irq(KS8695_IRQ_UART_LINE_STATUS, port); | ||
361 | err_ls: | ||
362 | free_irq(KS8695_IRQ_UART_RX, port); | ||
363 | err_rx: | ||
364 | free_irq(KS8695_IRQ_UART_TX, port); | ||
365 | err_tx: | ||
366 | return retval; | ||
367 | } | ||
368 | |||
369 | static void ks8695uart_shutdown(struct uart_port *port) | ||
370 | { | ||
371 | /* | ||
372 | * Free the interrupt | ||
373 | */ | ||
374 | free_irq(KS8695_IRQ_UART_RX, port); | ||
375 | free_irq(KS8695_IRQ_UART_TX, port); | ||
376 | free_irq(KS8695_IRQ_UART_MODEM_STATUS, port); | ||
377 | free_irq(KS8695_IRQ_UART_LINE_STATUS, port); | ||
378 | |||
379 | /* disable break condition and fifos */ | ||
380 | UART_PUT_LCR(port, UART_GET_LCR(port) & ~URLC_URSBC); | ||
381 | UART_PUT_FCR(port, UART_GET_FCR(port) & ~URFC_URFE); | ||
382 | } | ||
383 | |||
384 | static void ks8695uart_set_termios(struct uart_port *port, struct ktermios *termios, struct ktermios *old) | ||
385 | { | ||
386 | unsigned int lcr, fcr = 0; | ||
387 | unsigned long flags; | ||
388 | unsigned int baud, quot; | ||
389 | |||
390 | /* | ||
391 | * Ask the core to calculate the divisor for us. | ||
392 | */ | ||
393 | baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); | ||
394 | quot = uart_get_divisor(port, baud); | ||
395 | |||
396 | switch (termios->c_cflag & CSIZE) { | ||
397 | case CS5: | ||
398 | lcr = URCL_5; | ||
399 | break; | ||
400 | case CS6: | ||
401 | lcr = URCL_6; | ||
402 | break; | ||
403 | case CS7: | ||
404 | lcr = URCL_7; | ||
405 | break; | ||
406 | default: | ||
407 | lcr = URCL_8; | ||
408 | break; | ||
409 | } | ||
410 | |||
411 | /* stop bits */ | ||
412 | if (termios->c_cflag & CSTOPB) | ||
413 | lcr |= URLC_URSB; | ||
414 | |||
415 | /* parity */ | ||
416 | if (termios->c_cflag & PARENB) { | ||
417 | if (termios->c_cflag & CMSPAR) { /* Mark or Space parity */ | ||
418 | if (termios->c_cflag & PARODD) | ||
419 | lcr |= URPE_MARK; | ||
420 | else | ||
421 | lcr |= URPE_SPACE; | ||
422 | } | ||
423 | else if (termios->c_cflag & PARODD) | ||
424 | lcr |= URPE_ODD; | ||
425 | else | ||
426 | lcr |= URPE_EVEN; | ||
427 | } | ||
428 | |||
429 | if (port->fifosize > 1) | ||
430 | fcr = URFC_URFRT_8 | URFC_URTFR | URFC_URRFR | URFC_URFE; | ||
431 | |||
432 | spin_lock_irqsave(&port->lock, flags); | ||
433 | |||
434 | /* | ||
435 | * Update the per-port timeout. | ||
436 | */ | ||
437 | uart_update_timeout(port, termios->c_cflag, baud); | ||
438 | |||
439 | port->read_status_mask = URLS_URROE; | ||
440 | if (termios->c_iflag & INPCK) | ||
441 | port->read_status_mask |= (URLS_URFE | URLS_URPE); | ||
442 | if (termios->c_iflag & (BRKINT | PARMRK)) | ||
443 | port->read_status_mask |= URLS_URBI; | ||
444 | |||
445 | /* | ||
446 | * Characters to ignore | ||
447 | */ | ||
448 | port->ignore_status_mask = 0; | ||
449 | if (termios->c_iflag & IGNPAR) | ||
450 | port->ignore_status_mask |= (URLS_URFE | URLS_URPE); | ||
451 | if (termios->c_iflag & IGNBRK) { | ||
452 | port->ignore_status_mask |= URLS_URBI; | ||
453 | /* | ||
454 | * If we're ignoring parity and break indicators, | ||
455 | * ignore overruns too (for real raw support). | ||
456 | */ | ||
457 | if (termios->c_iflag & IGNPAR) | ||
458 | port->ignore_status_mask |= URLS_URROE; | ||
459 | } | ||
460 | |||
461 | /* | ||
462 | * Ignore all characters if CREAD is not set. | ||
463 | */ | ||
464 | if ((termios->c_cflag & CREAD) == 0) | ||
465 | port->ignore_status_mask |= UART_DUMMY_LSR_RX; | ||
466 | |||
467 | /* first, disable everything */ | ||
468 | if (UART_ENABLE_MS(port, termios->c_cflag)) | ||
469 | ks8695uart_enable_ms(port); | ||
470 | else | ||
471 | ks8695uart_disable_ms(port); | ||
472 | |||
473 | /* Set baud rate */ | ||
474 | UART_PUT_BRDR(port, quot); | ||
475 | |||
476 | UART_PUT_LCR(port, lcr); | ||
477 | UART_PUT_FCR(port, fcr); | ||
478 | |||
479 | spin_unlock_irqrestore(&port->lock, flags); | ||
480 | } | ||
481 | |||
482 | static const char *ks8695uart_type(struct uart_port *port) | ||
483 | { | ||
484 | return port->type == PORT_KS8695 ? "KS8695" : NULL; | ||
485 | } | ||
486 | |||
487 | /* | ||
488 | * Release the memory region(s) being used by 'port' | ||
489 | */ | ||
490 | static void ks8695uart_release_port(struct uart_port *port) | ||
491 | { | ||
492 | release_mem_region(port->mapbase, UART_PORT_SIZE); | ||
493 | } | ||
494 | |||
495 | /* | ||
496 | * Request the memory region(s) being used by 'port' | ||
497 | */ | ||
498 | static int ks8695uart_request_port(struct uart_port *port) | ||
499 | { | ||
500 | return request_mem_region(port->mapbase, UART_PORT_SIZE, | ||
501 | "serial_ks8695") != NULL ? 0 : -EBUSY; | ||
502 | } | ||
503 | |||
504 | /* | ||
505 | * Configure/autoconfigure the port. | ||
506 | */ | ||
507 | static void ks8695uart_config_port(struct uart_port *port, int flags) | ||
508 | { | ||
509 | if (flags & UART_CONFIG_TYPE) { | ||
510 | port->type = PORT_KS8695; | ||
511 | ks8695uart_request_port(port); | ||
512 | } | ||
513 | } | ||
514 | |||
515 | /* | ||
516 | * verify the new serial_struct (for TIOCSSERIAL). | ||
517 | */ | ||
518 | static int ks8695uart_verify_port(struct uart_port *port, struct serial_struct *ser) | ||
519 | { | ||
520 | int ret = 0; | ||
521 | |||
522 | if (ser->type != PORT_UNKNOWN && ser->type != PORT_KS8695) | ||
523 | ret = -EINVAL; | ||
524 | if (ser->irq != port->irq) | ||
525 | ret = -EINVAL; | ||
526 | if (ser->baud_base < 9600) | ||
527 | ret = -EINVAL; | ||
528 | return ret; | ||
529 | } | ||
530 | |||
531 | static struct uart_ops ks8695uart_pops = { | ||
532 | .tx_empty = ks8695uart_tx_empty, | ||
533 | .set_mctrl = ks8695uart_set_mctrl, | ||
534 | .get_mctrl = ks8695uart_get_mctrl, | ||
535 | .stop_tx = ks8695uart_stop_tx, | ||
536 | .start_tx = ks8695uart_start_tx, | ||
537 | .stop_rx = ks8695uart_stop_rx, | ||
538 | .enable_ms = ks8695uart_enable_ms, | ||
539 | .break_ctl = ks8695uart_break_ctl, | ||
540 | .startup = ks8695uart_startup, | ||
541 | .shutdown = ks8695uart_shutdown, | ||
542 | .set_termios = ks8695uart_set_termios, | ||
543 | .type = ks8695uart_type, | ||
544 | .release_port = ks8695uart_release_port, | ||
545 | .request_port = ks8695uart_request_port, | ||
546 | .config_port = ks8695uart_config_port, | ||
547 | .verify_port = ks8695uart_verify_port, | ||
548 | }; | ||
549 | |||
550 | static struct uart_port ks8695uart_ports[SERIAL_KS8695_NR] = { | ||
551 | { | ||
552 | .membase = (void *) KS8695_UART_VA, | ||
553 | .mapbase = KS8695_UART_VA, | ||
554 | .iotype = SERIAL_IO_MEM, | ||
555 | .irq = KS8695_IRQ_UART_TX, | ||
556 | .uartclk = KS8695_CLOCK_RATE * 16, | ||
557 | .fifosize = 16, | ||
558 | .ops = &ks8695uart_pops, | ||
559 | .flags = ASYNC_BOOT_AUTOCONF, | ||
560 | .line = 0, | ||
561 | } | ||
562 | }; | ||
563 | |||
564 | #ifdef CONFIG_SERIAL_KS8695_CONSOLE | ||
565 | static void ks8695_console_putchar(struct uart_port *port, int ch) | ||
566 | { | ||
567 | while (!(UART_GET_LSR(port) & URLS_URTHRE)) | ||
568 | barrier(); | ||
569 | |||
570 | UART_PUT_CHAR(port, ch); | ||
571 | } | ||
572 | |||
573 | static void ks8695_console_write(struct console *co, const char *s, u_int count) | ||
574 | { | ||
575 | struct uart_port *port = ks8695uart_ports + co->index; | ||
576 | |||
577 | uart_console_write(port, s, count, ks8695_console_putchar); | ||
578 | } | ||
579 | |||
580 | static void __init ks8695_console_get_options(struct uart_port *port, int *baud, int *parity, int *bits) | ||
581 | { | ||
582 | unsigned int lcr; | ||
583 | |||
584 | lcr = UART_GET_LCR(port); | ||
585 | |||
586 | switch (lcr & URLC_PARITY) { | ||
587 | case URPE_ODD: | ||
588 | *parity = 'o'; | ||
589 | break; | ||
590 | case URPE_EVEN: | ||
591 | *parity = 'e'; | ||
592 | break; | ||
593 | default: | ||
594 | *parity = 'n'; | ||
595 | } | ||
596 | |||
597 | switch (lcr & URLC_URCL) { | ||
598 | case URCL_5: | ||
599 | *bits = 5; | ||
600 | break; | ||
601 | case URCL_6: | ||
602 | *bits = 6; | ||
603 | break; | ||
604 | case URCL_7: | ||
605 | *bits = 7; | ||
606 | break; | ||
607 | default: | ||
608 | *bits = 8; | ||
609 | } | ||
610 | |||
611 | *baud = port->uartclk / (UART_GET_BRDR(port) & 0x0FFF); | ||
612 | *baud /= 16; | ||
613 | *baud &= 0xFFFFFFF0; | ||
614 | } | ||
615 | |||
616 | static int __init ks8695_console_setup(struct console *co, char *options) | ||
617 | { | ||
618 | struct uart_port *port; | ||
619 | int baud = 115200; | ||
620 | int bits = 8; | ||
621 | int parity = 'n'; | ||
622 | int flow = 'n'; | ||
623 | |||
624 | /* | ||
625 | * Check whether an invalid uart number has been specified, and | ||
626 | * if so, search for the first available port that does have | ||
627 | * console support. | ||
628 | */ | ||
629 | port = uart_get_console(ks8695uart_ports, SERIAL_KS8695_NR, co); | ||
630 | |||
631 | if (options) | ||
632 | uart_parse_options(options, &baud, &parity, &bits, &flow); | ||
633 | else | ||
634 | ks8695_console_get_options(port, &baud, &parity, &bits); | ||
635 | |||
636 | return uart_set_options(port, co, baud, parity, bits, flow); | ||
637 | } | ||
638 | |||
639 | static struct uart_driver ks8695_reg; | ||
640 | |||
641 | static struct console ks8695_console = { | ||
642 | .name = SERIAL_KS8695_DEVNAME, | ||
643 | .write = ks8695_console_write, | ||
644 | .device = uart_console_device, | ||
645 | .setup = ks8695_console_setup, | ||
646 | .flags = CON_PRINTBUFFER, | ||
647 | .index = -1, | ||
648 | .data = &ks8695_reg, | ||
649 | }; | ||
650 | |||
651 | static int __init ks8695_console_init(void) | ||
652 | { | ||
653 | add_preferred_console(SERIAL_KS8695_DEVNAME, 0, NULL); | ||
654 | register_console(&ks8695_console); | ||
655 | return 0; | ||
656 | } | ||
657 | |||
658 | console_initcall(ks8695_console_init); | ||
659 | |||
660 | #define KS8695_CONSOLE &ks8695_console | ||
661 | #else | ||
662 | #define KS8695_CONSOLE NULL | ||
663 | #endif | ||
664 | |||
665 | static struct uart_driver ks8695_reg = { | ||
666 | .owner = THIS_MODULE, | ||
667 | .driver_name = "serial_ks8695", | ||
668 | .dev_name = SERIAL_KS8695_DEVNAME, | ||
669 | .major = SERIAL_KS8695_MAJOR, | ||
670 | .minor = SERIAL_KS8695_MINOR, | ||
671 | .nr = SERIAL_KS8695_NR, | ||
672 | .cons = KS8695_CONSOLE, | ||
673 | }; | ||
674 | |||
675 | static int __init ks8695uart_init(void) | ||
676 | { | ||
677 | int i, ret; | ||
678 | |||
679 | printk(KERN_INFO "Serial: Micrel KS8695 UART driver\n"); | ||
680 | |||
681 | ret = uart_register_driver(&ks8695_reg); | ||
682 | if (ret) | ||
683 | return ret; | ||
684 | |||
685 | for (i = 0; i < SERIAL_KS8695_NR; i++) | ||
686 | uart_add_one_port(&ks8695_reg, &ks8695uart_ports[0]); | ||
687 | |||
688 | return 0; | ||
689 | } | ||
690 | |||
691 | static void __exit ks8695uart_exit(void) | ||
692 | { | ||
693 | int i; | ||
694 | |||
695 | for (i = 0; i < SERIAL_KS8695_NR; i++) | ||
696 | uart_remove_one_port(&ks8695_reg, &ks8695uart_ports[0]); | ||
697 | uart_unregister_driver(&ks8695_reg); | ||
698 | } | ||
699 | |||
700 | module_init(ks8695uart_init); | ||
701 | module_exit(ks8695uart_exit); | ||
702 | |||
703 | MODULE_DESCRIPTION("KS8695 serial port driver"); | ||
704 | MODULE_AUTHOR("Micrel Inc."); | ||
705 | MODULE_LICENSE("GPL"); | ||