2 Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
3 <http://rt2x00.serialmonkey.com>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the
17 Free Software Foundation, Inc.,
18 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 Abstract: rt2x00 generic pci device routines.
26 #include <linux/dma-mapping.h>
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/pci.h>
30 #include <linux/slab.h>
33 #include "rt2x00pci.h"
38 int rt2x00pci_regbusy_read(struct rt2x00_dev *rt2x00dev,
39 const unsigned int offset,
40 const struct rt2x00_field32 field,
45 if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags))
48 for (i = 0; i < REGISTER_BUSY_COUNT; i++) {
49 rt2x00pci_register_read(rt2x00dev, offset, reg);
50 if (!rt2x00_get_field32(*reg, field))
52 udelay(REGISTER_BUSY_DELAY);
55 ERROR(rt2x00dev, "Indirect register access failed: "
56 "offset=0x%.08x, value=0x%.08x\n", offset, *reg);
61 EXPORT_SYMBOL_GPL(rt2x00pci_regbusy_read);
63 bool rt2x00pci_rxdone(struct rt2x00_dev *rt2x00dev)
65 struct data_queue *queue = rt2x00dev->rx;
66 struct queue_entry *entry;
67 struct queue_entry_priv_pci *entry_priv;
68 struct skb_frame_desc *skbdesc;
72 entry = rt2x00queue_get_entry(queue, Q_INDEX);
73 entry_priv = entry->priv_data;
75 if (rt2x00dev->ops->lib->get_entry_state(entry))
79 * Fill in desc fields of the skb descriptor
81 skbdesc = get_skb_frame_desc(entry->skb);
82 skbdesc->desc = entry_priv->desc;
83 skbdesc->desc_len = entry->queue->desc_size;
86 * DMA is already done, notify rt2x00lib that
87 * it finished successfully.
89 rt2x00lib_dmastart(entry);
90 rt2x00lib_dmadone(entry);
93 * Send the frame to rt2x00lib for further processing.
95 rt2x00lib_rxdone(entry, GFP_ATOMIC);
100 EXPORT_SYMBOL_GPL(rt2x00pci_rxdone);
102 void rt2x00pci_flush_queue(struct data_queue *queue, bool drop)
106 for (i = 0; !rt2x00queue_empty(queue) && i < 10; i++)
109 EXPORT_SYMBOL_GPL(rt2x00pci_flush_queue);
112 * Device initialization handlers.
114 static int rt2x00pci_alloc_queue_dma(struct rt2x00_dev *rt2x00dev,
115 struct data_queue *queue)
117 struct queue_entry_priv_pci *entry_priv;
123 * Allocate DMA memory for descriptor and buffer.
125 addr = dma_alloc_coherent(rt2x00dev->dev,
126 queue->limit * queue->desc_size,
127 &dma, GFP_KERNEL | __GFP_ZERO);
132 * Initialize all queue entries to contain valid addresses.
134 for (i = 0; i < queue->limit; i++) {
135 entry_priv = queue->entries[i].priv_data;
136 entry_priv->desc = addr + i * queue->desc_size;
137 entry_priv->desc_dma = dma + i * queue->desc_size;
143 static void rt2x00pci_free_queue_dma(struct rt2x00_dev *rt2x00dev,
144 struct data_queue *queue)
146 struct queue_entry_priv_pci *entry_priv =
147 queue->entries[0].priv_data;
149 if (entry_priv->desc)
150 dma_free_coherent(rt2x00dev->dev,
151 queue->limit * queue->desc_size,
152 entry_priv->desc, entry_priv->desc_dma);
153 entry_priv->desc = NULL;
156 int rt2x00pci_initialize(struct rt2x00_dev *rt2x00dev)
158 struct data_queue *queue;
164 queue_for_each(rt2x00dev, queue) {
165 status = rt2x00pci_alloc_queue_dma(rt2x00dev, queue);
171 * Register interrupt handler.
173 status = request_irq(rt2x00dev->irq,
174 rt2x00dev->ops->lib->irq_handler,
175 IRQF_SHARED, rt2x00dev->name, rt2x00dev);
177 ERROR(rt2x00dev, "IRQ %d allocation failed (error %d).\n",
178 rt2x00dev->irq, status);
185 queue_for_each(rt2x00dev, queue)
186 rt2x00pci_free_queue_dma(rt2x00dev, queue);
190 EXPORT_SYMBOL_GPL(rt2x00pci_initialize);
192 void rt2x00pci_uninitialize(struct rt2x00_dev *rt2x00dev)
194 struct data_queue *queue;
199 free_irq(rt2x00dev->irq, rt2x00dev);
204 queue_for_each(rt2x00dev, queue)
205 rt2x00pci_free_queue_dma(rt2x00dev, queue);
207 EXPORT_SYMBOL_GPL(rt2x00pci_uninitialize);
210 * PCI driver handlers.
212 static void rt2x00pci_free_reg(struct rt2x00_dev *rt2x00dev)
214 kfree(rt2x00dev->rf);
215 rt2x00dev->rf = NULL;
217 kfree(rt2x00dev->eeprom);
218 rt2x00dev->eeprom = NULL;
220 if (rt2x00dev->csr.base) {
221 iounmap(rt2x00dev->csr.base);
222 rt2x00dev->csr.base = NULL;
226 static int rt2x00pci_alloc_reg(struct rt2x00_dev *rt2x00dev)
228 struct pci_dev *pci_dev = to_pci_dev(rt2x00dev->dev);
230 rt2x00dev->csr.base = pci_ioremap_bar(pci_dev, 0);
231 if (!rt2x00dev->csr.base)
234 rt2x00dev->eeprom = kzalloc(rt2x00dev->ops->eeprom_size, GFP_KERNEL);
235 if (!rt2x00dev->eeprom)
238 rt2x00dev->rf = kzalloc(rt2x00dev->ops->rf_size, GFP_KERNEL);
245 ERROR_PROBE("Failed to allocate registers.\n");
247 rt2x00pci_free_reg(rt2x00dev);
252 int rt2x00pci_probe(struct pci_dev *pci_dev, const struct rt2x00_ops *ops)
254 struct ieee80211_hw *hw;
255 struct rt2x00_dev *rt2x00dev;
259 retval = pci_enable_device(pci_dev);
261 ERROR_PROBE("Enable device failed.\n");
265 retval = pci_request_regions(pci_dev, pci_name(pci_dev));
267 ERROR_PROBE("PCI request regions failed.\n");
268 goto exit_disable_device;
271 pci_set_master(pci_dev);
273 if (pci_set_mwi(pci_dev))
274 ERROR_PROBE("MWI not available.\n");
276 if (dma_set_mask(&pci_dev->dev, DMA_BIT_MASK(32))) {
277 ERROR_PROBE("PCI DMA not supported.\n");
279 goto exit_release_regions;
282 hw = ieee80211_alloc_hw(sizeof(struct rt2x00_dev), ops->hw);
284 ERROR_PROBE("Failed to allocate hardware.\n");
286 goto exit_release_regions;
289 pci_set_drvdata(pci_dev, hw);
291 rt2x00dev = hw->priv;
292 rt2x00dev->dev = &pci_dev->dev;
293 rt2x00dev->ops = ops;
295 rt2x00dev->irq = pci_dev->irq;
296 rt2x00dev->name = pci_name(pci_dev);
298 if (pci_is_pcie(pci_dev))
299 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_PCIE);
301 rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_PCI);
303 retval = rt2x00pci_alloc_reg(rt2x00dev);
305 goto exit_free_device;
308 * Because rt3290 chip use different efuse offset to read efuse data.
309 * So before read efuse it need to indicate it is the
312 pci_read_config_word(pci_dev, PCI_DEVICE_ID, &chip);
313 rt2x00dev->chip.rt = chip;
315 retval = rt2x00lib_probe_dev(rt2x00dev);
322 rt2x00pci_free_reg(rt2x00dev);
325 ieee80211_free_hw(hw);
327 exit_release_regions:
328 pci_release_regions(pci_dev);
331 pci_disable_device(pci_dev);
333 pci_set_drvdata(pci_dev, NULL);
337 EXPORT_SYMBOL_GPL(rt2x00pci_probe);
339 void rt2x00pci_remove(struct pci_dev *pci_dev)
341 struct ieee80211_hw *hw = pci_get_drvdata(pci_dev);
342 struct rt2x00_dev *rt2x00dev = hw->priv;
345 * Free all allocated data.
347 rt2x00lib_remove_dev(rt2x00dev);
348 rt2x00pci_free_reg(rt2x00dev);
349 ieee80211_free_hw(hw);
352 * Free the PCI device data.
354 pci_set_drvdata(pci_dev, NULL);
355 pci_disable_device(pci_dev);
356 pci_release_regions(pci_dev);
358 EXPORT_SYMBOL_GPL(rt2x00pci_remove);
361 int rt2x00pci_suspend(struct pci_dev *pci_dev, pm_message_t state)
363 struct ieee80211_hw *hw = pci_get_drvdata(pci_dev);
364 struct rt2x00_dev *rt2x00dev = hw->priv;
367 retval = rt2x00lib_suspend(rt2x00dev, state);
371 pci_save_state(pci_dev);
372 pci_disable_device(pci_dev);
373 return pci_set_power_state(pci_dev, pci_choose_state(pci_dev, state));
375 EXPORT_SYMBOL_GPL(rt2x00pci_suspend);
377 int rt2x00pci_resume(struct pci_dev *pci_dev)
379 struct ieee80211_hw *hw = pci_get_drvdata(pci_dev);
380 struct rt2x00_dev *rt2x00dev = hw->priv;
382 if (pci_set_power_state(pci_dev, PCI_D0) ||
383 pci_enable_device(pci_dev)) {
384 ERROR(rt2x00dev, "Failed to resume device.\n");
388 pci_restore_state(pci_dev);
389 return rt2x00lib_resume(rt2x00dev);
391 EXPORT_SYMBOL_GPL(rt2x00pci_resume);
392 #endif /* CONFIG_PM */
395 * rt2x00pci module information.
397 MODULE_AUTHOR(DRV_PROJECT);
398 MODULE_VERSION(DRV_VERSION);
399 MODULE_DESCRIPTION("rt2x00 pci library");
400 MODULE_LICENSE("GPL");