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