tty: serial: switch from circ_buf to kfifo
[linux-block.git] / drivers / tty / serial / 8250 / 8250_bcm7271.c
index 504c4c02085776c610e8a6d9010f6982046c674a..de270863eb5e14961930221bb36831425972e0f0 100644 (file)
@@ -22,6 +22,7 @@
 #include <linux/delay.h>
 #include <linux/clk.h>
 #include <linux/debugfs.h>
+#include <linux/units.h>
 
 #include "8250.h"
 
 #define TX_BUF_SIZE 4096
 #define RX_BUF_SIZE 4096
 #define RX_BUFS_COUNT 2
-#define KHZ    1000
-#define MHZ(x) ((x) * KHZ * KHZ)
 
 static const u32 brcmstb_rate_table[] = {
-       MHZ(81),
-       MHZ(108),
-       MHZ(64),                /* Actually 64285715 for some chips */
-       MHZ(48),
+       81 * HZ_PER_MHZ,
+       108 * HZ_PER_MHZ,
+       64 * HZ_PER_MHZ,                /* Actually 64285715 for some chips */
+       48 * HZ_PER_MHZ,
 };
 
 static const u32 brcmstb_rate_table_7278[] = {
-       MHZ(81),
-       MHZ(108),
+       81 * HZ_PER_MHZ,
+       108 * HZ_PER_MHZ,
        0,
-       MHZ(48),
+       48 * HZ_PER_MHZ,
 };
 
 struct brcmuart_priv {
@@ -414,20 +413,18 @@ static int stop_tx_dma(struct uart_8250_port *p)
 static int brcmuart_tx_dma(struct uart_8250_port *p)
 {
        struct brcmuart_priv *priv = p->port.private_data;
-       struct circ_buf *xmit = &p->port.state->xmit;
+       struct tty_port *tport = &p->port.state->port;
        u32 tx_size;
 
        if (uart_tx_stopped(&p->port) || priv->tx_running ||
-               uart_circ_empty(xmit)) {
+               kfifo_is_empty(&tport->xmit_fifo)) {
                return 0;
        }
-       tx_size = CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE);
 
        priv->dma.tx_err = 0;
-       memcpy(priv->tx_buf, &xmit->buf[xmit->tail], tx_size);
-       uart_xmit_advance(&p->port, tx_size);
+       tx_size = uart_fifo_out(&p->port, priv->tx_buf, UART_XMIT_SIZE);
 
-       if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
+       if (kfifo_len(&tport->xmit_fifo) < WAKEUP_CHARS)
                uart_write_wakeup(&p->port);
 
        udma_writel(priv, REGS_DMA_TX, UDMA_TX_TRANSFER_LEN, tx_size);
@@ -541,7 +538,7 @@ static void brcmuart_tx_isr(struct uart_port *up, u32 isr)
        struct brcmuart_priv *priv = up->private_data;
        struct device *dev = up->dev;
        struct uart_8250_port *port_8250 = up_to_u8250p(up);
-       struct circ_buf *xmit = &port_8250->port.state->xmit;
+       struct tty_port *tport = &port_8250->port.state->port;
 
        if (isr & UDMA_INTR_TX_ABORT) {
                if (priv->tx_running)
@@ -549,7 +546,7 @@ static void brcmuart_tx_isr(struct uart_port *up, u32 isr)
                return;
        }
        priv->tx_running = false;
-       if (!uart_circ_empty(xmit) && !uart_tx_stopped(up))
+       if (!kfifo_is_empty(&tport->xmit_fifo) && !uart_tx_stopped(up))
                brcmuart_tx_dma(port_8250);
 }
 
