[PATCH 20/24] tty: serial: fsl_lpuart: Introduce lpuart_rx_dma_startup()

[Andrey Smirnov]

Code doing initial DMA RX configuration in lpuart_startup() and
lpuart32_startup() is exactly the same, so move it into a standalone
subroutine.

Signed-off-by: Andrey Smirnov <andrew.smir...@gmail.com>
Cc: Stefan Agner <ste...@agner.ch>
Cc: Bhuvanchandra DV <bhuvanchandra...@toradex.com>
Cc: Chris Healy <cphe...@gmail.com>
Cc: Cory Tusar <cory.tu...@zii.aero>
Cc: Lucas Stach <l.st...@pengutronix.de>
Cc: Greg Kroah-Hartman <gre...@linuxfoundation.org>
Cc: Jiri Slaby <jsl...@suse.com>
Cc: linux-...@nxp.com
Cc: linux-ser...@vger.kernel.org
Cc: linux-kernel@vger.kernel.org
---
 drivers/tty/serial/fsl_lpuart.c | 41 ++++++++++++++-------------------
 1 file changed, 17 insertions(+), 24 deletions(-)

diff --git a/drivers/tty/serial/fsl_lpuart.c b/drivers/tty/serial/fsl_lpuart.c
index 558acf29cbed..bda01d23cea8 100644
--- a/drivers/tty/serial/fsl_lpuart.c
+++ b/drivers/tty/serial/fsl_lpuart.c
@@ -1454,6 +1454,21 @@ static void lpuart_tx_dma_startup(struct lpuart_port 
*sport)
        }
 }
 
+static void lpuart_rx_dma_startup(struct lpuart_port *sport)
+{
+       if (sport->dma_rx_chan && !lpuart_start_rx_dma(sport)) {
+               /* set Rx DMA timeout */
+               sport->dma_rx_timeout = msecs_to_jiffies(DMA_RX_TIMEOUT);
+               if (!sport->dma_rx_timeout)
+                       sport->dma_rx_timeout = 1;
+
+               sport->lpuart_dma_rx_use = true;
+               rx_dma_timer_init(sport);
+       } else {
+               sport->lpuart_dma_rx_use = false;
+       }
+}
+
 static int lpuart_startup(struct uart_port *port)
 {
        struct lpuart_port *sport = container_of(port, struct lpuart_port, 
port);
@@ -1479,18 +1494,7 @@ static int lpuart_startup(struct uart_port *port)
        temp |= UARTCR2_RIE | UARTCR2_TIE | UARTCR2_RE | UARTCR2_TE;
        writeb(temp, sport->port.membase + UARTCR2);
 
-       if (sport->dma_rx_chan && !lpuart_start_rx_dma(sport)) {
-               /* set Rx DMA timeout */
-               sport->dma_rx_timeout = msecs_to_jiffies(DMA_RX_TIMEOUT);
-               if (!sport->dma_rx_timeout)
-                    sport->dma_rx_timeout = 1;
-
-               sport->lpuart_dma_rx_use = true;
-               rx_dma_timer_init(sport);
-       } else {
-               sport->lpuart_dma_rx_use = false;
-       }
-
+       lpuart_rx_dma_startup(sport);
        lpuart_tx_dma_startup(port);
 
        spin_unlock_irqrestore(&sport->port.lock, flags);
@@ -1523,18 +1527,7 @@ static int lpuart32_startup(struct uart_port *port)
        temp |= UARTCTRL_RE | UARTCTRL_TE | UARTCTRL_ILIE;
        lpuart32_write(&sport->port, temp, UARTCTRL);
 
-       if (sport->dma_rx_chan && !lpuart_start_rx_dma(sport)) {
-               /* set Rx DMA timeout */
-               sport->dma_rx_timeout = msecs_to_jiffies(DMA_RX_TIMEOUT);
-               if (!sport->dma_rx_timeout)
-                       sport->dma_rx_timeout = 1;
-
-               sport->lpuart_dma_rx_use = true;
-               rx_dma_timer_init(sport);
-       } else {
-               sport->lpuart_dma_rx_use = false;
-       }
-
+       lpuart_rx_dma_startup(sport);
        lpuart_tx_dma_startup(port);
 
        if (sport->lpuart_dma_rx_use) {
-- 
2.21.0