drivers/bcma/host_soc.c

   1 /*
   2  * Broadcom specific AMBA
   3  * System on Chip (SoC) Host
   4  *
   5  * Licensed under the GNU/GPL. See COPYING for details.
   6  */
   7
   8 #include "bcma_private.h"
   9 #include "scan.h"
  10 #include <linux/bcma/bcma.h>
  11 #include <linux/bcma/bcma_soc.h>
  12
  13 static u8 bcma_host_soc_read8(struct bcma_device *core, u16 offset)
  14 {
  15         return readb(core->io_addr + offset);
  16 }
  17
  18 static u16 bcma_host_soc_read16(struct bcma_device *core, u16 offset)
  19 {
  20         return readw(core->io_addr + offset);
  21 }
  22
  23 static u32 bcma_host_soc_read32(struct bcma_device *core, u16 offset)
  24 {
  25         return readl(core->io_addr + offset);
  26 }
  27
  28 static void bcma_host_soc_write8(struct bcma_device *core, u16 offset,
  29                                  u8 value)
  30 {
  31         writeb(value, core->io_addr + offset);
  32 }
  33
  34 static void bcma_host_soc_write16(struct bcma_device *core, u16 offset,
  35                                  u16 value)
  36 {
  37         writew(value, core->io_addr + offset);
  38 }
  39
  40 static void bcma_host_soc_write32(struct bcma_device *core, u16 offset,
  41                                  u32 value)
  42 {
  43         writel(value, core->io_addr + offset);
  44 }
  45
  46 #ifdef CONFIG_BCMA_BLOCKIO
  47 static void bcma_host_soc_block_read(struct bcma_device *core, void *buffer,
  48                                      size_t count, u16 offset, u8 reg_width)
  49 {
  50         void __iomem *addr = core->io_addr + offset;
  51
  52         switch (reg_width) {
  53         case sizeof(u8): {
  54                 u8 *buf = buffer;
  55
  56                 while (count) {
  57                         *buf = __raw_readb(addr);
  58                         buf++;
  59                         count--;
  60                 }
  61                 break;
  62         }
  63         case sizeof(u16): {
  64                 __le16 *buf = buffer;
  65
  66                 WARN_ON(count & 1);
  67                 while (count) {
  68                         *buf = (__force __le16)__raw_readw(addr);
  69                         buf++;
  70                         count -= 2;
  71                 }
  72                 break;
  73         }
  74         case sizeof(u32): {
  75                 __le32 *buf = buffer;
  76
  77                 WARN_ON(count & 3);
  78                 while (count) {
  79                         *buf = (__force __le32)__raw_readl(addr);
  80                         buf++;
  81                         count -= 4;
  82                 }
  83                 break;
  84         }
  85         default:
  86                 WARN_ON(1);
  87         }
  88 }
  89
  90 static void bcma_host_soc_block_write(struct bcma_device *core,
  91                                       const void *buffer,
  92                                       size_t count, u16 offset, u8 reg_width)
  93 {
  94         void __iomem *addr = core->io_addr + offset;
  95
  96         switch (reg_width) {
  97         case sizeof(u8): {
  98                 const u8 *buf = buffer;
  99
 100                 while (count) {
 101                         __raw_writeb(*buf, addr);
 102                         buf++;
 103                         count--;
 104                 }
 105                 break;
 106         }
 107         case sizeof(u16): {
 108                 const __le16 *buf = buffer;
 109
 110                 WARN_ON(count & 1);
 111                 while (count) {
 112                         __raw_writew((__force u16)(*buf), addr);
 113                         buf++;
 114                         count -= 2;
 115                 }
 116                 break;
 117         }
 118         case sizeof(u32): {
 119                 const __le32 *buf = buffer;
 120
 121                 WARN_ON(count & 3);
 122                 while (count) {
 123                         __raw_writel((__force u32)(*buf), addr);
 124                         buf++;
 125                         count -= 4;
 126                 }
 127                 break;
 128         }
 129         default:
 130                 WARN_ON(1);
 131         }
 132 }
 133 #endif /* CONFIG_BCMA_BLOCKIO */
 134
 135 static u32 bcma_host_soc_aread32(struct bcma_device *core, u16 offset)
 136 {
 137         if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
 138                 return ~0;
 139         return readl(core->io_wrap + offset);
 140 }
 141
 142 static void bcma_host_soc_awrite32(struct bcma_device *core, u16 offset,
 143                                   u32 value)
 144 {
 145         if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
 146                 return;
 147         writel(value, core->io_wrap + offset);
 148 }
 149
 150 static const struct bcma_host_ops bcma_host_soc_ops = {
 151         .read8          = bcma_host_soc_read8,
 152         .read16         = bcma_host_soc_read16,
 153         .read32         = bcma_host_soc_read32,
 154         .write8         = bcma_host_soc_write8,
 155         .write16        = bcma_host_soc_write16,
 156         .write32        = bcma_host_soc_write32,
 157 #ifdef CONFIG_BCMA_BLOCKIO
 158         .block_read     = bcma_host_soc_block_read,
 159         .block_write    = bcma_host_soc_block_write,
 160 #endif
 161         .aread32        = bcma_host_soc_aread32,
 162         .awrite32       = bcma_host_soc_awrite32,
 163 };
 164
 165 int __init bcma_host_soc_register(struct bcma_soc *soc)
 166 {
 167         struct bcma_bus *bus = &soc->bus;
 168
 169         /* iomap only first core. We have to read some register on this core
 170          * to scan the bus.
 171          */
 172         bus->mmio = ioremap_nocache(BCMA_ADDR_BASE, BCMA_CORE_SIZE * 1);
 173         if (!bus->mmio)
 174                 return -ENOMEM;
 175
 176         /* Host specific */
 177         bus->hosttype = BCMA_HOSTTYPE_SOC;
 178         bus->ops = &bcma_host_soc_ops;
 179
 180         /* Initialize struct, detect chip */
 181         bcma_init_bus(bus);
 182
 183         return 0;
 184 }
 185
 186 int __init bcma_host_soc_init(struct bcma_soc *soc)
 187 {
 188         struct bcma_bus *bus = &soc->bus;
 189         int err;
 190
 191         /* Scan bus and initialize it */
 192         err = bcma_bus_early_register(bus, &soc->core_cc, &soc->core_mips);
 193         if (err)
 194                 iounmap(bus->mmio);
 195
 196         return err;
 197 }