@@ -936,17 +933,14 @@ static void brcmuart_init_debugfs(struct brcmuart_priv *priv,
 static int brcmuart_probe(struct platform_device *pdev)
 {
        struct resource *regs;
-       struct device_node *np = pdev->dev.of_node;
        const struct of_device_id *of_id = NULL;
        struct uart_8250_port *new_port;
        struct device *dev = &pdev->dev;
        struct brcmuart_priv *priv;
        struct clk *baud_mux_clk;
        struct uart_8250_port up;
-       int irq;
        void __iomem *membase = NULL;
        resource_size_t mapbase = 0;
-       u32 clk_rate = 0;
        int ret;
        int x;
        int dma_irq;
@@ -954,15 +948,12 @@ static int brcmuart_probe(struct platform_device *pdev)
                "uart", "dma_rx", "dma_tx", "dma_intr2", "dma_arb"
        };
 
-       irq = platform_get_irq(pdev, 0);
-       if (irq < 0)
-               return irq;
        priv = devm_kzalloc(dev, sizeof(struct brcmuart_priv),
                        GFP_KERNEL);
        if (!priv)
                return -ENOMEM;
 
-       of_id = of_match_node(brcmuart_dt_ids, np);
+       of_id = of_match_node(brcmuart_dt_ids, dev->of_node);
        if (!of_id || !of_id->data)
                priv->rate_table = brcmstb_rate_table;
        else
@@ -1012,7 +1003,23 @@ static int brcmuart_probe(struct platform_device *pdev)
                }
        }
 
-       of_property_read_u32(np, "clock-frequency", &clk_rate);
+       dev_dbg(dev, "DMA is %senabled\n", priv->dma_enabled ? "" : "not ");
+
+       memset(&up, 0, sizeof(up));
+       up.port.type = PORT_BCM7271;
+       up.port.dev = dev;
+       up.port.mapbase = mapbase;
+       up.port.membase = membase;
+       up.port.handle_irq = brcmuart_handle_irq;
+       up.port.flags = UPF_BOOT_AUTOCONF | UPF_FIXED_PORT | UPF_FIXED_TYPE;
+       up.port.private_data = priv;
+
+       ret = uart_read_port_properties(&up.port);
+       if (ret)
+               goto release_dma;
+
+       up.port.regshift = 2;
+       up.port.iotype = device_is_big_endian(dev) ? UPIO_MEM32BE : UPIO_MEM32;
 
        /* See if a Baud clock has been specified */
        baud_mux_clk = devm_clk_get_optional_enabled(dev, "sw_baud");
@@ -1024,39 +1031,11 @@ static int brcmuart_probe(struct platform_device *pdev)
 
                priv->baud_mux_clk = baud_mux_clk;
                init_real_clk_rates(dev, priv);
-               clk_rate = priv->default_mux_rate;
+               up.port.uartclk = priv->default_mux_rate;
        } else {
                dev_dbg(dev, "BAUD MUX clock not specified\n");
        }
 
-       if (clk_rate == 0) {
-               ret = dev_err_probe(dev, -EINVAL, "clock-frequency or clk not defined\n");
-               goto release_dma;
-       }
-
-       dev_dbg(dev, "DMA is %senabled\n", priv->dma_enabled ? "" : "not ");
-
-       memset(&up, 0, sizeof(up));
-       up.port.type = PORT_BCM7271;
-       up.port.uartclk = clk_rate;
-       up.port.dev = dev;
-       up.port.mapbase = mapbase;
-       up.port.membase = membase;
-       up.port.irq = irq;
-       up.port.handle_irq = brcmuart_handle_irq;
-       up.port.regshift = 2;
-       up.port.iotype = of_device_is_big_endian(np) ?
-               UPIO_MEM32BE : UPIO_MEM32;
-       up.port.flags = UPF_SHARE_IRQ | UPF_BOOT_AUTOCONF
-               | UPF_FIXED_PORT | UPF_FIXED_TYPE;
-       up.port.dev = dev;
-       up.port.private_data = priv;
-
-       /* Check for a fixed line number */
-       ret = of_alias_get_id(np, "serial");
-       if (ret >= 0)
-               up.port.line = ret;
-
        /* setup HR timer */
        hrtimer_init(&priv->hrt, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
        priv->hrt.function = brcmuart_hrtimer_func;