linux/drivers/uwb/whci.c
<<
>>
Prefs
   1/*
   2 * WHCI UWB Multi-interface Controller enumerator.
   3 *
   4 * Copyright (C) 2007 Cambridge Silicon Radio Ltd.
   5 *
   6 * This file is released under the GNU GPL v2.
   7 */
   8#include <linux/delay.h>
   9#include <linux/kernel.h>
  10#include <linux/pci.h>
  11#include <linux/dma-mapping.h>
  12#include <linux/uwb/whci.h>
  13#include <linux/uwb/umc.h>
  14
  15struct whci_card {
  16        struct pci_dev *pci;
  17        void __iomem *uwbbase;
  18        u8 n_caps;
  19        struct umc_dev *devs[0];
  20};
  21
  22
  23/* Fix faulty HW :( */
  24static
  25u64 whci_capdata_quirks(struct whci_card *card, u64 capdata)
  26{
  27        u64 capdata_orig = capdata;
  28        struct pci_dev *pci_dev = card->pci;
  29        if (pci_dev->vendor == PCI_VENDOR_ID_INTEL
  30            && (pci_dev->device == 0x0c3b || pci_dev->device == 0004)
  31            && pci_dev->class == 0x0d1010) {
  32                switch (UWBCAPDATA_TO_CAP_ID(capdata)) {
  33                        /* WLP capability has 0x100 bytes of aperture */
  34                case 0x80:
  35                        capdata |= 0x40 << 8; break;
  36                        /* WUSB capability has 0x80 bytes of aperture
  37                         * and ID is 1 */
  38                case 0x02:
  39                        capdata &= ~0xffff;
  40                        capdata |= 0x2001;
  41                        break;
  42                }
  43        }
  44        if (capdata_orig != capdata)
  45                dev_warn(&pci_dev->dev,
  46                         "PCI v%04x d%04x c%06x#%02x: "
  47                         "corrected capdata from %016Lx to %016Lx\n",
  48                         pci_dev->vendor, pci_dev->device, pci_dev->class,
  49                         (unsigned)UWBCAPDATA_TO_CAP_ID(capdata),
  50                         (unsigned long long)capdata_orig,
  51                         (unsigned long long)capdata);
  52        return capdata;
  53}
  54
  55
  56/**
  57 * whci_wait_for - wait for a WHCI register to be set
  58 *
  59 * Polls (for at most @max_ms ms) until '*@reg & @mask == @result'.
  60 */
  61int whci_wait_for(struct device *dev, u32 __iomem *reg, u32 mask, u32 result,
  62        unsigned long max_ms, const char *tag)
  63{
  64        unsigned t = 0;
  65        u32 val;
  66        for (;;) {
  67                val = le_readl(reg);
  68                if ((val & mask) == result)
  69                        break;
  70                msleep(10);
  71                if (t >= max_ms) {
  72                        dev_err(dev, "timed out waiting for %s ", tag);
  73                        return -ETIMEDOUT;
  74                }
  75                t += 10;
  76        }
  77        return 0;
  78}
  79EXPORT_SYMBOL_GPL(whci_wait_for);
  80
  81
  82/*
  83 * NOTE: the capinfo and capdata registers are slightly different
  84 *       (size and cap-id fields). So for cap #0, we need to fill
  85 *       in. Size comes from the size of the register block
  86 *       (statically calculated); cap_id comes from nowhere, we use
  87 *       zero, that is reserved, for the radio controller, because
  88 *       none was defined at the spec level.
  89 */
  90static int whci_add_cap(struct whci_card *card, int n)
  91{
  92        struct umc_dev *umc;
  93        u64 capdata;
  94        int bar, err;
  95
  96        umc = umc_device_create(&card->pci->dev, n);
  97        if (umc == NULL)
  98                return -ENOMEM;
  99
 100        capdata = le_readq(card->uwbbase + UWBCAPDATA(n));
 101
 102        bar = UWBCAPDATA_TO_BAR(capdata) << 1;
 103
 104        capdata = whci_capdata_quirks(card, capdata);
 105        /* Capability 0 is the radio controller. It's size is 32
 106         * bytes (WHCI0.95[2.3, T2-9]). */
 107        umc->version         = UWBCAPDATA_TO_VERSION(capdata);
 108        umc->cap_id          = n == 0 ? 0 : UWBCAPDATA_TO_CAP_ID(capdata);
 109        umc->bar             = bar;
 110        umc->resource.start  = pci_resource_start(card->pci, bar)
 111                + UWBCAPDATA_TO_OFFSET(capdata);
 112        umc->resource.end    = umc->resource.start
 113                + (n == 0 ? 0x20 : UWBCAPDATA_TO_SIZE(capdata)) - 1;
 114        umc->resource.name   = umc->dev.bus_id;
 115        umc->resource.flags  = card->pci->resource[bar].flags;
 116        umc->resource.parent = &card->pci->resource[bar];
 117        umc->irq             = card->pci->irq;
 118
 119        err = umc_device_register(umc);
 120        if (err < 0)
 121                goto error;
 122        card->devs[n] = umc;
 123        return 0;
 124
 125error:
 126        kfree(umc);
 127        return err;
 128}
 129
 130static void whci_del_cap(struct whci_card *card, int n)
 131{
 132        struct umc_dev *umc = card->devs[n];
 133
 134        if (umc != NULL)
 135                umc_device_unregister(umc);
 136}
 137
 138static int whci_n_caps(struct pci_dev *pci)
 139{
 140        void __iomem *uwbbase;
 141        u64 capinfo;
 142
 143        uwbbase = pci_iomap(pci, 0, 8);
 144        if (!uwbbase)
 145                return -ENOMEM;
 146        capinfo = le_readq(uwbbase + UWBCAPINFO);
 147        pci_iounmap(pci, uwbbase);
 148
 149        return UWBCAPINFO_TO_N_CAPS(capinfo);
 150}
 151
 152static int whci_probe(struct pci_dev *pci, const struct pci_device_id *id)
 153{
 154        struct whci_card *card;
 155        int err, n_caps, n;
 156
 157        err = pci_enable_device(pci);
 158        if (err < 0)
 159                goto error;
 160        pci_enable_msi(pci);
 161        pci_set_master(pci);
 162        err = -ENXIO;
 163        if (!pci_set_dma_mask(pci, DMA_64BIT_MASK))
 164                pci_set_consistent_dma_mask(pci, DMA_64BIT_MASK);
 165        else if (!pci_set_dma_mask(pci, DMA_32BIT_MASK))
 166                pci_set_consistent_dma_mask(pci, DMA_32BIT_MASK);
 167        else
 168                goto error_dma;
 169
 170        err = n_caps = whci_n_caps(pci);
 171        if (n_caps < 0)
 172                goto error_ncaps;
 173
 174        err = -ENOMEM;
 175        card = kzalloc(sizeof(struct whci_card)
 176                       + sizeof(struct whci_dev *) * (n_caps + 1),
 177                       GFP_KERNEL);
 178        if (card == NULL)
 179                goto error_kzalloc;
 180        card->pci = pci;
 181        card->n_caps = n_caps;
 182
 183        err = -EBUSY;
 184        if (!request_mem_region(pci_resource_start(pci, 0),
 185                                UWBCAPDATA_SIZE(card->n_caps),
 186                                "whci (capability data)"))
 187                goto error_request_memregion;
 188        err = -ENOMEM;
 189        card->uwbbase = pci_iomap(pci, 0, UWBCAPDATA_SIZE(card->n_caps));
 190        if (!card->uwbbase)
 191                goto error_iomap;
 192
 193        /* Add each capability. */
 194        for (n = 0; n <= card->n_caps; n++) {
 195                err = whci_add_cap(card, n);
 196                if (err < 0 && n == 0) {
 197                        dev_err(&pci->dev, "cannot bind UWB radio controller:"
 198                                " %d\n", err);
 199                        goto error_bind;
 200                }
 201                if (err < 0)
 202                        dev_warn(&pci->dev, "warning: cannot bind capability "
 203                                 "#%u: %d\n", n, err);
 204        }
 205        pci_set_drvdata(pci, card);
 206        return 0;
 207
 208error_bind:
 209        pci_iounmap(pci, card->uwbbase);
 210error_iomap:
 211        release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
 212error_request_memregion:
 213        kfree(card);
 214error_kzalloc:
 215error_ncaps:
 216error_dma:
 217        pci_disable_msi(pci);
 218        pci_disable_device(pci);
 219error:
 220        return err;
 221}
 222
 223static void whci_remove(struct pci_dev *pci)
 224{
 225        struct whci_card *card = pci_get_drvdata(pci);
 226        int n;
 227
 228        pci_set_drvdata(pci, NULL);
 229        /* Unregister each capability in reverse (so the master device
 230         * is unregistered last). */
 231        for (n = card->n_caps; n >= 0 ; n--)
 232                whci_del_cap(card, n);
 233        pci_iounmap(pci, card->uwbbase);
 234        release_mem_region(pci_resource_start(pci, 0), UWBCAPDATA_SIZE(card->n_caps));
 235        kfree(card);
 236        pci_disable_msi(pci);
 237        pci_disable_device(pci);
 238}
 239
 240static struct pci_device_id whci_id_table[] = {
 241        { PCI_DEVICE_CLASS(PCI_CLASS_WIRELESS_WHCI, ~0) },
 242        { 0 },
 243};
 244MODULE_DEVICE_TABLE(pci, whci_id_table);
 245
 246
 247static struct pci_driver whci_driver = {
 248        .name     = "whci",
 249        .id_table = whci_id_table,
 250        .probe    = whci_probe,
 251        .remove   = whci_remove,
 252};
 253
 254static int __init whci_init(void)
 255{
 256        return pci_register_driver(&whci_driver);
 257}
 258
 259static void __exit whci_exit(void)
 260{
 261        pci_unregister_driver(&whci_driver);
 262}
 263
 264module_init(whci_init);
 265module_exit(whci_exit);
 266
 267MODULE_DESCRIPTION("WHCI UWB Multi-interface Controller enumerator");
 268MODULE_AUTHOR("Cambridge Silicon Radio Ltd.");
 269MODULE_LICENSE("GPL");
 270