]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/tty/serial/serial_core.c
procfs: new helper - PDE_DATA(inode)
[mirror_ubuntu-bionic-kernel.git] / drivers / tty / serial / serial_core.c
1 /*
2 * Driver core for serial ports
3 *
4 * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
5 *
6 * Copyright 1999 ARM Limited
7 * Copyright (C) 2000-2001 Deep Blue Solutions Ltd.
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 */
23 #include <linux/module.h>
24 #include <linux/tty.h>
25 #include <linux/tty_flip.h>
26 #include <linux/slab.h>
27 #include <linux/init.h>
28 #include <linux/console.h>
29 #include <linux/proc_fs.h>
30 #include <linux/seq_file.h>
31 #include <linux/device.h>
32 #include <linux/serial.h> /* for serial_state and serial_icounter_struct */
33 #include <linux/serial_core.h>
34 #include <linux/delay.h>
35 #include <linux/mutex.h>
36
37 #include <asm/irq.h>
38 #include <asm/uaccess.h>
39
40 /*
41 * This is used to lock changes in serial line configuration.
42 */
43 static DEFINE_MUTEX(port_mutex);
44
45 /*
46 * lockdep: port->lock is initialized in two places, but we
47 * want only one lock-class:
48 */
49 static struct lock_class_key port_lock_key;
50
51 #define HIGH_BITS_OFFSET ((sizeof(long)-sizeof(int))*8)
52
53 #ifdef CONFIG_SERIAL_CORE_CONSOLE
54 #define uart_console(port) ((port)->cons && (port)->cons->index == (port)->line)
55 #else
56 #define uart_console(port) (0)
57 #endif
58
59 static void uart_change_speed(struct tty_struct *tty, struct uart_state *state,
60 struct ktermios *old_termios);
61 static void uart_wait_until_sent(struct tty_struct *tty, int timeout);
62 static void uart_change_pm(struct uart_state *state,
63 enum uart_pm_state pm_state);
64
65 static void uart_port_shutdown(struct tty_port *port);
66
67 /*
68 * This routine is used by the interrupt handler to schedule processing in
69 * the software interrupt portion of the driver.
70 */
71 void uart_write_wakeup(struct uart_port *port)
72 {
73 struct uart_state *state = port->state;
74 /*
75 * This means you called this function _after_ the port was
76 * closed. No cookie for you.
77 */
78 BUG_ON(!state);
79 tty_wakeup(state->port.tty);
80 }
81
82 static void uart_stop(struct tty_struct *tty)
83 {
84 struct uart_state *state = tty->driver_data;
85 struct uart_port *port = state->uart_port;
86 unsigned long flags;
87
88 spin_lock_irqsave(&port->lock, flags);
89 port->ops->stop_tx(port);
90 spin_unlock_irqrestore(&port->lock, flags);
91 }
92
93 static void __uart_start(struct tty_struct *tty)
94 {
95 struct uart_state *state = tty->driver_data;
96 struct uart_port *port = state->uart_port;
97
98 if (!uart_circ_empty(&state->xmit) && state->xmit.buf &&
99 !tty->stopped && !tty->hw_stopped)
100 port->ops->start_tx(port);
101 }
102
103 static void uart_start(struct tty_struct *tty)
104 {
105 struct uart_state *state = tty->driver_data;
106 struct uart_port *port = state->uart_port;
107 unsigned long flags;
108
109 spin_lock_irqsave(&port->lock, flags);
110 __uart_start(tty);
111 spin_unlock_irqrestore(&port->lock, flags);
112 }
113
114 static inline void
115 uart_update_mctrl(struct uart_port *port, unsigned int set, unsigned int clear)
116 {
117 unsigned long flags;
118 unsigned int old;
119
120 spin_lock_irqsave(&port->lock, flags);
121 old = port->mctrl;
122 port->mctrl = (old & ~clear) | set;
123 if (old != port->mctrl)
124 port->ops->set_mctrl(port, port->mctrl);
125 spin_unlock_irqrestore(&port->lock, flags);
126 }
127
128 #define uart_set_mctrl(port, set) uart_update_mctrl(port, set, 0)
129 #define uart_clear_mctrl(port, clear) uart_update_mctrl(port, 0, clear)
130
131 /*
132 * Startup the port. This will be called once per open. All calls
133 * will be serialised by the per-port mutex.
134 */
135 static int uart_port_startup(struct tty_struct *tty, struct uart_state *state,
136 int init_hw)
137 {
138 struct uart_port *uport = state->uart_port;
139 struct tty_port *port = &state->port;
140 unsigned long page;
141 int retval = 0;
142
143 if (uport->type == PORT_UNKNOWN)
144 return 1;
145
146 /*
147 * Initialise and allocate the transmit and temporary
148 * buffer.
149 */
150 if (!state->xmit.buf) {
151 /* This is protected by the per port mutex */
152 page = get_zeroed_page(GFP_KERNEL);
153 if (!page)
154 return -ENOMEM;
155
156 state->xmit.buf = (unsigned char *) page;
157 uart_circ_clear(&state->xmit);
158 }
159
160 retval = uport->ops->startup(uport);
161 if (retval == 0) {
162 if (uart_console(uport) && uport->cons->cflag) {
163 tty->termios.c_cflag = uport->cons->cflag;
164 uport->cons->cflag = 0;
165 }
166 /*
167 * Initialise the hardware port settings.
168 */
169 uart_change_speed(tty, state, NULL);
170
171 if (init_hw) {
172 /*
173 * Setup the RTS and DTR signals once the
174 * port is open and ready to respond.
175 */
176 if (tty->termios.c_cflag & CBAUD)
177 uart_set_mctrl(uport, TIOCM_RTS | TIOCM_DTR);
178 }
179
180 if (tty_port_cts_enabled(port)) {
181 spin_lock_irq(&uport->lock);
182 if (!(uport->ops->get_mctrl(uport) & TIOCM_CTS))
183 tty->hw_stopped = 1;
184 spin_unlock_irq(&uport->lock);
185 }
186 }
187
188 /*
189 * This is to allow setserial on this port. People may want to set
190 * port/irq/type and then reconfigure the port properly if it failed
191 * now.
192 */
193 if (retval && capable(CAP_SYS_ADMIN))
194 return 1;
195
196 return retval;
197 }
198
199 static int uart_startup(struct tty_struct *tty, struct uart_state *state,
200 int init_hw)
201 {
202 struct tty_port *port = &state->port;
203 int retval;
204
205 if (port->flags & ASYNC_INITIALIZED)
206 return 0;
207
208 /*
209 * Set the TTY IO error marker - we will only clear this
210 * once we have successfully opened the port.
211 */
212 set_bit(TTY_IO_ERROR, &tty->flags);
213
214 retval = uart_port_startup(tty, state, init_hw);
215 if (!retval) {
216 set_bit(ASYNCB_INITIALIZED, &port->flags);
217 clear_bit(TTY_IO_ERROR, &tty->flags);
218 } else if (retval > 0)
219 retval = 0;
220
221 return retval;
222 }
223
224 /*
225 * This routine will shutdown a serial port; interrupts are disabled, and
226 * DTR is dropped if the hangup on close termio flag is on. Calls to
227 * uart_shutdown are serialised by the per-port semaphore.
228 */
229 static void uart_shutdown(struct tty_struct *tty, struct uart_state *state)
230 {
231 struct uart_port *uport = state->uart_port;
232 struct tty_port *port = &state->port;
233
234 /*
235 * Set the TTY IO error marker
236 */
237 if (tty)
238 set_bit(TTY_IO_ERROR, &tty->flags);
239
240 if (test_and_clear_bit(ASYNCB_INITIALIZED, &port->flags)) {
241 /*
242 * Turn off DTR and RTS early.
243 */
244 if (!tty || (tty->termios.c_cflag & HUPCL))
245 uart_clear_mctrl(uport, TIOCM_DTR | TIOCM_RTS);
246
247 uart_port_shutdown(port);
248 }
249
250 /*
251 * It's possible for shutdown to be called after suspend if we get
252 * a DCD drop (hangup) at just the right time. Clear suspended bit so
253 * we don't try to resume a port that has been shutdown.
254 */
255 clear_bit(ASYNCB_SUSPENDED, &port->flags);
256
257 /*
258 * Free the transmit buffer page.
259 */
260 if (state->xmit.buf) {
261 free_page((unsigned long)state->xmit.buf);
262 state->xmit.buf = NULL;
263 }
264 }
265
266 /**
267 * uart_update_timeout - update per-port FIFO timeout.
268 * @port: uart_port structure describing the port
269 * @cflag: termios cflag value
270 * @baud: speed of the port
271 *
272 * Set the port FIFO timeout value. The @cflag value should
273 * reflect the actual hardware settings.
274 */
275 void
276 uart_update_timeout(struct uart_port *port, unsigned int cflag,
277 unsigned int baud)
278 {
279 unsigned int bits;
280
281 /* byte size and parity */
282 switch (cflag & CSIZE) {
283 case CS5:
284 bits = 7;
285 break;
286 case CS6:
287 bits = 8;
288 break;
289 case CS7:
290 bits = 9;
291 break;
292 default:
293 bits = 10;
294 break; /* CS8 */
295 }
296
297 if (cflag & CSTOPB)
298 bits++;
299 if (cflag & PARENB)
300 bits++;
301
302 /*
303 * The total number of bits to be transmitted in the fifo.
304 */
305 bits = bits * port->fifosize;
306
307 /*
308 * Figure the timeout to send the above number of bits.
309 * Add .02 seconds of slop
310 */
311 port->timeout = (HZ * bits) / baud + HZ/50;
312 }
313
314 EXPORT_SYMBOL(uart_update_timeout);
315
316 /**
317 * uart_get_baud_rate - return baud rate for a particular port
318 * @port: uart_port structure describing the port in question.
319 * @termios: desired termios settings.
320 * @old: old termios (or NULL)
321 * @min: minimum acceptable baud rate
322 * @max: maximum acceptable baud rate
323 *
324 * Decode the termios structure into a numeric baud rate,
325 * taking account of the magic 38400 baud rate (with spd_*
326 * flags), and mapping the %B0 rate to 9600 baud.
327 *
328 * If the new baud rate is invalid, try the old termios setting.
329 * If it's still invalid, we try 9600 baud.
330 *
331 * Update the @termios structure to reflect the baud rate
332 * we're actually going to be using. Don't do this for the case
333 * where B0 is requested ("hang up").
334 */
335 unsigned int
336 uart_get_baud_rate(struct uart_port *port, struct ktermios *termios,
337 struct ktermios *old, unsigned int min, unsigned int max)
338 {
339 unsigned int try, baud, altbaud = 38400;
340 int hung_up = 0;
341 upf_t flags = port->flags & UPF_SPD_MASK;
342
343 if (flags == UPF_SPD_HI)
344 altbaud = 57600;
345 else if (flags == UPF_SPD_VHI)
346 altbaud = 115200;
347 else if (flags == UPF_SPD_SHI)
348 altbaud = 230400;
349 else if (flags == UPF_SPD_WARP)
350 altbaud = 460800;
351
352 for (try = 0; try < 2; try++) {
353 baud = tty_termios_baud_rate(termios);
354
355 /*
356 * The spd_hi, spd_vhi, spd_shi, spd_warp kludge...
357 * Die! Die! Die!
358 */
359 if (baud == 38400)
360 baud = altbaud;
361
362 /*
363 * Special case: B0 rate.
364 */
365 if (baud == 0) {
366 hung_up = 1;
367 baud = 9600;
368 }
369
370 if (baud >= min && baud <= max)
371 return baud;
372
373 /*
374 * Oops, the quotient was zero. Try again with
375 * the old baud rate if possible.
376 */
377 termios->c_cflag &= ~CBAUD;
378 if (old) {
379 baud = tty_termios_baud_rate(old);
380 if (!hung_up)
381 tty_termios_encode_baud_rate(termios,
382 baud, baud);
383 old = NULL;
384 continue;
385 }
386
387 /*
388 * As a last resort, if the range cannot be met then clip to
389 * the nearest chip supported rate.
390 */
391 if (!hung_up) {
392 if (baud <= min)
393 tty_termios_encode_baud_rate(termios,
394 min + 1, min + 1);
395 else
396 tty_termios_encode_baud_rate(termios,
397 max - 1, max - 1);
398 }
399 }
400 /* Should never happen */
401 WARN_ON(1);
402 return 0;
403 }
404
405 EXPORT_SYMBOL(uart_get_baud_rate);
406
407 /**
408 * uart_get_divisor - return uart clock divisor
409 * @port: uart_port structure describing the port.
410 * @baud: desired baud rate
411 *
412 * Calculate the uart clock divisor for the port.
413 */
414 unsigned int
415 uart_get_divisor(struct uart_port *port, unsigned int baud)
416 {
417 unsigned int quot;
418
419 /*
420 * Old custom speed handling.
421 */
422 if (baud == 38400 && (port->flags & UPF_SPD_MASK) == UPF_SPD_CUST)
423 quot = port->custom_divisor;
424 else
425 quot = DIV_ROUND_CLOSEST(port->uartclk, 16 * baud);
426
427 return quot;
428 }
429
430 EXPORT_SYMBOL(uart_get_divisor);
431
432 /* FIXME: Consistent locking policy */
433 static void uart_change_speed(struct tty_struct *tty, struct uart_state *state,
434 struct ktermios *old_termios)
435 {
436 struct tty_port *port = &state->port;
437 struct uart_port *uport = state->uart_port;
438 struct ktermios *termios;
439
440 /*
441 * If we have no tty, termios, or the port does not exist,
442 * then we can't set the parameters for this port.
443 */
444 if (!tty || uport->type == PORT_UNKNOWN)
445 return;
446
447 termios = &tty->termios;
448
449 /*
450 * Set flags based on termios cflag
451 */
452 if (termios->c_cflag & CRTSCTS)
453 set_bit(ASYNCB_CTS_FLOW, &port->flags);
454 else
455 clear_bit(ASYNCB_CTS_FLOW, &port->flags);
456
457 if (termios->c_cflag & CLOCAL)
458 clear_bit(ASYNCB_CHECK_CD, &port->flags);
459 else
460 set_bit(ASYNCB_CHECK_CD, &port->flags);
461
462 uport->ops->set_termios(uport, termios, old_termios);
463 }
464
465 static inline int __uart_put_char(struct uart_port *port,
466 struct circ_buf *circ, unsigned char c)
467 {
468 unsigned long flags;
469 int ret = 0;
470
471 if (!circ->buf)
472 return 0;
473
474 spin_lock_irqsave(&port->lock, flags);
475 if (uart_circ_chars_free(circ) != 0) {
476 circ->buf[circ->head] = c;
477 circ->head = (circ->head + 1) & (UART_XMIT_SIZE - 1);
478 ret = 1;
479 }
480 spin_unlock_irqrestore(&port->lock, flags);
481 return ret;
482 }
483
484 static int uart_put_char(struct tty_struct *tty, unsigned char ch)
485 {
486 struct uart_state *state = tty->driver_data;
487
488 return __uart_put_char(state->uart_port, &state->xmit, ch);
489 }
490
491 static void uart_flush_chars(struct tty_struct *tty)
492 {
493 uart_start(tty);
494 }
495
496 static int uart_write(struct tty_struct *tty,
497 const unsigned char *buf, int count)
498 {
499 struct uart_state *state = tty->driver_data;
500 struct uart_port *port;
501 struct circ_buf *circ;
502 unsigned long flags;
503 int c, ret = 0;
504
505 /*
506 * This means you called this function _after_ the port was
507 * closed. No cookie for you.
508 */
509 if (!state) {
510 WARN_ON(1);
511 return -EL3HLT;
512 }
513
514 port = state->uart_port;
515 circ = &state->xmit;
516
517 if (!circ->buf)
518 return 0;
519
520 spin_lock_irqsave(&port->lock, flags);
521 while (1) {
522 c = CIRC_SPACE_TO_END(circ->head, circ->tail, UART_XMIT_SIZE);
523 if (count < c)
524 c = count;
525 if (c <= 0)
526 break;
527 memcpy(circ->buf + circ->head, buf, c);
528 circ->head = (circ->head + c) & (UART_XMIT_SIZE - 1);
529 buf += c;
530 count -= c;
531 ret += c;
532 }
533 spin_unlock_irqrestore(&port->lock, flags);
534
535 uart_start(tty);
536 return ret;
537 }
538
539 static int uart_write_room(struct tty_struct *tty)
540 {
541 struct uart_state *state = tty->driver_data;
542 unsigned long flags;
543 int ret;
544
545 spin_lock_irqsave(&state->uart_port->lock, flags);
546 ret = uart_circ_chars_free(&state->xmit);
547 spin_unlock_irqrestore(&state->uart_port->lock, flags);
548 return ret;
549 }
550
551 static int uart_chars_in_buffer(struct tty_struct *tty)
552 {
553 struct uart_state *state = tty->driver_data;
554 unsigned long flags;
555 int ret;
556
557 spin_lock_irqsave(&state->uart_port->lock, flags);
558 ret = uart_circ_chars_pending(&state->xmit);
559 spin_unlock_irqrestore(&state->uart_port->lock, flags);
560 return ret;
561 }
562
563 static void uart_flush_buffer(struct tty_struct *tty)
564 {
565 struct uart_state *state = tty->driver_data;
566 struct uart_port *port;
567 unsigned long flags;
568
569 /*
570 * This means you called this function _after_ the port was
571 * closed. No cookie for you.
572 */
573 if (!state) {
574 WARN_ON(1);
575 return;
576 }
577
578 port = state->uart_port;
579 pr_debug("uart_flush_buffer(%d) called\n", tty->index);
580
581 spin_lock_irqsave(&port->lock, flags);
582 uart_circ_clear(&state->xmit);
583 if (port->ops->flush_buffer)
584 port->ops->flush_buffer(port);
585 spin_unlock_irqrestore(&port->lock, flags);
586 tty_wakeup(tty);
587 }
588
589 /*
590 * This function is used to send a high-priority XON/XOFF character to
591 * the device
592 */
593 static void uart_send_xchar(struct tty_struct *tty, char ch)
594 {
595 struct uart_state *state = tty->driver_data;
596 struct uart_port *port = state->uart_port;
597 unsigned long flags;
598
599 if (port->ops->send_xchar)
600 port->ops->send_xchar(port, ch);
601 else {
602 port->x_char = ch;
603 if (ch) {
604 spin_lock_irqsave(&port->lock, flags);
605 port->ops->start_tx(port);
606 spin_unlock_irqrestore(&port->lock, flags);
607 }
608 }
609 }
610
611 static void uart_throttle(struct tty_struct *tty)
612 {
613 struct uart_state *state = tty->driver_data;
614 struct uart_port *port = state->uart_port;
615 uint32_t mask = 0;
616
617 if (I_IXOFF(tty))
618 mask |= UPF_SOFT_FLOW;
619 if (tty->termios.c_cflag & CRTSCTS)
620 mask |= UPF_HARD_FLOW;
621
622 if (port->flags & mask) {
623 port->ops->throttle(port);
624 mask &= ~port->flags;
625 }
626
627 if (mask & UPF_SOFT_FLOW)
628 uart_send_xchar(tty, STOP_CHAR(tty));
629
630 if (mask & UPF_HARD_FLOW)
631 uart_clear_mctrl(port, TIOCM_RTS);
632 }
633
634 static void uart_unthrottle(struct tty_struct *tty)
635 {
636 struct uart_state *state = tty->driver_data;
637 struct uart_port *port = state->uart_port;
638 uint32_t mask = 0;
639
640 if (I_IXOFF(tty))
641 mask |= UPF_SOFT_FLOW;
642 if (tty->termios.c_cflag & CRTSCTS)
643 mask |= UPF_HARD_FLOW;
644
645 if (port->flags & mask) {
646 port->ops->unthrottle(port);
647 mask &= ~port->flags;
648 }
649
650 if (mask & UPF_SOFT_FLOW) {
651 if (port->x_char)
652 port->x_char = 0;
653 else
654 uart_send_xchar(tty, START_CHAR(tty));
655 }
656
657 if (mask & UPF_HARD_FLOW)
658 uart_set_mctrl(port, TIOCM_RTS);
659 }
660
661 static void do_uart_get_info(struct tty_port *port,
662 struct serial_struct *retinfo)
663 {
664 struct uart_state *state = container_of(port, struct uart_state, port);
665 struct uart_port *uport = state->uart_port;
666
667 memset(retinfo, 0, sizeof(*retinfo));
668
669 retinfo->type = uport->type;
670 retinfo->line = uport->line;
671 retinfo->port = uport->iobase;
672 if (HIGH_BITS_OFFSET)
673 retinfo->port_high = (long) uport->iobase >> HIGH_BITS_OFFSET;
674 retinfo->irq = uport->irq;
675 retinfo->flags = uport->flags;
676 retinfo->xmit_fifo_size = uport->fifosize;
677 retinfo->baud_base = uport->uartclk / 16;
678 retinfo->close_delay = jiffies_to_msecs(port->close_delay) / 10;
679 retinfo->closing_wait = port->closing_wait == ASYNC_CLOSING_WAIT_NONE ?
680 ASYNC_CLOSING_WAIT_NONE :
681 jiffies_to_msecs(port->closing_wait) / 10;
682 retinfo->custom_divisor = uport->custom_divisor;
683 retinfo->hub6 = uport->hub6;
684 retinfo->io_type = uport->iotype;
685 retinfo->iomem_reg_shift = uport->regshift;
686 retinfo->iomem_base = (void *)(unsigned long)uport->mapbase;
687 }
688
689 static void uart_get_info(struct tty_port *port,
690 struct serial_struct *retinfo)
691 {
692 /* Ensure the state we copy is consistent and no hardware changes
693 occur as we go */
694 mutex_lock(&port->mutex);
695 do_uart_get_info(port, retinfo);
696 mutex_unlock(&port->mutex);
697 }
698
699 static int uart_get_info_user(struct tty_port *port,
700 struct serial_struct __user *retinfo)
701 {
702 struct serial_struct tmp;
703 uart_get_info(port, &tmp);
704
705 if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
706 return -EFAULT;
707 return 0;
708 }
709
710 static int uart_set_info(struct tty_struct *tty, struct tty_port *port,
711 struct uart_state *state,
712 struct serial_struct *new_info)
713 {
714 struct uart_port *uport = state->uart_port;
715 unsigned long new_port;
716 unsigned int change_irq, change_port, closing_wait;
717 unsigned int old_custom_divisor, close_delay;
718 upf_t old_flags, new_flags;
719 int retval = 0;
720
721 new_port = new_info->port;
722 if (HIGH_BITS_OFFSET)
723 new_port += (unsigned long) new_info->port_high << HIGH_BITS_OFFSET;
724
725 new_info->irq = irq_canonicalize(new_info->irq);
726 close_delay = msecs_to_jiffies(new_info->close_delay * 10);
727 closing_wait = new_info->closing_wait == ASYNC_CLOSING_WAIT_NONE ?
728 ASYNC_CLOSING_WAIT_NONE :
729 msecs_to_jiffies(new_info->closing_wait * 10);
730
731
732 change_irq = !(uport->flags & UPF_FIXED_PORT)
733 && new_info->irq != uport->irq;
734
735 /*
736 * Since changing the 'type' of the port changes its resource
737 * allocations, we should treat type changes the same as
738 * IO port changes.
739 */
740 change_port = !(uport->flags & UPF_FIXED_PORT)
741 && (new_port != uport->iobase ||
742 (unsigned long)new_info->iomem_base != uport->mapbase ||
743 new_info->hub6 != uport->hub6 ||
744 new_info->io_type != uport->iotype ||
745 new_info->iomem_reg_shift != uport->regshift ||
746 new_info->type != uport->type);
747
748 old_flags = uport->flags;
749 new_flags = new_info->flags;
750 old_custom_divisor = uport->custom_divisor;
751
752 if (!capable(CAP_SYS_ADMIN)) {
753 retval = -EPERM;
754 if (change_irq || change_port ||
755 (new_info->baud_base != uport->uartclk / 16) ||
756 (close_delay != port->close_delay) ||
757 (closing_wait != port->closing_wait) ||
758 (new_info->xmit_fifo_size &&
759 new_info->xmit_fifo_size != uport->fifosize) ||
760 (((new_flags ^ old_flags) & ~UPF_USR_MASK) != 0))
761 goto exit;
762 uport->flags = ((uport->flags & ~UPF_USR_MASK) |
763 (new_flags & UPF_USR_MASK));
764 uport->custom_divisor = new_info->custom_divisor;
765 goto check_and_exit;
766 }
767
768 /*
769 * Ask the low level driver to verify the settings.
770 */
771 if (uport->ops->verify_port)
772 retval = uport->ops->verify_port(uport, new_info);
773
774 if ((new_info->irq >= nr_irqs) || (new_info->irq < 0) ||
775 (new_info->baud_base < 9600))
776 retval = -EINVAL;
777
778 if (retval)
779 goto exit;
780
781 if (change_port || change_irq) {
782 retval = -EBUSY;
783
784 /*
785 * Make sure that we are the sole user of this port.
786 */
787 if (tty_port_users(port) > 1)
788 goto exit;
789
790 /*
791 * We need to shutdown the serial port at the old
792 * port/type/irq combination.
793 */
794 uart_shutdown(tty, state);
795 }
796
797 if (change_port) {
798 unsigned long old_iobase, old_mapbase;
799 unsigned int old_type, old_iotype, old_hub6, old_shift;
800
801 old_iobase = uport->iobase;
802 old_mapbase = uport->mapbase;
803 old_type = uport->type;
804 old_hub6 = uport->hub6;
805 old_iotype = uport->iotype;
806 old_shift = uport->regshift;
807
808 /*
809 * Free and release old regions
810 */
811 if (old_type != PORT_UNKNOWN)
812 uport->ops->release_port(uport);
813
814 uport->iobase = new_port;
815 uport->type = new_info->type;
816 uport->hub6 = new_info->hub6;
817 uport->iotype = new_info->io_type;
818 uport->regshift = new_info->iomem_reg_shift;
819 uport->mapbase = (unsigned long)new_info->iomem_base;
820
821 /*
822 * Claim and map the new regions
823 */
824 if (uport->type != PORT_UNKNOWN) {
825 retval = uport->ops->request_port(uport);
826 } else {
827 /* Always success - Jean II */
828 retval = 0;
829 }
830
831 /*
832 * If we fail to request resources for the
833 * new port, try to restore the old settings.
834 */
835 if (retval && old_type != PORT_UNKNOWN) {
836 uport->iobase = old_iobase;
837 uport->type = old_type;
838 uport->hub6 = old_hub6;
839 uport->iotype = old_iotype;
840 uport->regshift = old_shift;
841 uport->mapbase = old_mapbase;
842 retval = uport->ops->request_port(uport);
843 /*
844 * If we failed to restore the old settings,
845 * we fail like this.
846 */
847 if (retval)
848 uport->type = PORT_UNKNOWN;
849
850 /*
851 * We failed anyway.
852 */
853 retval = -EBUSY;
854 /* Added to return the correct error -Ram Gupta */
855 goto exit;
856 }
857 }
858
859 if (change_irq)
860 uport->irq = new_info->irq;
861 if (!(uport->flags & UPF_FIXED_PORT))
862 uport->uartclk = new_info->baud_base * 16;
863 uport->flags = (uport->flags & ~UPF_CHANGE_MASK) |
864 (new_flags & UPF_CHANGE_MASK);
865 uport->custom_divisor = new_info->custom_divisor;
866 port->close_delay = close_delay;
867 port->closing_wait = closing_wait;
868 if (new_info->xmit_fifo_size)
869 uport->fifosize = new_info->xmit_fifo_size;
870 port->low_latency = (uport->flags & UPF_LOW_LATENCY) ? 1 : 0;
871
872 check_and_exit:
873 retval = 0;
874 if (uport->type == PORT_UNKNOWN)
875 goto exit;
876 if (port->flags & ASYNC_INITIALIZED) {
877 if (((old_flags ^ uport->flags) & UPF_SPD_MASK) ||
878 old_custom_divisor != uport->custom_divisor) {
879 /*
880 * If they're setting up a custom divisor or speed,
881 * instead of clearing it, then bitch about it. No
882 * need to rate-limit; it's CAP_SYS_ADMIN only.
883 */
884 if (uport->flags & UPF_SPD_MASK) {
885 char buf[64];
886 printk(KERN_NOTICE
887 "%s sets custom speed on %s. This "
888 "is deprecated.\n", current->comm,
889 tty_name(port->tty, buf));
890 }
891 uart_change_speed(tty, state, NULL);
892 }
893 } else
894 retval = uart_startup(tty, state, 1);
895 exit:
896 return retval;
897 }
898
899 static int uart_set_info_user(struct tty_struct *tty, struct uart_state *state,
900 struct serial_struct __user *newinfo)
901 {
902 struct serial_struct new_serial;
903 struct tty_port *port = &state->port;
904 int retval;
905
906 if (copy_from_user(&new_serial, newinfo, sizeof(new_serial)))
907 return -EFAULT;
908
909 /*
910 * This semaphore protects port->count. It is also
911 * very useful to prevent opens. Also, take the
912 * port configuration semaphore to make sure that a
913 * module insertion/removal doesn't change anything
914 * under us.
915 */
916 mutex_lock(&port->mutex);
917 retval = uart_set_info(tty, port, state, &new_serial);
918 mutex_unlock(&port->mutex);
919 return retval;
920 }
921
922 /**
923 * uart_get_lsr_info - get line status register info
924 * @tty: tty associated with the UART
925 * @state: UART being queried
926 * @value: returned modem value
927 *
928 * Note: uart_ioctl protects us against hangups.
929 */
930 static int uart_get_lsr_info(struct tty_struct *tty,
931 struct uart_state *state, unsigned int __user *value)
932 {
933 struct uart_port *uport = state->uart_port;
934 unsigned int result;
935
936 result = uport->ops->tx_empty(uport);
937
938 /*
939 * If we're about to load something into the transmit
940 * register, we'll pretend the transmitter isn't empty to
941 * avoid a race condition (depending on when the transmit
942 * interrupt happens).
943 */
944 if (uport->x_char ||
945 ((uart_circ_chars_pending(&state->xmit) > 0) &&
946 !tty->stopped && !tty->hw_stopped))
947 result &= ~TIOCSER_TEMT;
948
949 return put_user(result, value);
950 }
951
952 static int uart_tiocmget(struct tty_struct *tty)
953 {
954 struct uart_state *state = tty->driver_data;
955 struct tty_port *port = &state->port;
956 struct uart_port *uport = state->uart_port;
957 int result = -EIO;
958
959 mutex_lock(&port->mutex);
960 if (!(tty->flags & (1 << TTY_IO_ERROR))) {
961 result = uport->mctrl;
962 spin_lock_irq(&uport->lock);
963 result |= uport->ops->get_mctrl(uport);
964 spin_unlock_irq(&uport->lock);
965 }
966 mutex_unlock(&port->mutex);
967
968 return result;
969 }
970
971 static int
972 uart_tiocmset(struct tty_struct *tty, unsigned int set, unsigned int clear)
973 {
974 struct uart_state *state = tty->driver_data;
975 struct uart_port *uport = state->uart_port;
976 struct tty_port *port = &state->port;
977 int ret = -EIO;
978
979 mutex_lock(&port->mutex);
980 if (!(tty->flags & (1 << TTY_IO_ERROR))) {
981 uart_update_mctrl(uport, set, clear);
982 ret = 0;
983 }
984 mutex_unlock(&port->mutex);
985 return ret;
986 }
987
988 static int uart_break_ctl(struct tty_struct *tty, int break_state)
989 {
990 struct uart_state *state = tty->driver_data;
991 struct tty_port *port = &state->port;
992 struct uart_port *uport = state->uart_port;
993
994 mutex_lock(&port->mutex);
995
996 if (uport->type != PORT_UNKNOWN)
997 uport->ops->break_ctl(uport, break_state);
998
999 mutex_unlock(&port->mutex);
1000 return 0;
1001 }
1002
1003 static int uart_do_autoconfig(struct tty_struct *tty,struct uart_state *state)
1004 {
1005 struct uart_port *uport = state->uart_port;
1006 struct tty_port *port = &state->port;
1007 int flags, ret;
1008
1009 if (!capable(CAP_SYS_ADMIN))
1010 return -EPERM;
1011
1012 /*
1013 * Take the per-port semaphore. This prevents count from
1014 * changing, and hence any extra opens of the port while
1015 * we're auto-configuring.
1016 */
1017 if (mutex_lock_interruptible(&port->mutex))
1018 return -ERESTARTSYS;
1019
1020 ret = -EBUSY;
1021 if (tty_port_users(port) == 1) {
1022 uart_shutdown(tty, state);
1023
1024 /*
1025 * If we already have a port type configured,
1026 * we must release its resources.
1027 */
1028 if (uport->type != PORT_UNKNOWN)
1029 uport->ops->release_port(uport);
1030
1031 flags = UART_CONFIG_TYPE;
1032 if (uport->flags & UPF_AUTO_IRQ)
1033 flags |= UART_CONFIG_IRQ;
1034
1035 /*
1036 * This will claim the ports resources if
1037 * a port is found.
1038 */
1039 uport->ops->config_port(uport, flags);
1040
1041 ret = uart_startup(tty, state, 1);
1042 }
1043 mutex_unlock(&port->mutex);
1044 return ret;
1045 }
1046
1047 /*
1048 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
1049 * - mask passed in arg for lines of interest
1050 * (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
1051 * Caller should use TIOCGICOUNT to see which one it was
1052 *
1053 * FIXME: This wants extracting into a common all driver implementation
1054 * of TIOCMWAIT using tty_port.
1055 */
1056 static int
1057 uart_wait_modem_status(struct uart_state *state, unsigned long arg)
1058 {
1059 struct uart_port *uport = state->uart_port;
1060 struct tty_port *port = &state->port;
1061 DECLARE_WAITQUEUE(wait, current);
1062 struct uart_icount cprev, cnow;
1063 int ret;
1064
1065 /*
1066 * note the counters on entry
1067 */
1068 spin_lock_irq(&uport->lock);
1069 memcpy(&cprev, &uport->icount, sizeof(struct uart_icount));
1070
1071 /*
1072 * Force modem status interrupts on
1073 */
1074 uport->ops->enable_ms(uport);
1075 spin_unlock_irq(&uport->lock);
1076
1077 add_wait_queue(&port->delta_msr_wait, &wait);
1078 for (;;) {
1079 spin_lock_irq(&uport->lock);
1080 memcpy(&cnow, &uport->icount, sizeof(struct uart_icount));
1081 spin_unlock_irq(&uport->lock);
1082
1083 set_current_state(TASK_INTERRUPTIBLE);
1084
1085 if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
1086 ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
1087 ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
1088 ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
1089 ret = 0;
1090 break;
1091 }
1092
1093 schedule();
1094
1095 /* see if a signal did it */
1096 if (signal_pending(current)) {
1097 ret = -ERESTARTSYS;
1098 break;
1099 }
1100
1101 cprev = cnow;
1102 }
1103
1104 current->state = TASK_RUNNING;
1105 remove_wait_queue(&port->delta_msr_wait, &wait);
1106
1107 return ret;
1108 }
1109
1110 /*
1111 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
1112 * Return: write counters to the user passed counter struct
1113 * NB: both 1->0 and 0->1 transitions are counted except for
1114 * RI where only 0->1 is counted.
1115 */
1116 static int uart_get_icount(struct tty_struct *tty,
1117 struct serial_icounter_struct *icount)
1118 {
1119 struct uart_state *state = tty->driver_data;
1120 struct uart_icount cnow;
1121 struct uart_port *uport = state->uart_port;
1122
1123 spin_lock_irq(&uport->lock);
1124 memcpy(&cnow, &uport->icount, sizeof(struct uart_icount));
1125 spin_unlock_irq(&uport->lock);
1126
1127 icount->cts = cnow.cts;
1128 icount->dsr = cnow.dsr;
1129 icount->rng = cnow.rng;
1130 icount->dcd = cnow.dcd;
1131 icount->rx = cnow.rx;
1132 icount->tx = cnow.tx;
1133 icount->frame = cnow.frame;
1134 icount->overrun = cnow.overrun;
1135 icount->parity = cnow.parity;
1136 icount->brk = cnow.brk;
1137 icount->buf_overrun = cnow.buf_overrun;
1138
1139 return 0;
1140 }
1141
1142 /*
1143 * Called via sys_ioctl. We can use spin_lock_irq() here.
1144 */
1145 static int
1146 uart_ioctl(struct tty_struct *tty, unsigned int cmd,
1147 unsigned long arg)
1148 {
1149 struct uart_state *state = tty->driver_data;
1150 struct tty_port *port = &state->port;
1151 void __user *uarg = (void __user *)arg;
1152 int ret = -ENOIOCTLCMD;
1153
1154
1155 /*
1156 * These ioctls don't rely on the hardware to be present.
1157 */
1158 switch (cmd) {
1159 case TIOCGSERIAL:
1160 ret = uart_get_info_user(port, uarg);
1161 break;
1162
1163 case TIOCSSERIAL:
1164 ret = uart_set_info_user(tty, state, uarg);
1165 break;
1166
1167 case TIOCSERCONFIG:
1168 ret = uart_do_autoconfig(tty, state);
1169 break;
1170
1171 case TIOCSERGWILD: /* obsolete */
1172 case TIOCSERSWILD: /* obsolete */
1173 ret = 0;
1174 break;
1175 }
1176
1177 if (ret != -ENOIOCTLCMD)
1178 goto out;
1179
1180 if (tty->flags & (1 << TTY_IO_ERROR)) {
1181 ret = -EIO;
1182 goto out;
1183 }
1184
1185 /*
1186 * The following should only be used when hardware is present.
1187 */
1188 switch (cmd) {
1189 case TIOCMIWAIT:
1190 ret = uart_wait_modem_status(state, arg);
1191 break;
1192 }
1193
1194 if (ret != -ENOIOCTLCMD)
1195 goto out;
1196
1197 mutex_lock(&port->mutex);
1198
1199 if (tty->flags & (1 << TTY_IO_ERROR)) {
1200 ret = -EIO;
1201 goto out_up;
1202 }
1203
1204 /*
1205 * All these rely on hardware being present and need to be
1206 * protected against the tty being hung up.
1207 */
1208 switch (cmd) {
1209 case TIOCSERGETLSR: /* Get line status register */
1210 ret = uart_get_lsr_info(tty, state, uarg);
1211 break;
1212
1213 default: {
1214 struct uart_port *uport = state->uart_port;
1215 if (uport->ops->ioctl)
1216 ret = uport->ops->ioctl(uport, cmd, arg);
1217 break;
1218 }
1219 }
1220 out_up:
1221 mutex_unlock(&port->mutex);
1222 out:
1223 return ret;
1224 }
1225
1226 static void uart_set_ldisc(struct tty_struct *tty)
1227 {
1228 struct uart_state *state = tty->driver_data;
1229 struct uart_port *uport = state->uart_port;
1230
1231 if (uport->ops->set_ldisc)
1232 uport->ops->set_ldisc(uport, tty->termios.c_line);
1233 }
1234
1235 static void uart_set_termios(struct tty_struct *tty,
1236 struct ktermios *old_termios)
1237 {
1238 struct uart_state *state = tty->driver_data;
1239 struct uart_port *uport = state->uart_port;
1240 unsigned long flags;
1241 unsigned int cflag = tty->termios.c_cflag;
1242 unsigned int iflag_mask = IGNBRK|BRKINT|IGNPAR|PARMRK|INPCK;
1243 bool sw_changed = false;
1244
1245 /*
1246 * Drivers doing software flow control also need to know
1247 * about changes to these input settings.
1248 */
1249 if (uport->flags & UPF_SOFT_FLOW) {
1250 iflag_mask |= IXANY|IXON|IXOFF;
1251 sw_changed =
1252 tty->termios.c_cc[VSTART] != old_termios->c_cc[VSTART] ||
1253 tty->termios.c_cc[VSTOP] != old_termios->c_cc[VSTOP];
1254 }
1255
1256 /*
1257 * These are the bits that are used to setup various
1258 * flags in the low level driver. We can ignore the Bfoo
1259 * bits in c_cflag; c_[io]speed will always be set
1260 * appropriately by set_termios() in tty_ioctl.c
1261 */
1262 if ((cflag ^ old_termios->c_cflag) == 0 &&
1263 tty->termios.c_ospeed == old_termios->c_ospeed &&
1264 tty->termios.c_ispeed == old_termios->c_ispeed &&
1265 ((tty->termios.c_iflag ^ old_termios->c_iflag) & iflag_mask) == 0 &&
1266 !sw_changed) {
1267 return;
1268 }
1269
1270 uart_change_speed(tty, state, old_termios);
1271
1272 /* Handle transition to B0 status */
1273 if ((old_termios->c_cflag & CBAUD) && !(cflag & CBAUD))
1274 uart_clear_mctrl(uport, TIOCM_RTS | TIOCM_DTR);
1275 /* Handle transition away from B0 status */
1276 else if (!(old_termios->c_cflag & CBAUD) && (cflag & CBAUD)) {
1277 unsigned int mask = TIOCM_DTR;
1278 if (!(cflag & CRTSCTS) ||
1279 !test_bit(TTY_THROTTLED, &tty->flags))
1280 mask |= TIOCM_RTS;
1281 uart_set_mctrl(uport, mask);
1282 }
1283
1284 /*
1285 * If the port is doing h/w assisted flow control, do nothing.
1286 * We assume that tty->hw_stopped has never been set.
1287 */
1288 if (uport->flags & UPF_HARD_FLOW)
1289 return;
1290
1291 /* Handle turning off CRTSCTS */
1292 if ((old_termios->c_cflag & CRTSCTS) && !(cflag & CRTSCTS)) {
1293 spin_lock_irqsave(&uport->lock, flags);
1294 tty->hw_stopped = 0;
1295 __uart_start(tty);
1296 spin_unlock_irqrestore(&uport->lock, flags);
1297 }
1298 /* Handle turning on CRTSCTS */
1299 else if (!(old_termios->c_cflag & CRTSCTS) && (cflag & CRTSCTS)) {
1300 spin_lock_irqsave(&uport->lock, flags);
1301 if (!(uport->ops->get_mctrl(uport) & TIOCM_CTS)) {
1302 tty->hw_stopped = 1;
1303 uport->ops->stop_tx(uport);
1304 }
1305 spin_unlock_irqrestore(&uport->lock, flags);
1306 }
1307 }
1308
1309 /*
1310 * Calls to uart_close() are serialised via the tty_lock in
1311 * drivers/tty/tty_io.c:tty_release()
1312 * drivers/tty/tty_io.c:do_tty_hangup()
1313 * This runs from a workqueue and can sleep for a _short_ time only.
1314 */
1315 static void uart_close(struct tty_struct *tty, struct file *filp)
1316 {
1317 struct uart_state *state = tty->driver_data;
1318 struct tty_port *port;
1319 struct uart_port *uport;
1320 unsigned long flags;
1321
1322 if (!state)
1323 return;
1324
1325 uport = state->uart_port;
1326 port = &state->port;
1327
1328 pr_debug("uart_close(%d) called\n", uport->line);
1329
1330 if (tty_port_close_start(port, tty, filp) == 0)
1331 return;
1332
1333 /*
1334 * At this point, we stop accepting input. To do this, we
1335 * disable the receive line status interrupts.
1336 */
1337 if (port->flags & ASYNC_INITIALIZED) {
1338 unsigned long flags;
1339 spin_lock_irqsave(&uport->lock, flags);
1340 uport->ops->stop_rx(uport);
1341 spin_unlock_irqrestore(&uport->lock, flags);
1342 /*
1343 * Before we drop DTR, make sure the UART transmitter
1344 * has completely drained; this is especially
1345 * important if there is a transmit FIFO!
1346 */
1347 uart_wait_until_sent(tty, uport->timeout);
1348 }
1349
1350 mutex_lock(&port->mutex);
1351 uart_shutdown(tty, state);
1352 uart_flush_buffer(tty);
1353
1354 tty_ldisc_flush(tty);
1355
1356 tty_port_tty_set(port, NULL);
1357 spin_lock_irqsave(&port->lock, flags);
1358 tty->closing = 0;
1359
1360 if (port->blocked_open) {
1361 spin_unlock_irqrestore(&port->lock, flags);
1362 if (port->close_delay)
1363 msleep_interruptible(
1364 jiffies_to_msecs(port->close_delay));
1365 spin_lock_irqsave(&port->lock, flags);
1366 } else if (!uart_console(uport)) {
1367 spin_unlock_irqrestore(&port->lock, flags);
1368 uart_change_pm(state, UART_PM_STATE_OFF);
1369 spin_lock_irqsave(&port->lock, flags);
1370 }
1371
1372 /*
1373 * Wake up anyone trying to open this port.
1374 */
1375 clear_bit(ASYNCB_NORMAL_ACTIVE, &port->flags);
1376 clear_bit(ASYNCB_CLOSING, &port->flags);
1377 spin_unlock_irqrestore(&port->lock, flags);
1378 wake_up_interruptible(&port->open_wait);
1379 wake_up_interruptible(&port->close_wait);
1380
1381 mutex_unlock(&port->mutex);
1382 }
1383
1384 static void uart_wait_until_sent(struct tty_struct *tty, int timeout)
1385 {
1386 struct uart_state *state = tty->driver_data;
1387 struct uart_port *port = state->uart_port;
1388 unsigned long char_time, expire;
1389
1390 if (port->type == PORT_UNKNOWN || port->fifosize == 0)
1391 return;
1392
1393 /*
1394 * Set the check interval to be 1/5 of the estimated time to
1395 * send a single character, and make it at least 1. The check
1396 * interval should also be less than the timeout.
1397 *
1398 * Note: we have to use pretty tight timings here to satisfy
1399 * the NIST-PCTS.
1400 */
1401 char_time = (port->timeout - HZ/50) / port->fifosize;
1402 char_time = char_time / 5;
1403 if (char_time == 0)
1404 char_time = 1;
1405 if (timeout && timeout < char_time)
1406 char_time = timeout;
1407
1408 /*
1409 * If the transmitter hasn't cleared in twice the approximate
1410 * amount of time to send the entire FIFO, it probably won't
1411 * ever clear. This assumes the UART isn't doing flow
1412 * control, which is currently the case. Hence, if it ever
1413 * takes longer than port->timeout, this is probably due to a
1414 * UART bug of some kind. So, we clamp the timeout parameter at
1415 * 2*port->timeout.
1416 */
1417 if (timeout == 0 || timeout > 2 * port->timeout)
1418 timeout = 2 * port->timeout;
1419
1420 expire = jiffies + timeout;
1421
1422 pr_debug("uart_wait_until_sent(%d), jiffies=%lu, expire=%lu...\n",
1423 port->line, jiffies, expire);
1424
1425 /*
1426 * Check whether the transmitter is empty every 'char_time'.
1427 * 'timeout' / 'expire' give us the maximum amount of time
1428 * we wait.
1429 */
1430 while (!port->ops->tx_empty(port)) {
1431 msleep_interruptible(jiffies_to_msecs(char_time));
1432 if (signal_pending(current))
1433 break;
1434 if (time_after(jiffies, expire))
1435 break;
1436 }
1437 }
1438
1439 /*
1440 * Calls to uart_hangup() are serialised by the tty_lock in
1441 * drivers/tty/tty_io.c:do_tty_hangup()
1442 * This runs from a workqueue and can sleep for a _short_ time only.
1443 */
1444 static void uart_hangup(struct tty_struct *tty)
1445 {
1446 struct uart_state *state = tty->driver_data;
1447 struct tty_port *port = &state->port;
1448 unsigned long flags;
1449
1450 pr_debug("uart_hangup(%d)\n", state->uart_port->line);
1451
1452 mutex_lock(&port->mutex);
1453 if (port->flags & ASYNC_NORMAL_ACTIVE) {
1454 uart_flush_buffer(tty);
1455 uart_shutdown(tty, state);
1456 spin_lock_irqsave(&port->lock, flags);
1457 port->count = 0;
1458 clear_bit(ASYNCB_NORMAL_ACTIVE, &port->flags);
1459 spin_unlock_irqrestore(&port->lock, flags);
1460 tty_port_tty_set(port, NULL);
1461 wake_up_interruptible(&port->open_wait);
1462 wake_up_interruptible(&port->delta_msr_wait);
1463 }
1464 mutex_unlock(&port->mutex);
1465 }
1466
1467 static int uart_port_activate(struct tty_port *port, struct tty_struct *tty)
1468 {
1469 return 0;
1470 }
1471
1472 static void uart_port_shutdown(struct tty_port *port)
1473 {
1474 struct uart_state *state = container_of(port, struct uart_state, port);
1475 struct uart_port *uport = state->uart_port;
1476
1477 /*
1478 * clear delta_msr_wait queue to avoid mem leaks: we may free
1479 * the irq here so the queue might never be woken up. Note
1480 * that we won't end up waiting on delta_msr_wait again since
1481 * any outstanding file descriptors should be pointing at
1482 * hung_up_tty_fops now.
1483 */
1484 wake_up_interruptible(&port->delta_msr_wait);
1485
1486 /*
1487 * Free the IRQ and disable the port.
1488 */
1489 uport->ops->shutdown(uport);
1490
1491 /*
1492 * Ensure that the IRQ handler isn't running on another CPU.
1493 */
1494 synchronize_irq(uport->irq);
1495 }
1496
1497 static int uart_carrier_raised(struct tty_port *port)
1498 {
1499 struct uart_state *state = container_of(port, struct uart_state, port);
1500 struct uart_port *uport = state->uart_port;
1501 int mctrl;
1502 spin_lock_irq(&uport->lock);
1503 uport->ops->enable_ms(uport);
1504 mctrl = uport->ops->get_mctrl(uport);
1505 spin_unlock_irq(&uport->lock);
1506 if (mctrl & TIOCM_CAR)
1507 return 1;
1508 return 0;
1509 }
1510
1511 static void uart_dtr_rts(struct tty_port *port, int onoff)
1512 {
1513 struct uart_state *state = container_of(port, struct uart_state, port);
1514 struct uart_port *uport = state->uart_port;
1515
1516 if (onoff)
1517 uart_set_mctrl(uport, TIOCM_DTR | TIOCM_RTS);
1518 else
1519 uart_clear_mctrl(uport, TIOCM_DTR | TIOCM_RTS);
1520 }
1521
1522 /*
1523 * Calls to uart_open are serialised by the tty_lock in
1524 * drivers/tty/tty_io.c:tty_open()
1525 * Note that if this fails, then uart_close() _will_ be called.
1526 *
1527 * In time, we want to scrap the "opening nonpresent ports"
1528 * behaviour and implement an alternative way for setserial
1529 * to set base addresses/ports/types. This will allow us to
1530 * get rid of a certain amount of extra tests.
1531 */
1532 static int uart_open(struct tty_struct *tty, struct file *filp)
1533 {
1534 struct uart_driver *drv = (struct uart_driver *)tty->driver->driver_state;
1535 int retval, line = tty->index;
1536 struct uart_state *state = drv->state + line;
1537 struct tty_port *port = &state->port;
1538
1539 pr_debug("uart_open(%d) called\n", line);
1540
1541 /*
1542 * We take the semaphore here to guarantee that we won't be re-entered
1543 * while allocating the state structure, or while we request any IRQs
1544 * that the driver may need. This also has the nice side-effect that
1545 * it delays the action of uart_hangup, so we can guarantee that
1546 * state->port.tty will always contain something reasonable.
1547 */
1548 if (mutex_lock_interruptible(&port->mutex)) {
1549 retval = -ERESTARTSYS;
1550 goto end;
1551 }
1552
1553 port->count++;
1554 if (!state->uart_port || state->uart_port->flags & UPF_DEAD) {
1555 retval = -ENXIO;
1556 goto err_dec_count;
1557 }
1558
1559 /*
1560 * Once we set tty->driver_data here, we are guaranteed that
1561 * uart_close() will decrement the driver module use count.
1562 * Any failures from here onwards should not touch the count.
1563 */
1564 tty->driver_data = state;
1565 state->uart_port->state = state;
1566 state->port.low_latency =
1567 (state->uart_port->flags & UPF_LOW_LATENCY) ? 1 : 0;
1568 tty_port_tty_set(port, tty);
1569
1570 /*
1571 * If the port is in the middle of closing, bail out now.
1572 */
1573 if (tty_hung_up_p(filp)) {
1574 retval = -EAGAIN;
1575 goto err_dec_count;
1576 }
1577
1578 /*
1579 * Make sure the device is in D0 state.
1580 */
1581 if (port->count == 1)
1582 uart_change_pm(state, UART_PM_STATE_ON);
1583
1584 /*
1585 * Start up the serial port.
1586 */
1587 retval = uart_startup(tty, state, 0);
1588
1589 /*
1590 * If we succeeded, wait until the port is ready.
1591 */
1592 mutex_unlock(&port->mutex);
1593 if (retval == 0)
1594 retval = tty_port_block_til_ready(port, tty, filp);
1595
1596 end:
1597 return retval;
1598 err_dec_count:
1599 port->count--;
1600 mutex_unlock(&port->mutex);
1601 goto end;
1602 }
1603
1604 static const char *uart_type(struct uart_port *port)
1605 {
1606 const char *str = NULL;
1607
1608 if (port->ops->type)
1609 str = port->ops->type(port);
1610
1611 if (!str)
1612 str = "unknown";
1613
1614 return str;
1615 }
1616
1617 #ifdef CONFIG_PROC_FS
1618
1619 static void uart_line_info(struct seq_file *m, struct uart_driver *drv, int i)
1620 {
1621 struct uart_state *state = drv->state + i;
1622 struct tty_port *port = &state->port;
1623 enum uart_pm_state pm_state;
1624 struct uart_port *uport = state->uart_port;
1625 char stat_buf[32];
1626 unsigned int status;
1627 int mmio;
1628
1629 if (!uport)
1630 return;
1631
1632 mmio = uport->iotype >= UPIO_MEM;
1633 seq_printf(m, "%d: uart:%s %s%08llX irq:%d",
1634 uport->line, uart_type(uport),
1635 mmio ? "mmio:0x" : "port:",
1636 mmio ? (unsigned long long)uport->mapbase
1637 : (unsigned long long)uport->iobase,
1638 uport->irq);
1639
1640 if (uport->type == PORT_UNKNOWN) {
1641 seq_putc(m, '\n');
1642 return;
1643 }
1644
1645 if (capable(CAP_SYS_ADMIN)) {
1646 mutex_lock(&port->mutex);
1647 pm_state = state->pm_state;
1648 if (pm_state != UART_PM_STATE_ON)
1649 uart_change_pm(state, UART_PM_STATE_ON);
1650 spin_lock_irq(&uport->lock);
1651 status = uport->ops->get_mctrl(uport);
1652 spin_unlock_irq(&uport->lock);
1653 if (pm_state != UART_PM_STATE_ON)
1654 uart_change_pm(state, pm_state);
1655 mutex_unlock(&port->mutex);
1656
1657 seq_printf(m, " tx:%d rx:%d",
1658 uport->icount.tx, uport->icount.rx);
1659 if (uport->icount.frame)
1660 seq_printf(m, " fe:%d",
1661 uport->icount.frame);
1662 if (uport->icount.parity)
1663 seq_printf(m, " pe:%d",
1664 uport->icount.parity);
1665 if (uport->icount.brk)
1666 seq_printf(m, " brk:%d",
1667 uport->icount.brk);
1668 if (uport->icount.overrun)
1669 seq_printf(m, " oe:%d",
1670 uport->icount.overrun);
1671
1672 #define INFOBIT(bit, str) \
1673 if (uport->mctrl & (bit)) \
1674 strncat(stat_buf, (str), sizeof(stat_buf) - \
1675 strlen(stat_buf) - 2)
1676 #define STATBIT(bit, str) \
1677 if (status & (bit)) \
1678 strncat(stat_buf, (str), sizeof(stat_buf) - \
1679 strlen(stat_buf) - 2)
1680
1681 stat_buf[0] = '\0';
1682 stat_buf[1] = '\0';
1683 INFOBIT(TIOCM_RTS, "|RTS");
1684 STATBIT(TIOCM_CTS, "|CTS");
1685 INFOBIT(TIOCM_DTR, "|DTR");
1686 STATBIT(TIOCM_DSR, "|DSR");
1687 STATBIT(TIOCM_CAR, "|CD");
1688 STATBIT(TIOCM_RNG, "|RI");
1689 if (stat_buf[0])
1690 stat_buf[0] = ' ';
1691
1692 seq_puts(m, stat_buf);
1693 }
1694 seq_putc(m, '\n');
1695 #undef STATBIT
1696 #undef INFOBIT
1697 }
1698
1699 static int uart_proc_show(struct seq_file *m, void *v)
1700 {
1701 struct tty_driver *ttydrv = m->private;
1702 struct uart_driver *drv = ttydrv->driver_state;
1703 int i;
1704
1705 seq_printf(m, "serinfo:1.0 driver%s%s revision:%s\n",
1706 "", "", "");
1707 for (i = 0; i < drv->nr; i++)
1708 uart_line_info(m, drv, i);
1709 return 0;
1710 }
1711
1712 static int uart_proc_open(struct inode *inode, struct file *file)
1713 {
1714 return single_open(file, uart_proc_show, PDE_DATA(inode));
1715 }
1716
1717 static const struct file_operations uart_proc_fops = {
1718 .owner = THIS_MODULE,
1719 .open = uart_proc_open,
1720 .read = seq_read,
1721 .llseek = seq_lseek,
1722 .release = single_release,
1723 };
1724 #endif
1725
1726 #if defined(CONFIG_SERIAL_CORE_CONSOLE) || defined(CONFIG_CONSOLE_POLL)
1727 /*
1728 * uart_console_write - write a console message to a serial port
1729 * @port: the port to write the message
1730 * @s: array of characters
1731 * @count: number of characters in string to write
1732 * @write: function to write character to port
1733 */
1734 void uart_console_write(struct uart_port *port, const char *s,
1735 unsigned int count,
1736 void (*putchar)(struct uart_port *, int))
1737 {
1738 unsigned int i;
1739
1740 for (i = 0; i < count; i++, s++) {
1741 if (*s == '\n')
1742 putchar(port, '\r');
1743 putchar(port, *s);
1744 }
1745 }
1746 EXPORT_SYMBOL_GPL(uart_console_write);
1747
1748 /*
1749 * Check whether an invalid uart number has been specified, and
1750 * if so, search for the first available port that does have
1751 * console support.
1752 */
1753 struct uart_port * __init
1754 uart_get_console(struct uart_port *ports, int nr, struct console *co)
1755 {
1756 int idx = co->index;
1757
1758 if (idx < 0 || idx >= nr || (ports[idx].iobase == 0 &&
1759 ports[idx].membase == NULL))
1760 for (idx = 0; idx < nr; idx++)
1761 if (ports[idx].iobase != 0 ||
1762 ports[idx].membase != NULL)
1763 break;
1764
1765 co->index = idx;
1766
1767 return ports + idx;
1768 }
1769
1770 /**
1771 * uart_parse_options - Parse serial port baud/parity/bits/flow contro.
1772 * @options: pointer to option string
1773 * @baud: pointer to an 'int' variable for the baud rate.
1774 * @parity: pointer to an 'int' variable for the parity.
1775 * @bits: pointer to an 'int' variable for the number of data bits.
1776 * @flow: pointer to an 'int' variable for the flow control character.
1777 *
1778 * uart_parse_options decodes a string containing the serial console
1779 * options. The format of the string is <baud><parity><bits><flow>,
1780 * eg: 115200n8r
1781 */
1782 void
1783 uart_parse_options(char *options, int *baud, int *parity, int *bits, int *flow)
1784 {
1785 char *s = options;
1786
1787 *baud = simple_strtoul(s, NULL, 10);
1788 while (*s >= '0' && *s <= '9')
1789 s++;
1790 if (*s)
1791 *parity = *s++;
1792 if (*s)
1793 *bits = *s++ - '0';
1794 if (*s)
1795 *flow = *s;
1796 }
1797 EXPORT_SYMBOL_GPL(uart_parse_options);
1798
1799 struct baud_rates {
1800 unsigned int rate;
1801 unsigned int cflag;
1802 };
1803
1804 static const struct baud_rates baud_rates[] = {
1805 { 921600, B921600 },
1806 { 460800, B460800 },
1807 { 230400, B230400 },
1808 { 115200, B115200 },
1809 { 57600, B57600 },
1810 { 38400, B38400 },
1811 { 19200, B19200 },
1812 { 9600, B9600 },
1813 { 4800, B4800 },
1814 { 2400, B2400 },
1815 { 1200, B1200 },
1816 { 0, B38400 }
1817 };
1818
1819 /**
1820 * uart_set_options - setup the serial console parameters
1821 * @port: pointer to the serial ports uart_port structure
1822 * @co: console pointer
1823 * @baud: baud rate
1824 * @parity: parity character - 'n' (none), 'o' (odd), 'e' (even)
1825 * @bits: number of data bits
1826 * @flow: flow control character - 'r' (rts)
1827 */
1828 int
1829 uart_set_options(struct uart_port *port, struct console *co,
1830 int baud, int parity, int bits, int flow)
1831 {
1832 struct ktermios termios;
1833 static struct ktermios dummy;
1834 int i;
1835
1836 /*
1837 * Ensure that the serial console lock is initialised
1838 * early.
1839 */
1840 spin_lock_init(&port->lock);
1841 lockdep_set_class(&port->lock, &port_lock_key);
1842
1843 memset(&termios, 0, sizeof(struct ktermios));
1844
1845 termios.c_cflag = CREAD | HUPCL | CLOCAL;
1846
1847 /*
1848 * Construct a cflag setting.
1849 */
1850 for (i = 0; baud_rates[i].rate; i++)
1851 if (baud_rates[i].rate <= baud)
1852 break;
1853
1854 termios.c_cflag |= baud_rates[i].cflag;
1855
1856 if (bits == 7)
1857 termios.c_cflag |= CS7;
1858 else
1859 termios.c_cflag |= CS8;
1860
1861 switch (parity) {
1862 case 'o': case 'O':
1863 termios.c_cflag |= PARODD;
1864 /*fall through*/
1865 case 'e': case 'E':
1866 termios.c_cflag |= PARENB;
1867 break;
1868 }
1869
1870 if (flow == 'r')
1871 termios.c_cflag |= CRTSCTS;
1872
1873 /*
1874 * some uarts on other side don't support no flow control.
1875 * So we set * DTR in host uart to make them happy
1876 */
1877 port->mctrl |= TIOCM_DTR;
1878
1879 port->ops->set_termios(port, &termios, &dummy);
1880 /*
1881 * Allow the setting of the UART parameters with a NULL console
1882 * too:
1883 */
1884 if (co)
1885 co->cflag = termios.c_cflag;
1886
1887 return 0;
1888 }
1889 EXPORT_SYMBOL_GPL(uart_set_options);
1890 #endif /* CONFIG_SERIAL_CORE_CONSOLE */
1891
1892 /**
1893 * uart_change_pm - set power state of the port
1894 *
1895 * @state: port descriptor
1896 * @pm_state: new state
1897 *
1898 * Locking: port->mutex has to be held
1899 */
1900 static void uart_change_pm(struct uart_state *state,
1901 enum uart_pm_state pm_state)
1902 {
1903 struct uart_port *port = state->uart_port;
1904
1905 if (state->pm_state != pm_state) {
1906 if (port->ops->pm)
1907 port->ops->pm(port, pm_state, state->pm_state);
1908 state->pm_state = pm_state;
1909 }
1910 }
1911
1912 struct uart_match {
1913 struct uart_port *port;
1914 struct uart_driver *driver;
1915 };
1916
1917 static int serial_match_port(struct device *dev, void *data)
1918 {
1919 struct uart_match *match = data;
1920 struct tty_driver *tty_drv = match->driver->tty_driver;
1921 dev_t devt = MKDEV(tty_drv->major, tty_drv->minor_start) +
1922 match->port->line;
1923
1924 return dev->devt == devt; /* Actually, only one tty per port */
1925 }
1926
1927 int uart_suspend_port(struct uart_driver *drv, struct uart_port *uport)
1928 {
1929 struct uart_state *state = drv->state + uport->line;
1930 struct tty_port *port = &state->port;
1931 struct device *tty_dev;
1932 struct uart_match match = {uport, drv};
1933
1934 mutex_lock(&port->mutex);
1935
1936 tty_dev = device_find_child(uport->dev, &match, serial_match_port);
1937 if (device_may_wakeup(tty_dev)) {
1938 if (!enable_irq_wake(uport->irq))
1939 uport->irq_wake = 1;
1940 put_device(tty_dev);
1941 mutex_unlock(&port->mutex);
1942 return 0;
1943 }
1944 if (console_suspend_enabled || !uart_console(uport))
1945 uport->suspended = 1;
1946
1947 if (port->flags & ASYNC_INITIALIZED) {
1948 const struct uart_ops *ops = uport->ops;
1949 int tries;
1950
1951 if (console_suspend_enabled || !uart_console(uport)) {
1952 set_bit(ASYNCB_SUSPENDED, &port->flags);
1953 clear_bit(ASYNCB_INITIALIZED, &port->flags);
1954
1955 spin_lock_irq(&uport->lock);
1956 ops->stop_tx(uport);
1957 ops->set_mctrl(uport, 0);
1958 ops->stop_rx(uport);
1959 spin_unlock_irq(&uport->lock);
1960 }
1961
1962 /*
1963 * Wait for the transmitter to empty.
1964 */
1965 for (tries = 3; !ops->tx_empty(uport) && tries; tries--)
1966 msleep(10);
1967 if (!tries)
1968 printk(KERN_ERR "%s%s%s%d: Unable to drain "
1969 "transmitter\n",
1970 uport->dev ? dev_name(uport->dev) : "",
1971 uport->dev ? ": " : "",
1972 drv->dev_name,
1973 drv->tty_driver->name_base + uport->line);
1974
1975 if (console_suspend_enabled || !uart_console(uport))
1976 ops->shutdown(uport);
1977 }
1978
1979 /*
1980 * Disable the console device before suspending.
1981 */
1982 if (console_suspend_enabled && uart_console(uport))
1983 console_stop(uport->cons);
1984
1985 if (console_suspend_enabled || !uart_console(uport))
1986 uart_change_pm(state, UART_PM_STATE_OFF);
1987
1988 mutex_unlock(&port->mutex);
1989
1990 return 0;
1991 }
1992
1993 int uart_resume_port(struct uart_driver *drv, struct uart_port *uport)
1994 {
1995 struct uart_state *state = drv->state + uport->line;
1996 struct tty_port *port = &state->port;
1997 struct device *tty_dev;
1998 struct uart_match match = {uport, drv};
1999 struct ktermios termios;
2000
2001 mutex_lock(&port->mutex);
2002
2003 tty_dev = device_find_child(uport->dev, &match, serial_match_port);
2004 if (!uport->suspended && device_may_wakeup(tty_dev)) {
2005 if (uport->irq_wake) {
2006 disable_irq_wake(uport->irq);
2007 uport->irq_wake = 0;
2008 }
2009 mutex_unlock(&port->mutex);
2010 return 0;
2011 }
2012 uport->suspended = 0;
2013
2014 /*
2015 * Re-enable the console device after suspending.
2016 */
2017 if (uart_console(uport)) {
2018 /*
2019 * First try to use the console cflag setting.
2020 */
2021 memset(&termios, 0, sizeof(struct ktermios));
2022 termios.c_cflag = uport->cons->cflag;
2023
2024 /*
2025 * If that's unset, use the tty termios setting.
2026 */
2027 if (port->tty && termios.c_cflag == 0)
2028 termios = port->tty->termios;
2029
2030 if (console_suspend_enabled)
2031 uart_change_pm(state, UART_PM_STATE_ON);
2032 uport->ops->set_termios(uport, &termios, NULL);
2033 if (console_suspend_enabled)
2034 console_start(uport->cons);
2035 }
2036
2037 if (port->flags & ASYNC_SUSPENDED) {
2038 const struct uart_ops *ops = uport->ops;
2039 int ret;
2040
2041 uart_change_pm(state, UART_PM_STATE_ON);
2042 spin_lock_irq(&uport->lock);
2043 ops->set_mctrl(uport, 0);
2044 spin_unlock_irq(&uport->lock);
2045 if (console_suspend_enabled || !uart_console(uport)) {
2046 /* Protected by port mutex for now */
2047 struct tty_struct *tty = port->tty;
2048 ret = ops->startup(uport);
2049 if (ret == 0) {
2050 if (tty)
2051 uart_change_speed(tty, state, NULL);
2052 spin_lock_irq(&uport->lock);
2053 ops->set_mctrl(uport, uport->mctrl);
2054 ops->start_tx(uport);
2055 spin_unlock_irq(&uport->lock);
2056 set_bit(ASYNCB_INITIALIZED, &port->flags);
2057 } else {
2058 /*
2059 * Failed to resume - maybe hardware went away?
2060 * Clear the "initialized" flag so we won't try
2061 * to call the low level drivers shutdown method.
2062 */
2063 uart_shutdown(tty, state);
2064 }
2065 }
2066
2067 clear_bit(ASYNCB_SUSPENDED, &port->flags);
2068 }
2069
2070 mutex_unlock(&port->mutex);
2071
2072 return 0;
2073 }
2074
2075 static inline void
2076 uart_report_port(struct uart_driver *drv, struct uart_port *port)
2077 {
2078 char address[64];
2079
2080 switch (port->iotype) {
2081 case UPIO_PORT:
2082 snprintf(address, sizeof(address), "I/O 0x%lx", port->iobase);
2083 break;
2084 case UPIO_HUB6:
2085 snprintf(address, sizeof(address),
2086 "I/O 0x%lx offset 0x%x", port->iobase, port->hub6);
2087 break;
2088 case UPIO_MEM:
2089 case UPIO_MEM32:
2090 case UPIO_AU:
2091 case UPIO_TSI:
2092 snprintf(address, sizeof(address),
2093 "MMIO 0x%llx", (unsigned long long)port->mapbase);
2094 break;
2095 default:
2096 strlcpy(address, "*unknown*", sizeof(address));
2097 break;
2098 }
2099
2100 printk(KERN_INFO "%s%s%s%d at %s (irq = %d) is a %s\n",
2101 port->dev ? dev_name(port->dev) : "",
2102 port->dev ? ": " : "",
2103 drv->dev_name,
2104 drv->tty_driver->name_base + port->line,
2105 address, port->irq, uart_type(port));
2106 }
2107
2108 static void
2109 uart_configure_port(struct uart_driver *drv, struct uart_state *state,
2110 struct uart_port *port)
2111 {
2112 unsigned int flags;
2113
2114 /*
2115 * If there isn't a port here, don't do anything further.
2116 */
2117 if (!port->iobase && !port->mapbase && !port->membase)
2118 return;
2119
2120 /*
2121 * Now do the auto configuration stuff. Note that config_port
2122 * is expected to claim the resources and map the port for us.
2123 */
2124 flags = 0;
2125 if (port->flags & UPF_AUTO_IRQ)
2126 flags |= UART_CONFIG_IRQ;
2127 if (port->flags & UPF_BOOT_AUTOCONF) {
2128 if (!(port->flags & UPF_FIXED_TYPE)) {
2129 port->type = PORT_UNKNOWN;
2130 flags |= UART_CONFIG_TYPE;
2131 }
2132 port->ops->config_port(port, flags);
2133 }
2134
2135 if (port->type != PORT_UNKNOWN) {
2136 unsigned long flags;
2137
2138 uart_report_port(drv, port);
2139
2140 /* Power up port for set_mctrl() */
2141 uart_change_pm(state, UART_PM_STATE_ON);
2142
2143 /*
2144 * Ensure that the modem control lines are de-activated.
2145 * keep the DTR setting that is set in uart_set_options()
2146 * We probably don't need a spinlock around this, but
2147 */
2148 spin_lock_irqsave(&port->lock, flags);
2149 port->ops->set_mctrl(port, port->mctrl & TIOCM_DTR);
2150 spin_unlock_irqrestore(&port->lock, flags);
2151
2152 /*
2153 * If this driver supports console, and it hasn't been
2154 * successfully registered yet, try to re-register it.
2155 * It may be that the port was not available.
2156 */
2157 if (port->cons && !(port->cons->flags & CON_ENABLED))
2158 register_console(port->cons);
2159
2160 /*
2161 * Power down all ports by default, except the
2162 * console if we have one.
2163 */
2164 if (!uart_console(port))
2165 uart_change_pm(state, UART_PM_STATE_OFF);
2166 }
2167 }
2168
2169 #ifdef CONFIG_CONSOLE_POLL
2170
2171 static int uart_poll_init(struct tty_driver *driver, int line, char *options)
2172 {
2173 struct uart_driver *drv = driver->driver_state;
2174 struct uart_state *state = drv->state + line;
2175 struct uart_port *port;
2176 int baud = 9600;
2177 int bits = 8;
2178 int parity = 'n';
2179 int flow = 'n';
2180 int ret;
2181
2182 if (!state || !state->uart_port)
2183 return -1;
2184
2185 port = state->uart_port;
2186 if (!(port->ops->poll_get_char && port->ops->poll_put_char))
2187 return -1;
2188
2189 if (port->ops->poll_init) {
2190 struct tty_port *tport = &state->port;
2191
2192 ret = 0;
2193 mutex_lock(&tport->mutex);
2194 /*
2195 * We don't set ASYNCB_INITIALIZED as we only initialized the
2196 * hw, e.g. state->xmit is still uninitialized.
2197 */
2198 if (!test_bit(ASYNCB_INITIALIZED, &tport->flags))
2199 ret = port->ops->poll_init(port);
2200 mutex_unlock(&tport->mutex);
2201 if (ret)
2202 return ret;
2203 }
2204
2205 if (options) {
2206 uart_parse_options(options, &baud, &parity, &bits, &flow);
2207 return uart_set_options(port, NULL, baud, parity, bits, flow);
2208 }
2209
2210 return 0;
2211 }
2212
2213 static int uart_poll_get_char(struct tty_driver *driver, int line)
2214 {
2215 struct uart_driver *drv = driver->driver_state;
2216 struct uart_state *state = drv->state + line;
2217 struct uart_port *port;
2218
2219 if (!state || !state->uart_port)
2220 return -1;
2221
2222 port = state->uart_port;
2223 return port->ops->poll_get_char(port);
2224 }
2225
2226 static void uart_poll_put_char(struct tty_driver *driver, int line, char ch)
2227 {
2228 struct uart_driver *drv = driver->driver_state;
2229 struct uart_state *state = drv->state + line;
2230 struct uart_port *port;
2231
2232 if (!state || !state->uart_port)
2233 return;
2234
2235 port = state->uart_port;
2236 port->ops->poll_put_char(port, ch);
2237 }
2238 #endif
2239
2240 static const struct tty_operations uart_ops = {
2241 .open = uart_open,
2242 .close = uart_close,
2243 .write = uart_write,
2244 .put_char = uart_put_char,
2245 .flush_chars = uart_flush_chars,
2246 .write_room = uart_write_room,
2247 .chars_in_buffer= uart_chars_in_buffer,
2248 .flush_buffer = uart_flush_buffer,
2249 .ioctl = uart_ioctl,
2250 .throttle = uart_throttle,
2251 .unthrottle = uart_unthrottle,
2252 .send_xchar = uart_send_xchar,
2253 .set_termios = uart_set_termios,
2254 .set_ldisc = uart_set_ldisc,
2255 .stop = uart_stop,
2256 .start = uart_start,
2257 .hangup = uart_hangup,
2258 .break_ctl = uart_break_ctl,
2259 .wait_until_sent= uart_wait_until_sent,
2260 #ifdef CONFIG_PROC_FS
2261 .proc_fops = &uart_proc_fops,
2262 #endif
2263 .tiocmget = uart_tiocmget,
2264 .tiocmset = uart_tiocmset,
2265 .get_icount = uart_get_icount,
2266 #ifdef CONFIG_CONSOLE_POLL
2267 .poll_init = uart_poll_init,
2268 .poll_get_char = uart_poll_get_char,
2269 .poll_put_char = uart_poll_put_char,
2270 #endif
2271 };
2272
2273 static const struct tty_port_operations uart_port_ops = {
2274 .activate = uart_port_activate,
2275 .shutdown = uart_port_shutdown,
2276 .carrier_raised = uart_carrier_raised,
2277 .dtr_rts = uart_dtr_rts,
2278 };
2279
2280 /**
2281 * uart_register_driver - register a driver with the uart core layer
2282 * @drv: low level driver structure
2283 *
2284 * Register a uart driver with the core driver. We in turn register
2285 * with the tty layer, and initialise the core driver per-port state.
2286 *
2287 * We have a proc file in /proc/tty/driver which is named after the
2288 * normal driver.
2289 *
2290 * drv->port should be NULL, and the per-port structures should be
2291 * registered using uart_add_one_port after this call has succeeded.
2292 */
2293 int uart_register_driver(struct uart_driver *drv)
2294 {
2295 struct tty_driver *normal;
2296 int i, retval;
2297
2298 BUG_ON(drv->state);
2299
2300 /*
2301 * Maybe we should be using a slab cache for this, especially if
2302 * we have a large number of ports to handle.
2303 */
2304 drv->state = kzalloc(sizeof(struct uart_state) * drv->nr, GFP_KERNEL);
2305 if (!drv->state)
2306 goto out;
2307
2308 normal = alloc_tty_driver(drv->nr);
2309 if (!normal)
2310 goto out_kfree;
2311
2312 drv->tty_driver = normal;
2313
2314 normal->driver_name = drv->driver_name;
2315 normal->name = drv->dev_name;
2316 normal->major = drv->major;
2317 normal->minor_start = drv->minor;
2318 normal->type = TTY_DRIVER_TYPE_SERIAL;
2319 normal->subtype = SERIAL_TYPE_NORMAL;
2320 normal->init_termios = tty_std_termios;
2321 normal->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
2322 normal->init_termios.c_ispeed = normal->init_termios.c_ospeed = 9600;
2323 normal->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
2324 normal->driver_state = drv;
2325 tty_set_operations(normal, &uart_ops);
2326
2327 /*
2328 * Initialise the UART state(s).
2329 */
2330 for (i = 0; i < drv->nr; i++) {
2331 struct uart_state *state = drv->state + i;
2332 struct tty_port *port = &state->port;
2333
2334 tty_port_init(port);
2335 port->ops = &uart_port_ops;
2336 port->close_delay = HZ / 2; /* .5 seconds */
2337 port->closing_wait = 30 * HZ;/* 30 seconds */
2338 }
2339
2340 retval = tty_register_driver(normal);
2341 if (retval >= 0)
2342 return retval;
2343
2344 for (i = 0; i < drv->nr; i++)
2345 tty_port_destroy(&drv->state[i].port);
2346 put_tty_driver(normal);
2347 out_kfree:
2348 kfree(drv->state);
2349 out:
2350 return -ENOMEM;
2351 }
2352
2353 /**
2354 * uart_unregister_driver - remove a driver from the uart core layer
2355 * @drv: low level driver structure
2356 *
2357 * Remove all references to a driver from the core driver. The low
2358 * level driver must have removed all its ports via the
2359 * uart_remove_one_port() if it registered them with uart_add_one_port().
2360 * (ie, drv->port == NULL)
2361 */
2362 void uart_unregister_driver(struct uart_driver *drv)
2363 {
2364 struct tty_driver *p = drv->tty_driver;
2365 unsigned int i;
2366
2367 tty_unregister_driver(p);
2368 put_tty_driver(p);
2369 for (i = 0; i < drv->nr; i++)
2370 tty_port_destroy(&drv->state[i].port);
2371 kfree(drv->state);
2372 drv->state = NULL;
2373 drv->tty_driver = NULL;
2374 }
2375
2376 struct tty_driver *uart_console_device(struct console *co, int *index)
2377 {
2378 struct uart_driver *p = co->data;
2379 *index = co->index;
2380 return p->tty_driver;
2381 }
2382
2383 static ssize_t uart_get_attr_uartclk(struct device *dev,
2384 struct device_attribute *attr, char *buf)
2385 {
2386 struct serial_struct tmp;
2387 struct tty_port *port = dev_get_drvdata(dev);
2388
2389 uart_get_info(port, &tmp);
2390 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.baud_base * 16);
2391 }
2392
2393 static ssize_t uart_get_attr_type(struct device *dev,
2394 struct device_attribute *attr, char *buf)
2395 {
2396 struct serial_struct tmp;
2397 struct tty_port *port = dev_get_drvdata(dev);
2398
2399 uart_get_info(port, &tmp);
2400 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.type);
2401 }
2402 static ssize_t uart_get_attr_line(struct device *dev,
2403 struct device_attribute *attr, char *buf)
2404 {
2405 struct serial_struct tmp;
2406 struct tty_port *port = dev_get_drvdata(dev);
2407
2408 uart_get_info(port, &tmp);
2409 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.line);
2410 }
2411
2412 static ssize_t uart_get_attr_port(struct device *dev,
2413 struct device_attribute *attr, char *buf)
2414 {
2415 struct serial_struct tmp;
2416 struct tty_port *port = dev_get_drvdata(dev);
2417 unsigned long ioaddr;
2418
2419 uart_get_info(port, &tmp);
2420 ioaddr = tmp.port;
2421 if (HIGH_BITS_OFFSET)
2422 ioaddr |= (unsigned long)tmp.port_high << HIGH_BITS_OFFSET;
2423 return snprintf(buf, PAGE_SIZE, "0x%lX\n", ioaddr);
2424 }
2425
2426 static ssize_t uart_get_attr_irq(struct device *dev,
2427 struct device_attribute *attr, char *buf)
2428 {
2429 struct serial_struct tmp;
2430 struct tty_port *port = dev_get_drvdata(dev);
2431
2432 uart_get_info(port, &tmp);
2433 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.irq);
2434 }
2435
2436 static ssize_t uart_get_attr_flags(struct device *dev,
2437 struct device_attribute *attr, char *buf)
2438 {
2439 struct serial_struct tmp;
2440 struct tty_port *port = dev_get_drvdata(dev);
2441
2442 uart_get_info(port, &tmp);
2443 return snprintf(buf, PAGE_SIZE, "0x%X\n", tmp.flags);
2444 }
2445
2446 static ssize_t uart_get_attr_xmit_fifo_size(struct device *dev,
2447 struct device_attribute *attr, char *buf)
2448 {
2449 struct serial_struct tmp;
2450 struct tty_port *port = dev_get_drvdata(dev);
2451
2452 uart_get_info(port, &tmp);
2453 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.xmit_fifo_size);
2454 }
2455
2456
2457 static ssize_t uart_get_attr_close_delay(struct device *dev,
2458 struct device_attribute *attr, char *buf)
2459 {
2460 struct serial_struct tmp;
2461 struct tty_port *port = dev_get_drvdata(dev);
2462
2463 uart_get_info(port, &tmp);
2464 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.close_delay);
2465 }
2466
2467
2468 static ssize_t uart_get_attr_closing_wait(struct device *dev,
2469 struct device_attribute *attr, char *buf)
2470 {
2471 struct serial_struct tmp;
2472 struct tty_port *port = dev_get_drvdata(dev);
2473
2474 uart_get_info(port, &tmp);
2475 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.closing_wait);
2476 }
2477
2478 static ssize_t uart_get_attr_custom_divisor(struct device *dev,
2479 struct device_attribute *attr, char *buf)
2480 {
2481 struct serial_struct tmp;
2482 struct tty_port *port = dev_get_drvdata(dev);
2483
2484 uart_get_info(port, &tmp);
2485 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.custom_divisor);
2486 }
2487
2488 static ssize_t uart_get_attr_io_type(struct device *dev,
2489 struct device_attribute *attr, char *buf)
2490 {
2491 struct serial_struct tmp;
2492 struct tty_port *port = dev_get_drvdata(dev);
2493
2494 uart_get_info(port, &tmp);
2495 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.io_type);
2496 }
2497
2498 static ssize_t uart_get_attr_iomem_base(struct device *dev,
2499 struct device_attribute *attr, char *buf)
2500 {
2501 struct serial_struct tmp;
2502 struct tty_port *port = dev_get_drvdata(dev);
2503
2504 uart_get_info(port, &tmp);
2505 return snprintf(buf, PAGE_SIZE, "0x%lX\n", (unsigned long)tmp.iomem_base);
2506 }
2507
2508 static ssize_t uart_get_attr_iomem_reg_shift(struct device *dev,
2509 struct device_attribute *attr, char *buf)
2510 {
2511 struct serial_struct tmp;
2512 struct tty_port *port = dev_get_drvdata(dev);
2513
2514 uart_get_info(port, &tmp);
2515 return snprintf(buf, PAGE_SIZE, "%d\n", tmp.iomem_reg_shift);
2516 }
2517
2518 static DEVICE_ATTR(type, S_IRUSR | S_IRGRP, uart_get_attr_type, NULL);
2519 static DEVICE_ATTR(line, S_IRUSR | S_IRGRP, uart_get_attr_line, NULL);
2520 static DEVICE_ATTR(port, S_IRUSR | S_IRGRP, uart_get_attr_port, NULL);
2521 static DEVICE_ATTR(irq, S_IRUSR | S_IRGRP, uart_get_attr_irq, NULL);
2522 static DEVICE_ATTR(flags, S_IRUSR | S_IRGRP, uart_get_attr_flags, NULL);
2523 static DEVICE_ATTR(xmit_fifo_size, S_IRUSR | S_IRGRP, uart_get_attr_xmit_fifo_size, NULL);
2524 static DEVICE_ATTR(uartclk, S_IRUSR | S_IRGRP, uart_get_attr_uartclk, NULL);
2525 static DEVICE_ATTR(close_delay, S_IRUSR | S_IRGRP, uart_get_attr_close_delay, NULL);
2526 static DEVICE_ATTR(closing_wait, S_IRUSR | S_IRGRP, uart_get_attr_closing_wait, NULL);
2527 static DEVICE_ATTR(custom_divisor, S_IRUSR | S_IRGRP, uart_get_attr_custom_divisor, NULL);
2528 static DEVICE_ATTR(io_type, S_IRUSR | S_IRGRP, uart_get_attr_io_type, NULL);
2529 static DEVICE_ATTR(iomem_base, S_IRUSR | S_IRGRP, uart_get_attr_iomem_base, NULL);
2530 static DEVICE_ATTR(iomem_reg_shift, S_IRUSR | S_IRGRP, uart_get_attr_iomem_reg_shift, NULL);
2531
2532 static struct attribute *tty_dev_attrs[] = {
2533 &dev_attr_type.attr,
2534 &dev_attr_line.attr,
2535 &dev_attr_port.attr,
2536 &dev_attr_irq.attr,
2537 &dev_attr_flags.attr,
2538 &dev_attr_xmit_fifo_size.attr,
2539 &dev_attr_uartclk.attr,
2540 &dev_attr_close_delay.attr,
2541 &dev_attr_closing_wait.attr,
2542 &dev_attr_custom_divisor.attr,
2543 &dev_attr_io_type.attr,
2544 &dev_attr_iomem_base.attr,
2545 &dev_attr_iomem_reg_shift.attr,
2546 NULL,
2547 };
2548
2549 static const struct attribute_group tty_dev_attr_group = {
2550 .attrs = tty_dev_attrs,
2551 };
2552
2553 static const struct attribute_group *tty_dev_attr_groups[] = {
2554 &tty_dev_attr_group,
2555 NULL
2556 };
2557
2558
2559 /**
2560 * uart_add_one_port - attach a driver-defined port structure
2561 * @drv: pointer to the uart low level driver structure for this port
2562 * @uport: uart port structure to use for this port.
2563 *
2564 * This allows the driver to register its own uart_port structure
2565 * with the core driver. The main purpose is to allow the low
2566 * level uart drivers to expand uart_port, rather than having yet
2567 * more levels of structures.
2568 */
2569 int uart_add_one_port(struct uart_driver *drv, struct uart_port *uport)
2570 {
2571 struct uart_state *state;
2572 struct tty_port *port;
2573 int ret = 0;
2574 struct device *tty_dev;
2575
2576 BUG_ON(in_interrupt());
2577
2578 if (uport->line >= drv->nr)
2579 return -EINVAL;
2580
2581 state = drv->state + uport->line;
2582 port = &state->port;
2583
2584 mutex_lock(&port_mutex);
2585 mutex_lock(&port->mutex);
2586 if (state->uart_port) {
2587 ret = -EINVAL;
2588 goto out;
2589 }
2590
2591 state->uart_port = uport;
2592 state->pm_state = UART_PM_STATE_UNDEFINED;
2593
2594 uport->cons = drv->cons;
2595 uport->state = state;
2596
2597 /*
2598 * If this port is a console, then the spinlock is already
2599 * initialised.
2600 */
2601 if (!(uart_console(uport) && (uport->cons->flags & CON_ENABLED))) {
2602 spin_lock_init(&uport->lock);
2603 lockdep_set_class(&uport->lock, &port_lock_key);
2604 }
2605
2606 uart_configure_port(drv, state, uport);
2607
2608 /*
2609 * Register the port whether it's detected or not. This allows
2610 * setserial to be used to alter this ports parameters.
2611 */
2612 tty_dev = tty_port_register_device_attr(port, drv->tty_driver,
2613 uport->line, uport->dev, port, tty_dev_attr_groups);
2614 if (likely(!IS_ERR(tty_dev))) {
2615 device_set_wakeup_capable(tty_dev, 1);
2616 } else {
2617 printk(KERN_ERR "Cannot register tty device on line %d\n",
2618 uport->line);
2619 }
2620
2621 /*
2622 * Ensure UPF_DEAD is not set.
2623 */
2624 uport->flags &= ~UPF_DEAD;
2625
2626 out:
2627 mutex_unlock(&port->mutex);
2628 mutex_unlock(&port_mutex);
2629
2630 return ret;
2631 }
2632
2633 /**
2634 * uart_remove_one_port - detach a driver defined port structure
2635 * @drv: pointer to the uart low level driver structure for this port
2636 * @uport: uart port structure for this port
2637 *
2638 * This unhooks (and hangs up) the specified port structure from the
2639 * core driver. No further calls will be made to the low-level code
2640 * for this port.
2641 */
2642 int uart_remove_one_port(struct uart_driver *drv, struct uart_port *uport)
2643 {
2644 struct uart_state *state = drv->state + uport->line;
2645 struct tty_port *port = &state->port;
2646 int ret = 0;
2647
2648 BUG_ON(in_interrupt());
2649
2650 if (state->uart_port != uport)
2651 printk(KERN_ALERT "Removing wrong port: %p != %p\n",
2652 state->uart_port, uport);
2653
2654 mutex_lock(&port_mutex);
2655
2656 /*
2657 * Mark the port "dead" - this prevents any opens from
2658 * succeeding while we shut down the port.
2659 */
2660 mutex_lock(&port->mutex);
2661 if (!state->uart_port) {
2662 mutex_unlock(&port->mutex);
2663 ret = -EINVAL;
2664 goto out;
2665 }
2666 uport->flags |= UPF_DEAD;
2667 mutex_unlock(&port->mutex);
2668
2669 /*
2670 * Remove the devices from the tty layer
2671 */
2672 tty_unregister_device(drv->tty_driver, uport->line);
2673
2674 if (port->tty)
2675 tty_vhangup(port->tty);
2676
2677 /*
2678 * Free the port IO and memory resources, if any.
2679 */
2680 if (uport->type != PORT_UNKNOWN)
2681 uport->ops->release_port(uport);
2682
2683 /*
2684 * Indicate that there isn't a port here anymore.
2685 */
2686 uport->type = PORT_UNKNOWN;
2687
2688 state->uart_port = NULL;
2689 out:
2690 mutex_unlock(&port_mutex);
2691
2692 return ret;
2693 }
2694
2695 /*
2696 * Are the two ports equivalent?
2697 */
2698 int uart_match_port(struct uart_port *port1, struct uart_port *port2)
2699 {
2700 if (port1->iotype != port2->iotype)
2701 return 0;
2702
2703 switch (port1->iotype) {
2704 case UPIO_PORT:
2705 return (port1->iobase == port2->iobase);
2706 case UPIO_HUB6:
2707 return (port1->iobase == port2->iobase) &&
2708 (port1->hub6 == port2->hub6);
2709 case UPIO_MEM:
2710 case UPIO_MEM32:
2711 case UPIO_AU:
2712 case UPIO_TSI:
2713 return (port1->mapbase == port2->mapbase);
2714 }
2715 return 0;
2716 }
2717 EXPORT_SYMBOL(uart_match_port);
2718
2719 /**
2720 * uart_handle_dcd_change - handle a change of carrier detect state
2721 * @uport: uart_port structure for the open port
2722 * @status: new carrier detect status, nonzero if active
2723 */
2724 void uart_handle_dcd_change(struct uart_port *uport, unsigned int status)
2725 {
2726 struct tty_port *port = &uport->state->port;
2727 struct tty_struct *tty = port->tty;
2728 struct tty_ldisc *ld = tty ? tty_ldisc_ref(tty) : NULL;
2729
2730 if (ld) {
2731 if (ld->ops->dcd_change)
2732 ld->ops->dcd_change(tty, status);
2733 tty_ldisc_deref(ld);
2734 }
2735
2736 uport->icount.dcd++;
2737
2738 if (port->flags & ASYNC_CHECK_CD) {
2739 if (status)
2740 wake_up_interruptible(&port->open_wait);
2741 else if (tty)
2742 tty_hangup(tty);
2743 }
2744 }
2745 EXPORT_SYMBOL_GPL(uart_handle_dcd_change);
2746
2747 /**
2748 * uart_handle_cts_change - handle a change of clear-to-send state
2749 * @uport: uart_port structure for the open port
2750 * @status: new clear to send status, nonzero if active
2751 */
2752 void uart_handle_cts_change(struct uart_port *uport, unsigned int status)
2753 {
2754 struct tty_port *port = &uport->state->port;
2755 struct tty_struct *tty = port->tty;
2756
2757 uport->icount.cts++;
2758
2759 if (tty_port_cts_enabled(port)) {
2760 if (tty->hw_stopped) {
2761 if (status) {
2762 tty->hw_stopped = 0;
2763 uport->ops->start_tx(uport);
2764 uart_write_wakeup(uport);
2765 }
2766 } else {
2767 if (!status) {
2768 tty->hw_stopped = 1;
2769 uport->ops->stop_tx(uport);
2770 }
2771 }
2772 }
2773 }
2774 EXPORT_SYMBOL_GPL(uart_handle_cts_change);
2775
2776 /**
2777 * uart_insert_char - push a char to the uart layer
2778 *
2779 * User is responsible to call tty_flip_buffer_push when they are done with
2780 * insertion.
2781 *
2782 * @port: corresponding port
2783 * @status: state of the serial port RX buffer (LSR for 8250)
2784 * @overrun: mask of overrun bits in @status
2785 * @ch: character to push
2786 * @flag: flag for the character (see TTY_NORMAL and friends)
2787 */
2788 void uart_insert_char(struct uart_port *port, unsigned int status,
2789 unsigned int overrun, unsigned int ch, unsigned int flag)
2790 {
2791 struct tty_port *tport = &port->state->port;
2792
2793 if ((status & port->ignore_status_mask & ~overrun) == 0)
2794 if (tty_insert_flip_char(tport, ch, flag) == 0)
2795 ++port->icount.buf_overrun;
2796
2797 /*
2798 * Overrun is special. Since it's reported immediately,
2799 * it doesn't affect the current character.
2800 */
2801 if (status & ~port->ignore_status_mask & overrun)
2802 if (tty_insert_flip_char(tport, 0, TTY_OVERRUN) == 0)
2803 ++port->icount.buf_overrun;
2804 }
2805 EXPORT_SYMBOL_GPL(uart_insert_char);
2806
2807 EXPORT_SYMBOL(uart_write_wakeup);
2808 EXPORT_SYMBOL(uart_register_driver);
2809 EXPORT_SYMBOL(uart_unregister_driver);
2810 EXPORT_SYMBOL(uart_suspend_port);
2811 EXPORT_SYMBOL(uart_resume_port);
2812 EXPORT_SYMBOL(uart_add_one_port);
2813 EXPORT_SYMBOL(uart_remove_one_port);
2814
2815 MODULE_DESCRIPTION("Serial driver core");
2816 MODULE_LICENSE("GPL");