linux/drivers/bcma/host_pci.c
<<
>>
Prefs
   1/*
   2 * Broadcom specific AMBA
   3 * PCI Host
   4 *
   5 * Licensed under the GNU/GPL. See COPYING for details.
   6 */
   7
   8#include "bcma_private.h"
   9#include <linux/slab.h>
  10#include <linux/bcma/bcma.h>
  11#include <linux/pci.h>
  12#include <linux/module.h>
  13
  14static void bcma_host_pci_switch_core(struct bcma_device *core)
  15{
  16        pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN,
  17                               core->addr);
  18        pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN2,
  19                               core->wrap);
  20        core->bus->mapped_core = core;
  21        bcma_debug(core->bus, "Switched to core: 0x%X\n", core->id.id);
  22}
  23
  24/* Provides access to the requested core. Returns base offset that has to be
  25 * used. It makes use of fixed windows when possible. */
  26static u16 bcma_host_pci_provide_access_to_core(struct bcma_device *core)
  27{
  28        switch (core->id.id) {
  29        case BCMA_CORE_CHIPCOMMON:
  30                return 3 * BCMA_CORE_SIZE;
  31        case BCMA_CORE_PCIE:
  32                return 2 * BCMA_CORE_SIZE;
  33        }
  34
  35        if (core->bus->mapped_core != core)
  36                bcma_host_pci_switch_core(core);
  37        return 0;
  38}
  39
  40static u8 bcma_host_pci_read8(struct bcma_device *core, u16 offset)
  41{
  42        offset += bcma_host_pci_provide_access_to_core(core);
  43        return ioread8(core->bus->mmio + offset);
  44}
  45
  46static u16 bcma_host_pci_read16(struct bcma_device *core, u16 offset)
  47{
  48        offset += bcma_host_pci_provide_access_to_core(core);
  49        return ioread16(core->bus->mmio + offset);
  50}
  51
  52static u32 bcma_host_pci_read32(struct bcma_device *core, u16 offset)
  53{
  54        offset += bcma_host_pci_provide_access_to_core(core);
  55        return ioread32(core->bus->mmio + offset);
  56}
  57
  58static void bcma_host_pci_write8(struct bcma_device *core, u16 offset,
  59                                 u8 value)
  60{
  61        offset += bcma_host_pci_provide_access_to_core(core);
  62        iowrite8(value, core->bus->mmio + offset);
  63}
  64
  65static void bcma_host_pci_write16(struct bcma_device *core, u16 offset,
  66                                 u16 value)
  67{
  68        offset += bcma_host_pci_provide_access_to_core(core);
  69        iowrite16(value, core->bus->mmio + offset);
  70}
  71
  72static void bcma_host_pci_write32(struct bcma_device *core, u16 offset,
  73                                 u32 value)
  74{
  75        offset += bcma_host_pci_provide_access_to_core(core);
  76        iowrite32(value, core->bus->mmio + offset);
  77}
  78
  79#ifdef CONFIG_BCMA_BLOCKIO
  80static void bcma_host_pci_block_read(struct bcma_device *core, void *buffer,
  81                                     size_t count, u16 offset, u8 reg_width)
  82{
  83        void __iomem *addr = core->bus->mmio + offset;
  84        if (core->bus->mapped_core != core)
  85                bcma_host_pci_switch_core(core);
  86        switch (reg_width) {
  87        case sizeof(u8):
  88                ioread8_rep(addr, buffer, count);
  89                break;
  90        case sizeof(u16):
  91                WARN_ON(count & 1);
  92                ioread16_rep(addr, buffer, count >> 1);
  93                break;
  94        case sizeof(u32):
  95                WARN_ON(count & 3);
  96                ioread32_rep(addr, buffer, count >> 2);
  97                break;
  98        default:
  99                WARN_ON(1);
 100        }
 101}
 102
 103static void bcma_host_pci_block_write(struct bcma_device *core,
 104                                      const void *buffer, size_t count,
 105                                      u16 offset, u8 reg_width)
 106{
 107        void __iomem *addr = core->bus->mmio + offset;
 108        if (core->bus->mapped_core != core)
 109                bcma_host_pci_switch_core(core);
 110        switch (reg_width) {
 111        case sizeof(u8):
 112                iowrite8_rep(addr, buffer, count);
 113                break;
 114        case sizeof(u16):
 115                WARN_ON(count & 1);
 116                iowrite16_rep(addr, buffer, count >> 1);
 117                break;
 118        case sizeof(u32):
 119                WARN_ON(count & 3);
 120                iowrite32_rep(addr, buffer, count >> 2);
 121                break;
 122        default:
 123                WARN_ON(1);
 124        }
 125}
 126#endif
 127
 128static u32 bcma_host_pci_aread32(struct bcma_device *core, u16 offset)
 129{
 130        if (core->bus->mapped_core != core)
 131                bcma_host_pci_switch_core(core);
 132        return ioread32(core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
 133}
 134
 135static void bcma_host_pci_awrite32(struct bcma_device *core, u16 offset,
 136                                  u32 value)
 137{
 138        if (core->bus->mapped_core != core)
 139                bcma_host_pci_switch_core(core);
 140        iowrite32(value, core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
 141}
 142
 143static const struct bcma_host_ops bcma_host_pci_ops = {
 144        .read8          = bcma_host_pci_read8,
 145        .read16         = bcma_host_pci_read16,
 146        .read32         = bcma_host_pci_read32,
 147        .write8         = bcma_host_pci_write8,
 148        .write16        = bcma_host_pci_write16,
 149        .write32        = bcma_host_pci_write32,
 150#ifdef CONFIG_BCMA_BLOCKIO
 151        .block_read     = bcma_host_pci_block_read,
 152        .block_write    = bcma_host_pci_block_write,
 153#endif
 154        .aread32        = bcma_host_pci_aread32,
 155        .awrite32       = bcma_host_pci_awrite32,
 156};
 157
 158static int __devinit bcma_host_pci_probe(struct pci_dev *dev,
 159                                         const struct pci_device_id *id)
 160{
 161        struct bcma_bus *bus;
 162        int err = -ENOMEM;
 163        const char *name;
 164        u32 val;
 165
 166        /* Alloc */
 167        bus = kzalloc(sizeof(*bus), GFP_KERNEL);
 168        if (!bus)
 169                goto out;
 170
 171        /* Basic PCI configuration */
 172        err = pci_enable_device(dev);
 173        if (err)
 174                goto err_kfree_bus;
 175
 176        name = dev_name(&dev->dev);
 177        if (dev->driver && dev->driver->name)
 178                name = dev->driver->name;
 179        err = pci_request_regions(dev, name);
 180        if (err)
 181                goto err_pci_disable;
 182        pci_set_master(dev);
 183
 184        /* Disable the RETRY_TIMEOUT register (0x41) to keep
 185         * PCI Tx retries from interfering with C3 CPU state */
 186        pci_read_config_dword(dev, 0x40, &val);
 187        if ((val & 0x0000ff00) != 0)
 188                pci_write_config_dword(dev, 0x40, val & 0xffff00ff);
 189
 190        /* SSB needed additional powering up, do we have any AMBA PCI cards? */
 191        if (!pci_is_pcie(dev))
 192                bcma_err(bus, "PCI card detected, report problems.\n");
 193
 194        /* Map MMIO */
 195        err = -ENOMEM;
 196        bus->mmio = pci_iomap(dev, 0, ~0UL);
 197        if (!bus->mmio)
 198                goto err_pci_release_regions;
 199
 200        /* Host specific */
 201        bus->host_pci = dev;
 202        bus->hosttype = BCMA_HOSTTYPE_PCI;
 203        bus->ops = &bcma_host_pci_ops;
 204
 205        bus->boardinfo.vendor = bus->host_pci->subsystem_vendor;
 206        bus->boardinfo.type = bus->host_pci->subsystem_device;
 207
 208        /* Register */
 209        err = bcma_bus_register(bus);
 210        if (err)
 211                goto err_pci_unmap_mmio;
 212
 213        pci_set_drvdata(dev, bus);
 214
 215out:
 216        return err;
 217
 218err_pci_unmap_mmio:
 219        pci_iounmap(dev, bus->mmio);
 220err_pci_release_regions:
 221        pci_release_regions(dev);
 222err_pci_disable:
 223        pci_disable_device(dev);
 224err_kfree_bus:
 225        kfree(bus);
 226        return err;
 227}
 228
 229static void __devexit bcma_host_pci_remove(struct pci_dev *dev)
 230{
 231        struct bcma_bus *bus = pci_get_drvdata(dev);
 232
 233        bcma_bus_unregister(bus);
 234        pci_iounmap(dev, bus->mmio);
 235        pci_release_regions(dev);
 236        pci_disable_device(dev);
 237        kfree(bus);
 238        pci_set_drvdata(dev, NULL);
 239}
 240
 241#ifdef CONFIG_PM
 242static int bcma_host_pci_suspend(struct device *dev)
 243{
 244        struct pci_dev *pdev = to_pci_dev(dev);
 245        struct bcma_bus *bus = pci_get_drvdata(pdev);
 246
 247        bus->mapped_core = NULL;
 248
 249        return bcma_bus_suspend(bus);
 250}
 251
 252static int bcma_host_pci_resume(struct device *dev)
 253{
 254        struct pci_dev *pdev = to_pci_dev(dev);
 255        struct bcma_bus *bus = pci_get_drvdata(pdev);
 256
 257        return bcma_bus_resume(bus);
 258}
 259
 260static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bcma_host_pci_suspend,
 261                         bcma_host_pci_resume);
 262#define BCMA_PM_OPS     (&bcma_pm_ops)
 263
 264#else /* CONFIG_PM */
 265
 266#define BCMA_PM_OPS     NULL
 267
 268#endif /* CONFIG_PM */
 269
 270static DEFINE_PCI_DEVICE_TABLE(bcma_pci_bridge_tbl) = {
 271        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x0576) },
 272        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 43224) },
 273        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4331) },
 274        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) },
 275        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4357) },
 276        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4358) },
 277        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4359) },
 278        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) },
 279        { 0, },
 280};
 281MODULE_DEVICE_TABLE(pci, bcma_pci_bridge_tbl);
 282
 283static struct pci_driver bcma_pci_bridge_driver = {
 284        .name = "bcma-pci-bridge",
 285        .id_table = bcma_pci_bridge_tbl,
 286        .probe = bcma_host_pci_probe,
 287        .remove = __devexit_p(bcma_host_pci_remove),
 288        .driver.pm = BCMA_PM_OPS,
 289};
 290
 291int __init bcma_host_pci_init(void)
 292{
 293        return pci_register_driver(&bcma_pci_bridge_driver);
 294}
 295
 296void __exit bcma_host_pci_exit(void)
 297{
 298        pci_unregister_driver(&bcma_pci_bridge_driver);
 299}
 300
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.