69 static void mlb_usio_stop_tx(struct uart_port *port)  in mlb_usio_stop_tx()  argument
71 	writew(readw(port->membase + MLB_USIO_REG_FCR) & ~MLB_USIO_FCR_FTIE,  in mlb_usio_stop_tx()
72 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_stop_tx()
73 	writeb(readb(port->membase + MLB_USIO_REG_SCR) & ~MLB_USIO_SCR_TBIE,  in mlb_usio_stop_tx()
74 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_stop_tx()
77 static void mlb_usio_tx_chars(struct uart_port *port)  in mlb_usio_tx_chars()  argument
79 	struct circ_buf *xmit = &port->state->xmit;  in mlb_usio_tx_chars()
82 	writew(readw(port->membase + MLB_USIO_REG_FCR) & ~MLB_USIO_FCR_FTIE,  in mlb_usio_tx_chars()
83 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_tx_chars()
84 	writeb(readb(port->membase + MLB_USIO_REG_SCR) &  in mlb_usio_tx_chars()
86 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_tx_chars()
88 	if (port->x_char) {  in mlb_usio_tx_chars()
89 		writew(port->x_char, port->membase + MLB_USIO_REG_DR);  in mlb_usio_tx_chars()
90 		port->icount.tx++;  in mlb_usio_tx_chars()
91 		port->x_char = 0;  in mlb_usio_tx_chars()
94 	if (uart_circ_empty(xmit) || uart_tx_stopped(port)) {  in mlb_usio_tx_chars()
95 		mlb_usio_stop_tx(port);  in mlb_usio_tx_chars()
99 	count = port->fifosize -  in mlb_usio_tx_chars()
100 		(readw(port->membase + MLB_USIO_REG_FBYTE) & 0xff);  in mlb_usio_tx_chars()
103 		writew(xmit->buf[xmit->tail], port->membase + MLB_USIO_REG_DR);  in mlb_usio_tx_chars()
106 		port->icount.tx++;  in mlb_usio_tx_chars()
112 	writew(readw(port->membase + MLB_USIO_REG_FCR) & ~MLB_USIO_FCR_FDRQ,  in mlb_usio_tx_chars()
113 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_tx_chars()
115 	writeb(readb(port->membase + MLB_USIO_REG_SCR) | MLB_USIO_SCR_TBIE,  in mlb_usio_tx_chars()
116 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_tx_chars()
119 		uart_write_wakeup(port);  in mlb_usio_tx_chars()
122 		mlb_usio_stop_tx(port);  in mlb_usio_tx_chars()
125 static void mlb_usio_start_tx(struct uart_port *port)  in mlb_usio_start_tx()  argument
127 	u16 fcr = readw(port->membase + MLB_USIO_REG_FCR);  in mlb_usio_start_tx()
129 	writew(fcr | MLB_USIO_FCR_FTIE, port->membase + MLB_USIO_REG_FCR);  in mlb_usio_start_tx()
133 	writeb(readb(port->membase + MLB_USIO_REG_SCR) | MLB_USIO_SCR_TBIE,  in mlb_usio_start_tx()
134 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_start_tx()
136 	if (readb(port->membase + MLB_USIO_REG_SSR) & MLB_USIO_SSR_TBI)  in mlb_usio_start_tx()
137 		mlb_usio_tx_chars(port);  in mlb_usio_start_tx()
140 static void mlb_usio_stop_rx(struct uart_port *port)  in mlb_usio_stop_rx()  argument
142 	writeb(readb(port->membase + MLB_USIO_REG_SCR) & ~MLB_USIO_SCR_RIE,  in mlb_usio_stop_rx()
143 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_stop_rx()
146 static void mlb_usio_enable_ms(struct uart_port *port)  in mlb_usio_enable_ms()  argument
148 	writeb(readb(port->membase + MLB_USIO_REG_SCR) |  in mlb_usio_enable_ms()
150 	       port->membase + MLB_USIO_REG_SCR);  in mlb_usio_enable_ms()
153 static void mlb_usio_rx_chars(struct uart_port *port)  in mlb_usio_rx_chars()  argument
155 	struct tty_port *ttyport = &port->state->port;  in mlb_usio_rx_chars()
162 		status = readb(port->membase + MLB_USIO_REG_SSR);  in mlb_usio_rx_chars()
169 			ch = readw(port->membase + MLB_USIO_REG_DR);  in mlb_usio_rx_chars()
171 			port->icount.rx++;  in mlb_usio_rx_chars()
172 			if (uart_handle_sysrq_char(port, ch))  in mlb_usio_rx_chars()
174 			uart_insert_char(port, status, MLB_USIO_SSR_ORE,  in mlb_usio_rx_chars()
179 			port->icount.parity++;  in mlb_usio_rx_chars()
181 			port->icount.overrun++;  in mlb_usio_rx_chars()
182 		status &= port->read_status_mask;  in mlb_usio_rx_chars()
196 			uart_insert_char(port, status, MLB_USIO_SSR_ORE,  in mlb_usio_rx_chars()
199 		writeb(readb(port->membase + MLB_USIO_REG_SSR) |  in mlb_usio_rx_chars()
201 				port->membase + MLB_USIO_REG_SSR);  in mlb_usio_rx_chars()
203 		max_count = readw(port->membase + MLB_USIO_REG_FBYTE) >> 8;  in mlb_usio_rx_chars()
204 		writew(readw(port->membase + MLB_USIO_REG_FCR) |  in mlb_usio_rx_chars()
206 		port->membase + MLB_USIO_REG_FCR);  in mlb_usio_rx_chars()
214 	struct uart_port *port = dev_id;  in mlb_usio_rx_irq()  local
216 	spin_lock(&port->lock);  in mlb_usio_rx_irq()
217 	mlb_usio_rx_chars(port);  in mlb_usio_rx_irq()
218 	spin_unlock(&port->lock);  in mlb_usio_rx_irq()
225 	struct uart_port *port = dev_id;  in mlb_usio_tx_irq()  local
227 	spin_lock(&port->lock);  in mlb_usio_tx_irq()
228 	if (readb(port->membase + MLB_USIO_REG_SSR) & MLB_USIO_SSR_TBI)  in mlb_usio_tx_irq()
229 		mlb_usio_tx_chars(port);  in mlb_usio_tx_irq()
230 	spin_unlock(&port->lock);  in mlb_usio_tx_irq()
235 static unsigned int mlb_usio_tx_empty(struct uart_port *port)  in mlb_usio_tx_empty()  argument
237 	return (readb(port->membase + MLB_USIO_REG_SSR) & MLB_USIO_SSR_TBI) ?  in mlb_usio_tx_empty()
241 static void mlb_usio_set_mctrl(struct uart_port *port, unsigned int mctrl)  in mlb_usio_set_mctrl()  argument
245 static unsigned int mlb_usio_get_mctrl(struct uart_port *port)  in mlb_usio_get_mctrl()  argument
251 static void mlb_usio_break_ctl(struct uart_port *port, int break_state)  in mlb_usio_break_ctl()  argument
255 static int mlb_usio_startup(struct uart_port *port)  in mlb_usio_startup()  argument
257 	const char *portname = to_platform_device(port->dev)->name;  in mlb_usio_startup()
259 	int ret, index = port->line;  in mlb_usio_startup()
263 				0, portname, port);  in mlb_usio_startup()
267 				0, portname, port);  in mlb_usio_startup()
269 		free_irq(mlb_usio_irq[index][RX], port);  in mlb_usio_startup()
273 	escr = readb(port->membase + MLB_USIO_REG_ESCR);  in mlb_usio_startup()
274 	if (of_property_read_bool(port->dev->of_node, "auto-flow-control"))  in mlb_usio_startup()
276 	spin_lock_irqsave(&port->lock, flags);  in mlb_usio_startup()
277 	writeb(0, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_startup()
278 	writeb(escr, port->membase + MLB_USIO_REG_ESCR);  in mlb_usio_startup()
279 	writeb(MLB_USIO_SCR_UPCL, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_startup()
280 	writeb(MLB_USIO_SSR_REC, port->membase + MLB_USIO_REG_SSR);  in mlb_usio_startup()
281 	writew(0, port->membase + MLB_USIO_REG_FCR);  in mlb_usio_startup()
283 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_startup()
285 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_startup()
286 	writew(0, port->membase + MLB_USIO_REG_FBYTE);  in mlb_usio_startup()
287 	writew(BIT(12), port->membase + MLB_USIO_REG_FBYTE);  in mlb_usio_startup()
290 	       MLB_USIO_SCR_RXE, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_startup()
291 	spin_unlock_irqrestore(&port->lock, flags);  in mlb_usio_startup()
296 static void mlb_usio_shutdown(struct uart_port *port)  in mlb_usio_shutdown()  argument
298 	int index = port->line;  in mlb_usio_shutdown()
300 	free_irq(mlb_usio_irq[index][RX], port);  in mlb_usio_shutdown()
301 	free_irq(mlb_usio_irq[index][TX], port);  in mlb_usio_shutdown()
304 static void mlb_usio_set_termios(struct uart_port *port,  in mlb_usio_set_termios()  argument
335 	if (of_property_read_bool(port->dev->of_node, "auto-flow-control") ||  in mlb_usio_set_termios()
339 	baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk);  in mlb_usio_set_termios()
341 		quot = port->uartclk / baud - 1;  in mlb_usio_set_termios()
345 	spin_lock_irqsave(&port->lock, flags);  in mlb_usio_set_termios()
346 	uart_update_timeout(port, termios->c_cflag, baud);  in mlb_usio_set_termios()
347 	port->read_status_mask = MLB_USIO_SSR_ORE | MLB_USIO_SSR_RDRF |  in mlb_usio_set_termios()
350 		port->read_status_mask |= MLB_USIO_SSR_FRE | MLB_USIO_SSR_PE;  in mlb_usio_set_termios()
352 	port->ignore_status_mask = 0;  in mlb_usio_set_termios()
354 		port->ignore_status_mask |= MLB_USIO_SSR_FRE | MLB_USIO_SSR_PE;  in mlb_usio_set_termios()
356 		port->ignore_status_mask |= MLB_USIO_SSR_ORE;  in mlb_usio_set_termios()
358 		port->ignore_status_mask |= MLB_USIO_SSR_RDRF;  in mlb_usio_set_termios()
360 	writeb(0, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_set_termios()
361 	writeb(MLB_USIO_SCR_UPCL, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_set_termios()
362 	writeb(MLB_USIO_SSR_REC, port->membase + MLB_USIO_REG_SSR);  in mlb_usio_set_termios()
363 	writew(0, port->membase + MLB_USIO_REG_FCR);  in mlb_usio_set_termios()
364 	writeb(smr, port->membase + MLB_USIO_REG_SMR);  in mlb_usio_set_termios()
365 	writeb(escr, port->membase + MLB_USIO_REG_ESCR);  in mlb_usio_set_termios()
366 	writew(quot, port->membase + MLB_USIO_REG_BGR);  in mlb_usio_set_termios()
367 	writew(0, port->membase + MLB_USIO_REG_FCR);  in mlb_usio_set_termios()
370 	       port->membase + MLB_USIO_REG_FCR);  in mlb_usio_set_termios()
371 	writew(0, port->membase + MLB_USIO_REG_FBYTE);  in mlb_usio_set_termios()
372 	writew(BIT(12), port->membase + MLB_USIO_REG_FBYTE);  in mlb_usio_set_termios()
374 	       MLB_USIO_SCR_TXE, port->membase + MLB_USIO_REG_SCR);  in mlb_usio_set_termios()
375 	spin_unlock_irqrestore(&port->lock, flags);  in mlb_usio_set_termios()
378 static const char *mlb_usio_type(struct uart_port *port)  in mlb_usio_type()  argument
380 	return ((port->type == PORT_MLB_USIO) ? USIO_NAME : NULL);  in mlb_usio_type()
383 static void mlb_usio_config_port(struct uart_port *port, int flags)  in mlb_usio_config_port()  argument
386 		port->type = PORT_MLB_USIO;  in mlb_usio_config_port()
407 static void mlb_usio_console_putchar(struct uart_port *port, int c)  in mlb_usio_console_putchar()  argument
409 	while (!(readb(port->membase + MLB_USIO_REG_SSR) & MLB_USIO_SSR_TDRE))  in mlb_usio_console_putchar()
412 	writew(c, port->membase + MLB_USIO_REG_DR);  in mlb_usio_console_putchar()
418 	struct uart_port *port = &mlb_usio_ports[co->index];  in mlb_usio_console_write()  local
420 	uart_console_write(port, s, count, mlb_usio_console_putchar);  in mlb_usio_console_write()
425 	struct uart_port *port;  in mlb_usio_console_setup()  local
434 	port = &mlb_usio_ports[co->index];  in mlb_usio_console_setup()
435 	if (!port->membase)  in mlb_usio_console_setup()
442 	if (of_property_read_bool(port->dev->of_node, "auto-flow-control"))  in mlb_usio_console_setup()
445 	return uart_set_options(port, co, baud, parity, bits, flow);  in mlb_usio_console_setup()
473 	uart_console_write(&dev->port, s, count, mlb_usio_console_putchar);  in mlb_usio_early_console_write()
479 	if (!device->port.membase)  in mlb_usio_early_console_setup()
504 	struct uart_port *port;  in mlb_usio_probe()  local
519 	port = &mlb_usio_ports[index];  in mlb_usio_probe()
521 	port->private_data = (void *)clk;  in mlb_usio_probe()
528 	port->membase = devm_ioremap(&pdev->dev, res->start,  in mlb_usio_probe()
537 	port->irq = mlb_usio_irq[index][RX];  in mlb_usio_probe()
538 	port->uartclk = clk_get_rate(clk);  in mlb_usio_probe()
539 	port->fifosize = 128;  in mlb_usio_probe()
540 	port->iotype = UPIO_MEM32;  in mlb_usio_probe()
541 	port->flags = UPF_BOOT_AUTOCONF | UPF_SPD_VHI;  in mlb_usio_probe()
542 	port->line = index;  in mlb_usio_probe()
543 	port->ops = &mlb_usio_ops;  in mlb_usio_probe()
544 	port->dev = &pdev->dev;  in mlb_usio_probe()
546 	ret = uart_add_one_port(&mlb_usio_uart_driver, port);  in mlb_usio_probe()
548 		dev_err(&pdev->dev, "Adding port failed: %d\n", ret);  in mlb_usio_probe()
561 	struct uart_port *port = &mlb_usio_ports[pdev->id];  in mlb_usio_remove()  local
562 	struct clk *clk = port->private_data;  in mlb_usio_remove()
564 	uart_remove_one_port(&mlb_usio_uart_driver, port);  in mlb_usio_remove()