diff options
Diffstat (limited to 'drivers/net/wireless/rt2x00/rt2x00pci.c')
| -rw-r--r-- | drivers/net/wireless/rt2x00/rt2x00pci.c | 176 |
1 files changed, 0 insertions, 176 deletions
diff --git a/drivers/net/wireless/rt2x00/rt2x00pci.c b/drivers/net/wireless/rt2x00/rt2x00pci.c index a0c8caef3b0a..e87865e33113 100644 --- a/drivers/net/wireless/rt2x00/rt2x00pci.c +++ b/drivers/net/wireless/rt2x00/rt2x00pci.c | |||
| @@ -33,182 +33,6 @@ | |||
| 33 | #include "rt2x00pci.h" | 33 | #include "rt2x00pci.h" |
| 34 | 34 | ||
| 35 | /* | 35 | /* |
| 36 | * Register access. | ||
| 37 | */ | ||
| 38 | int rt2x00pci_regbusy_read(struct rt2x00_dev *rt2x00dev, | ||
| 39 | const unsigned int offset, | ||
| 40 | const struct rt2x00_field32 field, | ||
| 41 | u32 *reg) | ||
| 42 | { | ||
| 43 | unsigned int i; | ||
| 44 | |||
| 45 | if (!test_bit(DEVICE_STATE_PRESENT, &rt2x00dev->flags)) | ||
| 46 | return 0; | ||
| 47 | |||
| 48 | for (i = 0; i < REGISTER_BUSY_COUNT; i++) { | ||
| 49 | rt2x00pci_register_read(rt2x00dev, offset, reg); | ||
| 50 | if (!rt2x00_get_field32(*reg, field)) | ||
| 51 | return 1; | ||
| 52 | udelay(REGISTER_BUSY_DELAY); | ||
| 53 | } | ||
| 54 | |||
| 55 | ERROR(rt2x00dev, "Indirect register access failed: " | ||
| 56 | "offset=0x%.08x, value=0x%.08x\n", offset, *reg); | ||
| 57 | *reg = ~0; | ||
| 58 | |||
| 59 | return 0; | ||
| 60 | } | ||
| 61 | EXPORT_SYMBOL_GPL(rt2x00pci_regbusy_read); | ||
| 62 | |||
| 63 | bool rt2x00pci_rxdone(struct rt2x00_dev *rt2x00dev) | ||
| 64 | { | ||
| 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; | ||
| 69 | int max_rx = 16; | ||
| 70 | |||
| 71 | while (--max_rx) { | ||
| 72 | entry = rt2x00queue_get_entry(queue, Q_INDEX); | ||
| 73 | entry_priv = entry->priv_data; | ||
| 74 | |||
| 75 | if (rt2x00dev->ops->lib->get_entry_state(entry)) | ||
| 76 | break; | ||
| 77 | |||
| 78 | /* | ||
| 79 | * Fill in desc fields of the skb descriptor | ||
| 80 | */ | ||
| 81 | skbdesc = get_skb_frame_desc(entry->skb); | ||
| 82 | skbdesc->desc = entry_priv->desc; | ||
| 83 | skbdesc->desc_len = entry->queue->desc_size; | ||
| 84 | |||
| 85 | /* | ||
| 86 | * DMA is already done, notify rt2x00lib that | ||
| 87 | * it finished successfully. | ||
| 88 | */ | ||
| 89 | rt2x00lib_dmastart(entry); | ||
| 90 | rt2x00lib_dmadone(entry); | ||
| 91 | |||
| 92 | /* | ||
| 93 | * Send the frame to rt2x00lib for further processing. | ||
| 94 | */ | ||
| 95 | rt2x00lib_rxdone(entry, GFP_ATOMIC); | ||
| 96 | } | ||
| 97 | |||
| 98 | return !max_rx; | ||
| 99 | } | ||
| 100 | EXPORT_SYMBOL_GPL(rt2x00pci_rxdone); | ||
| 101 | |||
| 102 | void rt2x00pci_flush_queue(struct data_queue *queue, bool drop) | ||
| 103 | { | ||
| 104 | unsigned int i; | ||
| 105 | |||
| 106 | for (i = 0; !rt2x00queue_empty(queue) && i < 10; i++) | ||
| 107 | msleep(10); | ||
| 108 | } | ||
| 109 | EXPORT_SYMBOL_GPL(rt2x00pci_flush_queue); | ||
| 110 | |||
| 111 | /* | ||
| 112 | * Device initialization handlers. | ||
| 113 | */ | ||
| 114 | static int rt2x00pci_alloc_queue_dma(struct rt2x00_dev *rt2x00dev, | ||
| 115 | struct data_queue *queue) | ||
| 116 | { | ||
| 117 | struct queue_entry_priv_pci *entry_priv; | ||
| 118 | void *addr; | ||
| 119 | dma_addr_t dma; | ||
| 120 | unsigned int i; | ||
| 121 | |||
| 122 | /* | ||
| 123 | * Allocate DMA memory for descriptor and buffer. | ||
| 124 | */ | ||
| 125 | addr = dma_alloc_coherent(rt2x00dev->dev, | ||
| 126 | queue->limit * queue->desc_size, | ||
| 127 | &dma, GFP_KERNEL); | ||
| 128 | if (!addr) | ||
| 129 | return -ENOMEM; | ||
| 130 | |||
| 131 | memset(addr, 0, queue->limit * queue->desc_size); | ||
| 132 | |||
| 133 | /* | ||
| 134 | * Initialize all queue entries to contain valid addresses. | ||
| 135 | */ | ||
| 136 | for (i = 0; i < queue->limit; i++) { | ||
| 137 | entry_priv = queue->entries[i].priv_data; | ||
| 138 | entry_priv->desc = addr + i * queue->desc_size; | ||
| 139 | entry_priv->desc_dma = dma + i * queue->desc_size; | ||
| 140 | } | ||
| 141 | |||
| 142 | return 0; | ||
| 143 | } | ||
| 144 | |||
| 145 | static void rt2x00pci_free_queue_dma(struct rt2x00_dev *rt2x00dev, | ||
| 146 | struct data_queue *queue) | ||
| 147 | { | ||
| 148 | struct queue_entry_priv_pci *entry_priv = | ||
| 149 | queue->entries[0].priv_data; | ||
| 150 | |||
| 151 | if (entry_priv->desc) | ||
| 152 | dma_free_coherent(rt2x00dev->dev, | ||
| 153 | queue->limit * queue->desc_size, | ||
| 154 | entry_priv->desc, entry_priv->desc_dma); | ||
| 155 | entry_priv->desc = NULL; | ||
| 156 | } | ||
| 157 | |||
| 158 | int rt2x00pci_initialize(struct rt2x00_dev *rt2x00dev) | ||
| 159 | { | ||
| 160 | struct data_queue *queue; | ||
| 161 | int status; | ||
| 162 | |||
| 163 | /* | ||
| 164 | * Allocate DMA | ||
| 165 | */ | ||
| 166 | queue_for_each(rt2x00dev, queue) { | ||
| 167 | status = rt2x00pci_alloc_queue_dma(rt2x00dev, queue); | ||
| 168 | if (status) | ||
| 169 | goto exit; | ||
| 170 | } | ||
| 171 | |||
| 172 | /* | ||
| 173 | * Register interrupt handler. | ||
| 174 | */ | ||
| 175 | status = request_irq(rt2x00dev->irq, | ||
| 176 | rt2x00dev->ops->lib->irq_handler, | ||
| 177 | IRQF_SHARED, rt2x00dev->name, rt2x00dev); | ||
| 178 | if (status) { | ||
| 179 | ERROR(rt2x00dev, "IRQ %d allocation failed (error %d).\n", | ||
| 180 | rt2x00dev->irq, status); | ||
| 181 | goto exit; | ||
| 182 | } | ||
| 183 | |||
| 184 | return 0; | ||
| 185 | |||
| 186 | exit: | ||
| 187 | queue_for_each(rt2x00dev, queue) | ||
| 188 | rt2x00pci_free_queue_dma(rt2x00dev, queue); | ||
| 189 | |||
| 190 | return status; | ||
| 191 | } | ||
| 192 | EXPORT_SYMBOL_GPL(rt2x00pci_initialize); | ||
| 193 | |||
| 194 | void rt2x00pci_uninitialize(struct rt2x00_dev *rt2x00dev) | ||
| 195 | { | ||
| 196 | struct data_queue *queue; | ||
| 197 | |||
| 198 | /* | ||
| 199 | * Free irq line. | ||
| 200 | */ | ||
| 201 | free_irq(rt2x00dev->irq, rt2x00dev); | ||
| 202 | |||
| 203 | /* | ||
| 204 | * Free DMA | ||
| 205 | */ | ||
| 206 | queue_for_each(rt2x00dev, queue) | ||
| 207 | rt2x00pci_free_queue_dma(rt2x00dev, queue); | ||
| 208 | } | ||
| 209 | EXPORT_SYMBOL_GPL(rt2x00pci_uninitialize); | ||
| 210 | |||
| 211 | /* | ||
| 212 | * PCI driver handlers. | 36 | * PCI driver handlers. |
| 213 | */ | 37 | */ |
| 214 | static void rt2x00pci_free_reg(struct rt2x00_dev *rt2x00dev) | 38 | static void rt2x00pci_free_reg(struct rt2x00_dev *rt2x00dev) |
