bcma: host pci: implement block R/W operations

Signed-off-by: Rafał Miłecki <zajec5@gmail.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

2 files changed, 57 insertions, 0 deletions

diff --git a/drivers/bcma/Kconfig b/drivers/bcma/Kconfig
index 353781b5b78b..83e9adf46441 100644
--- a/drivers/bcma/Kconfig
+++ b/drivers/bcma/Kconfig
@@ -13,6 +13,11 @@ config BCMA
           Bus driver for Broadcom specific Advanced Microcontroller Bus
           Architecture.
 
+# Support for Block-I/O. SELECT this from the driver that needs it.
+config BCMA_BLOCKIO
+        bool
+        depends on BCMA
+
 config BCMA_HOST_PCI_POSSIBLE
         bool
         depends on BCMA && PCI = y
diff --git a/drivers/bcma/host_pci.c b/drivers/bcma/host_pci.c
index ffd8797faf4f..279bf50f6d8e 100644
--- a/drivers/bcma/host_pci.c
+++ b/drivers/bcma/host_pci.c
@@ -64,6 +64,54 @@ static void bcma_host_pci_write32(struct bcma_device *core, u16 offset,
         iowrite32(value, core->bus->mmio + offset);
 }
 
+#ifdef CONFIG_BCMA_BLOCKIO
+void bcma_host_pci_block_read(struct bcma_device *core, void *buffer,
+                              size_t count, u16 offset, u8 reg_width)
+{
+        void __iomem *addr = core->bus->mmio + offset;
+        if (core->bus->mapped_core != core)
+                bcma_host_pci_switch_core(core);
+        switch (reg_width) {
+        case sizeof(u8):
+                ioread8_rep(addr, buffer, count);
+                break;
+        case sizeof(u16):
+                WARN_ON(count & 1);
+                ioread16_rep(addr, buffer, count >> 1);
+                break;
+        case sizeof(u32):
+                WARN_ON(count & 3);
+                ioread32_rep(addr, buffer, count >> 2);
+                break;
+        default:
+                WARN_ON(1);
+        }
+}
+
+void bcma_host_pci_block_write(struct bcma_device *core, const void *buffer,
+                               size_t count, u16 offset, u8 reg_width)
+{
+        void __iomem *addr = core->bus->mmio + offset;
+        if (core->bus->mapped_core != core)
+                bcma_host_pci_switch_core(core);
+        switch (reg_width) {
+        case sizeof(u8):
+                iowrite8_rep(addr, buffer, count);
+                break;
+        case sizeof(u16):
+                WARN_ON(count & 1);
+                iowrite16_rep(addr, buffer, count >> 1);
+                break;
+        case sizeof(u32):
+                WARN_ON(count & 3);
+                iowrite32_rep(addr, buffer, count >> 2);
+                break;
+        default:
+                WARN_ON(1);
+        }
+}
+#endif
+
 static u32 bcma_host_pci_aread32(struct bcma_device *core, u16 offset)
 {
         if (core->bus->mapped_core != core)
@@ -86,6 +134,10 @@ const struct bcma_host_ops bcma_host_pci_ops = {
         .write8         = bcma_host_pci_write8,
         .write16        = bcma_host_pci_write16,
         .write32        = bcma_host_pci_write32,
+#ifdef CONFIG_BCMA_BLOCKIO
+        .block_read     = bcma_host_pci_block_read,
+        .block_write    = bcma_host_pci_block_write,
+#endif
         .aread32        = bcma_host_pci_aread32,
         .awrite32       = bcma_host_pci_awrite32,
 };