Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Driver for 8250/16550-type serial ports | |
3 | * | |
4 | * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o. | |
5 | * | |
6 | * Copyright (C) 2001 Russell King. | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License as published by | |
10 | * the Free Software Foundation; either version 2 of the License, or | |
11 | * (at your option) any later version. | |
12 | * | |
13 | * A note about mapbase / membase | |
14 | * | |
15 | * mapbase is the physical address of the IO port. Currently, we don't | |
16 | * support this very well, and it may well be dropped from this driver | |
17 | * in future. As such, mapbase should be NULL. | |
18 | * | |
19 | * membase is an 'ioremapped' cookie. This is compatible with the old | |
20 | * serial.c driver, and is currently the preferred form. | |
21 | */ | |
22 | #include <linux/config.h> | |
23 | #include <linux/module.h> | |
24 | #include <linux/tty.h> | |
25 | #include <linux/ioport.h> | |
26 | #include <linux/init.h> | |
27 | #include <linux/console.h> | |
28 | #include <linux/sysrq.h> | |
29 | #include <linux/serial.h> | |
30 | #include <linux/serialP.h> | |
31 | #include <linux/delay.h> | |
32 | ||
33 | #include <asm/serial.h> | |
34 | #include <asm/io.h> | |
35 | #include <asm/irq.h> | |
36 | #include <asm/mach-au1x00/au1000.h> | |
37 | ||
38 | #if defined(CONFIG_SERIAL_AU1X00_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ) | |
39 | #define SUPPORT_SYSRQ | |
40 | #endif | |
41 | ||
42 | #include <linux/serial_core.h> | |
43 | #include "8250.h" | |
44 | ||
45 | /* | |
46 | * Debugging. | |
47 | */ | |
48 | #if 0 | |
49 | #define DEBUG_AUTOCONF(fmt...) printk(fmt) | |
50 | #else | |
51 | #define DEBUG_AUTOCONF(fmt...) do { } while (0) | |
52 | #endif | |
53 | ||
54 | #if 0 | |
55 | #define DEBUG_INTR(fmt...) printk(fmt) | |
56 | #else | |
57 | #define DEBUG_INTR(fmt...) do { } while (0) | |
58 | #endif | |
59 | ||
60 | #define PASS_LIMIT 256 | |
61 | ||
62 | /* | |
63 | * We default to IRQ0 for the "no irq" hack. Some | |
64 | * machine types want others as well - they're free | |
65 | * to redefine this in their header file. | |
66 | */ | |
67 | #define is_real_interrupt(irq) ((irq) != 0) | |
68 | ||
69 | static struct old_serial_port old_serial_port[] = { | |
70 | { .baud_base = 0, | |
71 | .iomem_base = (u8 *)UART0_ADDR, | |
72 | .irq = AU1000_UART0_INT, | |
73 | .flags = STD_COM_FLAGS, | |
74 | .iomem_reg_shift = 2, | |
75 | }, { | |
76 | .baud_base = 0, | |
77 | .iomem_base = (u8 *)UART1_ADDR, | |
78 | .irq = AU1000_UART1_INT, | |
79 | .flags = STD_COM_FLAGS, | |
80 | .iomem_reg_shift = 2 | |
81 | }, { | |
82 | .baud_base = 0, | |
83 | .iomem_base = (u8 *)UART2_ADDR, | |
84 | .irq = AU1000_UART2_INT, | |
85 | .flags = STD_COM_FLAGS, | |
86 | .iomem_reg_shift = 2 | |
87 | }, { | |
88 | .baud_base = 0, | |
89 | .iomem_base = (u8 *)UART3_ADDR, | |
90 | .irq = AU1000_UART3_INT, | |
91 | .flags = STD_COM_FLAGS, | |
92 | .iomem_reg_shift = 2 | |
93 | } | |
94 | }; | |
95 | ||
96 | #define UART_NR ARRAY_SIZE(old_serial_port) | |
97 | ||
98 | struct uart_8250_port { | |
99 | struct uart_port port; | |
100 | struct timer_list timer; /* "no irq" timer */ | |
101 | struct list_head list; /* ports on this IRQ */ | |
102 | unsigned short rev; | |
103 | unsigned char acr; | |
104 | unsigned char ier; | |
105 | unsigned char lcr; | |
106 | unsigned char mcr_mask; /* mask of user bits */ | |
107 | unsigned char mcr_force; /* mask of forced bits */ | |
108 | unsigned char lsr_break_flag; | |
109 | ||
110 | /* | |
111 | * We provide a per-port pm hook. | |
112 | */ | |
113 | void (*pm)(struct uart_port *port, | |
114 | unsigned int state, unsigned int old); | |
115 | }; | |
116 | ||
117 | struct irq_info { | |
118 | spinlock_t lock; | |
119 | struct list_head *head; | |
120 | }; | |
121 | ||
122 | static struct irq_info irq_lists[NR_IRQS]; | |
123 | ||
124 | /* | |
125 | * Here we define the default xmit fifo size used for each type of UART. | |
126 | */ | |
127 | static const struct serial_uart_config uart_config[PORT_MAX_8250+1] = { | |
128 | { "unknown", 1, 0 }, | |
129 | { "8250", 1, 0 }, | |
130 | { "16450", 1, 0 }, | |
131 | { "16550", 1, 0 }, | |
132 | /* PORT_16550A */ | |
133 | { "AU1X00_UART",16, UART_CLEAR_FIFO | UART_USE_FIFO }, | |
134 | }; | |
135 | ||
136 | static _INLINE_ unsigned int serial_in(struct uart_8250_port *up, int offset) | |
137 | { | |
138 | return au_readl((unsigned long)up->port.membase + offset); | |
139 | } | |
140 | ||
141 | static _INLINE_ void | |
142 | serial_out(struct uart_8250_port *up, int offset, int value) | |
143 | { | |
144 | au_writel(value, (unsigned long)up->port.membase + offset); | |
145 | } | |
146 | ||
147 | #define serial_inp(up, offset) serial_in(up, offset) | |
148 | #define serial_outp(up, offset, value) serial_out(up, offset, value) | |
149 | ||
150 | /* | |
151 | * This routine is called by rs_init() to initialize a specific serial | |
152 | * port. It determines what type of UART chip this serial port is | |
153 | * using: 8250, 16450, 16550, 16550A. The important question is | |
154 | * whether or not this UART is a 16550A or not, since this will | |
155 | * determine whether or not we can use its FIFO features or not. | |
156 | */ | |
157 | static void autoconfig(struct uart_8250_port *up, unsigned int probeflags) | |
158 | { | |
159 | unsigned char save_lcr, save_mcr; | |
160 | unsigned long flags; | |
161 | ||
162 | if (!up->port.iobase && !up->port.mapbase && !up->port.membase) | |
163 | return; | |
164 | ||
165 | DEBUG_AUTOCONF("ttyS%d: autoconf (0x%04x, 0x%08lx): ", | |
166 | up->port.line, up->port.iobase, up->port.membase); | |
167 | ||
168 | /* | |
169 | * We really do need global IRQs disabled here - we're going to | |
170 | * be frobbing the chips IRQ enable register to see if it exists. | |
171 | */ | |
172 | spin_lock_irqsave(&up->port.lock, flags); | |
173 | // save_flags(flags); cli(); | |
174 | ||
175 | save_mcr = serial_in(up, UART_MCR); | |
176 | save_lcr = serial_in(up, UART_LCR); | |
177 | ||
178 | up->port.type = PORT_16550A; | |
179 | serial_outp(up, UART_LCR, save_lcr); | |
180 | ||
181 | up->port.fifosize = uart_config[up->port.type].dfl_xmit_fifo_size; | |
182 | ||
183 | if (up->port.type == PORT_UNKNOWN) | |
184 | goto out; | |
185 | ||
186 | /* | |
187 | * Reset the UART. | |
188 | */ | |
189 | serial_outp(up, UART_MCR, save_mcr); | |
190 | serial_outp(up, UART_FCR, (UART_FCR_ENABLE_FIFO | | |
191 | UART_FCR_CLEAR_RCVR | | |
192 | UART_FCR_CLEAR_XMIT)); | |
193 | serial_outp(up, UART_FCR, 0); | |
194 | (void)serial_in(up, UART_RX); | |
195 | serial_outp(up, UART_IER, 0); | |
196 | ||
197 | out: | |
198 | spin_unlock_irqrestore(&up->port.lock, flags); | |
199 | // restore_flags(flags); | |
200 | DEBUG_AUTOCONF("type=%s\n", uart_config[up->port.type].name); | |
201 | } | |
202 | ||
203 | static void serial8250_stop_tx(struct uart_port *port, unsigned int tty_stop) | |
204 | { | |
205 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
206 | ||
207 | if (up->ier & UART_IER_THRI) { | |
208 | up->ier &= ~UART_IER_THRI; | |
209 | serial_out(up, UART_IER, up->ier); | |
210 | } | |
211 | } | |
212 | ||
213 | static void serial8250_start_tx(struct uart_port *port, unsigned int tty_start) | |
214 | { | |
215 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
216 | ||
217 | if (!(up->ier & UART_IER_THRI)) { | |
218 | up->ier |= UART_IER_THRI; | |
219 | serial_out(up, UART_IER, up->ier); | |
220 | } | |
221 | } | |
222 | ||
223 | static void serial8250_stop_rx(struct uart_port *port) | |
224 | { | |
225 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
226 | ||
227 | up->ier &= ~UART_IER_RLSI; | |
228 | up->port.read_status_mask &= ~UART_LSR_DR; | |
229 | serial_out(up, UART_IER, up->ier); | |
230 | } | |
231 | ||
232 | static void serial8250_enable_ms(struct uart_port *port) | |
233 | { | |
234 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
235 | ||
236 | up->ier |= UART_IER_MSI; | |
237 | serial_out(up, UART_IER, up->ier); | |
238 | } | |
239 | ||
240 | static _INLINE_ void | |
241 | receive_chars(struct uart_8250_port *up, int *status, struct pt_regs *regs) | |
242 | { | |
243 | struct tty_struct *tty = up->port.info->tty; | |
244 | unsigned char ch; | |
245 | int max_count = 256; | |
246 | ||
247 | do { | |
248 | if (unlikely(tty->flip.count >= TTY_FLIPBUF_SIZE)) { | |
249 | tty->flip.work.func((void *)tty); | |
250 | if (tty->flip.count >= TTY_FLIPBUF_SIZE) | |
251 | return; // if TTY_DONT_FLIP is set | |
252 | } | |
253 | ch = serial_inp(up, UART_RX); | |
254 | *tty->flip.char_buf_ptr = ch; | |
255 | *tty->flip.flag_buf_ptr = TTY_NORMAL; | |
256 | up->port.icount.rx++; | |
257 | ||
258 | if (unlikely(*status & (UART_LSR_BI | UART_LSR_PE | | |
259 | UART_LSR_FE | UART_LSR_OE))) { | |
260 | /* | |
261 | * For statistics only | |
262 | */ | |
263 | if (*status & UART_LSR_BI) { | |
264 | *status &= ~(UART_LSR_FE | UART_LSR_PE); | |
265 | up->port.icount.brk++; | |
266 | /* | |
267 | * We do the SysRQ and SAK checking | |
268 | * here because otherwise the break | |
269 | * may get masked by ignore_status_mask | |
270 | * or read_status_mask. | |
271 | */ | |
272 | if (uart_handle_break(&up->port)) | |
273 | goto ignore_char; | |
274 | } else if (*status & UART_LSR_PE) | |
275 | up->port.icount.parity++; | |
276 | else if (*status & UART_LSR_FE) | |
277 | up->port.icount.frame++; | |
278 | if (*status & UART_LSR_OE) | |
279 | up->port.icount.overrun++; | |
280 | ||
281 | /* | |
282 | * Mask off conditions which should be ingored. | |
283 | */ | |
284 | *status &= up->port.read_status_mask; | |
285 | ||
286 | #ifdef CONFIG_SERIAL_AU1X00_CONSOLE | |
287 | if (up->port.line == up->port.cons->index) { | |
288 | /* Recover the break flag from console xmit */ | |
289 | *status |= up->lsr_break_flag; | |
290 | up->lsr_break_flag = 0; | |
291 | } | |
292 | #endif | |
293 | if (*status & UART_LSR_BI) { | |
294 | DEBUG_INTR("handling break...."); | |
295 | *tty->flip.flag_buf_ptr = TTY_BREAK; | |
296 | } else if (*status & UART_LSR_PE) | |
297 | *tty->flip.flag_buf_ptr = TTY_PARITY; | |
298 | else if (*status & UART_LSR_FE) | |
299 | *tty->flip.flag_buf_ptr = TTY_FRAME; | |
300 | } | |
301 | if (uart_handle_sysrq_char(&up->port, ch, regs)) | |
302 | goto ignore_char; | |
303 | if ((*status & up->port.ignore_status_mask) == 0) { | |
304 | tty->flip.flag_buf_ptr++; | |
305 | tty->flip.char_buf_ptr++; | |
306 | tty->flip.count++; | |
307 | } | |
308 | if ((*status & UART_LSR_OE) && | |
309 | tty->flip.count < TTY_FLIPBUF_SIZE) { | |
310 | /* | |
311 | * Overrun is special, since it's reported | |
312 | * immediately, and doesn't affect the current | |
313 | * character. | |
314 | */ | |
315 | *tty->flip.flag_buf_ptr = TTY_OVERRUN; | |
316 | tty->flip.flag_buf_ptr++; | |
317 | tty->flip.char_buf_ptr++; | |
318 | tty->flip.count++; | |
319 | } | |
320 | ignore_char: | |
321 | *status = serial_inp(up, UART_LSR); | |
322 | } while ((*status & UART_LSR_DR) && (max_count-- > 0)); | |
323 | spin_unlock(&up->port.lock); | |
324 | tty_flip_buffer_push(tty); | |
325 | spin_lock(&up->port.lock); | |
326 | } | |
327 | ||
328 | static _INLINE_ void transmit_chars(struct uart_8250_port *up) | |
329 | { | |
330 | struct circ_buf *xmit = &up->port.info->xmit; | |
331 | int count; | |
332 | ||
333 | if (up->port.x_char) { | |
334 | serial_outp(up, UART_TX, up->port.x_char); | |
335 | up->port.icount.tx++; | |
336 | up->port.x_char = 0; | |
337 | return; | |
338 | } | |
339 | if (uart_circ_empty(xmit) || uart_tx_stopped(&up->port)) { | |
340 | serial8250_stop_tx(&up->port, 0); | |
341 | return; | |
342 | } | |
343 | ||
344 | count = up->port.fifosize; | |
345 | do { | |
346 | serial_out(up, UART_TX, xmit->buf[xmit->tail]); | |
347 | xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1); | |
348 | up->port.icount.tx++; | |
349 | if (uart_circ_empty(xmit)) | |
350 | break; | |
351 | } while (--count > 0); | |
352 | ||
353 | if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS) | |
354 | uart_write_wakeup(&up->port); | |
355 | ||
356 | DEBUG_INTR("THRE..."); | |
357 | ||
358 | if (uart_circ_empty(xmit)) | |
359 | serial8250_stop_tx(&up->port, 0); | |
360 | } | |
361 | ||
362 | static _INLINE_ void check_modem_status(struct uart_8250_port *up) | |
363 | { | |
364 | int status; | |
365 | ||
366 | status = serial_in(up, UART_MSR); | |
367 | ||
368 | if ((status & UART_MSR_ANY_DELTA) == 0) | |
369 | return; | |
370 | ||
371 | if (status & UART_MSR_TERI) | |
372 | up->port.icount.rng++; | |
373 | if (status & UART_MSR_DDSR) | |
374 | up->port.icount.dsr++; | |
375 | if (status & UART_MSR_DDCD) | |
376 | uart_handle_dcd_change(&up->port, status & UART_MSR_DCD); | |
377 | if (status & UART_MSR_DCTS) | |
378 | uart_handle_cts_change(&up->port, status & UART_MSR_CTS); | |
379 | ||
380 | wake_up_interruptible(&up->port.info->delta_msr_wait); | |
381 | } | |
382 | ||
383 | /* | |
384 | * This handles the interrupt from one port. | |
385 | */ | |
386 | static inline void | |
387 | serial8250_handle_port(struct uart_8250_port *up, struct pt_regs *regs) | |
388 | { | |
389 | unsigned int status = serial_inp(up, UART_LSR); | |
390 | ||
391 | DEBUG_INTR("status = %x...", status); | |
392 | ||
393 | if (status & UART_LSR_DR) | |
394 | receive_chars(up, &status, regs); | |
395 | check_modem_status(up); | |
396 | if (status & UART_LSR_THRE) | |
397 | transmit_chars(up); | |
398 | } | |
399 | ||
400 | /* | |
401 | * This is the serial driver's interrupt routine. | |
402 | * | |
403 | * Arjan thinks the old way was overly complex, so it got simplified. | |
404 | * Alan disagrees, saying that need the complexity to handle the weird | |
405 | * nature of ISA shared interrupts. (This is a special exception.) | |
406 | * | |
407 | * In order to handle ISA shared interrupts properly, we need to check | |
408 | * that all ports have been serviced, and therefore the ISA interrupt | |
409 | * line has been de-asserted. | |
410 | * | |
411 | * This means we need to loop through all ports. checking that they | |
412 | * don't have an interrupt pending. | |
413 | */ | |
414 | static irqreturn_t serial8250_interrupt(int irq, void *dev_id, struct pt_regs *regs) | |
415 | { | |
416 | struct irq_info *i = dev_id; | |
417 | struct list_head *l, *end = NULL; | |
418 | int pass_counter = 0; | |
419 | ||
420 | DEBUG_INTR("serial8250_interrupt(%d)...", irq); | |
421 | ||
422 | spin_lock(&i->lock); | |
423 | ||
424 | l = i->head; | |
425 | do { | |
426 | struct uart_8250_port *up; | |
427 | unsigned int iir; | |
428 | ||
429 | up = list_entry(l, struct uart_8250_port, list); | |
430 | ||
431 | iir = serial_in(up, UART_IIR); | |
432 | if (!(iir & UART_IIR_NO_INT)) { | |
433 | spin_lock(&up->port.lock); | |
434 | serial8250_handle_port(up, regs); | |
435 | spin_unlock(&up->port.lock); | |
436 | ||
437 | end = NULL; | |
438 | } else if (end == NULL) | |
439 | end = l; | |
440 | ||
441 | l = l->next; | |
442 | ||
443 | if (l == i->head && pass_counter++ > PASS_LIMIT) { | |
444 | /* If we hit this, we're dead. */ | |
445 | printk(KERN_ERR "serial8250: too much work for " | |
446 | "irq%d\n", irq); | |
447 | break; | |
448 | } | |
449 | } while (l != end); | |
450 | ||
451 | spin_unlock(&i->lock); | |
452 | ||
453 | DEBUG_INTR("end.\n"); | |
454 | /* FIXME! Was it really ours? */ | |
455 | return IRQ_HANDLED; | |
456 | } | |
457 | ||
458 | /* | |
459 | * To support ISA shared interrupts, we need to have one interrupt | |
460 | * handler that ensures that the IRQ line has been deasserted | |
461 | * before returning. Failing to do this will result in the IRQ | |
462 | * line being stuck active, and, since ISA irqs are edge triggered, | |
463 | * no more IRQs will be seen. | |
464 | */ | |
465 | static void serial_do_unlink(struct irq_info *i, struct uart_8250_port *up) | |
466 | { | |
467 | spin_lock_irq(&i->lock); | |
468 | ||
469 | if (!list_empty(i->head)) { | |
470 | if (i->head == &up->list) | |
471 | i->head = i->head->next; | |
472 | list_del(&up->list); | |
473 | } else { | |
474 | BUG_ON(i->head != &up->list); | |
475 | i->head = NULL; | |
476 | } | |
477 | ||
478 | spin_unlock_irq(&i->lock); | |
479 | } | |
480 | ||
481 | static int serial_link_irq_chain(struct uart_8250_port *up) | |
482 | { | |
483 | struct irq_info *i = irq_lists + up->port.irq; | |
484 | int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? SA_SHIRQ : 0; | |
485 | ||
486 | spin_lock_irq(&i->lock); | |
487 | ||
488 | if (i->head) { | |
489 | list_add(&up->list, i->head); | |
490 | spin_unlock_irq(&i->lock); | |
491 | ||
492 | ret = 0; | |
493 | } else { | |
494 | INIT_LIST_HEAD(&up->list); | |
495 | i->head = &up->list; | |
496 | spin_unlock_irq(&i->lock); | |
497 | ||
498 | ret = request_irq(up->port.irq, serial8250_interrupt, | |
499 | irq_flags, "serial", i); | |
500 | if (ret < 0) | |
501 | serial_do_unlink(i, up); | |
502 | } | |
503 | ||
504 | return ret; | |
505 | } | |
506 | ||
507 | static void serial_unlink_irq_chain(struct uart_8250_port *up) | |
508 | { | |
509 | struct irq_info *i = irq_lists + up->port.irq; | |
510 | ||
511 | BUG_ON(i->head == NULL); | |
512 | ||
513 | if (list_empty(i->head)) | |
514 | free_irq(up->port.irq, i); | |
515 | ||
516 | serial_do_unlink(i, up); | |
517 | } | |
518 | ||
519 | /* | |
520 | * This function is used to handle ports that do not have an | |
521 | * interrupt. This doesn't work very well for 16450's, but gives | |
522 | * barely passable results for a 16550A. (Although at the expense | |
523 | * of much CPU overhead). | |
524 | */ | |
525 | static void serial8250_timeout(unsigned long data) | |
526 | { | |
527 | struct uart_8250_port *up = (struct uart_8250_port *)data; | |
528 | unsigned int timeout; | |
529 | unsigned int iir; | |
530 | ||
531 | iir = serial_in(up, UART_IIR); | |
532 | if (!(iir & UART_IIR_NO_INT)) { | |
533 | spin_lock(&up->port.lock); | |
534 | serial8250_handle_port(up, NULL); | |
535 | spin_unlock(&up->port.lock); | |
536 | } | |
537 | ||
538 | timeout = up->port.timeout; | |
539 | timeout = timeout > 6 ? (timeout / 2 - 2) : 1; | |
540 | mod_timer(&up->timer, jiffies + timeout); | |
541 | } | |
542 | ||
543 | static unsigned int serial8250_tx_empty(struct uart_port *port) | |
544 | { | |
545 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
546 | unsigned long flags; | |
547 | unsigned int ret; | |
548 | ||
549 | spin_lock_irqsave(&up->port.lock, flags); | |
550 | ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0; | |
551 | spin_unlock_irqrestore(&up->port.lock, flags); | |
552 | ||
553 | return ret; | |
554 | } | |
555 | ||
556 | static unsigned int serial8250_get_mctrl(struct uart_port *port) | |
557 | { | |
558 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
559 | unsigned long flags; | |
560 | unsigned char status; | |
561 | unsigned int ret; | |
562 | ||
563 | spin_lock_irqsave(&up->port.lock, flags); | |
564 | status = serial_in(up, UART_MSR); | |
565 | spin_unlock_irqrestore(&up->port.lock, flags); | |
566 | ||
567 | ret = 0; | |
568 | if (status & UART_MSR_DCD) | |
569 | ret |= TIOCM_CAR; | |
570 | if (status & UART_MSR_RI) | |
571 | ret |= TIOCM_RNG; | |
572 | if (status & UART_MSR_DSR) | |
573 | ret |= TIOCM_DSR; | |
574 | if (status & UART_MSR_CTS) | |
575 | ret |= TIOCM_CTS; | |
576 | return ret; | |
577 | } | |
578 | ||
579 | static void serial8250_set_mctrl(struct uart_port *port, unsigned int mctrl) | |
580 | { | |
581 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
582 | unsigned char mcr = 0; | |
583 | ||
584 | if (mctrl & TIOCM_RTS) | |
585 | mcr |= UART_MCR_RTS; | |
586 | if (mctrl & TIOCM_DTR) | |
587 | mcr |= UART_MCR_DTR; | |
588 | if (mctrl & TIOCM_OUT1) | |
589 | mcr |= UART_MCR_OUT1; | |
590 | if (mctrl & TIOCM_OUT2) | |
591 | mcr |= UART_MCR_OUT2; | |
592 | if (mctrl & TIOCM_LOOP) | |
593 | mcr |= UART_MCR_LOOP; | |
594 | ||
595 | mcr = (mcr & up->mcr_mask) | up->mcr_force; | |
596 | ||
597 | serial_out(up, UART_MCR, mcr); | |
598 | } | |
599 | ||
600 | static void serial8250_break_ctl(struct uart_port *port, int break_state) | |
601 | { | |
602 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
603 | unsigned long flags; | |
604 | ||
605 | spin_lock_irqsave(&up->port.lock, flags); | |
606 | if (break_state == -1) | |
607 | up->lcr |= UART_LCR_SBC; | |
608 | else | |
609 | up->lcr &= ~UART_LCR_SBC; | |
610 | serial_out(up, UART_LCR, up->lcr); | |
611 | spin_unlock_irqrestore(&up->port.lock, flags); | |
612 | } | |
613 | ||
614 | static int serial8250_startup(struct uart_port *port) | |
615 | { | |
616 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
617 | unsigned long flags; | |
618 | int retval; | |
619 | ||
620 | /* | |
621 | * Clear the FIFO buffers and disable them. | |
622 | * (they will be reeanbled in set_termios()) | |
623 | */ | |
624 | if (uart_config[up->port.type].flags & UART_CLEAR_FIFO) { | |
625 | serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO); | |
626 | serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | | |
627 | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT); | |
628 | serial_outp(up, UART_FCR, 0); | |
629 | } | |
630 | ||
631 | /* | |
632 | * Clear the interrupt registers. | |
633 | */ | |
634 | (void) serial_inp(up, UART_LSR); | |
635 | (void) serial_inp(up, UART_RX); | |
636 | (void) serial_inp(up, UART_IIR); | |
637 | (void) serial_inp(up, UART_MSR); | |
638 | ||
639 | /* | |
640 | * At this point, there's no way the LSR could still be 0xff; | |
641 | * if it is, then bail out, because there's likely no UART | |
642 | * here. | |
643 | */ | |
644 | if (!(up->port.flags & UPF_BUGGY_UART) && | |
645 | (serial_inp(up, UART_LSR) == 0xff)) { | |
646 | printk("ttyS%d: LSR safety check engaged!\n", up->port.line); | |
647 | return -ENODEV; | |
648 | } | |
649 | ||
650 | retval = serial_link_irq_chain(up); | |
651 | if (retval) | |
652 | return retval; | |
653 | ||
654 | /* | |
655 | * Now, initialize the UART | |
656 | */ | |
657 | serial_outp(up, UART_LCR, UART_LCR_WLEN8); | |
658 | ||
659 | spin_lock_irqsave(&up->port.lock, flags); | |
660 | if (up->port.flags & UPF_FOURPORT) { | |
661 | if (!is_real_interrupt(up->port.irq)) | |
662 | up->port.mctrl |= TIOCM_OUT1; | |
663 | } else | |
664 | /* | |
665 | * Most PC uarts need OUT2 raised to enable interrupts. | |
666 | */ | |
667 | if (is_real_interrupt(up->port.irq)) | |
668 | up->port.mctrl |= TIOCM_OUT2; | |
669 | ||
670 | serial8250_set_mctrl(&up->port, up->port.mctrl); | |
671 | spin_unlock_irqrestore(&up->port.lock, flags); | |
672 | ||
673 | /* | |
674 | * Finally, enable interrupts. Note: Modem status interrupts | |
675 | * are set via set_termios(), which will be occurring imminently | |
676 | * anyway, so we don't enable them here. | |
677 | */ | |
678 | up->ier = UART_IER_RLSI | UART_IER_RDI; | |
679 | serial_outp(up, UART_IER, up->ier); | |
680 | ||
681 | if (up->port.flags & UPF_FOURPORT) { | |
682 | unsigned int icp; | |
683 | /* | |
684 | * Enable interrupts on the AST Fourport board | |
685 | */ | |
686 | icp = (up->port.iobase & 0xfe0) | 0x01f; | |
687 | outb_p(0x80, icp); | |
688 | (void) inb_p(icp); | |
689 | } | |
690 | ||
691 | /* | |
692 | * And clear the interrupt registers again for luck. | |
693 | */ | |
694 | (void) serial_inp(up, UART_LSR); | |
695 | (void) serial_inp(up, UART_RX); | |
696 | (void) serial_inp(up, UART_IIR); | |
697 | (void) serial_inp(up, UART_MSR); | |
698 | ||
699 | return 0; | |
700 | } | |
701 | ||
702 | static void serial8250_shutdown(struct uart_port *port) | |
703 | { | |
704 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
705 | unsigned long flags; | |
706 | ||
707 | /* | |
708 | * Disable interrupts from this port | |
709 | */ | |
710 | up->ier = 0; | |
711 | serial_outp(up, UART_IER, 0); | |
712 | ||
713 | spin_lock_irqsave(&up->port.lock, flags); | |
714 | if (up->port.flags & UPF_FOURPORT) { | |
715 | /* reset interrupts on the AST Fourport board */ | |
716 | inb((up->port.iobase & 0xfe0) | 0x1f); | |
717 | up->port.mctrl |= TIOCM_OUT1; | |
718 | } else | |
719 | up->port.mctrl &= ~TIOCM_OUT2; | |
720 | ||
721 | serial8250_set_mctrl(&up->port, up->port.mctrl); | |
722 | spin_unlock_irqrestore(&up->port.lock, flags); | |
723 | ||
724 | /* | |
725 | * Disable break condition and FIFOs | |
726 | */ | |
727 | serial_out(up, UART_LCR, serial_inp(up, UART_LCR) & ~UART_LCR_SBC); | |
728 | serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | | |
729 | UART_FCR_CLEAR_RCVR | | |
730 | UART_FCR_CLEAR_XMIT); | |
731 | serial_outp(up, UART_FCR, 0); | |
732 | ||
733 | /* | |
734 | * Read data port to reset things, and then unlink from | |
735 | * the IRQ chain. | |
736 | */ | |
737 | (void) serial_in(up, UART_RX); | |
738 | ||
739 | if (!is_real_interrupt(up->port.irq)) | |
740 | del_timer_sync(&up->timer); | |
741 | else | |
742 | serial_unlink_irq_chain(up); | |
743 | } | |
744 | ||
745 | static unsigned int serial8250_get_divisor(struct uart_port *port, unsigned int baud) | |
746 | { | |
747 | unsigned int quot; | |
748 | ||
749 | /* | |
750 | * Handle magic divisors for baud rates above baud_base on | |
751 | * SMSC SuperIO chips. | |
752 | */ | |
753 | if ((port->flags & UPF_MAGIC_MULTIPLIER) && | |
754 | baud == (port->uartclk/4)) | |
755 | quot = 0x8001; | |
756 | else if ((port->flags & UPF_MAGIC_MULTIPLIER) && | |
757 | baud == (port->uartclk/8)) | |
758 | quot = 0x8002; | |
759 | else | |
760 | quot = uart_get_divisor(port, baud); | |
761 | ||
762 | return quot; | |
763 | } | |
764 | ||
765 | static void | |
766 | serial8250_set_termios(struct uart_port *port, struct termios *termios, | |
767 | struct termios *old) | |
768 | { | |
769 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
770 | unsigned char cval, fcr = 0; | |
771 | unsigned long flags; | |
772 | unsigned int baud, quot; | |
773 | ||
774 | switch (termios->c_cflag & CSIZE) { | |
775 | case CS5: | |
776 | cval = 0x00; | |
777 | break; | |
778 | case CS6: | |
779 | cval = 0x01; | |
780 | break; | |
781 | case CS7: | |
782 | cval = 0x02; | |
783 | break; | |
784 | default: | |
785 | case CS8: | |
786 | cval = 0x03; | |
787 | break; | |
788 | } | |
789 | ||
790 | if (termios->c_cflag & CSTOPB) | |
791 | cval |= 0x04; | |
792 | if (termios->c_cflag & PARENB) | |
793 | cval |= UART_LCR_PARITY; | |
794 | if (!(termios->c_cflag & PARODD)) | |
795 | cval |= UART_LCR_EPAR; | |
796 | #ifdef CMSPAR | |
797 | if (termios->c_cflag & CMSPAR) | |
798 | cval |= UART_LCR_SPAR; | |
799 | #endif | |
800 | ||
801 | /* | |
802 | * Ask the core to calculate the divisor for us. | |
803 | */ | |
804 | baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16); | |
805 | quot = serial8250_get_divisor(port, baud); | |
806 | quot = 0x35; /* FIXME */ | |
807 | ||
808 | /* | |
809 | * Work around a bug in the Oxford Semiconductor 952 rev B | |
810 | * chip which causes it to seriously miscalculate baud rates | |
811 | * when DLL is 0. | |
812 | */ | |
813 | if ((quot & 0xff) == 0 && up->port.type == PORT_16C950 && | |
814 | up->rev == 0x5201) | |
815 | quot ++; | |
816 | ||
817 | if (uart_config[up->port.type].flags & UART_USE_FIFO) { | |
818 | if (baud < 2400) | |
819 | fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIGGER_1; | |
820 | else | |
821 | fcr = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIGGER_8; | |
822 | } | |
823 | ||
824 | /* | |
825 | * Ok, we're now changing the port state. Do it with | |
826 | * interrupts disabled. | |
827 | */ | |
828 | spin_lock_irqsave(&up->port.lock, flags); | |
829 | ||
830 | /* | |
831 | * Update the per-port timeout. | |
832 | */ | |
833 | uart_update_timeout(port, termios->c_cflag, baud); | |
834 | ||
835 | up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR; | |
836 | if (termios->c_iflag & INPCK) | |
837 | up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE; | |
838 | if (termios->c_iflag & (BRKINT | PARMRK)) | |
839 | up->port.read_status_mask |= UART_LSR_BI; | |
840 | ||
841 | /* | |
842 | * Characteres to ignore | |
843 | */ | |
844 | up->port.ignore_status_mask = 0; | |
845 | if (termios->c_iflag & IGNPAR) | |
846 | up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE; | |
847 | if (termios->c_iflag & IGNBRK) { | |
848 | up->port.ignore_status_mask |= UART_LSR_BI; | |
849 | /* | |
850 | * If we're ignoring parity and break indicators, | |
851 | * ignore overruns too (for real raw support). | |
852 | */ | |
853 | if (termios->c_iflag & IGNPAR) | |
854 | up->port.ignore_status_mask |= UART_LSR_OE; | |
855 | } | |
856 | ||
857 | /* | |
858 | * ignore all characters if CREAD is not set | |
859 | */ | |
860 | if ((termios->c_cflag & CREAD) == 0) | |
861 | up->port.ignore_status_mask |= UART_LSR_DR; | |
862 | ||
863 | /* | |
864 | * CTS flow control flag and modem status interrupts | |
865 | */ | |
866 | up->ier &= ~UART_IER_MSI; | |
867 | if (UART_ENABLE_MS(&up->port, termios->c_cflag)) | |
868 | up->ier |= UART_IER_MSI; | |
869 | ||
870 | serial_out(up, UART_IER, up->ier); | |
871 | serial_outp(up, 0x28, quot & 0xffff); | |
872 | up->lcr = cval; /* Save LCR */ | |
873 | if (up->port.type != PORT_16750) { | |
874 | if (fcr & UART_FCR_ENABLE_FIFO) { | |
875 | /* emulated UARTs (Lucent Venus 167x) need two steps */ | |
876 | serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO); | |
877 | } | |
878 | serial_outp(up, UART_FCR, fcr); /* set fcr */ | |
879 | } | |
880 | spin_unlock_irqrestore(&up->port.lock, flags); | |
881 | } | |
882 | ||
883 | static void | |
884 | serial8250_pm(struct uart_port *port, unsigned int state, | |
885 | unsigned int oldstate) | |
886 | { | |
887 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
888 | if (state) { | |
889 | /* sleep */ | |
890 | if (up->pm) | |
891 | up->pm(port, state, oldstate); | |
892 | } else { | |
893 | /* wake */ | |
894 | if (up->pm) | |
895 | up->pm(port, state, oldstate); | |
896 | } | |
897 | } | |
898 | ||
899 | /* | |
900 | * Resource handling. This is complicated by the fact that resources | |
901 | * depend on the port type. Maybe we should be claiming the standard | |
902 | * 8250 ports, and then trying to get other resources as necessary? | |
903 | */ | |
904 | static int | |
905 | serial8250_request_std_resource(struct uart_8250_port *up, struct resource **res) | |
906 | { | |
907 | unsigned int size = 8 << up->port.regshift; | |
908 | int ret = 0; | |
909 | ||
910 | switch (up->port.iotype) { | |
911 | case SERIAL_IO_MEM: | |
912 | if (up->port.mapbase) { | |
913 | *res = request_mem_region(up->port.mapbase, size, "serial"); | |
914 | if (!*res) | |
915 | ret = -EBUSY; | |
916 | } | |
917 | break; | |
918 | ||
919 | case SERIAL_IO_HUB6: | |
920 | case SERIAL_IO_PORT: | |
921 | *res = request_region(up->port.iobase, size, "serial"); | |
922 | if (!*res) | |
923 | ret = -EBUSY; | |
924 | break; | |
925 | } | |
926 | return ret; | |
927 | } | |
928 | ||
929 | ||
930 | static void serial8250_release_port(struct uart_port *port) | |
931 | { | |
932 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
933 | unsigned long start, offset = 0, size = 0; | |
934 | ||
935 | size <<= up->port.regshift; | |
936 | ||
937 | switch (up->port.iotype) { | |
938 | case SERIAL_IO_MEM: | |
939 | if (up->port.mapbase) { | |
940 | /* | |
941 | * Unmap the area. | |
942 | */ | |
943 | iounmap(up->port.membase); | |
944 | up->port.membase = NULL; | |
945 | ||
946 | start = up->port.mapbase; | |
947 | ||
948 | if (size) | |
949 | release_mem_region(start + offset, size); | |
950 | release_mem_region(start, 8 << up->port.regshift); | |
951 | } | |
952 | break; | |
953 | ||
954 | case SERIAL_IO_HUB6: | |
955 | case SERIAL_IO_PORT: | |
956 | start = up->port.iobase; | |
957 | ||
958 | if (size) | |
959 | release_region(start + offset, size); | |
960 | release_region(start + offset, 8 << up->port.regshift); | |
961 | break; | |
962 | ||
963 | default: | |
964 | break; | |
965 | } | |
966 | } | |
967 | ||
968 | static int serial8250_request_port(struct uart_port *port) | |
969 | { | |
970 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
971 | struct resource *res = NULL, *res_rsa = NULL; | |
972 | int ret = 0; | |
973 | ||
974 | ret = serial8250_request_std_resource(up, &res); | |
975 | ||
976 | /* | |
977 | * If we have a mapbase, then request that as well. | |
978 | */ | |
979 | if (ret == 0 && up->port.flags & UPF_IOREMAP) { | |
980 | int size = res->end - res->start + 1; | |
981 | ||
982 | up->port.membase = ioremap(up->port.mapbase, size); | |
983 | if (!up->port.membase) | |
984 | ret = -ENOMEM; | |
985 | } | |
986 | ||
987 | if (ret < 0) { | |
988 | if (res_rsa) | |
989 | release_resource(res_rsa); | |
990 | if (res) | |
991 | release_resource(res); | |
992 | } | |
993 | return ret; | |
994 | } | |
995 | ||
996 | static void serial8250_config_port(struct uart_port *port, int flags) | |
997 | { | |
998 | struct uart_8250_port *up = (struct uart_8250_port *)port; | |
999 | struct resource *res_std = NULL, *res_rsa = NULL; | |
1000 | int probeflags = PROBE_ANY; | |
1001 | ||
1002 | probeflags &= ~PROBE_RSA; | |
1003 | ||
1004 | if (flags & UART_CONFIG_TYPE) | |
1005 | autoconfig(up, probeflags); | |
1006 | ||
1007 | /* | |
1008 | * If the port wasn't an RSA port, release the resource. | |
1009 | */ | |
1010 | if (up->port.type != PORT_RSA && res_rsa) | |
1011 | release_resource(res_rsa); | |
1012 | ||
1013 | if (up->port.type == PORT_UNKNOWN && res_std) | |
1014 | release_resource(res_std); | |
1015 | } | |
1016 | ||
1017 | static int | |
1018 | serial8250_verify_port(struct uart_port *port, struct serial_struct *ser) | |
1019 | { | |
1020 | if (ser->irq >= NR_IRQS || ser->irq < 0 || | |
1021 | ser->baud_base < 9600 || ser->type < PORT_UNKNOWN || | |
1022 | ser->type > PORT_MAX_8250 || ser->type == PORT_CIRRUS || | |
1023 | ser->type == PORT_STARTECH) | |
1024 | return -EINVAL; | |
1025 | return 0; | |
1026 | } | |
1027 | ||
1028 | static const char * | |
1029 | serial8250_type(struct uart_port *port) | |
1030 | { | |
1031 | int type = port->type; | |
1032 | ||
1033 | if (type >= ARRAY_SIZE(uart_config)) | |
1034 | type = 0; | |
1035 | return uart_config[type].name; | |
1036 | } | |
1037 | ||
1038 | static struct uart_ops serial8250_pops = { | |
1039 | .tx_empty = serial8250_tx_empty, | |
1040 | .set_mctrl = serial8250_set_mctrl, | |
1041 | .get_mctrl = serial8250_get_mctrl, | |
1042 | .stop_tx = serial8250_stop_tx, | |
1043 | .start_tx = serial8250_start_tx, | |
1044 | .stop_rx = serial8250_stop_rx, | |
1045 | .enable_ms = serial8250_enable_ms, | |
1046 | .break_ctl = serial8250_break_ctl, | |
1047 | .startup = serial8250_startup, | |
1048 | .shutdown = serial8250_shutdown, | |
1049 | .set_termios = serial8250_set_termios, | |
1050 | .pm = serial8250_pm, | |
1051 | .type = serial8250_type, | |
1052 | .release_port = serial8250_release_port, | |
1053 | .request_port = serial8250_request_port, | |
1054 | .config_port = serial8250_config_port, | |
1055 | .verify_port = serial8250_verify_port, | |
1056 | }; | |
1057 | ||
1058 | static struct uart_8250_port serial8250_ports[UART_NR]; | |
1059 | ||
1060 | static void __init serial8250_isa_init_ports(void) | |
1061 | { | |
1062 | struct uart_8250_port *up; | |
1063 | static int first = 1; | |
1064 | int i; | |
1065 | ||
1066 | if (!first) | |
1067 | return; | |
1068 | first = 0; | |
1069 | ||
1070 | for (i = 0, up = serial8250_ports; i < ARRAY_SIZE(old_serial_port); | |
1071 | i++, up++) { | |
1072 | up->port.iobase = old_serial_port[i].port; | |
1073 | up->port.irq = old_serial_port[i].irq; | |
1074 | up->port.uartclk = get_au1x00_uart_baud_base(); | |
1075 | up->port.flags = old_serial_port[i].flags; | |
1076 | up->port.hub6 = old_serial_port[i].hub6; | |
1077 | up->port.membase = old_serial_port[i].iomem_base; | |
1078 | up->port.iotype = old_serial_port[i].io_type; | |
1079 | up->port.regshift = old_serial_port[i].iomem_reg_shift; | |
1080 | up->port.ops = &serial8250_pops; | |
1081 | } | |
1082 | } | |
1083 | ||
1084 | static void __init serial8250_register_ports(struct uart_driver *drv) | |
1085 | { | |
1086 | int i; | |
1087 | ||
1088 | serial8250_isa_init_ports(); | |
1089 | ||
1090 | for (i = 0; i < UART_NR; i++) { | |
1091 | struct uart_8250_port *up = &serial8250_ports[i]; | |
1092 | ||
1093 | up->port.line = i; | |
1094 | up->port.ops = &serial8250_pops; | |
1095 | init_timer(&up->timer); | |
1096 | up->timer.function = serial8250_timeout; | |
1097 | ||
1098 | /* | |
1099 | * ALPHA_KLUDGE_MCR needs to be killed. | |
1100 | */ | |
1101 | up->mcr_mask = ~ALPHA_KLUDGE_MCR; | |
1102 | up->mcr_force = ALPHA_KLUDGE_MCR; | |
1103 | ||
1104 | uart_add_one_port(drv, &up->port); | |
1105 | } | |
1106 | } | |
1107 | ||
1108 | #ifdef CONFIG_SERIAL_AU1X00_CONSOLE | |
1109 | ||
1110 | #define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE) | |
1111 | ||
1112 | /* | |
1113 | * Wait for transmitter & holding register to empty | |
1114 | */ | |
1115 | static inline void wait_for_xmitr(struct uart_8250_port *up) | |
1116 | { | |
1117 | unsigned int status, tmout = 10000; | |
1118 | ||
1119 | /* Wait up to 10ms for the character(s) to be sent. */ | |
1120 | do { | |
1121 | status = serial_in(up, UART_LSR); | |
1122 | ||
1123 | if (status & UART_LSR_BI) | |
1124 | up->lsr_break_flag = UART_LSR_BI; | |
1125 | ||
1126 | if (--tmout == 0) | |
1127 | break; | |
1128 | udelay(1); | |
1129 | } while ((status & BOTH_EMPTY) != BOTH_EMPTY); | |
1130 | ||
1131 | /* Wait up to 1s for flow control if necessary */ | |
1132 | if (up->port.flags & UPF_CONS_FLOW) { | |
1133 | tmout = 1000000; | |
1134 | while (--tmout && | |
1135 | ((serial_in(up, UART_MSR) & UART_MSR_CTS) == 0)) | |
1136 | udelay(1); | |
1137 | } | |
1138 | } | |
1139 | ||
1140 | /* | |
1141 | * Print a string to the serial port trying not to disturb | |
1142 | * any possible real use of the port... | |
1143 | * | |
1144 | * The console_lock must be held when we get here. | |
1145 | */ | |
1146 | static void | |
1147 | serial8250_console_write(struct console *co, const char *s, unsigned int count) | |
1148 | { | |
1149 | struct uart_8250_port *up = &serial8250_ports[co->index]; | |
1150 | unsigned int ier; | |
1151 | int i; | |
1152 | ||
1153 | /* | |
1154 | * First save the UER then disable the interrupts | |
1155 | */ | |
1156 | ier = serial_in(up, UART_IER); | |
1157 | serial_out(up, UART_IER, 0); | |
1158 | ||
1159 | /* | |
1160 | * Now, do each character | |
1161 | */ | |
1162 | for (i = 0; i < count; i++, s++) { | |
1163 | wait_for_xmitr(up); | |
1164 | ||
1165 | /* | |
1166 | * Send the character out. | |
1167 | * If a LF, also do CR... | |
1168 | */ | |
1169 | serial_out(up, UART_TX, *s); | |
1170 | if (*s == 10) { | |
1171 | wait_for_xmitr(up); | |
1172 | serial_out(up, UART_TX, 13); | |
1173 | } | |
1174 | } | |
1175 | ||
1176 | /* | |
1177 | * Finally, wait for transmitter to become empty | |
1178 | * and restore the IER | |
1179 | */ | |
1180 | wait_for_xmitr(up); | |
1181 | serial_out(up, UART_IER, ier); | |
1182 | } | |
1183 | ||
1184 | static int __init serial8250_console_setup(struct console *co, char *options) | |
1185 | { | |
1186 | struct uart_port *port; | |
1187 | int baud = 9600; | |
1188 | int bits = 8; | |
1189 | int parity = 'n'; | |
1190 | int flow = 'n'; | |
1191 | ||
1192 | /* | |
1193 | * Check whether an invalid uart number has been specified, and | |
1194 | * if so, search for the first available port that does have | |
1195 | * console support. | |
1196 | */ | |
1197 | if (co->index >= UART_NR) | |
1198 | co->index = 0; | |
1199 | port = &serial8250_ports[co->index].port; | |
1200 | ||
1201 | /* | |
1202 | * Temporary fix. | |
1203 | */ | |
1204 | spin_lock_init(&port->lock); | |
1205 | ||
1206 | if (options) | |
1207 | uart_parse_options(options, &baud, &parity, &bits, &flow); | |
1208 | ||
1209 | return uart_set_options(port, co, baud, parity, bits, flow); | |
1210 | } | |
1211 | ||
1212 | extern struct uart_driver serial8250_reg; | |
1213 | static struct console serial8250_console = { | |
1214 | .name = "ttyS", | |
1215 | .write = serial8250_console_write, | |
1216 | .device = uart_console_device, | |
1217 | .setup = serial8250_console_setup, | |
1218 | .flags = CON_PRINTBUFFER, | |
1219 | .index = -1, | |
1220 | .data = &serial8250_reg, | |
1221 | }; | |
1222 | ||
1223 | static int __init serial8250_console_init(void) | |
1224 | { | |
1225 | serial8250_isa_init_ports(); | |
1226 | register_console(&serial8250_console); | |
1227 | return 0; | |
1228 | } | |
1229 | console_initcall(serial8250_console_init); | |
1230 | ||
1231 | #define SERIAL8250_CONSOLE &serial8250_console | |
1232 | #else | |
1233 | #define SERIAL8250_CONSOLE NULL | |
1234 | #endif | |
1235 | ||
1236 | static struct uart_driver serial8250_reg = { | |
1237 | .owner = THIS_MODULE, | |
1238 | .driver_name = "serial", | |
1239 | .devfs_name = "tts/", | |
1240 | .dev_name = "ttyS", | |
1241 | .major = TTY_MAJOR, | |
1242 | .minor = 64, | |
1243 | .nr = UART_NR, | |
1244 | .cons = SERIAL8250_CONSOLE, | |
1245 | }; | |
1246 | ||
1247 | int __init early_serial_setup(struct uart_port *port) | |
1248 | { | |
1249 | serial8250_isa_init_ports(); | |
1250 | serial8250_ports[port->line].port = *port; | |
1251 | serial8250_ports[port->line].port.ops = &serial8250_pops; | |
1252 | return 0; | |
1253 | } | |
1254 | ||
1255 | /** | |
1256 | * serial8250_suspend_port - suspend one serial port | |
1257 | * @line: serial line number | |
1258 | * @level: the level of port suspension, as per uart_suspend_port | |
1259 | * | |
1260 | * Suspend one serial port. | |
1261 | */ | |
1262 | void serial8250_suspend_port(int line) | |
1263 | { | |
1264 | uart_suspend_port(&serial8250_reg, &serial8250_ports[line].port); | |
1265 | } | |
1266 | ||
1267 | /** | |
1268 | * serial8250_resume_port - resume one serial port | |
1269 | * @line: serial line number | |
1270 | * @level: the level of port resumption, as per uart_resume_port | |
1271 | * | |
1272 | * Resume one serial port. | |
1273 | */ | |
1274 | void serial8250_resume_port(int line) | |
1275 | { | |
1276 | uart_resume_port(&serial8250_reg, &serial8250_ports[line].port); | |
1277 | } | |
1278 | ||
1279 | static int __init serial8250_init(void) | |
1280 | { | |
1281 | int ret, i; | |
1282 | ||
1283 | printk(KERN_INFO "Serial: Au1x00 driver\n"); | |
1284 | ||
1285 | for (i = 0; i < NR_IRQS; i++) | |
1286 | spin_lock_init(&irq_lists[i].lock); | |
1287 | ||
1288 | ret = uart_register_driver(&serial8250_reg); | |
1289 | if (ret >= 0) | |
1290 | serial8250_register_ports(&serial8250_reg); | |
1291 | ||
1292 | return ret; | |
1293 | } | |
1294 | ||
1295 | static void __exit serial8250_exit(void) | |
1296 | { | |
1297 | int i; | |
1298 | ||
1299 | for (i = 0; i < UART_NR; i++) | |
1300 | uart_remove_one_port(&serial8250_reg, &serial8250_ports[i].port); | |
1301 | ||
1302 | uart_unregister_driver(&serial8250_reg); | |
1303 | } | |
1304 | ||
1305 | module_init(serial8250_init); | |
1306 | module_exit(serial8250_exit); | |
1307 | ||
1308 | EXPORT_SYMBOL(serial8250_suspend_port); | |
1309 | EXPORT_SYMBOL(serial8250_resume_port); | |
1310 | ||
1311 | MODULE_LICENSE("GPL"); | |
1312 | MODULE_DESCRIPTION("Au1x00 serial driver\n"); |