1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#include <linux/compiler.h>
28#include <linux/kernel.h>
29#include <linux/module.h>
30#include <linux/list.h>
31#include <linux/completion.h>
32#include <linux/firmware.h>
33#include <linux/skbuff.h>
34#include <linux/usb.h>
35#include <net/mac80211.h>
36
37#include "ar5523.h"
38#include "ar5523_hw.h"
39
40
41
42
43
44
45static int ar5523_submit_rx_cmd(struct ar5523 *ar);
46static void ar5523_data_tx_pkt_put(struct ar5523 *ar);
47
48static void ar5523_read_reply(struct ar5523 *ar, struct ar5523_cmd_hdr *hdr,
49 struct ar5523_tx_cmd *cmd)
50{
51 int dlen, olen;
52 __be32 *rp;
53
54 dlen = be32_to_cpu(hdr->len) - sizeof(*hdr);
55
56 if (dlen < 0) {
57 WARN_ON(1);
58 goto out;
59 }
60
61 ar5523_dbg(ar, "Code = %d len = %d\n", be32_to_cpu(hdr->code) & 0xff,
62 dlen);
63
64 rp = (__be32 *)(hdr + 1);
65 if (dlen >= sizeof(u32)) {
66 olen = be32_to_cpu(rp[0]);
67 dlen -= sizeof(u32);
68 if (olen == 0) {
69
70 olen = sizeof(u32);
71 }
72 } else
73 olen = 0;
74
75 if (cmd->odata) {
76 if (cmd->olen < olen) {
77 ar5523_err(ar, "olen to small %d < %d\n",
78 cmd->olen, olen);
79 cmd->olen = 0;
80 cmd->res = -EOVERFLOW;
81 } else {
82 cmd->olen = olen;
83 memcpy(cmd->odata, &rp[1], olen);
84 cmd->res = 0;
85 }
86 }
87
88out:
89 complete(&cmd->done);
90}
91
92static void ar5523_cmd_rx_cb(struct urb *urb)
93{
94 struct ar5523 *ar = urb->context;
95 struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
96 struct ar5523_cmd_hdr *hdr = ar->rx_cmd_buf;
97 int dlen;
98 u32 code, hdrlen;
99
100 if (urb->status) {
101 if (urb->status != -ESHUTDOWN)
102 ar5523_err(ar, "RX USB error %d.\n", urb->status);
103 goto skip;
104 }
105
106 if (urb->actual_length < sizeof(struct ar5523_cmd_hdr)) {
107 ar5523_err(ar, "RX USB to short.\n");
108 goto skip;
109 }
110
111 ar5523_dbg(ar, "%s code %02x priv %d\n", __func__,
112 be32_to_cpu(hdr->code) & 0xff, hdr->priv);
113
114 code = be32_to_cpu(hdr->code);
115 hdrlen = be32_to_cpu(hdr->len);
116
117 switch (code & 0xff) {
118 default:
119
120 if (hdr->priv != AR5523_CMD_ID) {
121 ar5523_err(ar, "Unexpected command id: %02x\n",
122 code & 0xff);
123 goto skip;
124 }
125 ar5523_read_reply(ar, hdr, cmd);
126 break;
127
128 case WDCMSG_DEVICE_AVAIL:
129 ar5523_dbg(ar, "WDCMSG_DEVICE_AVAIL\n");
130 cmd->res = 0;
131 cmd->olen = 0;
132 complete(&cmd->done);
133 break;
134
135 case WDCMSG_SEND_COMPLETE:
136 ar5523_dbg(ar, "WDCMSG_SEND_COMPLETE: %d pending\n",
137 atomic_read(&ar->tx_nr_pending));
138 if (!test_bit(AR5523_HW_UP, &ar->flags))
139 ar5523_dbg(ar, "Unexpected WDCMSG_SEND_COMPLETE\n");
140 else {
141 mod_timer(&ar->tx_wd_timer,
142 jiffies + AR5523_TX_WD_TIMEOUT);
143 ar5523_data_tx_pkt_put(ar);
144
145 }
146 break;
147
148 case WDCMSG_TARGET_START:
149
150
151 dlen = hdrlen - sizeof(*hdr);
152 if (dlen != (int)sizeof(u32)) {
153 ar5523_err(ar, "Invalid reply to WDCMSG_TARGET_START");
154 return;
155 }
156 memcpy(cmd->odata, hdr + 1, sizeof(u32));
157 cmd->olen = sizeof(u32);
158 cmd->res = 0;
159 complete(&cmd->done);
160 break;
161
162 case WDCMSG_STATS_UPDATE:
163 ar5523_dbg(ar, "WDCMSG_STATS_UPDATE\n");
164 break;
165 }
166
167skip:
168 ar5523_submit_rx_cmd(ar);
169}
170
171static int ar5523_alloc_rx_cmd(struct ar5523 *ar)
172{
173 ar->rx_cmd_urb = usb_alloc_urb(0, GFP_KERNEL);
174 if (!ar->rx_cmd_urb)
175 return -ENOMEM;
176
177 ar->rx_cmd_buf = usb_alloc_coherent(ar->dev, AR5523_MAX_RXCMDSZ,
178 GFP_KERNEL,
179 &ar->rx_cmd_urb->transfer_dma);
180 if (!ar->rx_cmd_buf) {
181 usb_free_urb(ar->rx_cmd_urb);
182 return -ENOMEM;
183 }
184 return 0;
185}
186
187static void ar5523_cancel_rx_cmd(struct ar5523 *ar)
188{
189 usb_kill_urb(ar->rx_cmd_urb);
190}
191
192static void ar5523_free_rx_cmd(struct ar5523 *ar)
193{
194 usb_free_coherent(ar->dev, AR5523_MAX_RXCMDSZ,
195 ar->rx_cmd_buf, ar->rx_cmd_urb->transfer_dma);
196 usb_free_urb(ar->rx_cmd_urb);
197}
198
199static int ar5523_submit_rx_cmd(struct ar5523 *ar)
200{
201 int error;
202
203 usb_fill_bulk_urb(ar->rx_cmd_urb, ar->dev,
204 ar5523_cmd_rx_pipe(ar->dev), ar->rx_cmd_buf,
205 AR5523_MAX_RXCMDSZ, ar5523_cmd_rx_cb, ar);
206 ar->rx_cmd_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
207
208 error = usb_submit_urb(ar->rx_cmd_urb, GFP_ATOMIC);
209 if (error) {
210 if (error != -ENODEV)
211 ar5523_err(ar, "error %d when submitting rx urb\n",
212 error);
213 return error;
214 }
215 return 0;
216}
217
218
219
220
221static void ar5523_cmd_tx_cb(struct urb *urb)
222{
223 struct ar5523_tx_cmd *cmd = urb->context;
224 struct ar5523 *ar = cmd->ar;
225
226 if (urb->status) {
227 ar5523_err(ar, "Failed to TX command. Status = %d\n",
228 urb->status);
229 cmd->res = urb->status;
230 complete(&cmd->done);
231 return;
232 }
233
234 if (!(cmd->flags & AR5523_CMD_FLAG_READ)) {
235 cmd->res = 0;
236 complete(&cmd->done);
237 }
238}
239
240static int ar5523_cmd(struct ar5523 *ar, u32 code, const void *idata,
241 int ilen, void *odata, int olen, int flags)
242{
243 struct ar5523_cmd_hdr *hdr;
244 struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
245 int xferlen, error;
246
247
248 xferlen = (sizeof(struct ar5523_cmd_hdr) + ilen + 3) & ~3;
249
250 hdr = (struct ar5523_cmd_hdr *)cmd->buf_tx;
251 memset(hdr, 0, sizeof(struct ar5523_cmd_hdr));
252 hdr->len = cpu_to_be32(xferlen);
253 hdr->code = cpu_to_be32(code);
254 hdr->priv = AR5523_CMD_ID;
255
256 if (flags & AR5523_CMD_FLAG_MAGIC)
257 hdr->magic = cpu_to_be32(1 << 24);
258 memcpy(hdr + 1, idata, ilen);
259
260 cmd->odata = odata;
261 cmd->olen = olen;
262 cmd->flags = flags;
263
264 ar5523_dbg(ar, "do cmd %02x\n", code);
265
266 usb_fill_bulk_urb(cmd->urb_tx, ar->dev, ar5523_cmd_tx_pipe(ar->dev),
267 cmd->buf_tx, xferlen, ar5523_cmd_tx_cb, cmd);
268 cmd->urb_tx->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
269
270 error = usb_submit_urb(cmd->urb_tx, GFP_KERNEL);
271 if (error) {
272 ar5523_err(ar, "could not send command 0x%x, error=%d\n",
273 code, error);
274 return error;
275 }
276
277 if (!wait_for_completion_timeout(&cmd->done, 2 * HZ)) {
278 cmd->odata = NULL;
279 ar5523_err(ar, "timeout waiting for command %02x reply\n",
280 code);
281 cmd->res = -ETIMEDOUT;
282 }
283 return cmd->res;
284}
285
286static int ar5523_cmd_write(struct ar5523 *ar, u32 code, const void *data,
287 int len, int flags)
288{
289 flags &= ~AR5523_CMD_FLAG_READ;
290 return ar5523_cmd(ar, code, data, len, NULL, 0, flags);
291}
292
293static int ar5523_cmd_read(struct ar5523 *ar, u32 code, const void *idata,
294 int ilen, void *odata, int olen, int flags)
295{
296 flags |= AR5523_CMD_FLAG_READ;
297 return ar5523_cmd(ar, code, idata, ilen, odata, olen, flags);
298}
299
300static int ar5523_config(struct ar5523 *ar, u32 reg, u32 val)
301{
302 struct ar5523_write_mac write;
303 int error;
304
305 write.reg = cpu_to_be32(reg);
306 write.len = cpu_to_be32(0);
307 *(__be32 *)write.data = cpu_to_be32(val);
308
309 error = ar5523_cmd_write(ar, WDCMSG_TARGET_SET_CONFIG, &write,
310 3 * sizeof(u32), 0);
311 if (error != 0)
312 ar5523_err(ar, "could not write register 0x%02x\n", reg);
313 return error;
314}
315
316static int ar5523_config_multi(struct ar5523 *ar, u32 reg, const void *data,
317 int len)
318{
319 struct ar5523_write_mac write;
320 int error;
321
322 write.reg = cpu_to_be32(reg);
323 write.len = cpu_to_be32(len);
324 memcpy(write.data, data, len);
325
326
327 error = ar5523_cmd_write(ar, WDCMSG_TARGET_SET_CONFIG, &write,
328 (len == 0) ? sizeof(u32) : 2 * sizeof(u32) + len, 0);
329 if (error != 0)
330 ar5523_err(ar, "could not write %d bytes to register 0x%02x\n",
331 len, reg);
332 return error;
333}
334
335static int ar5523_get_status(struct ar5523 *ar, u32 which, void *odata,
336 int olen)
337{
338 int error;
339 __be32 which_be;
340
341 which_be = cpu_to_be32(which);
342 error = ar5523_cmd_read(ar, WDCMSG_TARGET_GET_STATUS,
343 &which_be, sizeof(which_be), odata, olen, AR5523_CMD_FLAG_MAGIC);
344 if (error != 0)
345 ar5523_err(ar, "could not read EEPROM offset 0x%02x\n", which);
346 return error;
347}
348
349static int ar5523_get_capability(struct ar5523 *ar, u32 cap, u32 *val)
350{
351 int error;
352 __be32 cap_be, val_be;
353
354 cap_be = cpu_to_be32(cap);
355 error = ar5523_cmd_read(ar, WDCMSG_TARGET_GET_CAPABILITY, &cap_be,
356 sizeof(cap_be), &val_be, sizeof(__be32),
357 AR5523_CMD_FLAG_MAGIC);
358 if (error != 0) {
359 ar5523_err(ar, "could not read capability %u\n", cap);
360 return error;
361 }
362 *val = be32_to_cpu(val_be);
363 return error;
364}
365
366static int ar5523_get_devcap(struct ar5523 *ar)
367{
368#define GETCAP(x) do { \
369 error = ar5523_get_capability(ar, x, &cap); \
370 if (error != 0) \
371 return error; \
372 ar5523_info(ar, "Cap: " \
373 "%s=0x%08x\n", #x, cap); \
374} while (0)
375 int error;
376 u32 cap;
377
378
379 GETCAP(CAP_TARGET_VERSION);
380 GETCAP(CAP_TARGET_REVISION);
381 GETCAP(CAP_MAC_VERSION);
382 GETCAP(CAP_MAC_REVISION);
383 GETCAP(CAP_PHY_REVISION);
384 GETCAP(CAP_ANALOG_5GHz_REVISION);
385 GETCAP(CAP_ANALOG_2GHz_REVISION);
386
387 GETCAP(CAP_REG_DOMAIN);
388 GETCAP(CAP_REG_CAP_BITS);
389 GETCAP(CAP_WIRELESS_MODES);
390 GETCAP(CAP_CHAN_SPREAD_SUPPORT);
391 GETCAP(CAP_COMPRESS_SUPPORT);
392 GETCAP(CAP_BURST_SUPPORT);
393 GETCAP(CAP_FAST_FRAMES_SUPPORT);
394 GETCAP(CAP_CHAP_TUNING_SUPPORT);
395 GETCAP(CAP_TURBOG_SUPPORT);
396 GETCAP(CAP_TURBO_PRIME_SUPPORT);
397 GETCAP(CAP_DEVICE_TYPE);
398 GETCAP(CAP_WME_SUPPORT);
399 GETCAP(CAP_TOTAL_QUEUES);
400 GETCAP(CAP_CONNECTION_ID_MAX);
401
402 GETCAP(CAP_LOW_5GHZ_CHAN);
403 GETCAP(CAP_HIGH_5GHZ_CHAN);
404 GETCAP(CAP_LOW_2GHZ_CHAN);
405 GETCAP(CAP_HIGH_2GHZ_CHAN);
406 GETCAP(CAP_TWICE_ANTENNAGAIN_5G);
407 GETCAP(CAP_TWICE_ANTENNAGAIN_2G);
408
409 GETCAP(CAP_CIPHER_AES_CCM);
410 GETCAP(CAP_CIPHER_TKIP);
411 GETCAP(CAP_MIC_TKIP);
412 return 0;
413}
414
415static int ar5523_set_ledsteady(struct ar5523 *ar, int lednum, int ledmode)
416{
417 struct ar5523_cmd_ledsteady led;
418
419 led.lednum = cpu_to_be32(lednum);
420 led.ledmode = cpu_to_be32(ledmode);
421
422 ar5523_dbg(ar, "set %s led %s (steady)\n",
423 (lednum == UATH_LED_LINK) ? "link" : "activity",
424 ledmode ? "on" : "off");
425 return ar5523_cmd_write(ar, WDCMSG_SET_LED_STEADY, &led, sizeof(led),
426 0);
427}
428
429static int ar5523_set_rxfilter(struct ar5523 *ar, u32 bits, u32 op)
430{
431 struct ar5523_cmd_rx_filter rxfilter;
432
433 rxfilter.bits = cpu_to_be32(bits);
434 rxfilter.op = cpu_to_be32(op);
435
436 ar5523_dbg(ar, "setting Rx filter=0x%x flags=0x%x\n", bits, op);
437 return ar5523_cmd_write(ar, WDCMSG_RX_FILTER, &rxfilter,
438 sizeof(rxfilter), 0);
439}
440
441static int ar5523_reset_tx_queues(struct ar5523 *ar)
442{
443 __be32 qid = cpu_to_be32(0);
444
445 ar5523_dbg(ar, "resetting Tx queue\n");
446 return ar5523_cmd_write(ar, WDCMSG_RELEASE_TX_QUEUE,
447 &qid, sizeof(qid), 0);
448}
449
450static int ar5523_set_chan(struct ar5523 *ar)
451{
452 struct ieee80211_conf *conf = &ar->hw->conf;
453
454 struct ar5523_cmd_reset reset;
455
456 memset(&reset, 0, sizeof(reset));
457 reset.flags |= cpu_to_be32(UATH_CHAN_2GHZ);
458 reset.flags |= cpu_to_be32(UATH_CHAN_OFDM);
459 reset.freq = cpu_to_be32(conf->chandef.chan->center_freq);
460 reset.maxrdpower = cpu_to_be32(50);
461 reset.channelchange = cpu_to_be32(1);
462 reset.keeprccontent = cpu_to_be32(0);
463
464 ar5523_dbg(ar, "set chan flags 0x%x freq %d\n",
465 be32_to_cpu(reset.flags),
466 conf->chandef.chan->center_freq);
467 return ar5523_cmd_write(ar, WDCMSG_RESET, &reset, sizeof(reset), 0);
468}
469
470static int ar5523_queue_init(struct ar5523 *ar)
471{
472 struct ar5523_cmd_txq_setup qinfo;
473
474 ar5523_dbg(ar, "setting up Tx queue\n");
475 qinfo.qid = cpu_to_be32(0);
476 qinfo.len = cpu_to_be32(sizeof(qinfo.attr));
477 qinfo.attr.priority = cpu_to_be32(0);
478 qinfo.attr.aifs = cpu_to_be32(3);
479 qinfo.attr.logcwmin = cpu_to_be32(4);
480 qinfo.attr.logcwmax = cpu_to_be32(10);
481 qinfo.attr.bursttime = cpu_to_be32(0);
482 qinfo.attr.mode = cpu_to_be32(0);
483 qinfo.attr.qflags = cpu_to_be32(1);
484 return ar5523_cmd_write(ar, WDCMSG_SETUP_TX_QUEUE, &qinfo,
485 sizeof(qinfo), 0);
486}
487
488static int ar5523_switch_chan(struct ar5523 *ar)
489{
490 int error;
491
492 error = ar5523_set_chan(ar);
493 if (error) {
494 ar5523_err(ar, "could not set chan, error %d\n", error);
495 goto out_err;
496 }
497
498
499 error = ar5523_reset_tx_queues(ar);
500 if (error) {
501 ar5523_err(ar, "could not reset Tx queues, error %d\n",
502 error);
503 goto out_err;
504 }
505
506 error = ar5523_queue_init(ar);
507 if (error)
508 ar5523_err(ar, "could not init wme, error %d\n", error);
509
510out_err:
511 return error;
512}
513
514static void ar5523_rx_data_put(struct ar5523 *ar,
515 struct ar5523_rx_data *data)
516{
517 unsigned long flags;
518 spin_lock_irqsave(&ar->rx_data_list_lock, flags);
519 list_move(&data->list, &ar->rx_data_free);
520 spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
521}
522
523static void ar5523_data_rx_cb(struct urb *urb)
524{
525 struct ar5523_rx_data *data = urb->context;
526 struct ar5523 *ar = data->ar;
527 struct ar5523_rx_desc *desc;
528 struct ar5523_chunk *chunk;
529 struct ieee80211_hw *hw = ar->hw;
530 struct ieee80211_rx_status *rx_status;
531 u32 rxlen;
532 int usblen = urb->actual_length;
533 int hdrlen, pad;
534
535 ar5523_dbg(ar, "%s\n", __func__);
536
537 if (urb->status) {
538 if (urb->status != -ESHUTDOWN)
539 ar5523_err(ar, "%s: USB err: %d\n", __func__,
540 urb->status);
541 goto skip;
542 }
543
544 if (usblen < AR5523_MIN_RXBUFSZ) {
545 ar5523_err(ar, "RX: wrong xfer size (usblen=%d)\n", usblen);
546 goto skip;
547 }
548
549 chunk = (struct ar5523_chunk *) data->skb->data;
550
551 if (((chunk->flags & UATH_CFLAGS_FINAL) == 0) ||
552 chunk->seqnum != 0) {
553 ar5523_dbg(ar, "RX: No final flag. s: %d f: %02x l: %d\n",
554 chunk->seqnum, chunk->flags,
555 be16_to_cpu(chunk->length));
556 goto skip;
557 }
558
559
560 desc = (struct ar5523_rx_desc *)
561 (data->skb->data + usblen - sizeof(struct ar5523_rx_desc));
562
563 rxlen = be32_to_cpu(desc->len);
564 if (rxlen > ar->rxbufsz) {
565 ar5523_dbg(ar, "RX: Bad descriptor (len=%d)\n",
566 be32_to_cpu(desc->len));
567 goto skip;
568 }
569
570 if (!rxlen) {
571 ar5523_dbg(ar, "RX: rxlen is 0\n");
572 goto skip;
573 }
574
575 if (be32_to_cpu(desc->status) != 0) {
576 ar5523_dbg(ar, "Bad RX status (0x%x len = %d). Skip\n",
577 be32_to_cpu(desc->status), be32_to_cpu(desc->len));
578 goto skip;
579 }
580
581 skb_reserve(data->skb, sizeof(*chunk));
582 skb_put(data->skb, rxlen - sizeof(struct ar5523_rx_desc));
583
584 hdrlen = ieee80211_get_hdrlen_from_skb(data->skb);
585 if (!IS_ALIGNED(hdrlen, 4)) {
586 ar5523_dbg(ar, "eek, alignment workaround activated\n");
587 pad = ALIGN(hdrlen, 4) - hdrlen;
588 memmove(data->skb->data + pad, data->skb->data, hdrlen);
589 skb_pull(data->skb, pad);
590 skb_put(data->skb, pad);
591 }
592
593 rx_status = IEEE80211_SKB_RXCB(data->skb);
594 memset(rx_status, 0, sizeof(*rx_status));
595 rx_status->freq = be32_to_cpu(desc->channel);
596 rx_status->band = hw->conf.chandef.chan->band;
597 rx_status->signal = -95 + be32_to_cpu(desc->rssi);
598
599 ieee80211_rx_irqsafe(hw, data->skb);
600 data->skb = NULL;
601
602skip:
603 if (data->skb) {
604 dev_kfree_skb_irq(data->skb);
605 data->skb = NULL;
606 }
607
608 ar5523_rx_data_put(ar, data);
609 if (atomic_inc_return(&ar->rx_data_free_cnt) >=
610 AR5523_RX_DATA_REFILL_COUNT &&
611 test_bit(AR5523_HW_UP, &ar->flags))
612 queue_work(ar->wq, &ar->rx_refill_work);
613}
614
615static void ar5523_rx_refill_work(struct work_struct *work)
616{
617 struct ar5523 *ar = container_of(work, struct ar5523, rx_refill_work);
618 struct ar5523_rx_data *data;
619 unsigned long flags;
620 int error;
621
622 ar5523_dbg(ar, "%s\n", __func__);
623 do {
624 spin_lock_irqsave(&ar->rx_data_list_lock, flags);
625
626 if (!list_empty(&ar->rx_data_free))
627 data = (struct ar5523_rx_data *) ar->rx_data_free.next;
628 else
629 data = NULL;
630 spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
631
632 if (!data)
633 goto done;
634
635 data->skb = alloc_skb(ar->rxbufsz, GFP_KERNEL);
636 if (!data->skb) {
637 ar5523_err(ar, "could not allocate rx skbuff\n");
638 return;
639 }
640
641 usb_fill_bulk_urb(data->urb, ar->dev,
642 ar5523_data_rx_pipe(ar->dev), data->skb->data,
643 ar->rxbufsz, ar5523_data_rx_cb, data);
644
645 spin_lock_irqsave(&ar->rx_data_list_lock, flags);
646 list_move(&data->list, &ar->rx_data_used);
647 spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
648 atomic_dec(&ar->rx_data_free_cnt);
649
650 error = usb_submit_urb(data->urb, GFP_KERNEL);
651 if (error) {
652 kfree_skb(data->skb);
653 if (error != -ENODEV)
654 ar5523_err(ar, "Err sending rx data urb %d\n",
655 error);
656 ar5523_rx_data_put(ar, data);
657 atomic_inc(&ar->rx_data_free_cnt);
658 return;
659 }
660
661 } while (true);
662done:
663 return;
664}
665
666static void ar5523_cancel_rx_bufs(struct ar5523 *ar)
667{
668 struct ar5523_rx_data *data;
669 unsigned long flags;
670
671 do {
672 spin_lock_irqsave(&ar->rx_data_list_lock, flags);
673 if (!list_empty(&ar->rx_data_used))
674 data = (struct ar5523_rx_data *) ar->rx_data_used.next;
675 else
676 data = NULL;
677 spin_unlock_irqrestore(&ar->rx_data_list_lock, flags);
678
679 if (!data)
680 break;
681
682 usb_kill_urb(data->urb);
683 list_move(&data->list, &ar->rx_data_free);
684 atomic_inc(&ar->rx_data_free_cnt);
685 } while (data);
686}
687
688static void ar5523_free_rx_bufs(struct ar5523 *ar)
689{
690 struct ar5523_rx_data *data;
691
692 ar5523_cancel_rx_bufs(ar);
693 while (!list_empty(&ar->rx_data_free)) {
694 data = (struct ar5523_rx_data *) ar->rx_data_free.next;
695 list_del(&data->list);
696 usb_free_urb(data->urb);
697 }
698}
699
700static int ar5523_alloc_rx_bufs(struct ar5523 *ar)
701{
702 int i;
703
704 for (i = 0; i < AR5523_RX_DATA_COUNT; i++) {
705 struct ar5523_rx_data *data = &ar->rx_data[i];
706
707 data->ar = ar;
708 data->urb = usb_alloc_urb(0, GFP_KERNEL);
709 if (!data->urb)
710 goto err;
711 list_add_tail(&data->list, &ar->rx_data_free);
712 atomic_inc(&ar->rx_data_free_cnt);
713 }
714 return 0;
715
716err:
717 ar5523_free_rx_bufs(ar);
718 return -ENOMEM;
719}
720
721static void ar5523_data_tx_pkt_put(struct ar5523 *ar)
722{
723 atomic_dec(&ar->tx_nr_total);
724 if (!atomic_dec_return(&ar->tx_nr_pending)) {
725 del_timer(&ar->tx_wd_timer);
726 wake_up(&ar->tx_flush_waitq);
727 }
728
729 if (atomic_read(&ar->tx_nr_total) < AR5523_TX_DATA_RESTART_COUNT) {
730 ar5523_dbg(ar, "restart tx queue\n");
731 ieee80211_wake_queues(ar->hw);
732 }
733}
734
735static void ar5523_data_tx_cb(struct urb *urb)
736{
737 struct sk_buff *skb = urb->context;
738 struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);
739 struct ar5523_tx_data *data = (struct ar5523_tx_data *)
740 txi->driver_data;
741 struct ar5523 *ar = data->ar;
742 unsigned long flags;
743
744 ar5523_dbg(ar, "data tx urb completed: %d\n", urb->status);
745
746 spin_lock_irqsave(&ar->tx_data_list_lock, flags);
747 list_del(&data->list);
748 spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
749
750 if (urb->status) {
751 ar5523_dbg(ar, "%s: urb status: %d\n", __func__, urb->status);
752 ar5523_data_tx_pkt_put(ar);
753 ieee80211_free_txskb(ar->hw, skb);
754 } else {
755 skb_pull(skb, sizeof(struct ar5523_tx_desc) + sizeof(__be32));
756 ieee80211_tx_status_irqsafe(ar->hw, skb);
757 }
758 usb_free_urb(urb);
759}
760
761static void ar5523_tx(struct ieee80211_hw *hw,
762 struct ieee80211_tx_control *control,
763 struct sk_buff *skb)
764{
765 struct ieee80211_tx_info *txi = IEEE80211_SKB_CB(skb);
766 struct ar5523_tx_data *data = (struct ar5523_tx_data *)
767 txi->driver_data;
768 struct ar5523 *ar = hw->priv;
769 unsigned long flags;
770
771 ar5523_dbg(ar, "tx called\n");
772 if (atomic_inc_return(&ar->tx_nr_total) >= AR5523_TX_DATA_COUNT) {
773 ar5523_dbg(ar, "tx queue full\n");
774 ar5523_dbg(ar, "stop queues (tot %d pend %d)\n",
775 atomic_read(&ar->tx_nr_total),
776 atomic_read(&ar->tx_nr_pending));
777 ieee80211_stop_queues(hw);
778 }
779
780 spin_lock_irqsave(&ar->tx_data_list_lock, flags);
781 list_add_tail(&data->list, &ar->tx_queue_pending);
782 spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
783
784 ieee80211_queue_work(ar->hw, &ar->tx_work);
785}
786
787static void ar5523_tx_work_locked(struct ar5523 *ar)
788{
789 struct ar5523_tx_data *data;
790 struct ar5523_tx_desc *desc;
791 struct ar5523_chunk *chunk;
792 struct ieee80211_tx_info *txi;
793 struct urb *urb;
794 struct sk_buff *skb;
795 int error = 0, paylen;
796 u32 txqid;
797 unsigned long flags;
798
799 BUILD_BUG_ON(sizeof(struct ar5523_tx_data) >
800 IEEE80211_TX_INFO_DRIVER_DATA_SIZE);
801
802 ar5523_dbg(ar, "%s\n", __func__);
803 do {
804 spin_lock_irqsave(&ar->tx_data_list_lock, flags);
805 if (!list_empty(&ar->tx_queue_pending)) {
806 data = (struct ar5523_tx_data *)
807 ar->tx_queue_pending.next;
808 list_del(&data->list);
809 } else
810 data = NULL;
811 spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
812
813 if (!data)
814 break;
815
816 txi = container_of((void *)data, struct ieee80211_tx_info,
817 driver_data);
818 txqid = 0;
819
820 skb = container_of((void *)txi, struct sk_buff, cb);
821 paylen = skb->len;
822
823 urb = usb_alloc_urb(0, GFP_KERNEL);
824 if (!urb) {
825 ieee80211_free_txskb(ar->hw, skb);
826 continue;
827 }
828
829 data->ar = ar;
830 data->urb = urb;
831
832 desc = skb_push(skb, sizeof(*desc));
833 chunk = skb_push(skb, sizeof(*chunk));
834
835 chunk->seqnum = 0;
836 chunk->flags = UATH_CFLAGS_FINAL;
837 chunk->length = cpu_to_be16(skb->len);
838
839 desc->msglen = cpu_to_be32(skb->len);
840 desc->msgid = AR5523_DATA_ID;
841 desc->buflen = cpu_to_be32(paylen);
842 desc->type = cpu_to_be32(WDCMSG_SEND);
843 desc->flags = cpu_to_be32(UATH_TX_NOTIFY);
844
845 if (test_bit(AR5523_CONNECTED, &ar->flags))
846 desc->connid = cpu_to_be32(AR5523_ID_BSS);
847 else
848 desc->connid = cpu_to_be32(AR5523_ID_BROADCAST);
849
850 if (txi->flags & IEEE80211_TX_CTL_USE_MINRATE)
851 txqid |= UATH_TXQID_MINRATE;
852
853 desc->txqid = cpu_to_be32(txqid);
854
855 urb->transfer_flags = URB_ZERO_PACKET;
856 usb_fill_bulk_urb(urb, ar->dev, ar5523_data_tx_pipe(ar->dev),
857 skb->data, skb->len, ar5523_data_tx_cb, skb);
858
859 spin_lock_irqsave(&ar->tx_data_list_lock, flags);
860 list_add_tail(&data->list, &ar->tx_queue_submitted);
861 spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
862 mod_timer(&ar->tx_wd_timer, jiffies + AR5523_TX_WD_TIMEOUT);
863 atomic_inc(&ar->tx_nr_pending);
864
865 ar5523_dbg(ar, "TX Frame (%d pending)\n",
866 atomic_read(&ar->tx_nr_pending));
867 error = usb_submit_urb(urb, GFP_KERNEL);
868 if (error) {
869 ar5523_err(ar, "error %d when submitting tx urb\n",
870 error);
871 spin_lock_irqsave(&ar->tx_data_list_lock, flags);
872 list_del(&data->list);
873 spin_unlock_irqrestore(&ar->tx_data_list_lock, flags);
874 atomic_dec(&ar->tx_nr_pending);
875 ar5523_data_tx_pkt_put(ar);
876 usb_free_urb(urb);
877 ieee80211_free_txskb(ar->hw, skb);
878 }
879 } while (true);
880}
881
882static void ar5523_tx_work(struct work_struct *work)
883{
884 struct ar5523 *ar = container_of(work, struct ar5523, tx_work);
885
886 ar5523_dbg(ar, "%s\n", __func__);
887 mutex_lock(&ar->mutex);
888 ar5523_tx_work_locked(ar);
889 mutex_unlock(&ar->mutex);
890}
891
892static void ar5523_tx_wd_timer(struct timer_list *t)
893{
894 struct ar5523 *ar = from_timer(ar, t, tx_wd_timer);
895
896 ar5523_dbg(ar, "TX watchdog timer triggered\n");
897 ieee80211_queue_work(ar->hw, &ar->tx_wd_work);
898}
899
900static void ar5523_tx_wd_work(struct work_struct *work)
901{
902 struct ar5523 *ar = container_of(work, struct ar5523, tx_wd_work);
903
904
905
906
907
908 mutex_lock(&ar->mutex);
909 ar5523_err(ar, "TX queue stuck (tot %d pend %d)\n",
910 atomic_read(&ar->tx_nr_total),
911 atomic_read(&ar->tx_nr_pending));
912
913 ar5523_err(ar, "Will restart dongle.\n");
914 ar5523_cmd_write(ar, WDCMSG_TARGET_RESET, NULL, 0, 0);
915 mutex_unlock(&ar->mutex);
916}
917
918static void ar5523_flush_tx(struct ar5523 *ar)
919{
920 ar5523_tx_work_locked(ar);
921
922
923 if (test_bit(AR5523_USB_DISCONNECTED, &ar->flags))
924 return;
925 if (!wait_event_timeout(ar->tx_flush_waitq,
926 !atomic_read(&ar->tx_nr_pending), AR5523_FLUSH_TIMEOUT))
927 ar5523_err(ar, "flush timeout (tot %d pend %d)\n",
928 atomic_read(&ar->tx_nr_total),
929 atomic_read(&ar->tx_nr_pending));
930}
931
932static void ar5523_free_tx_cmd(struct ar5523 *ar)
933{
934 struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
935
936 usb_free_coherent(ar->dev, AR5523_MAX_RXCMDSZ, cmd->buf_tx,
937 cmd->urb_tx->transfer_dma);
938 usb_free_urb(cmd->urb_tx);
939}
940
941static int ar5523_alloc_tx_cmd(struct ar5523 *ar)
942{
943 struct ar5523_tx_cmd *cmd = &ar->tx_cmd;
944
945 cmd->ar = ar;
946 init_completion(&cmd->done);
947
948 cmd->urb_tx = usb_alloc_urb(0, GFP_KERNEL);
949 if (!cmd->urb_tx)
950 return -ENOMEM;
951 cmd->buf_tx = usb_alloc_coherent(ar->dev, AR5523_MAX_TXCMDSZ,
952 GFP_KERNEL,
953 &cmd->urb_tx->transfer_dma);
954 if (!cmd->buf_tx) {
955 usb_free_urb(cmd->urb_tx);
956 return -ENOMEM;
957 }
958 return 0;
959}
960
961
962
963
964
965static void ar5523_stat_work(struct work_struct *work)
966{
967 struct ar5523 *ar = container_of(work, struct ar5523, stat_work.work);
968 int error;
969
970 ar5523_dbg(ar, "%s\n", __func__);
971 mutex_lock(&ar->mutex);
972
973
974
975
976
977 error = ar5523_cmd_write(ar, WDCMSG_TARGET_GET_STATS, NULL, 0, 0);
978 if (error)
979 ar5523_err(ar, "could not query stats, error %d\n", error);
980 mutex_unlock(&ar->mutex);
981 ieee80211_queue_delayed_work(ar->hw, &ar->stat_work, HZ);
982}
983
984
985
986
987static int ar5523_start(struct ieee80211_hw *hw)
988{
989 struct ar5523 *ar = hw->priv;
990 int error;
991 __be32 val;
992
993 ar5523_dbg(ar, "start called\n");
994
995 mutex_lock(&ar->mutex);
996 val = cpu_to_be32(0);
997 ar5523_cmd_write(ar, WDCMSG_BIND, &val, sizeof(val), 0);
998
999
1000 ar5523_config_multi(ar, CFG_MAC_ADDR, &ar->hw->wiphy->perm_addr,
1001 ETH_ALEN);
1002
1003
1004 ar5523_config(ar, CFG_RATE_CONTROL_ENABLE, 0x00000001);
1005 ar5523_config(ar, CFG_DIVERSITY_CTL, 0x00000001);
1006 ar5523_config(ar, CFG_ABOLT, 0x0000003f);
1007 ar5523_config(ar, CFG_WME_ENABLED, 0x00000000);
1008
1009 ar5523_config(ar, CFG_SERVICE_TYPE, 1);
1010 ar5523_config(ar, CFG_TP_SCALE, 0x00000000);
1011 ar5523_config(ar, CFG_TPC_HALF_DBM5, 0x0000003c);
1012 ar5523_config(ar, CFG_TPC_HALF_DBM2, 0x0000003c);
1013 ar5523_config(ar, CFG_OVERRD_TX_POWER, 0x00000000);
1014 ar5523_config(ar, CFG_GMODE_PROTECTION, 0x00000000);
1015 ar5523_config(ar, CFG_GMODE_PROTECT_RATE_INDEX, 0x00000003);
1016 ar5523_config(ar, CFG_PROTECTION_TYPE, 0x00000000);
1017 ar5523_config(ar, CFG_MODE_CTS, 0x00000002);
1018
1019 error = ar5523_cmd_read(ar, WDCMSG_TARGET_START, NULL, 0,
1020 &val, sizeof(val), AR5523_CMD_FLAG_MAGIC);
1021 if (error) {
1022 ar5523_dbg(ar, "could not start target, error %d\n", error);
1023 goto err;
1024 }
1025 ar5523_dbg(ar, "WDCMSG_TARGET_START returns handle: 0x%x\n",
1026 be32_to_cpu(val));
1027
1028 ar5523_switch_chan(ar);
1029
1030 val = cpu_to_be32(TARGET_DEVICE_AWAKE);
1031 ar5523_cmd_write(ar, WDCMSG_SET_PWR_MODE, &val, sizeof(val), 0);
1032
1033 ar5523_cmd_write(ar, WDCMSG_RESET_KEY_CACHE, NULL, 0, 0);
1034
1035 set_bit(AR5523_HW_UP, &ar->flags);
1036 queue_work(ar->wq, &ar->rx_refill_work);
1037
1038
1039 ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT);
1040 ar5523_set_rxfilter(ar,
1041 UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
1042 UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON,
1043 UATH_FILTER_OP_SET);
1044
1045 ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_ON);
1046 ar5523_dbg(ar, "start OK\n");
1047
1048err:
1049 mutex_unlock(&ar->mutex);
1050 return error;
1051}
1052
1053static void ar5523_stop(struct ieee80211_hw *hw)
1054{
1055 struct ar5523 *ar = hw->priv;
1056
1057 ar5523_dbg(ar, "stop called\n");
1058
1059 cancel_delayed_work_sync(&ar->stat_work);
1060 mutex_lock(&ar->mutex);
1061 clear_bit(AR5523_HW_UP, &ar->flags);
1062
1063 ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF);
1064 ar5523_set_ledsteady(ar, UATH_LED_ACTIVITY, UATH_LED_OFF);
1065
1066 ar5523_cmd_write(ar, WDCMSG_TARGET_STOP, NULL, 0, 0);
1067
1068 del_timer_sync(&ar->tx_wd_timer);
1069 cancel_work_sync(&ar->tx_wd_work);
1070 cancel_work_sync(&ar->rx_refill_work);
1071 ar5523_cancel_rx_bufs(ar);
1072 mutex_unlock(&ar->mutex);
1073}
1074
1075static int ar5523_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
1076{
1077 struct ar5523 *ar = hw->priv;
1078 int ret;
1079
1080 ar5523_dbg(ar, "set_rts_threshold called\n");
1081 mutex_lock(&ar->mutex);
1082
1083 ret = ar5523_config(ar, CFG_USER_RTS_THRESHOLD, value);
1084
1085 mutex_unlock(&ar->mutex);
1086 return ret;
1087}
1088
1089static void ar5523_flush(struct ieee80211_hw *hw, struct ieee80211_vif *vif,
1090 u32 queues, bool drop)
1091{
1092 struct ar5523 *ar = hw->priv;
1093
1094 ar5523_dbg(ar, "flush called\n");
1095 ar5523_flush_tx(ar);
1096}
1097
1098static int ar5523_add_interface(struct ieee80211_hw *hw,
1099 struct ieee80211_vif *vif)
1100{
1101 struct ar5523 *ar = hw->priv;
1102
1103 ar5523_dbg(ar, "add interface called\n");
1104
1105 if (ar->vif) {
1106 ar5523_dbg(ar, "invalid add_interface\n");
1107 return -EOPNOTSUPP;
1108 }
1109
1110 switch (vif->type) {
1111 case NL80211_IFTYPE_STATION:
1112 ar->vif = vif;
1113 break;
1114 default:
1115 return -EOPNOTSUPP;
1116 }
1117 return 0;
1118}
1119
1120static void ar5523_remove_interface(struct ieee80211_hw *hw,
1121 struct ieee80211_vif *vif)
1122{
1123 struct ar5523 *ar = hw->priv;
1124
1125 ar5523_dbg(ar, "remove interface called\n");
1126 ar->vif = NULL;
1127}
1128
1129static int ar5523_hwconfig(struct ieee80211_hw *hw, u32 changed)
1130{
1131 struct ar5523 *ar = hw->priv;
1132
1133 ar5523_dbg(ar, "config called\n");
1134 mutex_lock(&ar->mutex);
1135 if (changed & IEEE80211_CONF_CHANGE_CHANNEL) {
1136 ar5523_dbg(ar, "Do channel switch\n");
1137 ar5523_flush_tx(ar);
1138 ar5523_switch_chan(ar);
1139 }
1140 mutex_unlock(&ar->mutex);
1141 return 0;
1142}
1143
1144static int ar5523_get_wlan_mode(struct ar5523 *ar,
1145 struct ieee80211_bss_conf *bss_conf)
1146{
1147 struct ieee80211_supported_band *band;
1148 int bit;
1149 struct ieee80211_sta *sta;
1150 u32 sta_rate_set;
1151
1152 band = ar->hw->wiphy->bands[ar->hw->conf.chandef.chan->band];
1153 sta = ieee80211_find_sta(ar->vif, bss_conf->bssid);
1154 if (!sta) {
1155 ar5523_info(ar, "STA not found!\n");
1156 return WLAN_MODE_11b;
1157 }
1158 sta_rate_set = sta->supp_rates[ar->hw->conf.chandef.chan->band];
1159
1160 for (bit = 0; bit < band->n_bitrates; bit++) {
1161 if (sta_rate_set & 1) {
1162 int rate = band->bitrates[bit].bitrate;
1163 switch (rate) {
1164 case 60:
1165 case 90:
1166 case 120:
1167 case 180:
1168 case 240:
1169 case 360:
1170 case 480:
1171 case 540:
1172 return WLAN_MODE_11g;
1173 }
1174 }
1175 sta_rate_set >>= 1;
1176 }
1177 return WLAN_MODE_11b;
1178}
1179
1180static void ar5523_create_rateset(struct ar5523 *ar,
1181 struct ieee80211_bss_conf *bss_conf,
1182 struct ar5523_cmd_rateset *rs,
1183 bool basic)
1184{
1185 struct ieee80211_supported_band *band;
1186 struct ieee80211_sta *sta;
1187 int bit, i = 0;
1188 u32 sta_rate_set, basic_rate_set;
1189
1190 sta = ieee80211_find_sta(ar->vif, bss_conf->bssid);
1191 basic_rate_set = bss_conf->basic_rates;
1192 if (!sta) {
1193 ar5523_info(ar, "STA not found. Cannot set rates\n");
1194 sta_rate_set = bss_conf->basic_rates;
1195 } else
1196 sta_rate_set = sta->supp_rates[ar->hw->conf.chandef.chan->band];
1197
1198 ar5523_dbg(ar, "sta rate_set = %08x\n", sta_rate_set);
1199
1200 band = ar->hw->wiphy->bands[ar->hw->conf.chandef.chan->band];
1201 for (bit = 0; bit < band->n_bitrates; bit++) {
1202 BUG_ON(i >= AR5523_MAX_NRATES);
1203 ar5523_dbg(ar, "Considering rate %d : %d\n",
1204 band->bitrates[bit].hw_value, sta_rate_set & 1);
1205 if (sta_rate_set & 1) {
1206 rs->set[i] = band->bitrates[bit].hw_value;
1207 if (basic_rate_set & 1 && basic)
1208 rs->set[i] |= 0x80;
1209 i++;
1210 }
1211 sta_rate_set >>= 1;
1212 basic_rate_set >>= 1;
1213 }
1214
1215 rs->length = i;
1216}
1217
1218static int ar5523_set_basic_rates(struct ar5523 *ar,
1219 struct ieee80211_bss_conf *bss)
1220{
1221 struct ar5523_cmd_rates rates;
1222
1223 memset(&rates, 0, sizeof(rates));
1224 rates.connid = cpu_to_be32(2);
1225 rates.size = cpu_to_be32(sizeof(struct ar5523_cmd_rateset));
1226 ar5523_create_rateset(ar, bss, &rates.rateset, true);
1227
1228 return ar5523_cmd_write(ar, WDCMSG_SET_BASIC_RATE, &rates,
1229 sizeof(rates), 0);
1230}
1231
1232static int ar5523_create_connection(struct ar5523 *ar,
1233 struct ieee80211_vif *vif,
1234 struct ieee80211_bss_conf *bss)
1235{
1236 struct ar5523_cmd_create_connection create;
1237 int wlan_mode;
1238
1239 memset(&create, 0, sizeof(create));
1240 create.connid = cpu_to_be32(2);
1241 create.bssid = cpu_to_be32(0);
1242
1243 create.size = cpu_to_be32(sizeof(struct ar5523_cmd_rateset));
1244
1245 ar5523_create_rateset(ar, bss, &create.connattr.rateset, false);
1246
1247 wlan_mode = ar5523_get_wlan_mode(ar, bss);
1248 create.connattr.wlanmode = cpu_to_be32(wlan_mode);
1249
1250 return ar5523_cmd_write(ar, WDCMSG_CREATE_CONNECTION, &create,
1251 sizeof(create), 0);
1252}
1253
1254static int ar5523_write_associd(struct ar5523 *ar,
1255 struct ieee80211_bss_conf *bss)
1256{
1257 struct ar5523_cmd_set_associd associd;
1258
1259 memset(&associd, 0, sizeof(associd));
1260 associd.defaultrateix = cpu_to_be32(0);
1261 associd.associd = cpu_to_be32(bss->aid);
1262 associd.timoffset = cpu_to_be32(0x3b);
1263 memcpy(associd.bssid, bss->bssid, ETH_ALEN);
1264 return ar5523_cmd_write(ar, WDCMSG_WRITE_ASSOCID, &associd,
1265 sizeof(associd), 0);
1266}
1267
1268static void ar5523_bss_info_changed(struct ieee80211_hw *hw,
1269 struct ieee80211_vif *vif,
1270 struct ieee80211_bss_conf *bss,
1271 u32 changed)
1272{
1273 struct ar5523 *ar = hw->priv;
1274 int error;
1275
1276 ar5523_dbg(ar, "bss_info_changed called\n");
1277 mutex_lock(&ar->mutex);
1278
1279 if (!(changed & BSS_CHANGED_ASSOC))
1280 goto out_unlock;
1281
1282 if (bss->assoc) {
1283 error = ar5523_create_connection(ar, vif, bss);
1284 if (error) {
1285 ar5523_err(ar, "could not create connection\n");
1286 goto out_unlock;
1287 }
1288
1289 error = ar5523_set_basic_rates(ar, bss);
1290 if (error) {
1291 ar5523_err(ar, "could not set negotiated rate set\n");
1292 goto out_unlock;
1293 }
1294
1295 error = ar5523_write_associd(ar, bss);
1296 if (error) {
1297 ar5523_err(ar, "could not set association\n");
1298 goto out_unlock;
1299 }
1300
1301
1302 ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_ON);
1303 set_bit(AR5523_CONNECTED, &ar->flags);
1304 ieee80211_queue_delayed_work(hw, &ar->stat_work, HZ);
1305
1306 } else {
1307 cancel_delayed_work(&ar->stat_work);
1308 clear_bit(AR5523_CONNECTED, &ar->flags);
1309 ar5523_set_ledsteady(ar, UATH_LED_LINK, UATH_LED_OFF);
1310 }
1311
1312out_unlock:
1313 mutex_unlock(&ar->mutex);
1314
1315}
1316
1317#define AR5523_SUPPORTED_FILTERS (FIF_ALLMULTI | \
1318 FIF_FCSFAIL | \
1319 FIF_OTHER_BSS)
1320
1321static void ar5523_configure_filter(struct ieee80211_hw *hw,
1322 unsigned int changed_flags,
1323 unsigned int *total_flags,
1324 u64 multicast)
1325{
1326 struct ar5523 *ar = hw->priv;
1327 u32 filter = 0;
1328
1329 ar5523_dbg(ar, "configure_filter called\n");
1330 mutex_lock(&ar->mutex);
1331 ar5523_flush_tx(ar);
1332
1333 *total_flags &= AR5523_SUPPORTED_FILTERS;
1334
1335
1336
1337
1338
1339 filter |= UATH_FILTER_RX_UCAST | UATH_FILTER_RX_MCAST |
1340 UATH_FILTER_RX_BCAST | UATH_FILTER_RX_BEACON |
1341 UATH_FILTER_RX_PROM;
1342
1343 ar5523_set_rxfilter(ar, 0, UATH_FILTER_OP_INIT);
1344 ar5523_set_rxfilter(ar, filter, UATH_FILTER_OP_SET);
1345
1346 mutex_unlock(&ar->mutex);
1347}
1348
1349static const struct ieee80211_ops ar5523_ops = {
1350 .start = ar5523_start,
1351 .stop = ar5523_stop,
1352 .tx = ar5523_tx,
1353 .set_rts_threshold = ar5523_set_rts_threshold,
1354 .add_interface = ar5523_add_interface,
1355 .remove_interface = ar5523_remove_interface,
1356 .config = ar5523_hwconfig,
1357 .bss_info_changed = ar5523_bss_info_changed,
1358 .configure_filter = ar5523_configure_filter,
1359 .flush = ar5523_flush,
1360};
1361
1362static int ar5523_host_available(struct ar5523 *ar)
1363{
1364 struct ar5523_cmd_host_available setup;
1365
1366
1367 setup.sw_ver_major = cpu_to_be32(ATH_SW_VER_MAJOR);
1368 setup.sw_ver_minor = cpu_to_be32(ATH_SW_VER_MINOR);
1369 setup.sw_ver_patch = cpu_to_be32(ATH_SW_VER_PATCH);
1370 setup.sw_ver_build = cpu_to_be32(ATH_SW_VER_BUILD);
1371 return ar5523_cmd_read(ar, WDCMSG_HOST_AVAILABLE,
1372 &setup, sizeof(setup), NULL, 0, 0);
1373}
1374
1375static int ar5523_get_devstatus(struct ar5523 *ar)
1376{
1377 u8 macaddr[ETH_ALEN];
1378 int error;
1379
1380
1381 error = ar5523_get_status(ar, ST_MAC_ADDR, macaddr, ETH_ALEN);
1382 if (error) {
1383 ar5523_err(ar, "could not read MAC address\n");
1384 return error;
1385 }
1386
1387 SET_IEEE80211_PERM_ADDR(ar->hw, macaddr);
1388
1389 error = ar5523_get_status(ar, ST_SERIAL_NUMBER,
1390 &ar->serial[0], sizeof(ar->serial));
1391 if (error) {
1392 ar5523_err(ar, "could not read device serial number\n");
1393 return error;
1394 }
1395 return 0;
1396}
1397
1398#define AR5523_SANE_RXBUFSZ 2000
1399
1400static int ar5523_get_max_rxsz(struct ar5523 *ar)
1401{
1402 int error;
1403 __be32 rxsize;
1404
1405
1406 error = ar5523_get_status(ar, ST_WDC_TRANSPORT_CHUNK_SIZE, &rxsize,
1407 sizeof(rxsize));
1408 if (error != 0) {
1409 ar5523_err(ar, "could not read max RX size\n");
1410 return error;
1411 }
1412
1413 ar->rxbufsz = be32_to_cpu(rxsize);
1414
1415 if (!ar->rxbufsz || ar->rxbufsz > AR5523_SANE_RXBUFSZ) {
1416 ar5523_err(ar, "Bad rxbufsz from device. Using %d instead\n",
1417 AR5523_SANE_RXBUFSZ);
1418 ar->rxbufsz = AR5523_SANE_RXBUFSZ;
1419 }
1420
1421 ar5523_dbg(ar, "Max RX buf size: %d\n", ar->rxbufsz);
1422 return 0;
1423}
1424
1425
1426
1427
1428
1429static const struct ieee80211_rate ar5523_rates[] = {
1430 { .bitrate = 10, .hw_value = 2, },
1431 { .bitrate = 20, .hw_value = 4 },
1432 { .bitrate = 55, .hw_value = 11, },
1433 { .bitrate = 110, .hw_value = 22, },
1434 { .bitrate = 60, .hw_value = 12, },
1435 { .bitrate = 90, .hw_value = 18, },
1436 { .bitrate = 120, .hw_value = 24, },
1437 { .bitrate = 180, .hw_value = 36, },
1438 { .bitrate = 240, .hw_value = 48, },
1439 { .bitrate = 360, .hw_value = 72, },
1440 { .bitrate = 480, .hw_value = 96, },
1441 { .bitrate = 540, .hw_value = 108, },
1442};
1443
1444static const struct ieee80211_channel ar5523_channels[] = {
1445 { .center_freq = 2412 },
1446 { .center_freq = 2417 },
1447 { .center_freq = 2422 },
1448 { .center_freq = 2427 },
1449 { .center_freq = 2432 },
1450 { .center_freq = 2437 },
1451 { .center_freq = 2442 },
1452 { .center_freq = 2447 },
1453 { .center_freq = 2452 },
1454 { .center_freq = 2457 },
1455 { .center_freq = 2462 },
1456 { .center_freq = 2467 },
1457 { .center_freq = 2472 },
1458 { .center_freq = 2484 },
1459};
1460
1461static int ar5523_init_modes(struct ar5523 *ar)
1462{
1463 BUILD_BUG_ON(sizeof(ar->channels) != sizeof(ar5523_channels));
1464 BUILD_BUG_ON(sizeof(ar->rates) != sizeof(ar5523_rates));
1465
1466 memcpy(ar->channels, ar5523_channels, sizeof(ar5523_channels));
1467 memcpy(ar->rates, ar5523_rates, sizeof(ar5523_rates));
1468
1469 ar->band.band = NL80211_BAND_2GHZ;
1470 ar->band.channels = ar->channels;
1471 ar->band.n_channels = ARRAY_SIZE(ar5523_channels);
1472 ar->band.bitrates = ar->rates;
1473 ar->band.n_bitrates = ARRAY_SIZE(ar5523_rates);
1474 ar->hw->wiphy->bands[NL80211_BAND_2GHZ] = &ar->band;
1475 return 0;
1476}
1477
1478
1479
1480
1481
1482
1483static int ar5523_load_firmware(struct usb_device *dev)
1484{
1485 struct ar5523_fwblock *txblock, *rxblock;
1486 const struct firmware *fw;
1487 void *fwbuf;
1488 int len, offset;
1489 int foolen;
1490 int error = -ENXIO;
1491
1492 if (request_firmware(&fw, AR5523_FIRMWARE_FILE, &dev->dev)) {
1493 dev_err(&dev->dev, "no firmware found: %s\n",
1494 AR5523_FIRMWARE_FILE);
1495 return -ENOENT;
1496 }
1497
1498 txblock = kmalloc(sizeof(*txblock), GFP_KERNEL);
1499 if (!txblock)
1500 goto out;
1501
1502 rxblock = kmalloc(sizeof(*rxblock), GFP_KERNEL);
1503 if (!rxblock)
1504 goto out_free_txblock;
1505
1506 fwbuf = kmalloc(AR5523_MAX_FWBLOCK_SIZE, GFP_KERNEL);
1507 if (!fwbuf)
1508 goto out_free_rxblock;
1509
1510 memset(txblock, 0, sizeof(struct ar5523_fwblock));
1511 txblock->flags = cpu_to_be32(AR5523_WRITE_BLOCK);
1512 txblock->total = cpu_to_be32(fw->size);
1513
1514 offset = 0;
1515 len = fw->size;
1516 while (len > 0) {
1517 int mlen = min(len, AR5523_MAX_FWBLOCK_SIZE);
1518
1519 txblock->remain = cpu_to_be32(len - mlen);
1520 txblock->len = cpu_to_be32(mlen);
1521
1522
1523 error = usb_bulk_msg(dev, ar5523_cmd_tx_pipe(dev),
1524 txblock, sizeof(*txblock), &foolen,
1525 AR5523_CMD_TIMEOUT);
1526 if (error) {
1527 dev_err(&dev->dev,
1528 "could not send firmware block info\n");
1529 goto out_free_fwbuf;
1530 }
1531
1532
1533 memcpy(fwbuf, fw->data + offset, mlen);
1534 error = usb_bulk_msg(dev, ar5523_data_tx_pipe(dev),
1535 fwbuf, mlen, &foolen,
1536 AR5523_DATA_TIMEOUT);
1537 if (error) {
1538 dev_err(&dev->dev,
1539 "could not send firmware block data\n");
1540 goto out_free_fwbuf;
1541 }
1542
1543
1544 error = usb_bulk_msg(dev, ar5523_cmd_rx_pipe(dev),
1545 rxblock, sizeof(*rxblock), &foolen,
1546 AR5523_CMD_TIMEOUT);
1547 if (error) {
1548 dev_err(&dev->dev,
1549 "could not read firmware answer\n");
1550 goto out_free_fwbuf;
1551 }
1552
1553 len -= mlen;
1554 offset += mlen;
1555 }
1556
1557
1558
1559
1560
1561 error = -ENXIO;
1562
1563 out_free_fwbuf:
1564 kfree(fwbuf);
1565 out_free_rxblock:
1566 kfree(rxblock);
1567 out_free_txblock:
1568 kfree(txblock);
1569 out:
1570 release_firmware(fw);
1571 return error;
1572}
1573
1574static int ar5523_probe(struct usb_interface *intf,
1575 const struct usb_device_id *id)
1576{
1577 struct usb_device *dev = interface_to_usbdev(intf);
1578 struct ieee80211_hw *hw;
1579 struct ar5523 *ar;
1580 int error = -ENOMEM;
1581
1582
1583
1584
1585
1586
1587 if (id->driver_info & AR5523_FLAG_PRE_FIRMWARE)
1588 return ar5523_load_firmware(dev);
1589
1590
1591 hw = ieee80211_alloc_hw(sizeof(*ar), &ar5523_ops);
1592 if (!hw)
1593 goto out;
1594 SET_IEEE80211_DEV(hw, &intf->dev);
1595
1596 ar = hw->priv;
1597 ar->hw = hw;
1598 ar->dev = dev;
1599 mutex_init(&ar->mutex);
1600
1601 INIT_DELAYED_WORK(&ar->stat_work, ar5523_stat_work);
1602 timer_setup(&ar->tx_wd_timer, ar5523_tx_wd_timer, 0);
1603 INIT_WORK(&ar->tx_wd_work, ar5523_tx_wd_work);
1604 INIT_WORK(&ar->tx_work, ar5523_tx_work);
1605 INIT_LIST_HEAD(&ar->tx_queue_pending);
1606 INIT_LIST_HEAD(&ar->tx_queue_submitted);
1607 spin_lock_init(&ar->tx_data_list_lock);
1608 atomic_set(&ar->tx_nr_total, 0);
1609 atomic_set(&ar->tx_nr_pending, 0);
1610 init_waitqueue_head(&ar->tx_flush_waitq);
1611
1612 atomic_set(&ar->rx_data_free_cnt, 0);
1613 INIT_WORK(&ar->rx_refill_work, ar5523_rx_refill_work);
1614 INIT_LIST_HEAD(&ar->rx_data_free);
1615 INIT_LIST_HEAD(&ar->rx_data_used);
1616 spin_lock_init(&ar->rx_data_list_lock);
1617
1618 ar->wq = create_singlethread_workqueue("ar5523");
1619 if (!ar->wq) {
1620 ar5523_err(ar, "Could not create wq\n");
1621 goto out_free_ar;
1622 }
1623
1624 error = ar5523_alloc_rx_bufs(ar);
1625 if (error) {
1626 ar5523_err(ar, "Could not allocate rx buffers\n");
1627 goto out_free_wq;
1628 }
1629
1630 error = ar5523_alloc_rx_cmd(ar);
1631 if (error) {
1632 ar5523_err(ar, "Could not allocate rx command buffers\n");
1633 goto out_free_rx_bufs;
1634 }
1635
1636 error = ar5523_alloc_tx_cmd(ar);
1637 if (error) {
1638 ar5523_err(ar, "Could not allocate tx command buffers\n");
1639 goto out_free_rx_cmd;
1640 }
1641
1642 error = ar5523_submit_rx_cmd(ar);
1643 if (error) {
1644 ar5523_err(ar, "Failed to submit rx cmd\n");
1645 goto out_free_tx_cmd;
1646 }
1647
1648
1649
1650
1651 error = ar5523_host_available(ar);
1652 if (error) {
1653 ar5523_err(ar, "could not initialize adapter\n");
1654 goto out_cancel_rx_cmd;
1655 }
1656
1657 error = ar5523_get_max_rxsz(ar);
1658 if (error) {
1659 ar5523_err(ar, "could not get caps from adapter\n");
1660 goto out_cancel_rx_cmd;
1661 }
1662
1663 error = ar5523_get_devcap(ar);
1664 if (error) {
1665 ar5523_err(ar, "could not get caps from adapter\n");
1666 goto out_cancel_rx_cmd;
1667 }
1668
1669 error = ar5523_get_devstatus(ar);
1670 if (error != 0) {
1671 ar5523_err(ar, "could not get device status\n");
1672 goto out_cancel_rx_cmd;
1673 }
1674
1675 ar5523_info(ar, "MAC/BBP AR5523, RF AR%c112\n",
1676 (id->driver_info & AR5523_FLAG_ABG) ? '5' : '2');
1677
1678 ar->vif = NULL;
1679 ieee80211_hw_set(hw, HAS_RATE_CONTROL);
1680 ieee80211_hw_set(hw, RX_INCLUDES_FCS);
1681 ieee80211_hw_set(hw, SIGNAL_DBM);
1682 hw->extra_tx_headroom = sizeof(struct ar5523_tx_desc) +
1683 sizeof(struct ar5523_chunk);
1684 hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION);
1685 hw->queues = 1;
1686
1687 error = ar5523_init_modes(ar);
1688 if (error)
1689 goto out_cancel_rx_cmd;
1690
1691 wiphy_ext_feature_set(hw->wiphy, NL80211_EXT_FEATURE_CQM_RSSI_LIST);
1692
1693 usb_set_intfdata(intf, hw);
1694
1695 error = ieee80211_register_hw(hw);
1696 if (error) {
1697 ar5523_err(ar, "could not register device\n");
1698 goto out_cancel_rx_cmd;
1699 }
1700
1701 ar5523_info(ar, "Found and initialized AR5523 device\n");
1702 return 0;
1703
1704out_cancel_rx_cmd:
1705 ar5523_cancel_rx_cmd(ar);
1706out_free_tx_cmd:
1707 ar5523_free_tx_cmd(ar);
1708out_free_rx_cmd:
1709 ar5523_free_rx_cmd(ar);
1710out_free_rx_bufs:
1711 ar5523_free_rx_bufs(ar);
1712out_free_wq:
1713 destroy_workqueue(ar->wq);
1714out_free_ar:
1715 ieee80211_free_hw(hw);
1716out:
1717 return error;
1718}
1719
1720static void ar5523_disconnect(struct usb_interface *intf)
1721{
1722 struct ieee80211_hw *hw = usb_get_intfdata(intf);
1723 struct ar5523 *ar = hw->priv;
1724
1725 ar5523_dbg(ar, "detaching\n");
1726 set_bit(AR5523_USB_DISCONNECTED, &ar->flags);
1727
1728 ieee80211_unregister_hw(hw);
1729
1730 ar5523_cancel_rx_cmd(ar);
1731 ar5523_free_tx_cmd(ar);
1732 ar5523_free_rx_cmd(ar);
1733 ar5523_free_rx_bufs(ar);
1734
1735 destroy_workqueue(ar->wq);
1736
1737 ieee80211_free_hw(hw);
1738 usb_set_intfdata(intf, NULL);
1739}
1740
1741#define AR5523_DEVICE_UG(vendor, device) \
1742 { USB_DEVICE((vendor), (device)) }, \
1743 { USB_DEVICE((vendor), (device) + 1), \
1744 .driver_info = AR5523_FLAG_PRE_FIRMWARE }
1745#define AR5523_DEVICE_UX(vendor, device) \
1746 { USB_DEVICE((vendor), (device)), \
1747 .driver_info = AR5523_FLAG_ABG }, \
1748 { USB_DEVICE((vendor), (device) + 1), \
1749 .driver_info = AR5523_FLAG_ABG|AR5523_FLAG_PRE_FIRMWARE }
1750
1751static const struct usb_device_id ar5523_id_table[] = {
1752 AR5523_DEVICE_UG(0x168c, 0x0001),
1753 AR5523_DEVICE_UG(0x0cf3, 0x0001),
1754 AR5523_DEVICE_UG(0x0cf3, 0x0003),
1755 AR5523_DEVICE_UX(0x0cf3, 0x0005),
1756 AR5523_DEVICE_UG(0x0d8e, 0x7801),
1757 AR5523_DEVICE_UX(0x0d8e, 0x7811),
1758 AR5523_DEVICE_UX(0x2001, 0x3a00),
1759 AR5523_DEVICE_UG(0x2001, 0x3a02),
1760 AR5523_DEVICE_UX(0x2001, 0x3a04),
1761 AR5523_DEVICE_UG(0x07d1, 0x3a07),
1762 AR5523_DEVICE_UG(0x1690, 0x0712),
1763 AR5523_DEVICE_UG(0x1690, 0x0710),
1764 AR5523_DEVICE_UG(0x129b, 0x160b),
1765
1766 AR5523_DEVICE_UG(0x16ab, 0x7801),
1767 AR5523_DEVICE_UX(0x16ab, 0x7811),
1768 AR5523_DEVICE_UG(0x0d8e, 0x7802),
1769 AR5523_DEVICE_UX(0x0846, 0x4300),
1770 AR5523_DEVICE_UG(0x0846, 0x4250),
1771 AR5523_DEVICE_UG(0x0846, 0x5f00),
1772 AR5523_DEVICE_UG(0x157e, 0x3006),
1773 AR5523_DEVICE_UX(0x157e, 0x3205),
1774 AR5523_DEVICE_UG(0x157e, 0x3006),
1775 AR5523_DEVICE_UG(0x1435, 0x0826),
1776 AR5523_DEVICE_UX(0x1435, 0x0828),
1777 AR5523_DEVICE_UG(0x0cde, 0x0012),
1778 AR5523_DEVICE_UG(0x1385, 0x4250),
1779 AR5523_DEVICE_UG(0x1385, 0x5f00),
1780 AR5523_DEVICE_UG(0x1385, 0x5f02),
1781 { }
1782};
1783MODULE_DEVICE_TABLE(usb, ar5523_id_table);
1784
1785static struct usb_driver ar5523_driver = {
1786 .name = "ar5523",
1787 .id_table = ar5523_id_table,
1788 .probe = ar5523_probe,
1789 .disconnect = ar5523_disconnect,
1790};
1791
1792module_usb_driver(ar5523_driver);
1793
1794MODULE_LICENSE("Dual BSD/GPL");
1795MODULE_FIRMWARE(AR5523_FIRMWARE_FILE);
1796
