61 	struct uart_amba_port *uap =  in pl010_stop_tx()  local
65 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_tx()
67 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_tx()
72 	struct uart_amba_port *uap =  in pl010_start_tx()  local
76 	cr = readb(uap->port.membase + UART010_CR);  in pl010_start_tx()
78 	writel(cr, uap->port.membase + UART010_CR);  in pl010_start_tx()
83 	struct uart_amba_port *uap =  in pl010_stop_rx()  local
87 	cr = readb(uap->port.membase + UART010_CR);  in pl010_stop_rx()
89 	writel(cr, uap->port.membase + UART010_CR);  in pl010_stop_rx()
94 	struct uart_amba_port *uap = (struct uart_amba_port *)port;  in pl010_disable_ms()  local
97 	cr = readb(uap->port.membase + UART010_CR);  in pl010_disable_ms()
99 	writel(cr, uap->port.membase + UART010_CR);  in pl010_disable_ms()
104 	struct uart_amba_port *uap =  in pl010_enable_ms()  local
108 	cr = readb(uap->port.membase + UART010_CR);  in pl010_enable_ms()
110 	writel(cr, uap->port.membase + UART010_CR);  in pl010_enable_ms()
113 static void pl010_rx_chars(struct uart_amba_port *uap)  in pl010_rx_chars()  argument
117 	status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
119 		ch = readb(uap->port.membase + UART01x_DR);  in pl010_rx_chars()
122 		uap->port.icount.rx++;  in pl010_rx_chars()
128 		rsr = readb(uap->port.membase + UART01x_RSR) | UART_DUMMY_RSR_RX;  in pl010_rx_chars()
130 			writel(0, uap->port.membase + UART01x_ECR);  in pl010_rx_chars()
134 				uap->port.icount.brk++;  in pl010_rx_chars()
135 				if (uart_handle_break(&uap->port))  in pl010_rx_chars()
138 				uap->port.icount.parity++;  in pl010_rx_chars()
140 				uap->port.icount.frame++;  in pl010_rx_chars()
142 				uap->port.icount.overrun++;  in pl010_rx_chars()
144 			rsr &= uap->port.read_status_mask;  in pl010_rx_chars()
154 		if (uart_handle_sysrq_char(&uap->port, ch))  in pl010_rx_chars()
157 		uart_insert_char(&uap->port, rsr, UART01x_RSR_OE, ch, flag);  in pl010_rx_chars()
160 		status = readb(uap->port.membase + UART01x_FR);  in pl010_rx_chars()
162 	spin_unlock(&uap->port.lock);  in pl010_rx_chars()
163 	tty_flip_buffer_push(&uap->port.state->port);  in pl010_rx_chars()
164 	spin_lock(&uap->port.lock);  in pl010_rx_chars()
167 static void pl010_tx_chars(struct uart_amba_port *uap)  in pl010_tx_chars()  argument
169 	struct circ_buf *xmit = &uap->port.state->xmit;  in pl010_tx_chars()
172 	if (uap->port.x_char) {  in pl010_tx_chars()
173 		writel(uap->port.x_char, uap->port.membase + UART01x_DR);  in pl010_tx_chars()
174 		uap->port.icount.tx++;  in pl010_tx_chars()
175 		uap->port.x_char = 0;  in pl010_tx_chars()
178 	if (uart_circ_empty(xmit) || uart_tx_stopped(&uap->port)) {  in pl010_tx_chars()
179 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
183 	count = uap->port.fifosize >> 1;  in pl010_tx_chars()
185 		writel(xmit->buf[xmit->tail], uap->port.membase + UART01x_DR);  in pl010_tx_chars()
187 		uap->port.icount.tx++;  in pl010_tx_chars()
193 		uart_write_wakeup(&uap->port);  in pl010_tx_chars()
196 		pl010_stop_tx(&uap->port);  in pl010_tx_chars()
199 static void pl010_modem_status(struct uart_amba_port *uap)  in pl010_modem_status()  argument
203 	writel(0, uap->port.membase + UART010_ICR);  in pl010_modem_status()
205 	status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_modem_status()
207 	delta = status ^ uap->old_status;  in pl010_modem_status()
208 	uap->old_status = status;  in pl010_modem_status()
214 		uart_handle_dcd_change(&uap->port, status & UART01x_FR_DCD);  in pl010_modem_status()
217 		uap->port.icount.dsr++;  in pl010_modem_status()
220 		uart_handle_cts_change(&uap->port, status & UART01x_FR_CTS);  in pl010_modem_status()
222 	wake_up_interruptible(&uap->port.state->port.delta_msr_wait);  in pl010_modem_status()
227 	struct uart_amba_port *uap = dev_id;  in pl010_int()  local
231 	spin_lock(&uap->port.lock);  in pl010_int()
233 	status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
237 				pl010_rx_chars(uap);  in pl010_int()
239 				pl010_modem_status(uap);  in pl010_int()
241 				pl010_tx_chars(uap);  in pl010_int()
246 			status = readb(uap->port.membase + UART010_IIR);  in pl010_int()
252 	spin_unlock(&uap->port.lock);  in pl010_int()
259 	struct uart_amba_port *uap =  in pl010_tx_empty()  local
261 	unsigned int status = readb(uap->port.membase + UART01x_FR);  in pl010_tx_empty()
267 	struct uart_amba_port *uap =  in pl010_get_mctrl()  local
272 	status = readb(uap->port.membase + UART01x_FR);  in pl010_get_mctrl()
285 	struct uart_amba_port *uap =  in pl010_set_mctrl()  local
288 	if (uap->data)  in pl010_set_mctrl()
289 		uap->data->set_mctrl(uap->dev, uap->port.membase, mctrl);  in pl010_set_mctrl()
294 	struct uart_amba_port *uap =  in pl010_break_ctl()  local
299 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_break_ctl()
300 	lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
305 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_break_ctl()
306 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_break_ctl()
311 	struct uart_amba_port *uap =  in pl010_startup()  local
318 	retval = clk_prepare_enable(uap->clk);  in pl010_startup()
322 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_startup()
327 	retval = request_irq(uap->port.irq, pl010_int, 0, "uart-pl010", uap);  in pl010_startup()
334 	uap->old_status = readb(uap->port.membase + UART01x_FR) & UART01x_FR_MODEM_ANY;  in pl010_startup()
340 	       uap->port.membase + UART010_CR);  in pl010_startup()
345 	clk_disable_unprepare(uap->clk);  in pl010_startup()
352 	struct uart_amba_port *uap =  in pl010_shutdown()  local
358 	free_irq(uap->port.irq, uap);  in pl010_shutdown()
363 	writel(0, uap->port.membase + UART010_CR);  in pl010_shutdown()
366 	writel(readb(uap->port.membase + UART010_LCRH) &  in pl010_shutdown()
368 	       uap->port.membase + UART010_LCRH);  in pl010_shutdown()
373 	clk_disable_unprepare(uap->clk);  in pl010_shutdown()
380 	struct uart_amba_port *uap =  in pl010_set_termios()  local
389 	baud = uart_get_baud_rate(port, termios, old, 0, uap->port.uartclk/16);   in pl010_set_termios()
413 	if (uap->port.fifosize > 1)  in pl010_set_termios()
416 	spin_lock_irqsave(&uap->port.lock, flags);  in pl010_set_termios()
423 	uap->port.read_status_mask = UART01x_RSR_OE;  in pl010_set_termios()
425 		uap->port.read_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
427 		uap->port.read_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
432 	uap->port.ignore_status_mask = 0;  in pl010_set_termios()
434 		uap->port.ignore_status_mask |= UART01x_RSR_FE | UART01x_RSR_PE;  in pl010_set_termios()
436 		uap->port.ignore_status_mask |= UART01x_RSR_BE;  in pl010_set_termios()
442 			uap->port.ignore_status_mask |= UART01x_RSR_OE;  in pl010_set_termios()
449 		uap->port.ignore_status_mask |= UART_DUMMY_RSR_RX;  in pl010_set_termios()
452 	old_cr = readb(uap->port.membase + UART010_CR) & ~UART010_CR_MSIE;  in pl010_set_termios()
457 	writel(0, uap->port.membase + UART010_CR);  in pl010_set_termios()
461 	writel((quot & 0xf00) >> 8, uap->port.membase + UART010_LCRM);  in pl010_set_termios()
462 	writel(quot & 0xff, uap->port.membase + UART010_LCRL);  in pl010_set_termios()
469 	writel(lcr_h, uap->port.membase + UART010_LCRH);  in pl010_set_termios()
470 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_set_termios()
472 	spin_unlock_irqrestore(&uap->port.lock, flags);  in pl010_set_termios()
566 	struct uart_amba_port *uap =  in pl010_console_putchar()  local
571 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_putchar()
574 	writel(ch, uap->port.membase + UART01x_DR);  in pl010_console_putchar()
580 	struct uart_amba_port *uap = amba_ports[co->index];  in pl010_console_write()  local
583 	clk_enable(uap->clk);  in pl010_console_write()
588 	old_cr = readb(uap->port.membase + UART010_CR);  in pl010_console_write()
589 	writel(UART01x_CR_UARTEN, uap->port.membase + UART010_CR);  in pl010_console_write()
591 	uart_console_write(&uap->port, s, count, pl010_console_putchar);  in pl010_console_write()
598 		status = readb(uap->port.membase + UART01x_FR);  in pl010_console_write()
601 	writel(old_cr, uap->port.membase + UART010_CR);  in pl010_console_write()
603 	clk_disable(uap->clk);  in pl010_console_write()
607 pl010_console_get_options(struct uart_amba_port *uap, int *baud,  in pl010_console_get_options()  argument
610 	if (readb(uap->port.membase + UART010_CR) & UART01x_CR_UARTEN) {  in pl010_console_get_options()
612 		lcr_h = readb(uap->port.membase + UART010_LCRH);  in pl010_console_get_options()
627 		quot = readb(uap->port.membase + UART010_LCRL) |  in pl010_console_get_options()
628 		       readb(uap->port.membase + UART010_LCRM) << 8;  in pl010_console_get_options()
629 		*baud = uap->port.uartclk / (16 * (quot + 1));  in pl010_console_get_options()
635 	struct uart_amba_port *uap;  in pl010_console_setup()  local
649 	uap = amba_ports[co->index];  in pl010_console_setup()
650 	if (!uap)  in pl010_console_setup()
653 	ret = clk_prepare(uap->clk);  in pl010_console_setup()
657 	uap->port.uartclk = clk_get_rate(uap->clk);  in pl010_console_setup()
662 		pl010_console_get_options(uap, &baud, &parity, &bits);  in pl010_console_setup()
664 	return uart_set_options(&uap->port, co, baud, parity, bits, flow);  in pl010_console_setup()
696 	struct uart_amba_port *uap;  in pl010_probe()  local
707 	uap = devm_kzalloc(&dev->dev, sizeof(struct uart_amba_port),  in pl010_probe()
709 	if (!uap)  in pl010_probe()
717 	uap->clk = devm_clk_get(&dev->dev, NULL);  in pl010_probe()
718 	if (IS_ERR(uap->clk))  in pl010_probe()
719 		return PTR_ERR(uap->clk);  in pl010_probe()
721 	uap->port.dev = &dev->dev;  in pl010_probe()
722 	uap->port.mapbase = dev->res.start;  in pl010_probe()
723 	uap->port.membase = base;  in pl010_probe()
724 	uap->port.iotype = UPIO_MEM;  in pl010_probe()
725 	uap->port.irq = dev->irq[0];  in pl010_probe()
726 	uap->port.fifosize = 16;  in pl010_probe()
727 	uap->port.has_sysrq = IS_ENABLED(CONFIG_SERIAL_AMBA_PL010_CONSOLE);  in pl010_probe()
728 	uap->port.ops = &amba_pl010_pops;  in pl010_probe()
729 	uap->port.flags = UPF_BOOT_AUTOCONF;  in pl010_probe()
730 	uap->port.line = i;  in pl010_probe()
731 	uap->dev = dev;  in pl010_probe()
732 	uap->data = dev_get_platdata(&dev->dev);  in pl010_probe()
734 	amba_ports[i] = uap;  in pl010_probe()
736 	amba_set_drvdata(dev, uap);  in pl010_probe()
743 			dev_err(uap->port.dev,  in pl010_probe()
750 	ret = uart_add_one_port(&amba_reg, &uap->port);  in pl010_probe()
759 	struct uart_amba_port *uap = amba_get_drvdata(dev);  in pl010_remove()  local
763 	uart_remove_one_port(&amba_reg, &uap->port);  in pl010_remove()
766 		if (amba_ports[i] == uap)  in pl010_remove()
780 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_suspend()  local
782 	if (uap)  in pl010_suspend()
783 		uart_suspend_port(&amba_reg, &uap->port);  in pl010_suspend()
790 	struct uart_amba_port *uap = dev_get_drvdata(dev);  in pl010_resume()  local
792 	if (uap)  in pl010_resume()
793 		uart_resume_port(&amba_reg, &uap->port);  in pl010_resume()