SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/net/wireless/p54/p54pci.c

   1
   2 /*
   3  * Linux device driver for PCI based Prism54
   4  *
   5  * Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net>
   6  * Copyright (c) 2008, Christian Lamparter <chunkeey@web.de>
   7  *
   8  * Based on the islsm (softmac prism54) driver, which is:
   9  * Copyright 2004-2006 Jean-Baptiste Note <jean-baptiste.note@m4x.org>, et al.
  10  *
  11  * This program is free software; you can redistribute it and/or modify
  12  * it under the terms of the GNU General Public License version 2 as
  13  * published by the Free Software Foundation.
  14  */
  15
  16 #include <linux/init.h>
  17 #include <linux/pci.h>
  18 #include <linux/firmware.h>
  19 #include <linux/etherdevice.h>
  20 #include <linux/delay.h>
  21 #include <linux/completion.h>
  22 #include <net/mac80211.h>
  23
  24 #include "p54.h"
  25 #include "p54pci.h"
  26
  27 MODULE_AUTHOR("Michael Wu <flamingice@sourmilk.net>");
  28 MODULE_DESCRIPTION("Prism54 PCI wireless driver");
  29 MODULE_LICENSE("GPL");
  30 MODULE_ALIAS("prism54pci");
  31 MODULE_FIRMWARE("isl3886pci");
  32
  33 static struct pci_device_id p54p_table[] __devinitdata = {
  34         /* Intersil PRISM Duette/Prism GT Wireless LAN adapter */
  35         { PCI_DEVICE(0x1260, 0x3890) },
  36         /* 3COM 3CRWE154G72 Wireless LAN adapter */
  37         { PCI_DEVICE(0x10b7, 0x6001) },
  38         /* Intersil PRISM Indigo Wireless LAN adapter */
  39         { PCI_DEVICE(0x1260, 0x3877) },
  40         /* Intersil PRISM Javelin/Xbow Wireless LAN adapter */
  41         { PCI_DEVICE(0x1260, 0x3886) },
  42         { },
  43 };
  44
  45 MODULE_DEVICE_TABLE(pci, p54p_table);
  46
  47 static int p54p_upload_firmware(struct ieee80211_hw *dev)
  48 {
  49         struct p54p_priv *priv = dev->priv;
  50         __le32 reg;
  51         int err;
  52         __le32 *data;
  53         u32 remains, left, device_addr;
  54
  55         P54P_WRITE(int_enable, cpu_to_le32(0));
  56         P54P_READ(int_enable);
  57         udelay(10);
  58
  59         reg = P54P_READ(ctrl_stat);
  60         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_RESET);
  61         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_RAMBOOT);
  62         P54P_WRITE(ctrl_stat, reg);
  63         P54P_READ(ctrl_stat);
  64         udelay(10);
  65
  66         reg |= cpu_to_le32(ISL38XX_CTRL_STAT_RESET);
  67         P54P_WRITE(ctrl_stat, reg);
  68         wmb();
  69         udelay(10);
  70
  71         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_RESET);
  72         P54P_WRITE(ctrl_stat, reg);
  73         wmb();
  74
  75         /* wait for the firmware to reset properly */
  76         mdelay(10);
  77
  78         err = p54_parse_firmware(dev, priv->firmware);
  79         if (err)
  80                 return err;
  81
  82         if (priv->common.fw_interface != FW_LM86) {
  83                 dev_err(&priv->pdev->dev, "wrong firmware, "
  84                         "please get a LM86(PCI) firmware a try again.\n");
  85                 return -EINVAL;
  86         }
  87
  88         data = (__le32 *) priv->firmware->data;
  89         remains = priv->firmware->size;
  90         device_addr = ISL38XX_DEV_FIRMWARE_ADDR;
  91         while (remains) {
  92                 u32 i = 0;
  93                 left = min((u32)0x1000, remains);
  94                 P54P_WRITE(direct_mem_base, cpu_to_le32(device_addr));
  95                 P54P_READ(int_enable);
  96
  97                 device_addr += 0x1000;
  98                 while (i < left) {
  99                         P54P_WRITE(direct_mem_win[i], *data++);
 100                         i += sizeof(u32);
 101                 }
 102
 103                 remains -= left;
 104                 P54P_READ(int_enable);
 105         }
 106
 107         reg = P54P_READ(ctrl_stat);
 108         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_CLKRUN);
 109         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_RESET);
 110         reg |= cpu_to_le32(ISL38XX_CTRL_STAT_RAMBOOT);
 111         P54P_WRITE(ctrl_stat, reg);
 112         P54P_READ(ctrl_stat);
 113         udelay(10);
 114
 115         reg |= cpu_to_le32(ISL38XX_CTRL_STAT_RESET);
 116         P54P_WRITE(ctrl_stat, reg);
 117         wmb();
 118         udelay(10);
 119
 120         reg &= cpu_to_le32(~ISL38XX_CTRL_STAT_RESET);
 121         P54P_WRITE(ctrl_stat, reg);
 122         wmb();
 123         udelay(10);
 124
 125         /* wait for the firmware to boot properly */
 126         mdelay(100);
 127
 128         return 0;
 129 }
 130
 131 static void p54p_refill_rx_ring(struct ieee80211_hw *dev,
 132         int ring_index, struct p54p_desc *ring, u32 ring_limit,
 133         struct sk_buff **rx_buf)
 134 {
 135         struct p54p_priv *priv = dev->priv;
 136         struct p54p_ring_control *ring_control = priv->ring_control;
 137         u32 limit, idx, i;
 138
 139         idx = le32_to_cpu(ring_control->host_idx[ring_index]);
 140         limit = idx;
 141         limit -= le32_to_cpu(ring_control->device_idx[ring_index]);
 142         limit = ring_limit - limit;
 143
 144         i = idx % ring_limit;
 145         while (limit-- > 1) {
 146                 struct p54p_desc *desc = &ring[i];
 147
 148                 if (!desc->host_addr) {
 149                         struct sk_buff *skb;
 150                         dma_addr_t mapping;
 151                         skb = dev_alloc_skb(priv->common.rx_mtu + 32);
 152                         if (!skb)
 153                                 break;
 154
 155                         mapping = pci_map_single(priv->pdev,
 156                                                  skb_tail_pointer(skb),
 157                                                  priv->common.rx_mtu + 32,
 158                                                  PCI_DMA_FROMDEVICE);
 159                         desc->host_addr = cpu_to_le32(mapping);
 160                         desc->device_addr = 0;  // FIXME: necessary?
 161                         desc->len = cpu_to_le16(priv->common.rx_mtu + 32);
 162                         desc->flags = 0;
 163                         rx_buf[i] = skb;
 164                 }
 165
 166                 i++;
 167                 idx++;
 168                 i %= ring_limit;
 169         }
 170
 171         wmb();
 172         ring_control->host_idx[ring_index] = cpu_to_le32(idx);
 173 }
 174
 175 static void p54p_check_rx_ring(struct ieee80211_hw *dev, u32 *index,
 176         int ring_index, struct p54p_desc *ring, u32 ring_limit,
 177         struct sk_buff **rx_buf)
 178 {
 179         struct p54p_priv *priv = dev->priv;
 180         struct p54p_ring_control *ring_control = priv->ring_control;
 181         struct p54p_desc *desc;
 182         u32 idx, i;
 183
 184         i = (*index) % ring_limit;
 185         (*index) = idx = le32_to_cpu(ring_control->device_idx[ring_index]);
 186         idx %= ring_limit;
 187         while (i != idx) {
 188                 u16 len;
 189                 struct sk_buff *skb;
 190                 desc = &ring[i];
 191                 len = le16_to_cpu(desc->len);
 192                 skb = rx_buf[i];
 193
 194                 if (!skb) {
 195                         i++;
 196                         i %= ring_limit;
 197                         continue;
 198                 }
 199                 skb_put(skb, len);
 200
 201                 if (p54_rx(dev, skb)) {
 202                         pci_unmap_single(priv->pdev,
 203                                          le32_to_cpu(desc->host_addr),
 204                                          priv->common.rx_mtu + 32,
 205                                          PCI_DMA_FROMDEVICE);
 206                         rx_buf[i] = NULL;
 207                         desc->host_addr = 0;
 208                 } else {
 209                         skb_trim(skb, 0);
 210                         desc->len = cpu_to_le16(priv->common.rx_mtu + 32);
 211                 }
 212
 213                 i++;
 214                 i %= ring_limit;
 215         }
 216
 217         p54p_refill_rx_ring(dev, ring_index, ring, ring_limit, rx_buf);
 218 }
 219
 220 /* caller must hold priv->lock */
 221 static void p54p_check_tx_ring(struct ieee80211_hw *dev, u32 *index,
 222         int ring_index, struct p54p_desc *ring, u32 ring_limit,
 223         void **tx_buf)
 224 {
 225         struct p54p_priv *priv = dev->priv;
 226         struct p54p_ring_control *ring_control = priv->ring_control;
 227         struct p54p_desc *desc;
 228         u32 idx, i;
 229
 230         i = (*index) % ring_limit;
 231         (*index) = idx = le32_to_cpu(ring_control->device_idx[1]);
 232         idx %= ring_limit;
 233
 234         while (i != idx) {
 235                 desc = &ring[i];
 236                 if (tx_buf[i])
 237                         if (FREE_AFTER_TX((struct sk_buff *) tx_buf[i]))
 238                                 p54_free_skb(dev, tx_buf[i]);
 239                 tx_buf[i] = NULL;
 240
 241                 pci_unmap_single(priv->pdev, le32_to_cpu(desc->host_addr),
 242                                  le16_to_cpu(desc->len), PCI_DMA_TODEVICE);
 243
 244                 desc->host_addr = 0;
 245                 desc->device_addr = 0;
 246                 desc->len = 0;
 247                 desc->flags = 0;
 248
 249                 i++;
 250                 i %= ring_limit;
 251         }
 252 }
 253
 254 static void p54p_rx_tasklet(unsigned long dev_id)
 255 {
 256         struct ieee80211_hw *dev = (struct ieee80211_hw *)dev_id;
 257         struct p54p_priv *priv = dev->priv;
 258         struct p54p_ring_control *ring_control = priv->ring_control;
 259
 260         p54p_check_rx_ring(dev, &priv->rx_idx_mgmt, 2, ring_control->rx_mgmt,
 261                 ARRAY_SIZE(ring_control->rx_mgmt), priv->rx_buf_mgmt);
 262
 263         p54p_check_rx_ring(dev, &priv->rx_idx_data, 0, ring_control->rx_data,
 264                 ARRAY_SIZE(ring_control->rx_data), priv->rx_buf_data);
 265
 266         wmb();
 267         P54P_WRITE(dev_int, cpu_to_le32(ISL38XX_DEV_INT_UPDATE));
 268 }
 269
 270 static irqreturn_t p54p_interrupt(int irq, void *dev_id)
 271 {
 272         struct ieee80211_hw *dev = dev_id;
 273         struct p54p_priv *priv = dev->priv;
 274         struct p54p_ring_control *ring_control = priv->ring_control;
 275         __le32 reg;
 276
 277         spin_lock(&priv->lock);
 278         reg = P54P_READ(int_ident);
 279         if (unlikely(reg == cpu_to_le32(0xFFFFFFFF))) {
 280                 spin_unlock(&priv->lock);
 281                 return IRQ_HANDLED;
 282         }
 283
 284         P54P_WRITE(int_ack, reg);
 285
 286         reg &= P54P_READ(int_enable);
 287
 288         if (reg & cpu_to_le32(ISL38XX_INT_IDENT_UPDATE)) {
 289                 p54p_check_tx_ring(dev, &priv->tx_idx_mgmt,
 290                                    3, ring_control->tx_mgmt,
 291                                    ARRAY_SIZE(ring_control->tx_mgmt),
 292                                    priv->tx_buf_mgmt);
 293
 294                 p54p_check_tx_ring(dev, &priv->tx_idx_data,
 295                                    1, ring_control->tx_data,
 296                                    ARRAY_SIZE(ring_control->tx_data),
 297                                    priv->tx_buf_data);
 298
 299                 tasklet_schedule(&priv->rx_tasklet);
 300
 301         } else if (reg & cpu_to_le32(ISL38XX_INT_IDENT_INIT))
 302                 complete(&priv->boot_comp);
 303
 304         spin_unlock(&priv->lock);
 305
 306         return reg ? IRQ_HANDLED : IRQ_NONE;
 307 }
 308
 309 static void p54p_tx(struct ieee80211_hw *dev, struct sk_buff *skb)
 310 {
 311         struct p54p_priv *priv = dev->priv;
 312         struct p54p_ring_control *ring_control = priv->ring_control;
 313         unsigned long flags;
 314         struct p54p_desc *desc;
 315         dma_addr_t mapping;
 316         u32 device_idx, idx, i;
 317
 318         spin_lock_irqsave(&priv->lock, flags);
 319
 320         device_idx = le32_to_cpu(ring_control->device_idx[1]);
 321         idx = le32_to_cpu(ring_control->host_idx[1]);
 322         i = idx % ARRAY_SIZE(ring_control->tx_data);
 323
 324         priv->tx_buf_data[i] = skb;
 325         mapping = pci_map_single(priv->pdev, skb->data, skb->len,
 326                                  PCI_DMA_TODEVICE);
 327         desc = &ring_control->tx_data[i];
 328         desc->host_addr = cpu_to_le32(mapping);
 329         desc->device_addr = ((struct p54_hdr *)skb->data)->req_id;
 330         desc->len = cpu_to_le16(skb->len);
 331         desc->flags = 0;
 332
 333         wmb();
 334         ring_control->host_idx[1] = cpu_to_le32(idx + 1);
 335         spin_unlock_irqrestore(&priv->lock, flags);
 336
 337         P54P_WRITE(dev_int, cpu_to_le32(ISL38XX_DEV_INT_UPDATE));
 338         P54P_READ(dev_int);
 339 }
 340
 341 static void p54p_stop(struct ieee80211_hw *dev)
 342 {
 343         struct p54p_priv *priv = dev->priv;
 344         struct p54p_ring_control *ring_control = priv->ring_control;
 345         unsigned int i;
 346         struct p54p_desc *desc;
 347
 348         tasklet_kill(&priv->rx_tasklet);
 349
 350         P54P_WRITE(int_enable, cpu_to_le32(0));
 351         P54P_READ(int_enable);
 352         udelay(10);
 353
 354         free_irq(priv->pdev->irq, dev);
 355
 356         P54P_WRITE(dev_int, cpu_to_le32(ISL38XX_DEV_INT_RESET));
 357
 358         for (i = 0; i < ARRAY_SIZE(priv->rx_buf_data); i++) {
 359                 desc = &ring_control->rx_data[i];
 360                 if (desc->host_addr)
 361                         pci_unmap_single(priv->pdev,
 362                                          le32_to_cpu(desc->host_addr),
 363                                          priv->common.rx_mtu + 32,
 364                                          PCI_DMA_FROMDEVICE);
 365                 kfree_skb(priv->rx_buf_data[i]);
 366                 priv->rx_buf_data[i] = NULL;
 367         }
 368
 369         for (i = 0; i < ARRAY_SIZE(priv->rx_buf_mgmt); i++) {
 370                 desc = &ring_control->rx_mgmt[i];
 371                 if (desc->host_addr)
 372                         pci_unmap_single(priv->pdev,
 373                                          le32_to_cpu(desc->host_addr),
 374                                          priv->common.rx_mtu + 32,
 375                                          PCI_DMA_FROMDEVICE);
 376                 kfree_skb(priv->rx_buf_mgmt[i]);
 377                 priv->rx_buf_mgmt[i] = NULL;
 378         }
 379
 380         for (i = 0; i < ARRAY_SIZE(priv->tx_buf_data); i++) {
 381                 desc = &ring_control->tx_data[i];
 382                 if (desc->host_addr)
 383                         pci_unmap_single(priv->pdev,
 384                                          le32_to_cpu(desc->host_addr),
 385                                          le16_to_cpu(desc->len),
 386                                          PCI_DMA_TODEVICE);
 387
 388                 p54_free_skb(dev, priv->tx_buf_data[i]);
 389                 priv->tx_buf_data[i] = NULL;
 390         }
 391
 392         for (i = 0; i < ARRAY_SIZE(priv->tx_buf_mgmt); i++) {
 393                 desc = &ring_control->tx_mgmt[i];
 394                 if (desc->host_addr)
 395                         pci_unmap_single(priv->pdev,
 396                                          le32_to_cpu(desc->host_addr),
 397                                          le16_to_cpu(desc->len),
 398                                          PCI_DMA_TODEVICE);
 399
 400                 p54_free_skb(dev, priv->tx_buf_mgmt[i]);
 401                 priv->tx_buf_mgmt[i] = NULL;
 402         }
 403
 404         memset(ring_control, 0, sizeof(*ring_control));
 405 }
 406
 407 static int p54p_open(struct ieee80211_hw *dev)
 408 {
 409         struct p54p_priv *priv = dev->priv;
 410         int err;
 411
 412         init_completion(&priv->boot_comp);
 413         err = request_irq(priv->pdev->irq, &p54p_interrupt,
 414                           IRQF_SHARED, "p54pci", dev);
 415         if (err) {
 416                 printk(KERN_ERR "%s: failed to register IRQ handler\n",
 417                        wiphy_name(dev->wiphy));
 418                 return err;
 419         }
 420
 421         memset(priv->ring_control, 0, sizeof(*priv->ring_control));
 422         err = p54p_upload_firmware(dev);
 423         if (err) {
 424                 free_irq(priv->pdev->irq, dev);
 425                 return err;
 426         }
 427         priv->rx_idx_data = priv->tx_idx_data = 0;
 428         priv->rx_idx_mgmt = priv->tx_idx_mgmt = 0;
 429
 430         p54p_refill_rx_ring(dev, 0, priv->ring_control->rx_data,
 431                 ARRAY_SIZE(priv->ring_control->rx_data), priv->rx_buf_data);
 432
 433         p54p_refill_rx_ring(dev, 2, priv->ring_control->rx_mgmt,
 434                 ARRAY_SIZE(priv->ring_control->rx_mgmt), priv->rx_buf_mgmt);
 435
 436         P54P_WRITE(ring_control_base, cpu_to_le32(priv->ring_control_dma));
 437         P54P_READ(ring_control_base);
 438         wmb();
 439         udelay(10);
 440
 441         P54P_WRITE(int_enable, cpu_to_le32(ISL38XX_INT_IDENT_INIT));
 442         P54P_READ(int_enable);
 443         wmb();
 444         udelay(10);
 445
 446         P54P_WRITE(dev_int, cpu_to_le32(ISL38XX_DEV_INT_RESET));
 447         P54P_READ(dev_int);
 448
 449         if (!wait_for_completion_interruptible_timeout(&priv->boot_comp, HZ)) {
 450                 printk(KERN_ERR "%s: Cannot boot firmware!\n",
 451                        wiphy_name(dev->wiphy));
 452                 p54p_stop(dev);
 453                 return -ETIMEDOUT;
 454         }
 455
 456         P54P_WRITE(int_enable, cpu_to_le32(ISL38XX_INT_IDENT_UPDATE));
 457         P54P_READ(int_enable);
 458         wmb();
 459         udelay(10);
 460
 461         P54P_WRITE(dev_int, cpu_to_le32(ISL38XX_DEV_INT_UPDATE));
 462         P54P_READ(dev_int);
 463         wmb();
 464         udelay(10);
 465
 466         return 0;
 467 }
 468
 469 static int __devinit p54p_probe(struct pci_dev *pdev,
 470                                 const struct pci_device_id *id)
 471 {
 472         struct p54p_priv *priv;
 473         struct ieee80211_hw *dev;
 474         unsigned long mem_addr, mem_len;
 475         int err;
 476
 477         err = pci_enable_device(pdev);
 478         if (err) {
 479                 printk(KERN_ERR "%s (p54pci): Cannot enable new PCI device\n",
 480                        pci_name(pdev));
 481                 return err;
 482         }
 483
 484         mem_addr = pci_resource_start(pdev, 0);
 485         mem_len = pci_resource_len(pdev, 0);
 486         if (mem_len < sizeof(struct p54p_csr)) {
 487                 printk(KERN_ERR "%s (p54pci): Too short PCI resources\n",
 488                        pci_name(pdev));
 489                 goto err_disable_dev;
 490         }
 491
 492         err = pci_request_regions(pdev, "p54pci");
 493         if (err) {
 494                 printk(KERN_ERR "%s (p54pci): Cannot obtain PCI resources\n",
 495                        pci_name(pdev));
 496                 goto err_disable_dev;
 497         }
 498
 499         if (pci_set_dma_mask(pdev, DMA_32BIT_MASK) ||
 500             pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK)) {
 501                 printk(KERN_ERR "%s (p54pci): No suitable DMA available\n",
 502                        pci_name(pdev));
 503                 goto err_free_reg;
 504         }
 505
 506         pci_set_master(pdev);
 507         pci_try_set_mwi(pdev);
 508
 509         pci_write_config_byte(pdev, 0x40, 0);
 510         pci_write_config_byte(pdev, 0x41, 0);
 511
 512         dev = p54_init_common(sizeof(*priv));
 513         if (!dev) {
 514                 printk(KERN_ERR "%s (p54pci): ieee80211 alloc failed\n",
 515                        pci_name(pdev));
 516                 err = -ENOMEM;
 517                 goto err_free_reg;
 518         }
 519
 520         priv = dev->priv;
 521         priv->pdev = pdev;
 522
 523         SET_IEEE80211_DEV(dev, &pdev->dev);
 524         pci_set_drvdata(pdev, dev);
 525
 526         priv->map = ioremap(mem_addr, mem_len);
 527         if (!priv->map) {
 528                 printk(KERN_ERR "%s (p54pci): Cannot map device memory\n",
 529                        pci_name(pdev));
 530                 err = -EINVAL;  // TODO: use a better error code?
 531                 goto err_free_dev;
 532         }
 533
 534         priv->ring_control = pci_alloc_consistent(pdev, sizeof(*priv->ring_control),
 535                                                   &priv->ring_control_dma);
 536         if (!priv->ring_control) {
 537                 printk(KERN_ERR "%s (p54pci): Cannot allocate rings\n",
 538                        pci_name(pdev));
 539                 err = -ENOMEM;
 540                 goto err_iounmap;
 541         }
 542         priv->common.open = p54p_open;
 543         priv->common.stop = p54p_stop;
 544         priv->common.tx = p54p_tx;
 545
 546         spin_lock_init(&priv->lock);
 547         tasklet_init(&priv->rx_tasklet, p54p_rx_tasklet, (unsigned long)dev);
 548
 549         err = request_firmware(&priv->firmware, "isl3886pci",
 550                                &priv->pdev->dev);
 551         if (err) {
 552                 printk(KERN_ERR "%s (p54pci): cannot find firmware "
 553                         "(isl3886pci)\n", pci_name(priv->pdev));
 554                 err = request_firmware(&priv->firmware, "isl3886",
 555                                        &priv->pdev->dev);
 556                 if (err)
 557                         goto err_free_common;
 558         }
 559
 560         err = p54p_open(dev);
 561         if (err)
 562                 goto err_free_common;
 563         err = p54_read_eeprom(dev);
 564         p54p_stop(dev);
 565         if (err)
 566                 goto err_free_common;
 567
 568         err = ieee80211_register_hw(dev);
 569         if (err) {
 570                 printk(KERN_ERR "%s (p54pci): Cannot register netdevice\n",
 571                        pci_name(pdev));
 572                 goto err_free_common;
 573         }
 574
 575         return 0;
 576
 577  err_free_common:
 578         release_firmware(priv->firmware);
 579         p54_free_common(dev);
 580         pci_free_consistent(pdev, sizeof(*priv->ring_control),
 581                             priv->ring_control, priv->ring_control_dma);
 582
 583  err_iounmap:
 584         iounmap(priv->map);
 585
 586  err_free_dev:
 587         pci_set_drvdata(pdev, NULL);
 588         ieee80211_free_hw(dev);
 589
 590  err_free_reg:
 591         pci_release_regions(pdev);
 592  err_disable_dev:
 593         pci_disable_device(pdev);
 594         return err;
 595 }
 596
 597 static void __devexit p54p_remove(struct pci_dev *pdev)
 598 {
 599         struct ieee80211_hw *dev = pci_get_drvdata(pdev);
 600         struct p54p_priv *priv;
 601
 602         if (!dev)
 603                 return;
 604
 605         ieee80211_unregister_hw(dev);
 606         priv = dev->priv;
 607         release_firmware(priv->firmware);
 608         pci_free_consistent(pdev, sizeof(*priv->ring_control),
 609                             priv->ring_control, priv->ring_control_dma);
 610         p54_free_common(dev);
 611         iounmap(priv->map);
 612         pci_release_regions(pdev);
 613         pci_disable_device(pdev);
 614         ieee80211_free_hw(dev);
 615 }
 616
 617 #ifdef CONFIG_PM
 618 static int p54p_suspend(struct pci_dev *pdev, pm_message_t state)
 619 {
 620         struct ieee80211_hw *dev = pci_get_drvdata(pdev);
 621         struct p54p_priv *priv = dev->priv;
 622
 623         if (priv->common.mode != NL80211_IFTYPE_UNSPECIFIED) {
 624                 ieee80211_stop_queues(dev);
 625                 p54p_stop(dev);
 626         }
 627
 628         pci_save_state(pdev);
 629         pci_set_power_state(pdev, pci_choose_state(pdev, state));
 630         return 0;
 631 }
 632
 633 static int p54p_resume(struct pci_dev *pdev)
 634 {
 635         struct ieee80211_hw *dev = pci_get_drvdata(pdev);
 636         struct p54p_priv *priv = dev->priv;
 637
 638         pci_set_power_state(pdev, PCI_D0);
 639         pci_restore_state(pdev);
 640
 641         if (priv->common.mode != NL80211_IFTYPE_UNSPECIFIED) {
 642                 p54p_open(dev);
 643                 ieee80211_wake_queues(dev);
 644         }
 645
 646         return 0;
 647 }
 648 #endif /* CONFIG_PM */
 649
 650 static struct pci_driver p54p_driver = {
 651         .name           = "p54pci",
 652         .id_table       = p54p_table,
 653         .probe          = p54p_probe,
 654         .remove         = __devexit_p(p54p_remove),
 655 #ifdef CONFIG_PM
 656         .suspend        = p54p_suspend,
 657         .resume         = p54p_resume,
 658 #endif /* CONFIG_PM */
 659 };
 660
 661 static int __init p54p_init(void)
 662 {
 663         return pci_register_driver(&p54p_driver);
 664 }
 665
 666 static void __exit p54p_exit(void)
 667 {
 668         pci_unregister_driver(&p54p_driver);
 669 }
 670
 671 module_init(p54p_init);
 672 module_exit(p54p_exit);