[POWERPC] cell: Generalize io-workarounds code

This splits cell io-workaround code into spider-pci dependent code and
a generic part, and also moves io-workarounds initialization into
cell_setup_phb.

Signed-off-by: Kou Ishizaki <kou.ishizaki@toshiba.co.jp>
Acked-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>
Signed-off-by: Paul Mackerras <paulus@samba.org>

1 files changed, 184 insertions, 0 deletions

diff --git a/arch/powerpc/platforms/cell/spider-pci.c b/arch/powerpc/platforms/cell/spider-pci.c
new file mode 100644
index 000000000000..418b605ac35a
--- /dev/null
+++ b/arch/powerpc/platforms/cell/spider-pci.c
@@ -0,0 +1,184 @@
+/*
+ * IO workarounds for PCI on Celleb/Cell platform
+ *
+ * (C) Copyright 2006-2007 TOSHIBA CORPORATION
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ */
+
+#undef DEBUG
+
+#include <linux/kernel.h>
+#include <linux/of_platform.h>
+#include <linux/io.h>
+
+#include <asm/ppc-pci.h>
+#include <asm/pci-bridge.h>
+
+#include "io-workarounds.h"
+
+#define SPIDER_PCI_DISABLE_PREFETCH
+
+struct spiderpci_iowa_private {
+        void __iomem *regs;
+};
+
+static void spiderpci_io_flush(struct iowa_bus *bus)
+{
+        struct spiderpci_iowa_private *priv;
+        u32 val;
+
+        priv = bus->private;
+        val = in_be32(priv->regs + SPIDER_PCI_DUMMY_READ);
+        iosync();
+}
+
+#define SPIDER_PCI_MMIO_READ(name, ret)                                 \
+static ret spiderpci_##name(const PCI_IO_ADDR addr)                     \
+{                                                                       \
+        ret val = __do_##name(addr);                                    \
+        spiderpci_io_flush(iowa_mem_find_bus(addr));                    \
+        return val;                                                     \
+}
+
+#define SPIDER_PCI_MMIO_READ_STR(name)                                  \
+static void spiderpci_##name(const PCI_IO_ADDR addr, void *buf,         \
+                             unsigned long count)                       \
+{                                                                       \
+        __do_##name(addr, buf, count);                                  \
+        spiderpci_io_flush(iowa_mem_find_bus(addr));                    \
+}
+
+SPIDER_PCI_MMIO_READ(readb, u8)
+SPIDER_PCI_MMIO_READ(readw, u16)
+SPIDER_PCI_MMIO_READ(readl, u32)
+SPIDER_PCI_MMIO_READ(readq, u64)
+SPIDER_PCI_MMIO_READ(readw_be, u16)
+SPIDER_PCI_MMIO_READ(readl_be, u32)
+SPIDER_PCI_MMIO_READ(readq_be, u64)
+SPIDER_PCI_MMIO_READ_STR(readsb)
+SPIDER_PCI_MMIO_READ_STR(readsw)
+SPIDER_PCI_MMIO_READ_STR(readsl)
+
+static void spiderpci_memcpy_fromio(void *dest, const PCI_IO_ADDR src,
+                                    unsigned long n)
+{
+        __do_memcpy_fromio(dest, src, n);
+        spiderpci_io_flush(iowa_mem_find_bus(src));
+}
+
+static int __init spiderpci_pci_setup_chip(struct pci_controller *phb,
+                                           void __iomem *regs)
+{
+        void *dummy_page_va;
+        dma_addr_t dummy_page_da;
+
+#ifdef SPIDER_PCI_DISABLE_PREFETCH
+        u32 val = in_be32(regs + SPIDER_PCI_VCI_CNTL_STAT);
+        pr_debug("SPIDER_IOWA:PVCI_Control_Status was 0x%08x\n", val);
+        out_be32(regs + SPIDER_PCI_VCI_CNTL_STAT, val | 0x8);
+#endif /* SPIDER_PCI_DISABLE_PREFETCH */
+
+        /* setup dummy read */
+        /*
+         * On CellBlade, we can't know that which XDR memory is used by
+         * kmalloc() to allocate dummy_page_va.
+         * In order to imporve the performance, the XDR which is used to
+         * allocate dummy_page_va is the nearest the spider-pci.
+         * We have to select the CBE which is the nearest the spider-pci
+         * to allocate memory from the best XDR, but I don't know that
+         * how to do.
+         *
+         * Celleb does not have this problem, because it has only one XDR.
+         */
+        dummy_page_va = kmalloc(PAGE_SIZE, GFP_KERNEL);
+        if (!dummy_page_va) {
+                pr_err("SPIDERPCI-IOWA:Alloc dummy_page_va failed.\n");
+                return -1;
+        }
+
+        dummy_page_da = dma_map_single(phb->parent, dummy_page_va,
+                                       PAGE_SIZE, DMA_FROM_DEVICE);
+        if (dma_mapping_error(dummy_page_da)) {
+                pr_err("SPIDER-IOWA:Map dummy page filed.\n");
+                kfree(dummy_page_va);
+                return -1;
+        }
+
+        out_be32(regs + SPIDER_PCI_DUMMY_READ_BASE, dummy_page_da);
+
+        return 0;
+}
+
+int __init spiderpci_iowa_init(struct iowa_bus *bus, void *data)
+{
+        void __iomem *regs = NULL;
+        struct spiderpci_iowa_private *priv;
+        struct device_node *np = bus->phb->dn;
+        struct resource r;
+        unsigned long offset = (unsigned long)data;
+
+        pr_debug("SPIDERPCI-IOWA:Bus initialize for spider(%s)\n",
+                 np->full_name);
+
+        priv = kzalloc(sizeof(struct spiderpci_iowa_private), GFP_KERNEL);
+        if (!priv) {
+                pr_err("SPIDERPCI-IOWA:"
+                       "Can't allocate struct spiderpci_iowa_private");
+                return -1;
+        }
+
+        if (of_address_to_resource(np, 0, &r)) {
+                pr_err("SPIDERPCI-IOWA:Can't get resource.\n");
+                goto error;
+        }
+
+        regs = ioremap(r.start + offset, SPIDER_PCI_REG_SIZE);
+        if (!regs) {
+                pr_err("SPIDERPCI-IOWA:ioremap failed.\n");
+                goto error;
+        }
+        priv->regs = regs;
+        bus->private = priv;
+
+        if (spiderpci_pci_setup_chip(bus->phb, regs))
+                goto error;
+
+        return 0;
+
+error:
+        kfree(priv);
+        bus->private = NULL;
+
+        if (regs)
+                iounmap(regs);
+
+        return -1;
+}
+
+struct ppc_pci_io spiderpci_ops = {
+        .readb = spiderpci_readb,
+        .readw = spiderpci_readw,
+        .readl = spiderpci_readl,
+        .readq = spiderpci_readq,
+        .readw_be = spiderpci_readw_be,
+        .readl_be = spiderpci_readl_be,
+        .readq_be = spiderpci_readq_be,
+        .readsb = spiderpci_readsb,
+        .readsw = spiderpci_readsw,
+        .readsl = spiderpci_readsl,
+        .memcpy_fromio = spiderpci_memcpy_fromio,
+};
+