Merge tag 'u-boot-amlogic-20200727' of https://gitlab.denx.de/u-boot/custodians/u...

[platform/kernel/u-boot.git] / drivers / serial / serial_meson.c

diff --git a/drivers/serial/serial_meson.c b/drivers/serial/serial_meson.c
index dbb8537..496a2ca 100644 (file)
--- a/drivers/serial/serial_meson.c
+++ b/drivers/serial/serial_meson.c
@@ -7,6 +7,7 @@
 #include <dm.h>
 #include <errno.h>
 #include <fdtdec.h>
+#include <linux/bitops.h>
 #include <linux/compiler.h>
 #include <serial.h>
 
@@ -64,14 +65,36 @@ static int meson_serial_probe(struct udevice *dev)
        return 0;
 }
 
+static void meson_serial_rx_error(struct udevice *dev)
+{
+       struct meson_serial_platdata *plat = dev->platdata;
+       struct meson_uart *const uart = plat->reg;
+       u32 val = readl(&uart->control);
+
+       /* Clear error */
+       val |= AML_UART_CLR_ERR;
+       writel(val, &uart->control);
+       val &= ~AML_UART_CLR_ERR;
+       writel(val, &uart->control);
+
+       /* Remove spurious byte from fifo */
+       readl(&uart->rfifo);
+}
+
 static int meson_serial_getc(struct udevice *dev)
 {
        struct meson_serial_platdata *plat = dev->platdata;
        struct meson_uart *const uart = plat->reg;
+       uint32_t status = readl(&uart->status);
 
-       if (readl(&uart->status) & AML_UART_RX_EMPTY)
+       if (status & AML_UART_RX_EMPTY)
                return -EAGAIN;
 
+       if (status & AML_UART_ERR) {
+               meson_serial_rx_error(dev);
+               return -EIO;
+       }
+
        return readl(&uart->rfifo) & 0xff;
 }
 
@@ -94,10 +117,23 @@ static int meson_serial_pending(struct udevice *dev, bool input)
        struct meson_uart *const uart = plat->reg;
        uint32_t status = readl(&uart->status);
 
-       if (input)
-               return !(status & AML_UART_RX_EMPTY);
-       else
+       if (input) {
+               if (status & AML_UART_RX_EMPTY)
+                       return false;
+
+               /*
+                * Handle and drop any RX error here to avoid
+                * returning true here when an error byte is in the FIFO
+                */
+               if (status & AML_UART_ERR) {
+                       meson_serial_rx_error(dev);
+                       return false;
+               }
+
+               return true;
+       } else {
                return !(status & AML_UART_TX_FULL);
+       }
 }
 
 static int meson_serial_ofdata_to_platdata(struct udevice *dev)
@@ -105,7 +141,7 @@ static int meson_serial_ofdata_to_platdata(struct udevice *dev)
        struct meson_serial_platdata *plat = dev->platdata;
        fdt_addr_t addr;
 
-       addr = devfdt_get_addr(dev);
+       addr = dev_read_addr(dev);
        if (addr == FDT_ADDR_T_NONE)
                return -EINVAL;
 
@@ -132,7 +168,6 @@ U_BOOT_DRIVER(serial_meson) = {
        .of_match       = meson_serial_ids,
        .probe          = meson_serial_probe,
        .ops            = &meson_serial_ops,
-       .flags          = DM_FLAG_PRE_RELOC,
        .ofdata_to_platdata = meson_serial_ofdata_to_platdata,
        .platdata_auto_alloc_size = sizeof(struct meson_serial_platdata),
 };