tty: serial: fsl_lpuart: Introduce lpuart_tx_dma_startup()
Code configure DMA TX path in lpuart_startup(), lpuart32_startup() and lpuart_resume() is doing exactly the same thing, so move it into a standalone subroutine. Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com> Cc: Stefan Agner <stefan@agner.ch> Cc: Chris Healy <cphealy@gmail.com> Cc: Cory Tusar <cory.tusar@zii.aero> Cc: Lucas Stach <l.stach@pengutronix.de> Cc: Greg Kroah-Hartman <gregkh@linuxfoundation.org> Cc: Jiri Slaby <jslaby@suse.com> Cc: linux-imx@nxp.com Cc: linux-serial@vger.kernel.org Cc: linux-kernel@vger.kernel.org Link: https://lore.kernel.org/r/20190805185701.22863-2-andrew.smirnov@gmail.com Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
3f72879e00
commit
5982199ca0
|
@ -1435,6 +1435,26 @@ static void rx_dma_timer_init(struct lpuart_port *sport)
|
|||
add_timer(&sport->lpuart_timer);
|
||||
}
|
||||
|
||||
static void lpuart_tx_dma_startup(struct lpuart_port *sport)
|
||||
{
|
||||
u32 uartbaud;
|
||||
|
||||
if (sport->dma_tx_chan && !lpuart_dma_tx_request(&sport->port)) {
|
||||
init_waitqueue_head(&sport->dma_wait);
|
||||
sport->lpuart_dma_tx_use = true;
|
||||
if (lpuart_is_32(sport)) {
|
||||
uartbaud = lpuart32_read(&sport->port, UARTBAUD);
|
||||
lpuart32_write(&sport->port,
|
||||
uartbaud | UARTBAUD_TDMAE, UARTBAUD);
|
||||
} else {
|
||||
writeb(readb(sport->port.membase + UARTCR5) |
|
||||
UARTCR5_TDMAS, sport->port.membase + UARTCR5);
|
||||
}
|
||||
} else {
|
||||
sport->lpuart_dma_tx_use = false;
|
||||
}
|
||||
}
|
||||
|
||||
static int lpuart_startup(struct uart_port *port)
|
||||
{
|
||||
struct lpuart_port *sport = container_of(port, struct lpuart_port, port);
|
||||
|
@ -1471,14 +1491,7 @@ static int lpuart_startup(struct uart_port *port)
|
|||
sport->lpuart_dma_rx_use = false;
|
||||
}
|
||||
|
||||
if (sport->dma_tx_chan && !lpuart_dma_tx_request(port)) {
|
||||
init_waitqueue_head(&sport->dma_wait);
|
||||
sport->lpuart_dma_tx_use = true;
|
||||
temp = readb(port->membase + UARTCR5);
|
||||
writeb(temp | UARTCR5_TDMAS, port->membase + UARTCR5);
|
||||
} else {
|
||||
sport->lpuart_dma_tx_use = false;
|
||||
}
|
||||
lpuart_tx_dma_startup(sport);
|
||||
|
||||
spin_unlock_irqrestore(&sport->port.lock, flags);
|
||||
|
||||
|
@ -1521,14 +1534,7 @@ static int lpuart32_startup(struct uart_port *port)
|
|||
sport->lpuart_dma_rx_use = false;
|
||||
}
|
||||
|
||||
if (sport->dma_tx_chan && !lpuart_dma_tx_request(port)) {
|
||||
init_waitqueue_head(&sport->dma_wait);
|
||||
sport->lpuart_dma_tx_use = true;
|
||||
temp = lpuart32_read(&sport->port, UARTBAUD);
|
||||
lpuart32_write(&sport->port, temp | UARTBAUD_TDMAE, UARTBAUD);
|
||||
} else {
|
||||
sport->lpuart_dma_tx_use = false;
|
||||
}
|
||||
lpuart_tx_dma_startup(sport);
|
||||
|
||||
if (sport->lpuart_dma_rx_use) {
|
||||
/* RXWATER must be 0 */
|
||||
|
@ -2577,20 +2583,7 @@ static int lpuart_resume(struct device *dev)
|
|||
}
|
||||
}
|
||||
|
||||
if (sport->dma_tx_chan && !lpuart_dma_tx_request(&sport->port)) {
|
||||
init_waitqueue_head(&sport->dma_wait);
|
||||
sport->lpuart_dma_tx_use = true;
|
||||
if (lpuart_is_32(sport)) {
|
||||
temp = lpuart32_read(&sport->port, UARTBAUD);
|
||||
lpuart32_write(&sport->port,
|
||||
temp | UARTBAUD_TDMAE, UARTBAUD);
|
||||
} else {
|
||||
writeb(readb(sport->port.membase + UARTCR5) |
|
||||
UARTCR5_TDMAS, sport->port.membase + UARTCR5);
|
||||
}
|
||||
} else {
|
||||
sport->lpuart_dma_tx_use = false;
|
||||
}
|
||||
lpuart_tx_dma_startup(sport);
|
||||
|
||||
if (lpuart_is_32(sport)) {
|
||||
if (sport->lpuart_dma_rx_use) {
|
||||
|
|
Loading…
Reference in New Issue