diff options
-rw-r--r-- | drivers/net/wireless/b43/pio.c | 652 | ||||
-rw-r--r-- | drivers/net/wireless/b43/pio.h | 153 |
2 files changed, 0 insertions, 805 deletions
diff --git a/drivers/net/wireless/b43/pio.c b/drivers/net/wireless/b43/pio.c deleted file mode 100644 index 67752a28eb9c..000000000000 --- a/drivers/net/wireless/b43/pio.c +++ /dev/null | |||
@@ -1,652 +0,0 @@ | |||
1 | /* | ||
2 | |||
3 | Broadcom B43 wireless driver | ||
4 | |||
5 | PIO Transmission | ||
6 | |||
7 | Copyright (c) 2005 Michael Buesch <mb@bu3sch.de> | ||
8 | |||
9 | This program is free software; you can redistribute it and/or modify | ||
10 | it under the terms of the GNU General Public License as published by | ||
11 | the Free Software Foundation; either version 2 of the License, or | ||
12 | (at your option) any later version. | ||
13 | |||
14 | This program is distributed in the hope that it will be useful, | ||
15 | but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
17 | GNU General Public License for more details. | ||
18 | |||
19 | You should have received a copy of the GNU General Public License | ||
20 | along with this program; see the file COPYING. If not, write to | ||
21 | the Free Software Foundation, Inc., 51 Franklin Steet, Fifth Floor, | ||
22 | Boston, MA 02110-1301, USA. | ||
23 | |||
24 | */ | ||
25 | |||
26 | #include "b43.h" | ||
27 | #include "pio.h" | ||
28 | #include "main.h" | ||
29 | #include "xmit.h" | ||
30 | |||
31 | #include <linux/delay.h> | ||
32 | |||
33 | static void tx_start(struct b43_pioqueue *queue) | ||
34 | { | ||
35 | b43_pio_write(queue, B43_PIO_TXCTL, B43_PIO_TXCTL_INIT); | ||
36 | } | ||
37 | |||
38 | static void tx_octet(struct b43_pioqueue *queue, u8 octet) | ||
39 | { | ||
40 | if (queue->need_workarounds) { | ||
41 | b43_pio_write(queue, B43_PIO_TXDATA, octet); | ||
42 | b43_pio_write(queue, B43_PIO_TXCTL, B43_PIO_TXCTL_WRITELO); | ||
43 | } else { | ||
44 | b43_pio_write(queue, B43_PIO_TXCTL, B43_PIO_TXCTL_WRITELO); | ||
45 | b43_pio_write(queue, B43_PIO_TXDATA, octet); | ||
46 | } | ||
47 | } | ||
48 | |||
49 | static u16 tx_get_next_word(const u8 * txhdr, | ||
50 | const u8 * packet, | ||
51 | size_t txhdr_size, unsigned int *pos) | ||
52 | { | ||
53 | const u8 *source; | ||
54 | unsigned int i = *pos; | ||
55 | u16 ret; | ||
56 | |||
57 | if (i < txhdr_size) { | ||
58 | source = txhdr; | ||
59 | } else { | ||
60 | source = packet; | ||
61 | i -= txhdr_size; | ||
62 | } | ||
63 | ret = le16_to_cpu(*((__le16 *)(source + i))); | ||
64 | *pos += 2; | ||
65 | |||
66 | return ret; | ||
67 | } | ||
68 | |||
69 | static void tx_data(struct b43_pioqueue *queue, | ||
70 | u8 * txhdr, const u8 * packet, unsigned int octets) | ||
71 | { | ||
72 | u16 data; | ||
73 | unsigned int i = 0; | ||
74 | |||
75 | if (queue->need_workarounds) { | ||
76 | data = tx_get_next_word(txhdr, packet, | ||
77 | sizeof(struct b43_txhdr_fw4), &i); | ||
78 | b43_pio_write(queue, B43_PIO_TXDATA, data); | ||
79 | } | ||
80 | b43_pio_write(queue, B43_PIO_TXCTL, | ||
81 | B43_PIO_TXCTL_WRITELO | B43_PIO_TXCTL_WRITEHI); | ||
82 | while (i < octets - 1) { | ||
83 | data = tx_get_next_word(txhdr, packet, | ||
84 | sizeof(struct b43_txhdr_fw4), &i); | ||
85 | b43_pio_write(queue, B43_PIO_TXDATA, data); | ||
86 | } | ||
87 | if (octets % 2) | ||
88 | tx_octet(queue, | ||
89 | packet[octets - sizeof(struct b43_txhdr_fw4) - 1]); | ||
90 | } | ||
91 | |||
92 | static void tx_complete(struct b43_pioqueue *queue, struct sk_buff *skb) | ||
93 | { | ||
94 | if (queue->need_workarounds) { | ||
95 | b43_pio_write(queue, B43_PIO_TXDATA, skb->data[skb->len - 1]); | ||
96 | b43_pio_write(queue, B43_PIO_TXCTL, | ||
97 | B43_PIO_TXCTL_WRITELO | B43_PIO_TXCTL_COMPLETE); | ||
98 | } else { | ||
99 | b43_pio_write(queue, B43_PIO_TXCTL, B43_PIO_TXCTL_COMPLETE); | ||
100 | } | ||
101 | } | ||
102 | |||
103 | static u16 generate_cookie(struct b43_pioqueue *queue, | ||
104 | struct b43_pio_txpacket *packet) | ||
105 | { | ||
106 | u16 cookie = 0x0000; | ||
107 | u16 packetindex; | ||
108 | |||
109 | /* We use the upper 4 bits for the PIO | ||
110 | * controller ID and the lower 12 bits | ||
111 | * for the packet index (in the cache). | ||
112 | */ | ||
113 | switch (queue->mmio_base) { | ||
114 | case B43_MMIO_PIO1_BASE: | ||
115 | break; | ||
116 | case B43_MMIO_PIO2_BASE: | ||
117 | cookie = 0x1000; | ||
118 | break; | ||
119 | case B43_MMIO_PIO3_BASE: | ||
120 | cookie = 0x2000; | ||
121 | break; | ||
122 | case B43_MMIO_PIO4_BASE: | ||
123 | cookie = 0x3000; | ||
124 | break; | ||
125 | default: | ||
126 | B43_WARN_ON(1); | ||
127 | } | ||
128 | packetindex = packet->index; | ||
129 | B43_WARN_ON(packetindex & ~0x0FFF); | ||
130 | cookie |= (u16) packetindex; | ||
131 | |||
132 | return cookie; | ||
133 | } | ||
134 | |||
135 | static | ||
136 | struct b43_pioqueue *parse_cookie(struct b43_wldev *dev, | ||
137 | u16 cookie, struct b43_pio_txpacket **packet) | ||
138 | { | ||
139 | struct b43_pio *pio = &dev->pio; | ||
140 | struct b43_pioqueue *queue = NULL; | ||
141 | int packetindex; | ||
142 | |||
143 | switch (cookie & 0xF000) { | ||
144 | case 0x0000: | ||
145 | queue = pio->queue0; | ||
146 | break; | ||
147 | case 0x1000: | ||
148 | queue = pio->queue1; | ||
149 | break; | ||
150 | case 0x2000: | ||
151 | queue = pio->queue2; | ||
152 | break; | ||
153 | case 0x3000: | ||
154 | queue = pio->queue3; | ||
155 | break; | ||
156 | default: | ||
157 | B43_WARN_ON(1); | ||
158 | } | ||
159 | packetindex = (cookie & 0x0FFF); | ||
160 | B43_WARN_ON(!(packetindex >= 0 && packetindex < B43_PIO_MAXTXPACKETS)); | ||
161 | *packet = &(queue->tx_packets_cache[packetindex]); | ||
162 | |||
163 | return queue; | ||
164 | } | ||
165 | |||
166 | union txhdr_union { | ||
167 | struct b43_txhdr_fw4 txhdr_fw4; | ||
168 | }; | ||
169 | |||
170 | static void pio_tx_write_fragment(struct b43_pioqueue *queue, | ||
171 | struct sk_buff *skb, | ||
172 | struct b43_pio_txpacket *packet, | ||
173 | size_t txhdr_size) | ||
174 | { | ||
175 | union txhdr_union txhdr_data; | ||
176 | u8 *txhdr = NULL; | ||
177 | unsigned int octets; | ||
178 | |||
179 | txhdr = (u8 *) (&txhdr_data.txhdr_fw4); | ||
180 | |||
181 | B43_WARN_ON(skb_shinfo(skb)->nr_frags); | ||
182 | b43_generate_txhdr(queue->dev, | ||
183 | txhdr, skb->data, skb->len, | ||
184 | &packet->txstat.control, | ||
185 | generate_cookie(queue, packet)); | ||
186 | |||
187 | tx_start(queue); | ||
188 | octets = skb->len + txhdr_size; | ||
189 | if (queue->need_workarounds) | ||
190 | octets--; | ||
191 | tx_data(queue, txhdr, (u8 *) skb->data, octets); | ||
192 | tx_complete(queue, skb); | ||
193 | } | ||
194 | |||
195 | static void free_txpacket(struct b43_pio_txpacket *packet) | ||
196 | { | ||
197 | struct b43_pioqueue *queue = packet->queue; | ||
198 | |||
199 | if (packet->skb) | ||
200 | dev_kfree_skb_any(packet->skb); | ||
201 | list_move(&packet->list, &queue->txfree); | ||
202 | queue->nr_txfree++; | ||
203 | } | ||
204 | |||
205 | static int pio_tx_packet(struct b43_pio_txpacket *packet) | ||
206 | { | ||
207 | struct b43_pioqueue *queue = packet->queue; | ||
208 | struct sk_buff *skb = packet->skb; | ||
209 | u16 octets; | ||
210 | |||
211 | octets = (u16) skb->len + sizeof(struct b43_txhdr_fw4); | ||
212 | if (queue->tx_devq_size < octets) { | ||
213 | b43warn(queue->dev->wl, "PIO queue too small. " | ||
214 | "Dropping packet.\n"); | ||
215 | /* Drop it silently (return success) */ | ||
216 | free_txpacket(packet); | ||
217 | return 0; | ||
218 | } | ||
219 | B43_WARN_ON(queue->tx_devq_packets > B43_PIO_MAXTXDEVQPACKETS); | ||
220 | B43_WARN_ON(queue->tx_devq_used > queue->tx_devq_size); | ||
221 | /* Check if there is sufficient free space on the device | ||
222 | * TX queue. If not, return and let the TX tasklet | ||
223 | * retry later. | ||
224 | */ | ||
225 | if (queue->tx_devq_packets == B43_PIO_MAXTXDEVQPACKETS) | ||
226 | return -EBUSY; | ||
227 | if (queue->tx_devq_used + octets > queue->tx_devq_size) | ||
228 | return -EBUSY; | ||
229 | /* Now poke the device. */ | ||
230 | pio_tx_write_fragment(queue, skb, packet, sizeof(struct b43_txhdr_fw4)); | ||
231 | |||
232 | /* Account for the packet size. | ||
233 | * (We must not overflow the device TX queue) | ||
234 | */ | ||
235 | queue->tx_devq_packets++; | ||
236 | queue->tx_devq_used += octets; | ||
237 | |||
238 | /* Transmission started, everything ok, move the | ||
239 | * packet to the txrunning list. | ||
240 | */ | ||
241 | list_move_tail(&packet->list, &queue->txrunning); | ||
242 | |||
243 | return 0; | ||
244 | } | ||
245 | |||
246 | static void tx_tasklet(unsigned long d) | ||
247 | { | ||
248 | struct b43_pioqueue *queue = (struct b43_pioqueue *)d; | ||
249 | struct b43_wldev *dev = queue->dev; | ||
250 | unsigned long flags; | ||
251 | struct b43_pio_txpacket *packet, *tmp_packet; | ||
252 | int err; | ||
253 | u16 txctl; | ||
254 | |||
255 | spin_lock_irqsave(&dev->wl->irq_lock, flags); | ||
256 | if (queue->tx_frozen) | ||
257 | goto out_unlock; | ||
258 | txctl = b43_pio_read(queue, B43_PIO_TXCTL); | ||
259 | if (txctl & B43_PIO_TXCTL_SUSPEND) | ||
260 | goto out_unlock; | ||
261 | |||
262 | list_for_each_entry_safe(packet, tmp_packet, &queue->txqueue, list) { | ||
263 | /* Try to transmit the packet. This can fail, if | ||
264 | * the device queue is full. In case of failure, the | ||
265 | * packet is left in the txqueue. | ||
266 | * If transmission succeed, the packet is moved to txrunning. | ||
267 | * If it is impossible to transmit the packet, it | ||
268 | * is dropped. | ||
269 | */ | ||
270 | err = pio_tx_packet(packet); | ||
271 | if (err) | ||
272 | break; | ||
273 | } | ||
274 | out_unlock: | ||
275 | spin_unlock_irqrestore(&dev->wl->irq_lock, flags); | ||
276 | } | ||
277 | |||
278 | static void setup_txqueues(struct b43_pioqueue *queue) | ||
279 | { | ||
280 | struct b43_pio_txpacket *packet; | ||
281 | int i; | ||
282 | |||
283 | queue->nr_txfree = B43_PIO_MAXTXPACKETS; | ||
284 | for (i = 0; i < B43_PIO_MAXTXPACKETS; i++) { | ||
285 | packet = &(queue->tx_packets_cache[i]); | ||
286 | |||
287 | packet->queue = queue; | ||
288 | INIT_LIST_HEAD(&packet->list); | ||
289 | packet->index = i; | ||
290 | |||
291 | list_add(&packet->list, &queue->txfree); | ||
292 | } | ||
293 | } | ||
294 | |||
295 | static | ||
296 | struct b43_pioqueue *b43_setup_pioqueue(struct b43_wldev *dev, | ||
297 | u16 pio_mmio_base) | ||
298 | { | ||
299 | struct b43_pioqueue *queue; | ||
300 | u16 qsize; | ||
301 | |||
302 | queue = kzalloc(sizeof(*queue), GFP_KERNEL); | ||
303 | if (!queue) | ||
304 | goto out; | ||
305 | |||
306 | queue->dev = dev; | ||
307 | queue->mmio_base = pio_mmio_base; | ||
308 | queue->need_workarounds = (dev->dev->id.revision < 3); | ||
309 | |||
310 | INIT_LIST_HEAD(&queue->txfree); | ||
311 | INIT_LIST_HEAD(&queue->txqueue); | ||
312 | INIT_LIST_HEAD(&queue->txrunning); | ||
313 | tasklet_init(&queue->txtask, tx_tasklet, (unsigned long)queue); | ||
314 | |||
315 | b43_write32(dev, B43_MMIO_MACCTL, b43_read32(dev, B43_MMIO_MACCTL) | ||
316 | & ~B43_MACCTL_BE); | ||
317 | |||
318 | qsize = b43_read16(dev, queue->mmio_base + B43_PIO_TXQBUFSIZE); | ||
319 | if (qsize == 0) { | ||
320 | b43err(dev->wl, "This card does not support PIO " | ||
321 | "operation mode. Please use DMA mode " | ||
322 | "(module parameter pio=0).\n"); | ||
323 | goto err_freequeue; | ||
324 | } | ||
325 | if (qsize <= B43_PIO_TXQADJUST) { | ||
326 | b43err(dev->wl, "PIO tx device-queue too small (%u)\n", qsize); | ||
327 | goto err_freequeue; | ||
328 | } | ||
329 | qsize -= B43_PIO_TXQADJUST; | ||
330 | queue->tx_devq_size = qsize; | ||
331 | |||
332 | setup_txqueues(queue); | ||
333 | |||
334 | out: | ||
335 | return queue; | ||
336 | |||
337 | err_freequeue: | ||
338 | kfree(queue); | ||
339 | queue = NULL; | ||
340 | goto out; | ||
341 | } | ||
342 | |||
343 | static void cancel_transfers(struct b43_pioqueue *queue) | ||
344 | { | ||
345 | struct b43_pio_txpacket *packet, *tmp_packet; | ||
346 | |||
347 | tasklet_disable(&queue->txtask); | ||
348 | |||
349 | list_for_each_entry_safe(packet, tmp_packet, &queue->txrunning, list) | ||
350 | free_txpacket(packet); | ||
351 | list_for_each_entry_safe(packet, tmp_packet, &queue->txqueue, list) | ||
352 | free_txpacket(packet); | ||
353 | } | ||
354 | |||
355 | static void b43_destroy_pioqueue(struct b43_pioqueue *queue) | ||
356 | { | ||
357 | if (!queue) | ||
358 | return; | ||
359 | |||
360 | cancel_transfers(queue); | ||
361 | kfree(queue); | ||
362 | } | ||
363 | |||
364 | void b43_pio_free(struct b43_wldev *dev) | ||
365 | { | ||
366 | struct b43_pio *pio; | ||
367 | |||
368 | if (!b43_using_pio(dev)) | ||
369 | return; | ||
370 | pio = &dev->pio; | ||
371 | |||
372 | b43_destroy_pioqueue(pio->queue3); | ||
373 | pio->queue3 = NULL; | ||
374 | b43_destroy_pioqueue(pio->queue2); | ||
375 | pio->queue2 = NULL; | ||
376 | b43_destroy_pioqueue(pio->queue1); | ||
377 | pio->queue1 = NULL; | ||
378 | b43_destroy_pioqueue(pio->queue0); | ||
379 | pio->queue0 = NULL; | ||
380 | } | ||
381 | |||
382 | int b43_pio_init(struct b43_wldev *dev) | ||
383 | { | ||
384 | struct b43_pio *pio = &dev->pio; | ||
385 | struct b43_pioqueue *queue; | ||
386 | int err = -ENOMEM; | ||
387 | |||
388 | queue = b43_setup_pioqueue(dev, B43_MMIO_PIO1_BASE); | ||
389 | if (!queue) | ||
390 | goto out; | ||
391 | pio->queue0 = queue; | ||
392 | |||
393 | queue = b43_setup_pioqueue(dev, B43_MMIO_PIO2_BASE); | ||
394 | if (!queue) | ||
395 | goto err_destroy0; | ||
396 | pio->queue1 = queue; | ||
397 | |||
398 | queue = b43_setup_pioqueue(dev, B43_MMIO_PIO3_BASE); | ||
399 | if (!queue) | ||
400 | goto err_destroy1; | ||
401 | pio->queue2 = queue; | ||
402 | |||
403 | queue = b43_setup_pioqueue(dev, B43_MMIO_PIO4_BASE); | ||
404 | if (!queue) | ||
405 | goto err_destroy2; | ||
406 | pio->queue3 = queue; | ||
407 | |||
408 | if (dev->dev->id.revision < 3) | ||
409 | dev->irq_savedstate |= B43_IRQ_PIO_WORKAROUND; | ||
410 | |||
411 | b43dbg(dev->wl, "PIO initialized\n"); | ||
412 | err = 0; | ||
413 | out: | ||
414 | return err; | ||
415 | |||
416 | err_destroy2: | ||
417 | b43_destroy_pioqueue(pio->queue2); | ||
418 | pio->queue2 = NULL; | ||
419 | err_destroy1: | ||
420 | b43_destroy_pioqueue(pio->queue1); | ||
421 | pio->queue1 = NULL; | ||
422 | err_destroy0: | ||
423 | b43_destroy_pioqueue(pio->queue0); | ||
424 | pio->queue0 = NULL; | ||
425 | goto out; | ||
426 | } | ||
427 | |||
428 | int b43_pio_tx(struct b43_wldev *dev, | ||
429 | struct sk_buff *skb, struct ieee80211_tx_control *ctl) | ||
430 | { | ||
431 | struct b43_pioqueue *queue = dev->pio.queue1; | ||
432 | struct b43_pio_txpacket *packet; | ||
433 | |||
434 | B43_WARN_ON(queue->tx_suspended); | ||
435 | B43_WARN_ON(list_empty(&queue->txfree)); | ||
436 | |||
437 | packet = list_entry(queue->txfree.next, struct b43_pio_txpacket, list); | ||
438 | packet->skb = skb; | ||
439 | |||
440 | memset(&packet->txstat, 0, sizeof(packet->txstat)); | ||
441 | memcpy(&packet->txstat.control, ctl, sizeof(*ctl)); | ||
442 | |||
443 | list_move_tail(&packet->list, &queue->txqueue); | ||
444 | queue->nr_txfree--; | ||
445 | queue->nr_tx_packets++; | ||
446 | B43_WARN_ON(queue->nr_txfree >= B43_PIO_MAXTXPACKETS); | ||
447 | |||
448 | tasklet_schedule(&queue->txtask); | ||
449 | |||
450 | return 0; | ||
451 | } | ||
452 | |||
453 | void b43_pio_handle_txstatus(struct b43_wldev *dev, | ||
454 | const struct b43_txstatus *status) | ||
455 | { | ||
456 | struct b43_pioqueue *queue; | ||
457 | struct b43_pio_txpacket *packet; | ||
458 | |||
459 | queue = parse_cookie(dev, status->cookie, &packet); | ||
460 | if (B43_WARN_ON(!queue)) | ||
461 | return; | ||
462 | |||
463 | queue->tx_devq_packets--; | ||
464 | queue->tx_devq_used -= | ||
465 | (packet->skb->len + sizeof(struct b43_txhdr_fw4)); | ||
466 | |||
467 | if (status->acked) { | ||
468 | packet->txstat.flags |= IEEE80211_TX_STATUS_ACK; | ||
469 | } else { | ||
470 | if (!(packet->txstat.control.flags & IEEE80211_TXCTL_NO_ACK)) | ||
471 | packet->txstat.excessive_retries = 1; | ||
472 | } | ||
473 | if (status->frame_count == 0) { | ||
474 | /* The frame was not transmitted at all. */ | ||
475 | packet->txstat.retry_count = 0; | ||
476 | } else | ||
477 | packet->txstat.retry_count = status->frame_count - 1; | ||
478 | ieee80211_tx_status_irqsafe(dev->wl->hw, packet->skb, | ||
479 | &(packet->txstat)); | ||
480 | packet->skb = NULL; | ||
481 | |||
482 | free_txpacket(packet); | ||
483 | /* If there are packets on the txqueue, poke the tasklet | ||
484 | * to transmit them. | ||
485 | */ | ||
486 | if (!list_empty(&queue->txqueue)) | ||
487 | tasklet_schedule(&queue->txtask); | ||
488 | } | ||
489 | |||
490 | void b43_pio_get_tx_stats(struct b43_wldev *dev, | ||
491 | struct ieee80211_tx_queue_stats *stats) | ||
492 | { | ||
493 | struct b43_pio *pio = &dev->pio; | ||
494 | struct b43_pioqueue *queue; | ||
495 | struct ieee80211_tx_queue_stats_data *data; | ||
496 | |||
497 | queue = pio->queue1; | ||
498 | data = &(stats->data[0]); | ||
499 | data->len = B43_PIO_MAXTXPACKETS - queue->nr_txfree; | ||
500 | data->limit = B43_PIO_MAXTXPACKETS; | ||
501 | data->count = queue->nr_tx_packets; | ||
502 | } | ||
503 | |||
504 | static void pio_rx_error(struct b43_pioqueue *queue, | ||
505 | int clear_buffers, const char *error) | ||
506 | { | ||
507 | int i; | ||
508 | |||
509 | b43err(queue->dev->wl, "PIO RX error: %s\n", error); | ||
510 | b43_pio_write(queue, B43_PIO_RXCTL, B43_PIO_RXCTL_READY); | ||
511 | if (clear_buffers) { | ||
512 | B43_WARN_ON(queue->mmio_base != B43_MMIO_PIO1_BASE); | ||
513 | for (i = 0; i < 15; i++) { | ||
514 | /* Dummy read. */ | ||
515 | b43_pio_read(queue, B43_PIO_RXDATA); | ||
516 | } | ||
517 | } | ||
518 | } | ||
519 | |||
520 | void b43_pio_rx(struct b43_pioqueue *queue) | ||
521 | { | ||
522 | __le16 preamble[21] = { 0 }; | ||
523 | struct b43_rxhdr_fw4 *rxhdr; | ||
524 | u16 tmp, len; | ||
525 | u32 macstat; | ||
526 | int i, preamble_readwords; | ||
527 | struct sk_buff *skb; | ||
528 | |||
529 | tmp = b43_pio_read(queue, B43_PIO_RXCTL); | ||
530 | if (!(tmp & B43_PIO_RXCTL_DATAAVAILABLE)) | ||
531 | return; | ||
532 | b43_pio_write(queue, B43_PIO_RXCTL, B43_PIO_RXCTL_DATAAVAILABLE); | ||
533 | |||
534 | for (i = 0; i < 10; i++) { | ||
535 | tmp = b43_pio_read(queue, B43_PIO_RXCTL); | ||
536 | if (tmp & B43_PIO_RXCTL_READY) | ||
537 | goto data_ready; | ||
538 | udelay(10); | ||
539 | } | ||
540 | b43dbg(queue->dev->wl, "PIO RX timed out\n"); | ||
541 | return; | ||
542 | data_ready: | ||
543 | |||
544 | len = b43_pio_read(queue, B43_PIO_RXDATA); | ||
545 | if (unlikely(len > 0x700)) { | ||
546 | pio_rx_error(queue, 0, "len > 0x700"); | ||
547 | return; | ||
548 | } | ||
549 | if (unlikely(len == 0 && queue->mmio_base != B43_MMIO_PIO4_BASE)) { | ||
550 | pio_rx_error(queue, 0, "len == 0"); | ||
551 | return; | ||
552 | } | ||
553 | preamble[0] = cpu_to_le16(len); | ||
554 | if (queue->mmio_base == B43_MMIO_PIO4_BASE) | ||
555 | preamble_readwords = 14 / sizeof(u16); | ||
556 | else | ||
557 | preamble_readwords = 18 / sizeof(u16); | ||
558 | for (i = 0; i < preamble_readwords; i++) { | ||
559 | tmp = b43_pio_read(queue, B43_PIO_RXDATA); | ||
560 | preamble[i + 1] = cpu_to_le16(tmp); | ||
561 | } | ||
562 | rxhdr = (struct b43_rxhdr_fw4 *)preamble; | ||
563 | macstat = le32_to_cpu(rxhdr->mac_status); | ||
564 | if (macstat & B43_RX_MAC_FCSERR) { | ||
565 | pio_rx_error(queue, | ||
566 | (queue->mmio_base == B43_MMIO_PIO1_BASE), | ||
567 | "Frame FCS error"); | ||
568 | return; | ||
569 | } | ||
570 | if (queue->mmio_base == B43_MMIO_PIO4_BASE) { | ||
571 | /* We received an xmit status. */ | ||
572 | struct b43_hwtxstatus *hw; | ||
573 | |||
574 | hw = (struct b43_hwtxstatus *)(preamble + 1); | ||
575 | b43_handle_hwtxstatus(queue->dev, hw); | ||
576 | |||
577 | return; | ||
578 | } | ||
579 | |||
580 | skb = dev_alloc_skb(len); | ||
581 | if (unlikely(!skb)) { | ||
582 | pio_rx_error(queue, 1, "OOM"); | ||
583 | return; | ||
584 | } | ||
585 | skb_put(skb, len); | ||
586 | for (i = 0; i < len - 1; i += 2) { | ||
587 | tmp = b43_pio_read(queue, B43_PIO_RXDATA); | ||
588 | *((__le16 *)(skb->data + i)) = cpu_to_le16(tmp); | ||
589 | } | ||
590 | if (len % 2) { | ||
591 | tmp = b43_pio_read(queue, B43_PIO_RXDATA); | ||
592 | skb->data[len - 1] = (tmp & 0x00FF); | ||
593 | /* The specs say the following is required, but | ||
594 | * it is wrong and corrupts the PLCP. If we don't do | ||
595 | * this, the PLCP seems to be correct. So ifdef it out for now. | ||
596 | */ | ||
597 | #if 0 | ||
598 | if (rxflags2 & B43_RXHDR_FLAGS2_TYPE2FRAME) | ||
599 | skb->data[2] = (tmp & 0xFF00) >> 8; | ||
600 | else | ||
601 | skb->data[0] = (tmp & 0xFF00) >> 8; | ||
602 | #endif | ||
603 | } | ||
604 | b43_rx(queue->dev, skb, rxhdr); | ||
605 | } | ||
606 | |||
607 | void b43_pio_tx_suspend(struct b43_pioqueue *queue) | ||
608 | { | ||
609 | b43_power_saving_ctl_bits(queue->dev, B43_PS_AWAKE); | ||
610 | b43_pio_write(queue, B43_PIO_TXCTL, b43_pio_read(queue, B43_PIO_TXCTL) | ||
611 | | B43_PIO_TXCTL_SUSPEND); | ||
612 | } | ||
613 | |||
614 | void b43_pio_tx_resume(struct b43_pioqueue *queue) | ||
615 | { | ||
616 | b43_pio_write(queue, B43_PIO_TXCTL, b43_pio_read(queue, B43_PIO_TXCTL) | ||
617 | & ~B43_PIO_TXCTL_SUSPEND); | ||
618 | b43_power_saving_ctl_bits(queue->dev, 0); | ||
619 | tasklet_schedule(&queue->txtask); | ||
620 | } | ||
621 | |||
622 | void b43_pio_freeze_txqueues(struct b43_wldev *dev) | ||
623 | { | ||
624 | struct b43_pio *pio; | ||
625 | |||
626 | B43_WARN_ON(!b43_using_pio(dev)); | ||
627 | pio = &dev->pio; | ||
628 | pio->queue0->tx_frozen = 1; | ||
629 | pio->queue1->tx_frozen = 1; | ||
630 | pio->queue2->tx_frozen = 1; | ||
631 | pio->queue3->tx_frozen = 1; | ||
632 | } | ||
633 | |||
634 | void b43_pio_thaw_txqueues(struct b43_wldev *dev) | ||
635 | { | ||
636 | struct b43_pio *pio; | ||
637 | |||
638 | B43_WARN_ON(!b43_using_pio(dev)); | ||
639 | pio = &dev->pio; | ||
640 | pio->queue0->tx_frozen = 0; | ||
641 | pio->queue1->tx_frozen = 0; | ||
642 | pio->queue2->tx_frozen = 0; | ||
643 | pio->queue3->tx_frozen = 0; | ||
644 | if (!list_empty(&pio->queue0->txqueue)) | ||
645 | tasklet_schedule(&pio->queue0->txtask); | ||
646 | if (!list_empty(&pio->queue1->txqueue)) | ||
647 | tasklet_schedule(&pio->queue1->txtask); | ||
648 | if (!list_empty(&pio->queue2->txqueue)) | ||
649 | tasklet_schedule(&pio->queue2->txtask); | ||
650 | if (!list_empty(&pio->queue3->txqueue)) | ||
651 | tasklet_schedule(&pio->queue3->txtask); | ||
652 | } | ||
diff --git a/drivers/net/wireless/b43/pio.h b/drivers/net/wireless/b43/pio.h deleted file mode 100644 index 3488f2447bbf..000000000000 --- a/drivers/net/wireless/b43/pio.h +++ /dev/null | |||
@@ -1,153 +0,0 @@ | |||
1 | #ifndef B43_PIO_H_ | ||
2 | #define B43_PIO_H_ | ||
3 | |||
4 | #include "b43.h" | ||
5 | |||
6 | #include <linux/interrupt.h> | ||
7 | #include <linux/io.h> | ||
8 | #include <linux/list.h> | ||
9 | #include <linux/skbuff.h> | ||
10 | |||
11 | #define B43_PIO_TXCTL 0x00 | ||
12 | #define B43_PIO_TXDATA 0x02 | ||
13 | #define B43_PIO_TXQBUFSIZE 0x04 | ||
14 | #define B43_PIO_RXCTL 0x08 | ||
15 | #define B43_PIO_RXDATA 0x0A | ||
16 | |||
17 | #define B43_PIO_TXCTL_WRITELO (1 << 0) | ||
18 | #define B43_PIO_TXCTL_WRITEHI (1 << 1) | ||
19 | #define B43_PIO_TXCTL_COMPLETE (1 << 2) | ||
20 | #define B43_PIO_TXCTL_INIT (1 << 3) | ||
21 | #define B43_PIO_TXCTL_SUSPEND (1 << 7) | ||
22 | |||
23 | #define B43_PIO_RXCTL_DATAAVAILABLE (1 << 0) | ||
24 | #define B43_PIO_RXCTL_READY (1 << 1) | ||
25 | |||
26 | /* PIO constants */ | ||
27 | #define B43_PIO_MAXTXDEVQPACKETS 31 | ||
28 | #define B43_PIO_TXQADJUST 80 | ||
29 | |||
30 | /* PIO tuning knobs */ | ||
31 | #define B43_PIO_MAXTXPACKETS 256 | ||
32 | |||
33 | #ifdef CONFIG_B43_PIO | ||
34 | |||
35 | struct b43_pioqueue; | ||
36 | struct b43_xmitstatus; | ||
37 | |||
38 | struct b43_pio_txpacket { | ||
39 | struct b43_pioqueue *queue; | ||
40 | struct sk_buff *skb; | ||
41 | struct ieee80211_tx_status txstat; | ||
42 | struct list_head list; | ||
43 | u16 index; /* Index in the tx_packets_cache */ | ||
44 | }; | ||
45 | |||
46 | struct b43_pioqueue { | ||
47 | struct b43_wldev *dev; | ||
48 | u16 mmio_base; | ||
49 | |||
50 | bool tx_suspended; | ||
51 | bool tx_frozen; | ||
52 | bool need_workarounds; /* Workarounds needed for core.rev < 3 */ | ||
53 | |||
54 | /* Adjusted size of the device internal TX buffer. */ | ||
55 | u16 tx_devq_size; | ||
56 | /* Used octets of the device internal TX buffer. */ | ||
57 | u16 tx_devq_used; | ||
58 | /* Used packet slots in the device internal TX buffer. */ | ||
59 | u8 tx_devq_packets; | ||
60 | /* Packets from the txfree list can | ||
61 | * be taken on incoming TX requests. | ||
62 | */ | ||
63 | struct list_head txfree; | ||
64 | unsigned int nr_txfree; | ||
65 | /* Packets on the txqueue are queued, | ||
66 | * but not completely written to the chip, yet. | ||
67 | */ | ||
68 | struct list_head txqueue; | ||
69 | /* Packets on the txrunning queue are completely | ||
70 | * posted to the device. We are waiting for the txstatus. | ||
71 | */ | ||
72 | struct list_head txrunning; | ||
73 | /* Total number or packets sent. | ||
74 | * (This counter can obviously wrap). | ||
75 | */ | ||
76 | unsigned int nr_tx_packets; | ||
77 | struct tasklet_struct txtask; | ||
78 | struct b43_pio_txpacket tx_packets_cache[B43_PIO_MAXTXPACKETS]; | ||
79 | }; | ||
80 | |||
81 | static inline u16 b43_pio_read(struct b43_pioqueue *queue, u16 offset) | ||
82 | { | ||
83 | return b43_read16(queue->dev, queue->mmio_base + offset); | ||
84 | } | ||
85 | |||
86 | static inline | ||
87 | void b43_pio_write(struct b43_pioqueue *queue, u16 offset, u16 value) | ||
88 | { | ||
89 | b43_write16(queue->dev, queue->mmio_base + offset, value); | ||
90 | mmiowb(); | ||
91 | } | ||
92 | |||
93 | int b43_pio_init(struct b43_wldev *dev); | ||
94 | void b43_pio_free(struct b43_wldev *dev); | ||
95 | |||
96 | int b43_pio_tx(struct b43_wldev *dev, | ||
97 | struct sk_buff *skb, struct ieee80211_tx_control *ctl); | ||
98 | void b43_pio_handle_txstatus(struct b43_wldev *dev, | ||
99 | const struct b43_txstatus *status); | ||
100 | void b43_pio_get_tx_stats(struct b43_wldev *dev, | ||
101 | struct ieee80211_tx_queue_stats *stats); | ||
102 | void b43_pio_rx(struct b43_pioqueue *queue); | ||
103 | |||
104 | /* Suspend TX queue in hardware. */ | ||
105 | void b43_pio_tx_suspend(struct b43_pioqueue *queue); | ||
106 | void b43_pio_tx_resume(struct b43_pioqueue *queue); | ||
107 | /* Suspend (freeze) the TX tasklet (software level). */ | ||
108 | void b43_pio_freeze_txqueues(struct b43_wldev *dev); | ||
109 | void b43_pio_thaw_txqueues(struct b43_wldev *dev); | ||
110 | |||
111 | #else /* CONFIG_B43_PIO */ | ||
112 | |||
113 | static inline int b43_pio_init(struct b43_wldev *dev) | ||
114 | { | ||
115 | return 0; | ||
116 | } | ||
117 | static inline void b43_pio_free(struct b43_wldev *dev) | ||
118 | { | ||
119 | } | ||
120 | static inline | ||
121 | int b43_pio_tx(struct b43_wldev *dev, | ||
122 | struct sk_buff *skb, struct ieee80211_tx_control *ctl) | ||
123 | { | ||
124 | return 0; | ||
125 | } | ||
126 | static inline | ||
127 | void b43_pio_handle_txstatus(struct b43_wldev *dev, | ||
128 | const struct b43_txstatus *status) | ||
129 | { | ||
130 | } | ||
131 | static inline | ||
132 | void b43_pio_get_tx_stats(struct b43_wldev *dev, | ||
133 | struct ieee80211_tx_queue_stats *stats) | ||
134 | { | ||
135 | } | ||
136 | static inline void b43_pio_rx(struct b43_pioqueue *queue) | ||
137 | { | ||
138 | } | ||
139 | static inline void b43_pio_tx_suspend(struct b43_pioqueue *queue) | ||
140 | { | ||
141 | } | ||
142 | static inline void b43_pio_tx_resume(struct b43_pioqueue *queue) | ||
143 | { | ||
144 | } | ||
145 | static inline void b43_pio_freeze_txqueues(struct b43_wldev *dev) | ||
146 | { | ||
147 | } | ||
148 | static inline void b43_pio_thaw_txqueues(struct b43_wldev *dev) | ||
149 | { | ||
150 | } | ||
151 | |||
152 | #endif /* CONFIG_B43_PIO */ | ||
153 | #endif /* B43_PIO_H_ */ | ||