65 	struct uart_amba_port *uap =  in pl010_stop_tx()  local
69 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_tx()
71 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_tx()
76 	struct uart_amba_port *uap =  in pl010_start_tx()  local
80 	cr = readb(uap->port.membase + UART010_CR);  in pl010_start_tx()
82 	writel(cr, uap->port.membase + UART010_CR);  in pl010_start_tx()
87 	struct uart_amba_port *uap =  in pl010_stop_rx()  local
91 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_rx()
93 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_rx()
98 	struct uart_amba_port *uap = (struct uart_amba_port *)port;  in pl010_disable_ms()  local
101 	cr = readb(uap->port.membase + UART010_CR);  in pl010_disable_ms()
103 	writel(cr, uap->port.membase + UART010_CR);  in pl010_disable_ms()
108 	struct uart_amba_port *uap =  in pl010_enable_ms()  local
112 	cr = readb(uap->port.membase + UART010_CR);  in pl010_enable_ms()
114 	writel(cr, uap->port.membase + UART010_CR);  in pl010_enable_ms()
117 static void pl010_rx_chars(struct uart_amba_port *uap)  in pl010_rx_chars()  argument
121 	status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
123 		ch = readb(uap->port.membase + UART01x_DR);  in pl010_rx_chars()
126 		uap->port.icount.rx++;  in pl010_rx_chars()
132 		rsr = readb(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;  in pl010_rx_chars()
134 			writel(0, uap->port.membase + UART01x_ECR);  in pl010_rx_chars()
138 				uap->port.icount.brk++;  in pl010_rx_chars()
139 				if (uart_handle_break(&uap->port))  in pl010_rx_chars()
142 				uap->port.icount.parity++;  in pl010_rx_chars()
144 				uap->port.icount.frame++;  in pl010_rx_chars()
146 				uap->port.icount.overrun++;  in pl010_rx_chars()
148 			rsr &= uap->port.read_status_mask;  in pl010_rx_chars()
158 		if (uart_handle_sysrq_char(&uap->port, ch))  in pl010_rx_chars()
161 		uart_insert_char(&uap->port, rsr, UART01x_RSR_OE, ch, flag);  in pl010_rx_chars()
164 		status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
166 	spin_unlock(&uap->port.lock);  in pl010_rx_chars()
167 	tty_flip_buffer_push(&uap->port.state->port);  in pl010_rx_chars()
168 	spin_lock(&uap->port.lock);  in pl010_rx_chars()
171 static void pl010_tx_chars(struct uart_amba_port *uap)  in pl010_tx_chars()  argument
173 	struct circ_buf *xmit = &uap->port.state->xmit;  in pl010_tx_chars()
176 	if (uap->port.x_char) {  in pl010_tx_chars()
177 		writel(uap->port.x_char, uap->port.membase + UART01x_DR);  in pl010_tx_chars()
178 		uap->port.icount.tx++;  in pl010_tx_chars()
179 		uap->port.x_char = 0;  in pl010_tx_chars()
182 	if (uart_circ_empty(xmit) || uart_tx_stopped(&uap->port)) {  in pl010_tx_chars()
183 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
187 	count = uap->port.fifosize >> 1;  in pl010_tx_chars()
189 		writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);  in pl010_tx_chars()
191 		uap->port.icount.tx++;  in pl010_tx_chars()
197 		uart_write_wakeup(&uap->port);  in pl010_tx_chars()
200 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
203 static void pl010_modem_status(struct uart_amba_port *uap)  in pl010_modem_status()  argument
207 	writel(0, uap->port.membase + UART010_ICR);  in pl010_modem_status()
209 	status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_modem_status()
211 	delta = status ^ uap->old_status;  in pl010_modem_status()
212 	uap->old_status = status;  in pl010_modem_status()
218 		uart_handle_dcd_change(&uap->port, status & UART01x_FR_DCD);  in pl010_modem_status()
221 		uap->port.icount.dsr++;  in pl010_modem_status()
224 		uart_handle_cts_change(&uap->port, status & UART01x_FR_CTS);  in pl010_modem_status()
226 	wake_up_interruptible(&uap->port.state->port.delta_msr_wait);  in pl010_modem_status()
231 	struct uart_amba_port *uap = dev_id;  in pl010_int()  local
235 	spin_lock(&uap->port.lock);  in pl010_int()
237 	status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
241 				pl010_rx_chars(uap);  in pl010_int()
243 				pl010_modem_status(uap);  in pl010_int()
245 				pl010_tx_chars(uap);  in pl010_int()
250 			status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
256 	spin_unlock(&uap->port.lock);  in pl010_int()
263 	struct uart_amba_port *uap =  in pl010_tx_empty()  local
265 	unsigned int status = readb(uap->port.membase + UART01x_FR);  in pl010_tx_empty()
271 	struct uart_amba_port *uap =  in pl010_get_mctrl()  local
276 	status = readb(uap->port.membase + UART01x_FR);  in pl010_get_mctrl()
289 	struct uart_amba_port *uap =  in pl010_set_mctrl()  local
292 	if (uap->data)  in pl010_set_mctrl()
293 		uap->data->set_mctrl(uap->dev, uap->port.membase, mctrl);  in pl010_set_mctrl()
298 	struct uart_amba_port *uap =  in pl010_break_ctl()  local
303 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_break_ctl()
304 	lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
309 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
310 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_break_ctl()
315 	struct uart_amba_port *uap =  in pl010_startup()  local
322 	retval = clk_prepare_enable(uap->clk);  in pl010_startup()
326 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_startup()
331 	retval = request_irq(uap->port.irq, pl010_int, 0, "uart-pl010", uap);  in pl010_startup()
338 	uap->old_status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_startup()
344 	       uap->port.membase + UART010_CR);  in pl010_startup()
349 	clk_disable_unprepare(uap->clk);  in pl010_startup()
356 	struct uart_amba_port *uap =  in pl010_shutdown()  local
362 	free_irq(uap->port.irq, uap);  in pl010_shutdown()
367 	writel(0, uap->port.membase + UART010_CR);  in pl010_shutdown()
370 	writel(readb(uap->port.membase + UART010_LCRH) &  in pl010_shutdown()
372 	       uap->port.membase + UART010_LCRH);  in pl010_shutdown()
377 	clk_disable_unprepare(uap->clk);  in pl010_shutdown()
384 	struct uart_amba_port *uap =  in pl010_set_termios()  local
393 	baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);   in pl010_set_termios()
417 	if (uap->port.fifosize > 1)  in pl010_set_termios()
420 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_set_termios()
427 	uap->port.read_status_mask = UART01x_RSR_OE;  in pl010_set_termios()
429 		uap->port.read_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
431 		uap->port.read_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
436 	uap->port.ignore_status_mask = 0;  in pl010_set_termios()
438 		uap->port.ignore_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
440 		uap->port.ignore_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
446 			uap->port.ignore_status_mask |= UART01x_RSR_OE;  in pl010_set_termios()
453 		uap->port.ignore_status_mask |= UART_DUMMY_RSR_RX;  in pl010_set_termios()
456 	old_cr = readb(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;  in pl010_set_termios()
461 	writel(0, uap->port.membase + UART010_CR);  in pl010_set_termios()
465 	writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);  in pl010_set_termios()
466 	writel(quot & 0xff, uap->port.membase + UART010_LCRL);  in pl010_set_termios()
473 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_set_termios()
474 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_set_termios()
476 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_set_termios()
570 	struct uart_amba_port *uap =  in pl010_console_putchar()  local
575 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_putchar()
578 	writel(ch, uap->port.membase + UART01x_DR);  in pl010_console_putchar()
584 	struct uart_amba_port *uap = amba_ports[co->index];  in pl010_console_write()  local
587 	clk_enable(uap->clk);  in pl010_console_write()
592 	old_cr = readb(uap->port.membase + UART010_CR);  in pl010_console_write()
593 	writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);  in pl010_console_write()
595 	uart_console_write(&uap->port, s, count, pl010_console_putchar);  in pl010_console_write()
602 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_write()
605 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_console_write()
607 	clk_disable(uap->clk);  in pl010_console_write()
611 pl010_console_get_options(struct uart_amba_port *uap, int *baud,  in pl010_console_get_options()  argument
614 	if (readb(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {  in pl010_console_get_options()
616 		lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_console_get_options()
631 		quot = readb(uap->port.membase + UART010_LCRL) |  in pl010_console_get_options()
632 		       readb(uap->port.membase + UART010_LCRM) << 8;  in pl010_console_get_options()
633 		*baud = uap->port.uartclk / (16 * (quot + 1));  in pl010_console_get_options()
639 	struct uart_amba_port *uap;  in pl010_console_setup()  local
653 	uap = amba_ports[co->index];  in pl010_console_setup()
654 	if (!uap)  in pl010_console_setup()
657 	ret = clk_prepare(uap->clk);  in pl010_console_setup()
661 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_console_setup()
666 		pl010_console_get_options(uap, &baud, &parity, &bits);  in pl010_console_setup()
668 	return uart_set_options(&uap->port, co, baud, parity, bits, flow);  in pl010_console_setup()
700 	struct uart_amba_port *uap;  in pl010_probe()  local
711 	uap = devm_kzalloc(&dev->dev, sizeof(struct uart_amba_port),  in pl010_probe()
713 	if (!uap)  in pl010_probe()
721 	uap->clk = devm_clk_get(&dev->dev, NULL);  in pl010_probe()
722 	if (IS_ERR(uap->clk))  in pl010_probe()
723 		return PTR_ERR(uap->clk);  in pl010_probe()
725 	uap->port.dev = &dev->dev;  in pl010_probe()
726 	uap->port.mapbase = dev->res.start;  in pl010_probe()
727 	uap->port.membase = base;  in pl010_probe()
728 	uap->port.iotype = UPIO_MEM;  in pl010_probe()
729 	uap->port.irq = dev->irq[0];  in pl010_probe()
730 	uap->port.fifosize = 16;  in pl010_probe()
731 	uap->port.ops = &amba_pl010_pops;  in pl010_probe()
732 	uap->port.flags = UPF_BOOT_AUTOCONF;  in pl010_probe()
733 	uap->port.line = i;  in pl010_probe()
734 	uap->dev = dev;  in pl010_probe()
735 	uap->data = dev_get_platdata(&dev->dev);  in pl010_probe()
737 	amba_ports[i] = uap;  in pl010_probe()
739 	amba_set_drvdata(dev, uap);  in pl010_probe()
746 			dev_err(uap->port.dev,  in pl010_probe()
753 	ret = uart_add_one_port(&amba_reg, &uap->port);  in pl010_probe()
762 	struct uart_amba_port *uap = amba_get_drvdata(dev);  in pl010_remove()  local
766 	uart_remove_one_port(&amba_reg, &uap->port);  in pl010_remove()
769 		if (amba_ports[i] == uap)  in pl010_remove()
783 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_suspend()  local
785 	if (uap)  in pl010_suspend()
786 		uart_suspend_port(&amba_reg, &uap->port);  in pl010_suspend()
793 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_resume()  local
795 	if (uap)  in pl010_resume()
796 		uart_resume_port(&amba_reg, &uap->port);  in pl010_resume()