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