tty: serial: lpuart: add little endian 32 bit register support
authorDong Aisheng <aisheng.dong@nxp.com>
Tue, 13 Jun 2017 02:55:50 +0000 (10:55 +0800)
committerGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Thu, 29 Jun 2017 15:12:33 +0000 (17:12 +0200)
Use standard port->iotype to distinguish endian difference. Note as we
read/write register by checking iotype dynamically, we need to initialize
the iotype correctly for earlycon as well to avoid a break.

Cc: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
Cc: Jiri Slaby <jslaby@suse.com> (supporter:TTY LAYER)
Cc: Stefan Agner <stefan@agner.ch>
Cc: Mingkai Hu <Mingkai.Hu@nxp.com>
Cc: Yangbo Lu <yangbo.lu@nxp.com>
Cc: Fugang Duan <fugang.duan@nxp.com>
Cc: Andy Shevchenko <andy.shevchenko@gmail.com>
Cc: Nikita Yushchenko <nikita.yoush@cogentembedded.com>
Signed-off-by: Dong Aisheng <aisheng.dong@nxp.com>
ChangeLog:
v3->v4:
 * Removed unneeded semicolon catched by 0day Robot.
v2->v3:
 * Instead of using global var, use standard port->iotype to distinguish
   endian difference.
v1->v2:
 * No changes
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
drivers/tty/serial/fsl_lpuart.c

index 32d479b04197c848396b39499a931dfc4d634d44..ed0bf180ceb43b4996f51f40c009c19cedbe5abe 100644 (file)
@@ -279,15 +279,29 @@ MODULE_DEVICE_TABLE(of, lpuart_dt_ids);
 /* Forward declare this for the dma callbacks*/
 static void lpuart_dma_tx_complete(void *arg);
 
-static inline u32 lpuart32_read(struct uart_port *port, u32 reg_off)
-{
-       return ioread32be(port->membase + reg_off);
+static inline u32 lpuart32_read(struct uart_port *port, u32 off)
+{
+       switch (port->iotype) {
+       case UPIO_MEM32:
+               return readl(port->membase + off);
+       case UPIO_MEM32BE:
+               return ioread32be(port->membase + off);
+       default:
+               return 0;
+       }
 }
 
 static inline void lpuart32_write(struct uart_port *port, u32 val,
-                                 u32 reg_off)
-{
-       iowrite32be(val, port->membase + reg_off);
+                                 u32 off)
+{
+       switch (port->iotype) {
+       case UPIO_MEM32:
+               writel(val, port->membase + off);
+               break;
+       case UPIO_MEM32BE:
+               iowrite32be(val, port->membase + off);
+               break;
+       }
 }
 
 static void lpuart_stop_tx(struct uart_port *port)
@@ -601,7 +615,7 @@ static irqreturn_t lpuart_txint(int irq, void *dev_id)
 
        spin_lock_irqsave(&sport->port.lock, flags);
        if (sport->port.x_char) {
-               if (sport->port.iotype & UPIO_MEM32BE)
+               if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                        lpuart32_write(&sport->port, sport->port.x_char, UARTDATA);
                else
                        writeb(sport->port.x_char, sport->port.membase + UARTDR);
@@ -609,14 +623,14 @@ static irqreturn_t lpuart_txint(int irq, void *dev_id)
        }
 
        if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
-               if (sport->port.iotype & UPIO_MEM32BE)
+               if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                        lpuart32_stop_tx(&sport->port);
                else
                        lpuart_stop_tx(&sport->port);
                goto out;
        }
 
-       if (sport->port.iotype & UPIO_MEM32BE)
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                lpuart32_transmit_buffer(sport);
        else
                lpuart_transmit_buffer(sport);
@@ -1889,12 +1903,12 @@ static int __init lpuart_console_setup(struct console *co, char *options)
        if (options)
                uart_parse_options(options, &baud, &parity, &bits, &flow);
        else
-               if (sport->port.iotype & UPIO_MEM32BE)
+               if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                        lpuart32_console_get_options(sport, &baud, &parity, &bits);
                else
                        lpuart_console_get_options(sport, &baud, &parity, &bits);
 
-       if (sport->port.iotype & UPIO_MEM32BE)
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                lpuart32_setup_watermark(sport);
        else
                lpuart_setup_watermark(sport);
@@ -1953,6 +1967,7 @@ static int __init lpuart32_early_console_setup(struct earlycon_device *device,
        if (!device->port.membase)
                return -ENODEV;
 
+       device->port.iotype = UPIO_MEM32BE;
        device->con->write = lpuart32_early_write;
        return 0;
 }
@@ -2014,7 +2029,7 @@ static int lpuart_probe(struct platform_device *pdev)
        }
        sport->port.irq = ret;
        sport->port.iotype = sdata->iotype;
-       if (sport->port.iotype & UPIO_MEM32BE)
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                sport->port.ops = &lpuart32_pops;
        else
                sport->port.ops = &lpuart_pops;
@@ -2041,7 +2056,7 @@ static int lpuart_probe(struct platform_device *pdev)
 
        platform_set_drvdata(pdev, &sport->port);
 
-       if (sport->port.iotype & UPIO_MEM32BE)
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE))
                lpuart_reg.cons = LPUART32_CONSOLE;
        else
                lpuart_reg.cons = LPUART_CONSOLE;
@@ -2094,7 +2109,7 @@ static int lpuart_suspend(struct device *dev)
        struct lpuart_port *sport = dev_get_drvdata(dev);
        unsigned long temp;
 
-       if (sport->port.iotype & UPIO_MEM32BE) {
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE)) {
                /* disable Rx/Tx and interrupts */
                temp = lpuart32_read(&sport->port, UARTCTRL);
                temp &= ~(UARTCTRL_TE | UARTCTRL_TIE | UARTCTRL_TCIE);
@@ -2145,7 +2160,7 @@ static int lpuart_resume(struct device *dev)
        if (sport->port.suspended && !sport->port.irq_wake)
                clk_prepare_enable(sport->clk);
 
-       if (sport->port.iotype & UPIO_MEM32BE) {
+       if (sport->port.iotype & (UPIO_MEM32 | UPIO_MEM32BE)) {
                lpuart32_setup_watermark(sport);
                temp = lpuart32_read(&sport->port, UARTCTRL);
                temp |= (UARTCTRL_RIE | UARTCTRL_TIE | UARTCTRL_RE |