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