78 	struct uart_amba_port *uap =  in pl010_stop_tx()  local
82 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_tx()
84 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_tx()
89 	struct uart_amba_port *uap =  in pl010_start_tx()  local
93 	cr = readb(uap->port.membase + UART010_CR);  in pl010_start_tx()
95 	writel(cr, uap->port.membase + UART010_CR);  in pl010_start_tx()
100 	struct uart_amba_port *uap =  in pl010_stop_rx()  local
104 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_rx()
106 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_rx()
111 	struct uart_amba_port *uap = (struct uart_amba_port *)port;  in pl010_disable_ms()  local
114 	cr = readb(uap->port.membase + UART010_CR);  in pl010_disable_ms()
116 	writel(cr, uap->port.membase + UART010_CR);  in pl010_disable_ms()
121 	struct uart_amba_port *uap =  in pl010_enable_ms()  local
125 	cr = readb(uap->port.membase + UART010_CR);  in pl010_enable_ms()
127 	writel(cr, uap->port.membase + UART010_CR);  in pl010_enable_ms()
130 static void pl010_rx_chars(struct uart_amba_port *uap)  in pl010_rx_chars()  argument
134 	status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
136 		ch = readb(uap->port.membase + UART01x_DR);  in pl010_rx_chars()
139 		uap->port.icount.rx++;  in pl010_rx_chars()
145 		rsr = readb(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;  in pl010_rx_chars()
147 			writel(0, uap->port.membase + UART01x_ECR);  in pl010_rx_chars()
151 				uap->port.icount.brk++;  in pl010_rx_chars()
152 				if (uart_handle_break(&uap->port))  in pl010_rx_chars()
155 				uap->port.icount.parity++;  in pl010_rx_chars()
157 				uap->port.icount.frame++;  in pl010_rx_chars()
159 				uap->port.icount.overrun++;  in pl010_rx_chars()
161 			rsr &= uap->port.read_status_mask;  in pl010_rx_chars()
171 		if (uart_handle_sysrq_char(&uap->port, ch))  in pl010_rx_chars()
174 		uart_insert_char(&uap->port, rsr, UART01x_RSR_OE, ch, flag);  in pl010_rx_chars()
177 		status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
179 	spin_unlock(&uap->port.lock);  in pl010_rx_chars()
180 	tty_flip_buffer_push(&uap->port.state->port);  in pl010_rx_chars()
181 	spin_lock(&uap->port.lock);  in pl010_rx_chars()
184 static void pl010_tx_chars(struct uart_amba_port *uap)  in pl010_tx_chars()  argument
186 	struct circ_buf *xmit = &uap->port.state->xmit;  in pl010_tx_chars()
189 	if (uap->port.x_char) {  in pl010_tx_chars()
190 		writel(uap->port.x_char, uap->port.membase + UART01x_DR);  in pl010_tx_chars()
191 		uap->port.icount.tx++;  in pl010_tx_chars()
192 		uap->port.x_char = 0;  in pl010_tx_chars()
195 	if (uart_circ_empty(xmit) || uart_tx_stopped(&uap->port)) {  in pl010_tx_chars()
196 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
200 	count = uap->port.fifosize >> 1;  in pl010_tx_chars()
202 		writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);  in pl010_tx_chars()
204 		uap->port.icount.tx++;  in pl010_tx_chars()
210 		uart_write_wakeup(&uap->port);  in pl010_tx_chars()
213 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
216 static void pl010_modem_status(struct uart_amba_port *uap)  in pl010_modem_status()  argument
220 	writel(0, uap->port.membase + UART010_ICR);  in pl010_modem_status()
222 	status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_modem_status()
224 	delta = status ^ uap->old_status;  in pl010_modem_status()
225 	uap->old_status = status;  in pl010_modem_status()
231 		uart_handle_dcd_change(&uap->port, status & UART01x_FR_DCD);  in pl010_modem_status()
234 		uap->port.icount.dsr++;  in pl010_modem_status()
237 		uart_handle_cts_change(&uap->port, status & UART01x_FR_CTS);  in pl010_modem_status()
239 	wake_up_interruptible(&uap->port.state->port.delta_msr_wait);  in pl010_modem_status()
244 	struct uart_amba_port *uap = dev_id;  in pl010_int()  local
248 	spin_lock(&uap->port.lock);  in pl010_int()
250 	status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
254 				pl010_rx_chars(uap);  in pl010_int()
256 				pl010_modem_status(uap);  in pl010_int()
258 				pl010_tx_chars(uap);  in pl010_int()
263 			status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
269 	spin_unlock(&uap->port.lock);  in pl010_int()
276 	struct uart_amba_port *uap =  in pl010_tx_empty()  local
278 	unsigned int status = readb(uap->port.membase + UART01x_FR);  in pl010_tx_empty()
284 	struct uart_amba_port *uap =  in pl010_get_mctrl()  local
289 	status = readb(uap->port.membase + UART01x_FR);  in pl010_get_mctrl()
302 	struct uart_amba_port *uap =  in pl010_set_mctrl()  local
305 	if (uap->data)  in pl010_set_mctrl()
306 		uap->data->set_mctrl(uap->dev, uap->port.membase, mctrl);  in pl010_set_mctrl()
311 	struct uart_amba_port *uap =  in pl010_break_ctl()  local
316 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_break_ctl()
317 	lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
322 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
323 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_break_ctl()
328 	struct uart_amba_port *uap =  in pl010_startup()  local
335 	retval = clk_prepare_enable(uap->clk);  in pl010_startup()
339 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_startup()
344 	retval = request_irq(uap->port.irq, pl010_int, 0, "uart-pl010", uap);  in pl010_startup()
351 	uap->old_status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_startup()
357 	       uap->port.membase + UART010_CR);  in pl010_startup()
362 	clk_disable_unprepare(uap->clk);  in pl010_startup()
369 	struct uart_amba_port *uap =  in pl010_shutdown()  local
375 	free_irq(uap->port.irq, uap);  in pl010_shutdown()
380 	writel(0, uap->port.membase + UART010_CR);  in pl010_shutdown()
383 	writel(readb(uap->port.membase + UART010_LCRH) &  in pl010_shutdown()
385 	       uap->port.membase + UART010_LCRH);  in pl010_shutdown()
390 	clk_disable_unprepare(uap->clk);  in pl010_shutdown()
397 	struct uart_amba_port *uap =  in pl010_set_termios()  local
406 	baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);   in pl010_set_termios()
430 	if (uap->port.fifosize > 1)  in pl010_set_termios()
433 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_set_termios()
440 	uap->port.read_status_mask = UART01x_RSR_OE;  in pl010_set_termios()
442 		uap->port.read_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
444 		uap->port.read_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
449 	uap->port.ignore_status_mask = 0;  in pl010_set_termios()
451 		uap->port.ignore_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
453 		uap->port.ignore_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
459 			uap->port.ignore_status_mask |= UART01x_RSR_OE;  in pl010_set_termios()
466 		uap->port.ignore_status_mask |= UART_DUMMY_RSR_RX;  in pl010_set_termios()
469 	old_cr = readb(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;  in pl010_set_termios()
474 	writel(0, uap->port.membase + UART010_CR);  in pl010_set_termios()
478 	writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);  in pl010_set_termios()
479 	writel(quot & 0xff, uap->port.membase + UART010_LCRL);  in pl010_set_termios()
486 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_set_termios()
487 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_set_termios()
489 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_set_termios()
583 	struct uart_amba_port *uap =  in pl010_console_putchar()  local
588 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_putchar()
591 	writel(ch, uap->port.membase + UART01x_DR);  in pl010_console_putchar()
597 	struct uart_amba_port *uap = amba_ports[co->index];  in pl010_console_write()  local
600 	clk_enable(uap->clk);  in pl010_console_write()
605 	old_cr = readb(uap->port.membase + UART010_CR);  in pl010_console_write()
606 	writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);  in pl010_console_write()
608 	uart_console_write(&uap->port, s, count, pl010_console_putchar);  in pl010_console_write()
615 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_write()
618 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_console_write()
620 	clk_disable(uap->clk);  in pl010_console_write()
624 pl010_console_get_options(struct uart_amba_port *uap, int *baud,  in pl010_console_get_options()  argument
627 	if (readb(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {  in pl010_console_get_options()
629 		lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_console_get_options()
644 		quot = readb(uap->port.membase + UART010_LCRL) |  in pl010_console_get_options()
645 		       readb(uap->port.membase + UART010_LCRM) << 8;  in pl010_console_get_options()
646 		*baud = uap->port.uartclk / (16 * (quot + 1));  in pl010_console_get_options()
652 	struct uart_amba_port *uap;  in pl010_console_setup()  local
666 	uap = amba_ports[co->index];  in pl010_console_setup()
667 	if (!uap)  in pl010_console_setup()
670 	ret = clk_prepare(uap->clk);  in pl010_console_setup()
674 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_console_setup()
679 		pl010_console_get_options(uap, &baud, &parity, &bits);  in pl010_console_setup()
681 	return uart_set_options(&uap->port, co, baud, parity, bits, flow);  in pl010_console_setup()
712 	struct uart_amba_port *uap;  in pl010_probe()  local
723 	uap = devm_kzalloc(&dev->dev, sizeof(struct uart_amba_port),  in pl010_probe()
725 	if (!uap)  in pl010_probe()
733 	uap->clk = devm_clk_get(&dev->dev, NULL);  in pl010_probe()
734 	if (IS_ERR(uap->clk))  in pl010_probe()
735 		return PTR_ERR(uap->clk);  in pl010_probe()
737 	uap->port.dev = &dev->dev;  in pl010_probe()
738 	uap->port.mapbase = dev->res.start;  in pl010_probe()
739 	uap->port.membase = base;  in pl010_probe()
740 	uap->port.iotype = UPIO_MEM;  in pl010_probe()
741 	uap->port.irq = dev->irq[0];  in pl010_probe()
742 	uap->port.fifosize = 16;  in pl010_probe()
743 	uap->port.ops = &amba_pl010_pops;  in pl010_probe()
744 	uap->port.flags = UPF_BOOT_AUTOCONF;  in pl010_probe()
745 	uap->port.line = i;  in pl010_probe()
746 	uap->dev = dev;  in pl010_probe()
747 	uap->data = dev_get_platdata(&dev->dev);  in pl010_probe()
749 	amba_ports[i] = uap;  in pl010_probe()
751 	amba_set_drvdata(dev, uap);  in pl010_probe()
752 	ret = uart_add_one_port(&amba_reg, &uap->port);  in pl010_probe()
761 	struct uart_amba_port *uap = amba_get_drvdata(dev);  in pl010_remove()  local
764 	uart_remove_one_port(&amba_reg, &uap->port);  in pl010_remove()
767 		if (amba_ports[i] == uap)  in pl010_remove()
776 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_suspend()  local
778 	if (uap)  in pl010_suspend()
779 		uart_suspend_port(&amba_reg, &uap->port);  in pl010_suspend()
786 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_resume()  local
788 	if (uap)  in pl010_resume()
789 		uart_resume_port(&amba_reg, &uap->port);  in pl010_resume()