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