tty/serial/timbuart.c

25 	struct uart_port	port;
35 static void timbuart_mctrl_check(struct uart_port *port, u32 isr, u32 *ier);
39 static void timbuart_stop_rx(struct uart_port *port)
42 	u32 ier = ioread32(port->membase + TIMBUART_IER) & ~RXFLAGS;
43 	iowrite32(ier, port->membase + TIMBUART_IER);
46 static void timbuart_stop_tx(struct uart_port *port)
49 	u32 ier = ioread32(port->membase + TIMBUART_IER) & ~TXBAE;
50 	iowrite32(ier, port->membase + TIMBUART_IER);
53 static void timbuart_start_tx(struct uart_port *port)
56 		container_of(port, struct timbuart_port, port);
62 static unsigned int timbuart_tx_empty(struct uart_port *port)
64 	u32 isr = ioread32(port->membase + TIMBUART_ISR);
69 static void timbuart_flush_buffer(struct uart_port *port)
71 	if (!timbuart_tx_empty(port)) {
72 		u8 ctl = ioread8(port->membase + TIMBUART_CTRL) |
75 		iowrite8(ctl, port->membase + TIMBUART_CTRL);
76 		iowrite32(TXBF, port->membase + TIMBUART_ISR);
80 static void timbuart_rx_chars(struct uart_port *port)
82 	struct tty_port *tport = &port->state->port;
84 	while (ioread32(port->membase + TIMBUART_ISR) & RXDP) {
85 		u8 ch = ioread8(port->membase + TIMBUART_RXFIFO);
86 		port->icount.rx++;
92 	dev_dbg(port->dev, "%s - total read %d bytes\n",
93 		__func__, port->icount.rx);
96 static void timbuart_tx_chars(struct uart_port *port)
98 	struct circ_buf *xmit = &port->state->xmit;
100 	while (!(ioread32(port->membase + TIMBUART_ISR) & TXBF) &&
103 			port->membase + TIMBUART_TXFIFO);
104 		uart_xmit_advance(port, 1);
107 	dev_dbg(port->dev,
110 		port->icount.tx,
111 		ioread8(port->membase + TIMBUART_CTRL),
112 		port->mctrl & TIOCM_RTS,
113 		ioread8(port->membase + TIMBUART_BAUDRATE));
116 static void timbuart_handle_tx_port(struct uart_port *port, u32 isr, u32 *ier)
119 		container_of(port, struct timbuart_port, port);
120 	struct circ_buf *xmit = &port->state->xmit;
122 	if (uart_circ_empty(xmit) || uart_tx_stopped(port))
125 	if (port->x_char)
129 		timbuart_tx_chars(port);
131 		iowrite32(TXFLAGS, port->membase + TIMBUART_ISR);
134 			uart_write_wakeup(port);
147 	dev_dbg(port->dev, "%s - leaving\n", __func__);
150 static void timbuart_handle_rx_port(struct uart_port *port, u32 isr, u32 *ier)
155 			u8 ctl = ioread8(port->membase + TIMBUART_CTRL) |
157 			iowrite8(ctl, port->membase + TIMBUART_CTRL);
158 			port->icount.overrun++;
160 			timbuart_rx_chars(port);
163 		iowrite32(RXFLAGS, port->membase + TIMBUART_ISR);
169 	dev_dbg(port->dev, "%s - leaving\n", __func__);
177 	uart_port_lock(&uart->port);
179 	isr = ioread32(uart->port.membase + TIMBUART_ISR);
180 	dev_dbg(uart->port.dev, "%s ISR: %x\n", __func__, isr);
183 		timbuart_handle_tx_port(&uart->port, isr, &ier);
185 	timbuart_mctrl_check(&uart->port, isr, &ier);
188 		timbuart_handle_rx_port(&uart->port, isr, &ier);
190 	iowrite32(ier, uart->port.membase + TIMBUART_IER);
192 	uart_port_unlock(&uart->port);
193 	dev_dbg(uart->port.dev, "%s leaving\n", __func__);
196 static unsigned int timbuart_get_mctrl(struct uart_port *port)
198 	u8 cts = ioread8(port->membase + TIMBUART_CTRL);
199 	dev_dbg(port->dev, "%s - cts %x\n", __func__, cts);
207 static void timbuart_set_mctrl(struct uart_port *port, unsigned int mctrl)
209 	dev_dbg(port->dev, "%s - %x\n", __func__, mctrl);
212 		iowrite8(TIMBUART_CTRL_RTS, port->membase + TIMBUART_CTRL);
214 		iowrite8(0, port->membase + TIMBUART_CTRL);
217 static void timbuart_mctrl_check(struct uart_port *port, u32 isr, u32 *ier)
223 		iowrite32(CTS_DELTA, port->membase + TIMBUART_ISR);
224 		cts = timbuart_get_mctrl(port);
225 		uart_handle_cts_change(port, cts & TIOCM_CTS);
226 		wake_up_interruptible(&port->state->port.delta_msr_wait);
232 static void timbuart_break_ctl(struct uart_port *port, int ctl)
237 static int timbuart_startup(struct uart_port *port)
240 		container_of(port, struct timbuart_port, port);
242 	dev_dbg(port->dev, "%s\n", __func__);
244 	iowrite8(TIMBUART_CTRL_FLSHRX, port->membase + TIMBUART_CTRL);
245 	iowrite32(0x1ff, port->membase + TIMBUART_ISR);
248 		port->membase + TIMBUART_IER);
250 	return request_irq(port->irq, timbuart_handleinterrupt, IRQF_SHARED,
254 static void timbuart_shutdown(struct uart_port *port)
257 		container_of(port, struct timbuart_port, port);
258 	dev_dbg(port->dev, "%s\n", __func__);
259 	free_irq(port->irq, uart);
260 	iowrite32(0, port->membase + TIMBUART_IER);
262 	timbuart_flush_buffer(port);
276 static void timbuart_set_termios(struct uart_port *port,
284 	baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk / 16);
286 	dev_dbg(port->dev, "%s - bindex %d\n", __func__, bindex);
298 	uart_port_lock_irqsave(port, &flags);
299 	iowrite8((u8)bindex, port->membase + TIMBUART_BAUDRATE);
300 	uart_update_timeout(port, termios->c_cflag, baud);
301 	uart_port_unlock_irqrestore(port, flags);
304 static const char *timbuart_type(struct uart_port *port)
306 	return port->type == PORT_UNKNOWN ? "timbuart" : NULL;
312 static void timbuart_release_port(struct uart_port *port)
314 	struct platform_device *pdev = to_platform_device(port->dev);
318 	if (port->flags & UPF_IOREMAP) {
319 		iounmap(port->membase);
320 		port->membase = NULL;
323 	release_mem_region(port->mapbase, size);
326 static int timbuart_request_port(struct uart_port *port)
328 	struct platform_device *pdev = to_platform_device(port->dev);
332 	if (!request_mem_region(port->mapbase, size, "timb-uart"))
335 	if (port->flags & UPF_IOREMAP) {
336 		port->membase = ioremap(port->mapbase, size);
337 		if (port->membase == NULL) {
338 			release_mem_region(port->mapbase, size);
350 	if (ioread8(uart->port.membase + TIMBUART_IPR)) {
351 		uart->last_ier = ioread32(uart->port.membase + TIMBUART_IER);
354 		iowrite32(0, uart->port.membase + TIMBUART_IER);
365  * Configure/autoconfigure the port.
367 static void timbuart_config_port(struct uart_port *port, int flags)
370 		port->type = PORT_TIMBUART;
371 		timbuart_request_port(port);
375 static int timbuart_verify_port(struct uart_port *port,
378 	/* we don't want the core code to modify any port params */
426 	uart->port.uartclk = 3250000 * 16;
427 	uart->port.fifosize  = TIMBUART_FIFO_SIZE;
428 	uart->port.regshift  = 2;
429 	uart->port.iotype  = UPIO_MEM;
430 	uart->port.ops = &timbuart_ops;
431 	uart->port.irq = 0;
432 	uart->port.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP;
433 	uart->port.line  = 0;
434 	uart->port.dev	= &dev->dev;
441 	uart->port.mapbase = iomem->start;
442 	uart->port.membase = NULL;
449 	uart->port.irq = irq;
457 	err = uart_add_one_port(&timbuart_driver, &uart->port);
481 	uart_remove_one_port(&timbuart_driver, &uart->port);