Loading...
1/*
2 * Copyright (c) 2010-2011 Atheros Communications Inc.
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16
17#include <asm/unaligned.h>
18#include "htc.h"
19
20/* identify firmware images */
21#define FIRMWARE_AR7010_1_1 "htc_7010.fw"
22#define FIRMWARE_AR9271 "htc_9271.fw"
23
24MODULE_FIRMWARE(FIRMWARE_AR7010_1_1);
25MODULE_FIRMWARE(FIRMWARE_AR9271);
26
27static struct usb_device_id ath9k_hif_usb_ids[] = {
28 { USB_DEVICE(0x0cf3, 0x9271) }, /* Atheros */
29 { USB_DEVICE(0x0cf3, 0x1006) }, /* Atheros */
30 { USB_DEVICE(0x0846, 0x9030) }, /* Netgear N150 */
31 { USB_DEVICE(0x07D1, 0x3A10) }, /* Dlink Wireless 150 */
32 { USB_DEVICE(0x13D3, 0x3327) }, /* Azurewave */
33 { USB_DEVICE(0x13D3, 0x3328) }, /* Azurewave */
34 { USB_DEVICE(0x13D3, 0x3346) }, /* IMC Networks */
35 { USB_DEVICE(0x13D3, 0x3348) }, /* Azurewave */
36 { USB_DEVICE(0x13D3, 0x3349) }, /* Azurewave */
37 { USB_DEVICE(0x13D3, 0x3350) }, /* Azurewave */
38 { USB_DEVICE(0x04CA, 0x4605) }, /* Liteon */
39 { USB_DEVICE(0x040D, 0x3801) }, /* VIA */
40 { USB_DEVICE(0x0cf3, 0xb003) }, /* Ubiquiti WifiStation Ext */
41
42 { USB_DEVICE(0x0cf3, 0x7015),
43 .driver_info = AR9287_USB }, /* Atheros */
44 { USB_DEVICE(0x1668, 0x1200),
45 .driver_info = AR9287_USB }, /* Verizon */
46
47 { USB_DEVICE(0x0cf3, 0x7010),
48 .driver_info = AR9280_USB }, /* Atheros */
49 { USB_DEVICE(0x0846, 0x9018),
50 .driver_info = AR9280_USB }, /* Netgear WNDA3200 */
51 { USB_DEVICE(0x083A, 0xA704),
52 .driver_info = AR9280_USB }, /* SMC Networks */
53 { USB_DEVICE(0x0411, 0x017f),
54 .driver_info = AR9280_USB }, /* Sony UWA-BR100 */
55
56 { USB_DEVICE(0x0cf3, 0x20ff),
57 .driver_info = STORAGE_DEVICE },
58
59 { },
60};
61
62MODULE_DEVICE_TABLE(usb, ath9k_hif_usb_ids);
63
64static int __hif_usb_tx(struct hif_device_usb *hif_dev);
65
66static void hif_usb_regout_cb(struct urb *urb)
67{
68 struct cmd_buf *cmd = (struct cmd_buf *)urb->context;
69
70 switch (urb->status) {
71 case 0:
72 break;
73 case -ENOENT:
74 case -ECONNRESET:
75 case -ENODEV:
76 case -ESHUTDOWN:
77 goto free;
78 default:
79 break;
80 }
81
82 if (cmd) {
83 ath9k_htc_txcompletion_cb(cmd->hif_dev->htc_handle,
84 cmd->skb, true);
85 kfree(cmd);
86 }
87
88 return;
89free:
90 kfree_skb(cmd->skb);
91 kfree(cmd);
92}
93
94static int hif_usb_send_regout(struct hif_device_usb *hif_dev,
95 struct sk_buff *skb)
96{
97 struct urb *urb;
98 struct cmd_buf *cmd;
99 int ret = 0;
100
101 urb = usb_alloc_urb(0, GFP_KERNEL);
102 if (urb == NULL)
103 return -ENOMEM;
104
105 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
106 if (cmd == NULL) {
107 usb_free_urb(urb);
108 return -ENOMEM;
109 }
110
111 cmd->skb = skb;
112 cmd->hif_dev = hif_dev;
113
114 usb_fill_bulk_urb(urb, hif_dev->udev,
115 usb_sndbulkpipe(hif_dev->udev, USB_REG_OUT_PIPE),
116 skb->data, skb->len,
117 hif_usb_regout_cb, cmd);
118
119 usb_anchor_urb(urb, &hif_dev->regout_submitted);
120 ret = usb_submit_urb(urb, GFP_KERNEL);
121 if (ret) {
122 usb_unanchor_urb(urb);
123 kfree(cmd);
124 }
125 usb_free_urb(urb);
126
127 return ret;
128}
129
130static void hif_usb_mgmt_cb(struct urb *urb)
131{
132 struct cmd_buf *cmd = (struct cmd_buf *)urb->context;
133 struct hif_device_usb *hif_dev;
134 bool txok = true;
135
136 if (!cmd || !cmd->skb || !cmd->hif_dev)
137 return;
138
139 hif_dev = cmd->hif_dev;
140
141 switch (urb->status) {
142 case 0:
143 break;
144 case -ENOENT:
145 case -ECONNRESET:
146 case -ENODEV:
147 case -ESHUTDOWN:
148 txok = false;
149
150 /*
151 * If the URBs are being flushed, no need to complete
152 * this packet.
153 */
154 spin_lock(&hif_dev->tx.tx_lock);
155 if (hif_dev->tx.flags & HIF_USB_TX_FLUSH) {
156 spin_unlock(&hif_dev->tx.tx_lock);
157 dev_kfree_skb_any(cmd->skb);
158 kfree(cmd);
159 return;
160 }
161 spin_unlock(&hif_dev->tx.tx_lock);
162
163 break;
164 default:
165 txok = false;
166 break;
167 }
168
169 skb_pull(cmd->skb, 4);
170 ath9k_htc_txcompletion_cb(cmd->hif_dev->htc_handle,
171 cmd->skb, txok);
172 kfree(cmd);
173}
174
175static int hif_usb_send_mgmt(struct hif_device_usb *hif_dev,
176 struct sk_buff *skb)
177{
178 struct urb *urb;
179 struct cmd_buf *cmd;
180 int ret = 0;
181 __le16 *hdr;
182
183 urb = usb_alloc_urb(0, GFP_ATOMIC);
184 if (urb == NULL)
185 return -ENOMEM;
186
187 cmd = kzalloc(sizeof(*cmd), GFP_ATOMIC);
188 if (cmd == NULL) {
189 usb_free_urb(urb);
190 return -ENOMEM;
191 }
192
193 cmd->skb = skb;
194 cmd->hif_dev = hif_dev;
195
196 hdr = (__le16 *) skb_push(skb, 4);
197 *hdr++ = cpu_to_le16(skb->len - 4);
198 *hdr++ = cpu_to_le16(ATH_USB_TX_STREAM_MODE_TAG);
199
200 usb_fill_bulk_urb(urb, hif_dev->udev,
201 usb_sndbulkpipe(hif_dev->udev, USB_WLAN_TX_PIPE),
202 skb->data, skb->len,
203 hif_usb_mgmt_cb, cmd);
204
205 usb_anchor_urb(urb, &hif_dev->mgmt_submitted);
206 ret = usb_submit_urb(urb, GFP_ATOMIC);
207 if (ret) {
208 usb_unanchor_urb(urb);
209 kfree(cmd);
210 }
211 usb_free_urb(urb);
212
213 return ret;
214}
215
216static inline void ath9k_skb_queue_purge(struct hif_device_usb *hif_dev,
217 struct sk_buff_head *list)
218{
219 struct sk_buff *skb;
220
221 while ((skb = __skb_dequeue(list)) != NULL) {
222 dev_kfree_skb_any(skb);
223 }
224}
225
226static inline void ath9k_skb_queue_complete(struct hif_device_usb *hif_dev,
227 struct sk_buff_head *queue,
228 bool txok)
229{
230 struct sk_buff *skb;
231
232 while ((skb = __skb_dequeue(queue)) != NULL) {
233 ath9k_htc_txcompletion_cb(hif_dev->htc_handle,
234 skb, txok);
235 if (txok)
236 TX_STAT_INC(skb_success);
237 else
238 TX_STAT_INC(skb_failed);
239 }
240}
241
242static void hif_usb_tx_cb(struct urb *urb)
243{
244 struct tx_buf *tx_buf = (struct tx_buf *) urb->context;
245 struct hif_device_usb *hif_dev;
246 bool txok = true;
247
248 if (!tx_buf || !tx_buf->hif_dev)
249 return;
250
251 hif_dev = tx_buf->hif_dev;
252
253 switch (urb->status) {
254 case 0:
255 break;
256 case -ENOENT:
257 case -ECONNRESET:
258 case -ENODEV:
259 case -ESHUTDOWN:
260 txok = false;
261
262 /*
263 * If the URBs are being flushed, no need to add this
264 * URB to the free list.
265 */
266 spin_lock(&hif_dev->tx.tx_lock);
267 if (hif_dev->tx.flags & HIF_USB_TX_FLUSH) {
268 spin_unlock(&hif_dev->tx.tx_lock);
269 ath9k_skb_queue_purge(hif_dev, &tx_buf->skb_queue);
270 return;
271 }
272 spin_unlock(&hif_dev->tx.tx_lock);
273
274 break;
275 default:
276 txok = false;
277 break;
278 }
279
280 ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, txok);
281
282 /* Re-initialize the SKB queue */
283 tx_buf->len = tx_buf->offset = 0;
284 __skb_queue_head_init(&tx_buf->skb_queue);
285
286 /* Add this TX buffer to the free list */
287 spin_lock(&hif_dev->tx.tx_lock);
288 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
289 hif_dev->tx.tx_buf_cnt++;
290 if (!(hif_dev->tx.flags & HIF_USB_TX_STOP))
291 __hif_usb_tx(hif_dev); /* Check for pending SKBs */
292 TX_STAT_INC(buf_completed);
293 spin_unlock(&hif_dev->tx.tx_lock);
294}
295
296/* TX lock has to be taken */
297static int __hif_usb_tx(struct hif_device_usb *hif_dev)
298{
299 struct tx_buf *tx_buf = NULL;
300 struct sk_buff *nskb = NULL;
301 int ret = 0, i;
302 u16 tx_skb_cnt = 0;
303 u8 *buf;
304 __le16 *hdr;
305
306 if (hif_dev->tx.tx_skb_cnt == 0)
307 return 0;
308
309 /* Check if a free TX buffer is available */
310 if (list_empty(&hif_dev->tx.tx_buf))
311 return 0;
312
313 tx_buf = list_first_entry(&hif_dev->tx.tx_buf, struct tx_buf, list);
314 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_pending);
315 hif_dev->tx.tx_buf_cnt--;
316
317 tx_skb_cnt = min_t(u16, hif_dev->tx.tx_skb_cnt, MAX_TX_AGGR_NUM);
318
319 for (i = 0; i < tx_skb_cnt; i++) {
320 nskb = __skb_dequeue(&hif_dev->tx.tx_skb_queue);
321
322 /* Should never be NULL */
323 BUG_ON(!nskb);
324
325 hif_dev->tx.tx_skb_cnt--;
326
327 buf = tx_buf->buf;
328 buf += tx_buf->offset;
329 hdr = (__le16 *)buf;
330 *hdr++ = cpu_to_le16(nskb->len);
331 *hdr++ = cpu_to_le16(ATH_USB_TX_STREAM_MODE_TAG);
332 buf += 4;
333 memcpy(buf, nskb->data, nskb->len);
334 tx_buf->len = nskb->len + 4;
335
336 if (i < (tx_skb_cnt - 1))
337 tx_buf->offset += (((tx_buf->len - 1) / 4) + 1) * 4;
338
339 if (i == (tx_skb_cnt - 1))
340 tx_buf->len += tx_buf->offset;
341
342 __skb_queue_tail(&tx_buf->skb_queue, nskb);
343 TX_STAT_INC(skb_queued);
344 }
345
346 usb_fill_bulk_urb(tx_buf->urb, hif_dev->udev,
347 usb_sndbulkpipe(hif_dev->udev, USB_WLAN_TX_PIPE),
348 tx_buf->buf, tx_buf->len,
349 hif_usb_tx_cb, tx_buf);
350
351 ret = usb_submit_urb(tx_buf->urb, GFP_ATOMIC);
352 if (ret) {
353 tx_buf->len = tx_buf->offset = 0;
354 ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, false);
355 __skb_queue_head_init(&tx_buf->skb_queue);
356 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
357 hif_dev->tx.tx_buf_cnt++;
358 }
359
360 if (!ret)
361 TX_STAT_INC(buf_queued);
362
363 return ret;
364}
365
366static int hif_usb_send_tx(struct hif_device_usb *hif_dev, struct sk_buff *skb)
367{
368 struct ath9k_htc_tx_ctl *tx_ctl;
369 unsigned long flags;
370 int ret = 0;
371
372 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
373
374 if (hif_dev->tx.flags & HIF_USB_TX_STOP) {
375 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
376 return -ENODEV;
377 }
378
379 /* Check if the max queue count has been reached */
380 if (hif_dev->tx.tx_skb_cnt > MAX_TX_BUF_NUM) {
381 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
382 return -ENOMEM;
383 }
384
385 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
386
387 tx_ctl = HTC_SKB_CB(skb);
388
389 /* Mgmt/Beacon frames don't use the TX buffer pool */
390 if ((tx_ctl->type == ATH9K_HTC_MGMT) ||
391 (tx_ctl->type == ATH9K_HTC_BEACON)) {
392 ret = hif_usb_send_mgmt(hif_dev, skb);
393 }
394
395 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
396
397 if ((tx_ctl->type == ATH9K_HTC_NORMAL) ||
398 (tx_ctl->type == ATH9K_HTC_AMPDU)) {
399 __skb_queue_tail(&hif_dev->tx.tx_skb_queue, skb);
400 hif_dev->tx.tx_skb_cnt++;
401 }
402
403 /* Check if AMPDUs have to be sent immediately */
404 if ((hif_dev->tx.tx_buf_cnt == MAX_TX_URB_NUM) &&
405 (hif_dev->tx.tx_skb_cnt < 2)) {
406 __hif_usb_tx(hif_dev);
407 }
408
409 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
410
411 return ret;
412}
413
414static void hif_usb_start(void *hif_handle)
415{
416 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
417 unsigned long flags;
418
419 hif_dev->flags |= HIF_USB_START;
420
421 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
422 hif_dev->tx.flags &= ~HIF_USB_TX_STOP;
423 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
424}
425
426static void hif_usb_stop(void *hif_handle)
427{
428 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
429 struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL;
430 unsigned long flags;
431
432 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
433 ath9k_skb_queue_complete(hif_dev, &hif_dev->tx.tx_skb_queue, false);
434 hif_dev->tx.tx_skb_cnt = 0;
435 hif_dev->tx.flags |= HIF_USB_TX_STOP;
436 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
437
438 /* The pending URBs have to be canceled. */
439 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
440 &hif_dev->tx.tx_pending, list) {
441 usb_kill_urb(tx_buf->urb);
442 }
443
444 usb_kill_anchored_urbs(&hif_dev->mgmt_submitted);
445}
446
447static int hif_usb_send(void *hif_handle, u8 pipe_id, struct sk_buff *skb)
448{
449 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
450 int ret = 0;
451
452 switch (pipe_id) {
453 case USB_WLAN_TX_PIPE:
454 ret = hif_usb_send_tx(hif_dev, skb);
455 break;
456 case USB_REG_OUT_PIPE:
457 ret = hif_usb_send_regout(hif_dev, skb);
458 break;
459 default:
460 dev_err(&hif_dev->udev->dev,
461 "ath9k_htc: Invalid TX pipe: %d\n", pipe_id);
462 ret = -EINVAL;
463 break;
464 }
465
466 return ret;
467}
468
469static inline bool check_index(struct sk_buff *skb, u8 idx)
470{
471 struct ath9k_htc_tx_ctl *tx_ctl;
472
473 tx_ctl = HTC_SKB_CB(skb);
474
475 if ((tx_ctl->type == ATH9K_HTC_AMPDU) &&
476 (tx_ctl->sta_idx == idx))
477 return true;
478
479 return false;
480}
481
482static void hif_usb_sta_drain(void *hif_handle, u8 idx)
483{
484 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
485 struct sk_buff *skb, *tmp;
486 unsigned long flags;
487
488 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
489
490 skb_queue_walk_safe(&hif_dev->tx.tx_skb_queue, skb, tmp) {
491 if (check_index(skb, idx)) {
492 __skb_unlink(skb, &hif_dev->tx.tx_skb_queue);
493 ath9k_htc_txcompletion_cb(hif_dev->htc_handle,
494 skb, false);
495 hif_dev->tx.tx_skb_cnt--;
496 TX_STAT_INC(skb_failed);
497 }
498 }
499
500 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
501}
502
503static struct ath9k_htc_hif hif_usb = {
504 .transport = ATH9K_HIF_USB,
505 .name = "ath9k_hif_usb",
506
507 .control_ul_pipe = USB_REG_OUT_PIPE,
508 .control_dl_pipe = USB_REG_IN_PIPE,
509
510 .start = hif_usb_start,
511 .stop = hif_usb_stop,
512 .sta_drain = hif_usb_sta_drain,
513 .send = hif_usb_send,
514};
515
516static void ath9k_hif_usb_rx_stream(struct hif_device_usb *hif_dev,
517 struct sk_buff *skb)
518{
519 struct sk_buff *nskb, *skb_pool[MAX_PKT_NUM_IN_TRANSFER];
520 int index = 0, i = 0, len = skb->len;
521 int rx_remain_len, rx_pkt_len;
522 u16 pool_index = 0;
523 u8 *ptr;
524
525 spin_lock(&hif_dev->rx_lock);
526
527 rx_remain_len = hif_dev->rx_remain_len;
528 rx_pkt_len = hif_dev->rx_transfer_len;
529
530 if (rx_remain_len != 0) {
531 struct sk_buff *remain_skb = hif_dev->remain_skb;
532
533 if (remain_skb) {
534 ptr = (u8 *) remain_skb->data;
535
536 index = rx_remain_len;
537 rx_remain_len -= hif_dev->rx_pad_len;
538 ptr += rx_pkt_len;
539
540 memcpy(ptr, skb->data, rx_remain_len);
541
542 rx_pkt_len += rx_remain_len;
543 hif_dev->rx_remain_len = 0;
544 skb_put(remain_skb, rx_pkt_len);
545
546 skb_pool[pool_index++] = remain_skb;
547
548 } else {
549 index = rx_remain_len;
550 }
551 }
552
553 spin_unlock(&hif_dev->rx_lock);
554
555 while (index < len) {
556 u16 pkt_len;
557 u16 pkt_tag;
558 u16 pad_len;
559 int chk_idx;
560
561 ptr = (u8 *) skb->data;
562
563 pkt_len = get_unaligned_le16(ptr + index);
564 pkt_tag = get_unaligned_le16(ptr + index + 2);
565
566 if (pkt_tag != ATH_USB_RX_STREAM_MODE_TAG) {
567 RX_STAT_INC(skb_dropped);
568 return;
569 }
570
571 pad_len = 4 - (pkt_len & 0x3);
572 if (pad_len == 4)
573 pad_len = 0;
574
575 chk_idx = index;
576 index = index + 4 + pkt_len + pad_len;
577
578 if (index > MAX_RX_BUF_SIZE) {
579 spin_lock(&hif_dev->rx_lock);
580 hif_dev->rx_remain_len = index - MAX_RX_BUF_SIZE;
581 hif_dev->rx_transfer_len =
582 MAX_RX_BUF_SIZE - chk_idx - 4;
583 hif_dev->rx_pad_len = pad_len;
584
585 nskb = __dev_alloc_skb(pkt_len + 32, GFP_ATOMIC);
586 if (!nskb) {
587 dev_err(&hif_dev->udev->dev,
588 "ath9k_htc: RX memory allocation error\n");
589 spin_unlock(&hif_dev->rx_lock);
590 goto err;
591 }
592 skb_reserve(nskb, 32);
593 RX_STAT_INC(skb_allocated);
594
595 memcpy(nskb->data, &(skb->data[chk_idx+4]),
596 hif_dev->rx_transfer_len);
597
598 /* Record the buffer pointer */
599 hif_dev->remain_skb = nskb;
600 spin_unlock(&hif_dev->rx_lock);
601 } else {
602 nskb = __dev_alloc_skb(pkt_len + 32, GFP_ATOMIC);
603 if (!nskb) {
604 dev_err(&hif_dev->udev->dev,
605 "ath9k_htc: RX memory allocation error\n");
606 goto err;
607 }
608 skb_reserve(nskb, 32);
609 RX_STAT_INC(skb_allocated);
610
611 memcpy(nskb->data, &(skb->data[chk_idx+4]), pkt_len);
612 skb_put(nskb, pkt_len);
613 skb_pool[pool_index++] = nskb;
614 }
615 }
616
617err:
618 for (i = 0; i < pool_index; i++) {
619 ath9k_htc_rx_msg(hif_dev->htc_handle, skb_pool[i],
620 skb_pool[i]->len, USB_WLAN_RX_PIPE);
621 RX_STAT_INC(skb_completed);
622 }
623}
624
625static void ath9k_hif_usb_rx_cb(struct urb *urb)
626{
627 struct sk_buff *skb = (struct sk_buff *) urb->context;
628 struct hif_device_usb *hif_dev =
629 usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
630 int ret;
631
632 if (!skb)
633 return;
634
635 if (!hif_dev)
636 goto free;
637
638 switch (urb->status) {
639 case 0:
640 break;
641 case -ENOENT:
642 case -ECONNRESET:
643 case -ENODEV:
644 case -ESHUTDOWN:
645 goto free;
646 default:
647 goto resubmit;
648 }
649
650 if (likely(urb->actual_length != 0)) {
651 skb_put(skb, urb->actual_length);
652 ath9k_hif_usb_rx_stream(hif_dev, skb);
653 }
654
655resubmit:
656 skb_reset_tail_pointer(skb);
657 skb_trim(skb, 0);
658
659 usb_anchor_urb(urb, &hif_dev->rx_submitted);
660 ret = usb_submit_urb(urb, GFP_ATOMIC);
661 if (ret) {
662 usb_unanchor_urb(urb);
663 goto free;
664 }
665
666 return;
667free:
668 kfree_skb(skb);
669}
670
671static void ath9k_hif_usb_reg_in_cb(struct urb *urb)
672{
673 struct sk_buff *skb = (struct sk_buff *) urb->context;
674 struct sk_buff *nskb;
675 struct hif_device_usb *hif_dev =
676 usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
677 int ret;
678
679 if (!skb)
680 return;
681
682 if (!hif_dev)
683 goto free;
684
685 switch (urb->status) {
686 case 0:
687 break;
688 case -ENOENT:
689 case -ECONNRESET:
690 case -ENODEV:
691 case -ESHUTDOWN:
692 goto free;
693 default:
694 skb_reset_tail_pointer(skb);
695 skb_trim(skb, 0);
696
697 goto resubmit;
698 }
699
700 if (likely(urb->actual_length != 0)) {
701 skb_put(skb, urb->actual_length);
702
703 /* Process the command first */
704 ath9k_htc_rx_msg(hif_dev->htc_handle, skb,
705 skb->len, USB_REG_IN_PIPE);
706
707
708 nskb = alloc_skb(MAX_REG_IN_BUF_SIZE, GFP_ATOMIC);
709 if (!nskb) {
710 dev_err(&hif_dev->udev->dev,
711 "ath9k_htc: REG_IN memory allocation failure\n");
712 urb->context = NULL;
713 return;
714 }
715
716 usb_fill_bulk_urb(urb, hif_dev->udev,
717 usb_rcvbulkpipe(hif_dev->udev,
718 USB_REG_IN_PIPE),
719 nskb->data, MAX_REG_IN_BUF_SIZE,
720 ath9k_hif_usb_reg_in_cb, nskb);
721 }
722
723resubmit:
724 usb_anchor_urb(urb, &hif_dev->reg_in_submitted);
725 ret = usb_submit_urb(urb, GFP_ATOMIC);
726 if (ret) {
727 usb_unanchor_urb(urb);
728 goto free;
729 }
730
731 return;
732free:
733 kfree_skb(skb);
734 urb->context = NULL;
735}
736
737static void ath9k_hif_usb_dealloc_tx_urbs(struct hif_device_usb *hif_dev)
738{
739 struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL;
740 unsigned long flags;
741
742 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
743 &hif_dev->tx.tx_buf, list) {
744 usb_kill_urb(tx_buf->urb);
745 list_del(&tx_buf->list);
746 usb_free_urb(tx_buf->urb);
747 kfree(tx_buf->buf);
748 kfree(tx_buf);
749 }
750
751 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
752 hif_dev->tx.flags |= HIF_USB_TX_FLUSH;
753 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
754
755 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
756 &hif_dev->tx.tx_pending, list) {
757 usb_kill_urb(tx_buf->urb);
758 list_del(&tx_buf->list);
759 usb_free_urb(tx_buf->urb);
760 kfree(tx_buf->buf);
761 kfree(tx_buf);
762 }
763
764 usb_kill_anchored_urbs(&hif_dev->mgmt_submitted);
765}
766
767static int ath9k_hif_usb_alloc_tx_urbs(struct hif_device_usb *hif_dev)
768{
769 struct tx_buf *tx_buf;
770 int i;
771
772 INIT_LIST_HEAD(&hif_dev->tx.tx_buf);
773 INIT_LIST_HEAD(&hif_dev->tx.tx_pending);
774 spin_lock_init(&hif_dev->tx.tx_lock);
775 __skb_queue_head_init(&hif_dev->tx.tx_skb_queue);
776 init_usb_anchor(&hif_dev->mgmt_submitted);
777
778 for (i = 0; i < MAX_TX_URB_NUM; i++) {
779 tx_buf = kzalloc(sizeof(struct tx_buf), GFP_KERNEL);
780 if (!tx_buf)
781 goto err;
782
783 tx_buf->buf = kzalloc(MAX_TX_BUF_SIZE, GFP_KERNEL);
784 if (!tx_buf->buf)
785 goto err;
786
787 tx_buf->urb = usb_alloc_urb(0, GFP_KERNEL);
788 if (!tx_buf->urb)
789 goto err;
790
791 tx_buf->hif_dev = hif_dev;
792 __skb_queue_head_init(&tx_buf->skb_queue);
793
794 list_add_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
795 }
796
797 hif_dev->tx.tx_buf_cnt = MAX_TX_URB_NUM;
798
799 return 0;
800err:
801 if (tx_buf) {
802 kfree(tx_buf->buf);
803 kfree(tx_buf);
804 }
805 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
806 return -ENOMEM;
807}
808
809static void ath9k_hif_usb_dealloc_rx_urbs(struct hif_device_usb *hif_dev)
810{
811 usb_kill_anchored_urbs(&hif_dev->rx_submitted);
812}
813
814static int ath9k_hif_usb_alloc_rx_urbs(struct hif_device_usb *hif_dev)
815{
816 struct urb *urb = NULL;
817 struct sk_buff *skb = NULL;
818 int i, ret;
819
820 init_usb_anchor(&hif_dev->rx_submitted);
821 spin_lock_init(&hif_dev->rx_lock);
822
823 for (i = 0; i < MAX_RX_URB_NUM; i++) {
824
825 /* Allocate URB */
826 urb = usb_alloc_urb(0, GFP_KERNEL);
827 if (urb == NULL) {
828 ret = -ENOMEM;
829 goto err_urb;
830 }
831
832 /* Allocate buffer */
833 skb = alloc_skb(MAX_RX_BUF_SIZE, GFP_KERNEL);
834 if (!skb) {
835 ret = -ENOMEM;
836 goto err_skb;
837 }
838
839 usb_fill_bulk_urb(urb, hif_dev->udev,
840 usb_rcvbulkpipe(hif_dev->udev,
841 USB_WLAN_RX_PIPE),
842 skb->data, MAX_RX_BUF_SIZE,
843 ath9k_hif_usb_rx_cb, skb);
844
845 /* Anchor URB */
846 usb_anchor_urb(urb, &hif_dev->rx_submitted);
847
848 /* Submit URB */
849 ret = usb_submit_urb(urb, GFP_KERNEL);
850 if (ret) {
851 usb_unanchor_urb(urb);
852 goto err_submit;
853 }
854
855 /*
856 * Drop reference count.
857 * This ensures that the URB is freed when killing them.
858 */
859 usb_free_urb(urb);
860 }
861
862 return 0;
863
864err_submit:
865 kfree_skb(skb);
866err_skb:
867 usb_free_urb(urb);
868err_urb:
869 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
870 return ret;
871}
872
873static void ath9k_hif_usb_dealloc_reg_in_urbs(struct hif_device_usb *hif_dev)
874{
875 usb_kill_anchored_urbs(&hif_dev->reg_in_submitted);
876}
877
878static int ath9k_hif_usb_alloc_reg_in_urbs(struct hif_device_usb *hif_dev)
879{
880 struct urb *urb = NULL;
881 struct sk_buff *skb = NULL;
882 int i, ret;
883
884 init_usb_anchor(&hif_dev->reg_in_submitted);
885
886 for (i = 0; i < MAX_REG_IN_URB_NUM; i++) {
887
888 /* Allocate URB */
889 urb = usb_alloc_urb(0, GFP_KERNEL);
890 if (urb == NULL) {
891 ret = -ENOMEM;
892 goto err_urb;
893 }
894
895 /* Allocate buffer */
896 skb = alloc_skb(MAX_REG_IN_BUF_SIZE, GFP_KERNEL);
897 if (!skb) {
898 ret = -ENOMEM;
899 goto err_skb;
900 }
901
902 usb_fill_bulk_urb(urb, hif_dev->udev,
903 usb_rcvbulkpipe(hif_dev->udev,
904 USB_REG_IN_PIPE),
905 skb->data, MAX_REG_IN_BUF_SIZE,
906 ath9k_hif_usb_reg_in_cb, skb);
907
908 /* Anchor URB */
909 usb_anchor_urb(urb, &hif_dev->reg_in_submitted);
910
911 /* Submit URB */
912 ret = usb_submit_urb(urb, GFP_KERNEL);
913 if (ret) {
914 usb_unanchor_urb(urb);
915 goto err_submit;
916 }
917
918 /*
919 * Drop reference count.
920 * This ensures that the URB is freed when killing them.
921 */
922 usb_free_urb(urb);
923 }
924
925 return 0;
926
927err_submit:
928 kfree_skb(skb);
929err_skb:
930 usb_free_urb(urb);
931err_urb:
932 ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev);
933 return ret;
934}
935
936static int ath9k_hif_usb_alloc_urbs(struct hif_device_usb *hif_dev)
937{
938 /* Register Write */
939 init_usb_anchor(&hif_dev->regout_submitted);
940
941 /* TX */
942 if (ath9k_hif_usb_alloc_tx_urbs(hif_dev) < 0)
943 goto err;
944
945 /* RX */
946 if (ath9k_hif_usb_alloc_rx_urbs(hif_dev) < 0)
947 goto err_rx;
948
949 /* Register Read */
950 if (ath9k_hif_usb_alloc_reg_in_urbs(hif_dev) < 0)
951 goto err_reg;
952
953 return 0;
954err_reg:
955 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
956err_rx:
957 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
958err:
959 return -ENOMEM;
960}
961
962static void ath9k_hif_usb_dealloc_urbs(struct hif_device_usb *hif_dev)
963{
964 usb_kill_anchored_urbs(&hif_dev->regout_submitted);
965 ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev);
966 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
967 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
968}
969
970static int ath9k_hif_usb_download_fw(struct hif_device_usb *hif_dev,
971 u32 drv_info)
972{
973 int transfer, err;
974 const void *data = hif_dev->firmware->data;
975 size_t len = hif_dev->firmware->size;
976 u32 addr = AR9271_FIRMWARE;
977 u8 *buf = kzalloc(4096, GFP_KERNEL);
978 u32 firm_offset;
979
980 if (!buf)
981 return -ENOMEM;
982
983 while (len) {
984 transfer = min_t(int, len, 4096);
985 memcpy(buf, data, transfer);
986
987 err = usb_control_msg(hif_dev->udev,
988 usb_sndctrlpipe(hif_dev->udev, 0),
989 FIRMWARE_DOWNLOAD, 0x40 | USB_DIR_OUT,
990 addr >> 8, 0, buf, transfer, HZ);
991 if (err < 0) {
992 kfree(buf);
993 return err;
994 }
995
996 len -= transfer;
997 data += transfer;
998 addr += transfer;
999 }
1000 kfree(buf);
1001
1002 if (IS_AR7010_DEVICE(drv_info))
1003 firm_offset = AR7010_FIRMWARE_TEXT;
1004 else
1005 firm_offset = AR9271_FIRMWARE_TEXT;
1006
1007 /*
1008 * Issue FW download complete command to firmware.
1009 */
1010 err = usb_control_msg(hif_dev->udev, usb_sndctrlpipe(hif_dev->udev, 0),
1011 FIRMWARE_DOWNLOAD_COMP,
1012 0x40 | USB_DIR_OUT,
1013 firm_offset >> 8, 0, NULL, 0, HZ);
1014 if (err)
1015 return -EIO;
1016
1017 dev_info(&hif_dev->udev->dev, "ath9k_htc: Transferred FW: %s, size: %ld\n",
1018 hif_dev->fw_name, (unsigned long) hif_dev->firmware->size);
1019
1020 return 0;
1021}
1022
1023static int ath9k_hif_usb_dev_init(struct hif_device_usb *hif_dev, u32 drv_info)
1024{
1025 int ret, idx;
1026 struct usb_host_interface *alt = &hif_dev->interface->altsetting[0];
1027 struct usb_endpoint_descriptor *endp;
1028
1029 /* Request firmware */
1030 ret = request_firmware(&hif_dev->firmware, hif_dev->fw_name,
1031 &hif_dev->udev->dev);
1032 if (ret) {
1033 dev_err(&hif_dev->udev->dev,
1034 "ath9k_htc: Firmware - %s not found\n", hif_dev->fw_name);
1035 goto err_fw_req;
1036 }
1037
1038 /* Download firmware */
1039 ret = ath9k_hif_usb_download_fw(hif_dev, drv_info);
1040 if (ret) {
1041 dev_err(&hif_dev->udev->dev,
1042 "ath9k_htc: Firmware - %s download failed\n",
1043 hif_dev->fw_name);
1044 goto err_fw_download;
1045 }
1046
1047 /* On downloading the firmware to the target, the USB descriptor of EP4
1048 * is 'patched' to change the type of the endpoint to Bulk. This will
1049 * bring down CPU usage during the scan period.
1050 */
1051 for (idx = 0; idx < alt->desc.bNumEndpoints; idx++) {
1052 endp = &alt->endpoint[idx].desc;
1053 if ((endp->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK)
1054 == USB_ENDPOINT_XFER_INT) {
1055 endp->bmAttributes &= ~USB_ENDPOINT_XFERTYPE_MASK;
1056 endp->bmAttributes |= USB_ENDPOINT_XFER_BULK;
1057 endp->bInterval = 0;
1058 }
1059 }
1060
1061 /* Alloc URBs */
1062 ret = ath9k_hif_usb_alloc_urbs(hif_dev);
1063 if (ret) {
1064 dev_err(&hif_dev->udev->dev,
1065 "ath9k_htc: Unable to allocate URBs\n");
1066 goto err_fw_download;
1067 }
1068
1069 return 0;
1070
1071err_fw_download:
1072 release_firmware(hif_dev->firmware);
1073err_fw_req:
1074 hif_dev->firmware = NULL;
1075 return ret;
1076}
1077
1078static void ath9k_hif_usb_dev_deinit(struct hif_device_usb *hif_dev)
1079{
1080 ath9k_hif_usb_dealloc_urbs(hif_dev);
1081 if (hif_dev->firmware)
1082 release_firmware(hif_dev->firmware);
1083}
1084
1085/*
1086 * An exact copy of the function from zd1211rw.
1087 */
1088static int send_eject_command(struct usb_interface *interface)
1089{
1090 struct usb_device *udev = interface_to_usbdev(interface);
1091 struct usb_host_interface *iface_desc = &interface->altsetting[0];
1092 struct usb_endpoint_descriptor *endpoint;
1093 unsigned char *cmd;
1094 u8 bulk_out_ep;
1095 int r;
1096
1097 /* Find bulk out endpoint */
1098 for (r = 1; r >= 0; r--) {
1099 endpoint = &iface_desc->endpoint[r].desc;
1100 if (usb_endpoint_dir_out(endpoint) &&
1101 usb_endpoint_xfer_bulk(endpoint)) {
1102 bulk_out_ep = endpoint->bEndpointAddress;
1103 break;
1104 }
1105 }
1106 if (r == -1) {
1107 dev_err(&udev->dev,
1108 "ath9k_htc: Could not find bulk out endpoint\n");
1109 return -ENODEV;
1110 }
1111
1112 cmd = kzalloc(31, GFP_KERNEL);
1113 if (cmd == NULL)
1114 return -ENODEV;
1115
1116 /* USB bulk command block */
1117 cmd[0] = 0x55; /* bulk command signature */
1118 cmd[1] = 0x53; /* bulk command signature */
1119 cmd[2] = 0x42; /* bulk command signature */
1120 cmd[3] = 0x43; /* bulk command signature */
1121 cmd[14] = 6; /* command length */
1122
1123 cmd[15] = 0x1b; /* SCSI command: START STOP UNIT */
1124 cmd[19] = 0x2; /* eject disc */
1125
1126 dev_info(&udev->dev, "Ejecting storage device...\n");
1127 r = usb_bulk_msg(udev, usb_sndbulkpipe(udev, bulk_out_ep),
1128 cmd, 31, NULL, 2000);
1129 kfree(cmd);
1130 if (r)
1131 return r;
1132
1133 /* At this point, the device disconnects and reconnects with the real
1134 * ID numbers. */
1135
1136 usb_set_intfdata(interface, NULL);
1137 return 0;
1138}
1139
1140static int ath9k_hif_usb_probe(struct usb_interface *interface,
1141 const struct usb_device_id *id)
1142{
1143 struct usb_device *udev = interface_to_usbdev(interface);
1144 struct hif_device_usb *hif_dev;
1145 int ret = 0;
1146
1147 if (id->driver_info == STORAGE_DEVICE)
1148 return send_eject_command(interface);
1149
1150 hif_dev = kzalloc(sizeof(struct hif_device_usb), GFP_KERNEL);
1151 if (!hif_dev) {
1152 ret = -ENOMEM;
1153 goto err_alloc;
1154 }
1155
1156 usb_get_dev(udev);
1157 hif_dev->udev = udev;
1158 hif_dev->interface = interface;
1159 hif_dev->device_id = id->idProduct;
1160#ifdef CONFIG_PM
1161 udev->reset_resume = 1;
1162#endif
1163 usb_set_intfdata(interface, hif_dev);
1164
1165 hif_dev->htc_handle = ath9k_htc_hw_alloc(hif_dev, &hif_usb,
1166 &hif_dev->udev->dev);
1167 if (hif_dev->htc_handle == NULL) {
1168 ret = -ENOMEM;
1169 goto err_htc_hw_alloc;
1170 }
1171
1172 /* Find out which firmware to load */
1173
1174 if (IS_AR7010_DEVICE(id->driver_info))
1175 hif_dev->fw_name = FIRMWARE_AR7010_1_1;
1176 else
1177 hif_dev->fw_name = FIRMWARE_AR9271;
1178
1179 ret = ath9k_hif_usb_dev_init(hif_dev, id->driver_info);
1180 if (ret) {
1181 ret = -EINVAL;
1182 goto err_hif_init_usb;
1183 }
1184
1185 ret = ath9k_htc_hw_init(hif_dev->htc_handle,
1186 &interface->dev, hif_dev->device_id,
1187 hif_dev->udev->product, id->driver_info);
1188 if (ret) {
1189 ret = -EINVAL;
1190 goto err_htc_hw_init;
1191 }
1192
1193 dev_info(&hif_dev->udev->dev, "ath9k_htc: USB layer initialized\n");
1194
1195 return 0;
1196
1197err_htc_hw_init:
1198 ath9k_hif_usb_dev_deinit(hif_dev);
1199err_hif_init_usb:
1200 ath9k_htc_hw_free(hif_dev->htc_handle);
1201err_htc_hw_alloc:
1202 usb_set_intfdata(interface, NULL);
1203 kfree(hif_dev);
1204 usb_put_dev(udev);
1205err_alloc:
1206 return ret;
1207}
1208
1209static void ath9k_hif_usb_reboot(struct usb_device *udev)
1210{
1211 u32 reboot_cmd = 0xffffffff;
1212 void *buf;
1213 int ret;
1214
1215 buf = kmemdup(&reboot_cmd, 4, GFP_KERNEL);
1216 if (!buf)
1217 return;
1218
1219 ret = usb_bulk_msg(udev, usb_sndbulkpipe(udev, USB_REG_OUT_PIPE),
1220 buf, 4, NULL, HZ);
1221 if (ret)
1222 dev_err(&udev->dev, "ath9k_htc: USB reboot failed\n");
1223
1224 kfree(buf);
1225}
1226
1227static void ath9k_hif_usb_disconnect(struct usb_interface *interface)
1228{
1229 struct usb_device *udev = interface_to_usbdev(interface);
1230 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1231 bool unplugged = (udev->state == USB_STATE_NOTATTACHED) ? true : false;
1232
1233 if (!hif_dev)
1234 return;
1235
1236 ath9k_htc_hw_deinit(hif_dev->htc_handle, unplugged);
1237 ath9k_htc_hw_free(hif_dev->htc_handle);
1238 ath9k_hif_usb_dev_deinit(hif_dev);
1239 usb_set_intfdata(interface, NULL);
1240
1241 if (!unplugged && (hif_dev->flags & HIF_USB_START))
1242 ath9k_hif_usb_reboot(udev);
1243
1244 kfree(hif_dev);
1245 dev_info(&udev->dev, "ath9k_htc: USB layer deinitialized\n");
1246 usb_put_dev(udev);
1247}
1248
1249#ifdef CONFIG_PM
1250static int ath9k_hif_usb_suspend(struct usb_interface *interface,
1251 pm_message_t message)
1252{
1253 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1254
1255 /*
1256 * The device has to be set to FULLSLEEP mode in case no
1257 * interface is up.
1258 */
1259 if (!(hif_dev->flags & HIF_USB_START))
1260 ath9k_htc_suspend(hif_dev->htc_handle);
1261
1262 ath9k_hif_usb_dealloc_urbs(hif_dev);
1263
1264 return 0;
1265}
1266
1267static int ath9k_hif_usb_resume(struct usb_interface *interface)
1268{
1269 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1270 struct htc_target *htc_handle = hif_dev->htc_handle;
1271 int ret;
1272
1273 ret = ath9k_hif_usb_alloc_urbs(hif_dev);
1274 if (ret)
1275 return ret;
1276
1277 if (hif_dev->firmware) {
1278 ret = ath9k_hif_usb_download_fw(hif_dev,
1279 htc_handle->drv_priv->ah->hw_version.usbdev);
1280 if (ret)
1281 goto fail_resume;
1282 } else {
1283 ath9k_hif_usb_dealloc_urbs(hif_dev);
1284 return -EIO;
1285 }
1286
1287 mdelay(100);
1288
1289 ret = ath9k_htc_resume(htc_handle);
1290
1291 if (ret)
1292 goto fail_resume;
1293
1294 return 0;
1295
1296fail_resume:
1297 ath9k_hif_usb_dealloc_urbs(hif_dev);
1298
1299 return ret;
1300}
1301#endif
1302
1303static struct usb_driver ath9k_hif_usb_driver = {
1304 .name = KBUILD_MODNAME,
1305 .probe = ath9k_hif_usb_probe,
1306 .disconnect = ath9k_hif_usb_disconnect,
1307#ifdef CONFIG_PM
1308 .suspend = ath9k_hif_usb_suspend,
1309 .resume = ath9k_hif_usb_resume,
1310 .reset_resume = ath9k_hif_usb_resume,
1311#endif
1312 .id_table = ath9k_hif_usb_ids,
1313 .soft_unbind = 1,
1314};
1315
1316int ath9k_hif_usb_init(void)
1317{
1318 return usb_register(&ath9k_hif_usb_driver);
1319}
1320
1321void ath9k_hif_usb_exit(void)
1322{
1323 usb_deregister(&ath9k_hif_usb_driver);
1324}
1/*
2 * Copyright (c) 2010-2011 Atheros Communications Inc.
3 *
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */
16
17#include <asm/unaligned.h>
18#include "htc.h"
19
20/* identify firmware images */
21#define FIRMWARE_AR7010_1_1 "htc_7010.fw"
22#define FIRMWARE_AR9271 "htc_9271.fw"
23
24MODULE_FIRMWARE(FIRMWARE_AR7010_1_1);
25MODULE_FIRMWARE(FIRMWARE_AR9271);
26
27static struct usb_device_id ath9k_hif_usb_ids[] = {
28 { USB_DEVICE(0x0cf3, 0x9271) }, /* Atheros */
29 { USB_DEVICE(0x0cf3, 0x1006) }, /* Atheros */
30 { USB_DEVICE(0x0846, 0x9030) }, /* Netgear N150 */
31 { USB_DEVICE(0x07D1, 0x3A10) }, /* Dlink Wireless 150 */
32 { USB_DEVICE(0x13D3, 0x3327) }, /* Azurewave */
33 { USB_DEVICE(0x13D3, 0x3328) }, /* Azurewave */
34 { USB_DEVICE(0x13D3, 0x3346) }, /* IMC Networks */
35 { USB_DEVICE(0x13D3, 0x3348) }, /* Azurewave */
36 { USB_DEVICE(0x13D3, 0x3349) }, /* Azurewave */
37 { USB_DEVICE(0x13D3, 0x3350) }, /* Azurewave */
38 { USB_DEVICE(0x04CA, 0x4605) }, /* Liteon */
39 { USB_DEVICE(0x040D, 0x3801) }, /* VIA */
40 { USB_DEVICE(0x0cf3, 0xb003) }, /* Ubiquiti WifiStation Ext */
41 { USB_DEVICE(0x0cf3, 0xb002) }, /* Ubiquiti WifiStation */
42 { USB_DEVICE(0x057c, 0x8403) }, /* AVM FRITZ!WLAN 11N v2 USB */
43
44 { USB_DEVICE(0x0cf3, 0x7015),
45 .driver_info = AR9287_USB }, /* Atheros */
46 { USB_DEVICE(0x1668, 0x1200),
47 .driver_info = AR9287_USB }, /* Verizon */
48
49 { USB_DEVICE(0x0cf3, 0x7010),
50 .driver_info = AR9280_USB }, /* Atheros */
51 { USB_DEVICE(0x0846, 0x9018),
52 .driver_info = AR9280_USB }, /* Netgear WNDA3200 */
53 { USB_DEVICE(0x083A, 0xA704),
54 .driver_info = AR9280_USB }, /* SMC Networks */
55 { USB_DEVICE(0x0411, 0x017f),
56 .driver_info = AR9280_USB }, /* Sony UWA-BR100 */
57 { USB_DEVICE(0x0411, 0x0197),
58 .driver_info = AR9280_USB }, /* Buffalo WLI-UV-AG300P */
59 { USB_DEVICE(0x04da, 0x3904),
60 .driver_info = AR9280_USB },
61
62 { USB_DEVICE(0x0cf3, 0x20ff),
63 .driver_info = STORAGE_DEVICE },
64
65 { },
66};
67
68MODULE_DEVICE_TABLE(usb, ath9k_hif_usb_ids);
69
70static int __hif_usb_tx(struct hif_device_usb *hif_dev);
71
72static void hif_usb_regout_cb(struct urb *urb)
73{
74 struct cmd_buf *cmd = (struct cmd_buf *)urb->context;
75
76 switch (urb->status) {
77 case 0:
78 break;
79 case -ENOENT:
80 case -ECONNRESET:
81 case -ENODEV:
82 case -ESHUTDOWN:
83 goto free;
84 default:
85 break;
86 }
87
88 if (cmd) {
89 ath9k_htc_txcompletion_cb(cmd->hif_dev->htc_handle,
90 cmd->skb, true);
91 kfree(cmd);
92 }
93
94 return;
95free:
96 kfree_skb(cmd->skb);
97 kfree(cmd);
98}
99
100static int hif_usb_send_regout(struct hif_device_usb *hif_dev,
101 struct sk_buff *skb)
102{
103 struct urb *urb;
104 struct cmd_buf *cmd;
105 int ret = 0;
106
107 urb = usb_alloc_urb(0, GFP_KERNEL);
108 if (urb == NULL)
109 return -ENOMEM;
110
111 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
112 if (cmd == NULL) {
113 usb_free_urb(urb);
114 return -ENOMEM;
115 }
116
117 cmd->skb = skb;
118 cmd->hif_dev = hif_dev;
119
120 usb_fill_int_urb(urb, hif_dev->udev,
121 usb_sndintpipe(hif_dev->udev, USB_REG_OUT_PIPE),
122 skb->data, skb->len,
123 hif_usb_regout_cb, cmd, 1);
124
125 usb_anchor_urb(urb, &hif_dev->regout_submitted);
126 ret = usb_submit_urb(urb, GFP_KERNEL);
127 if (ret) {
128 usb_unanchor_urb(urb);
129 kfree(cmd);
130 }
131 usb_free_urb(urb);
132
133 return ret;
134}
135
136static void hif_usb_mgmt_cb(struct urb *urb)
137{
138 struct cmd_buf *cmd = (struct cmd_buf *)urb->context;
139 struct hif_device_usb *hif_dev;
140 bool txok = true;
141
142 if (!cmd || !cmd->skb || !cmd->hif_dev)
143 return;
144
145 hif_dev = cmd->hif_dev;
146
147 switch (urb->status) {
148 case 0:
149 break;
150 case -ENOENT:
151 case -ECONNRESET:
152 case -ENODEV:
153 case -ESHUTDOWN:
154 txok = false;
155
156 /*
157 * If the URBs are being flushed, no need to complete
158 * this packet.
159 */
160 spin_lock(&hif_dev->tx.tx_lock);
161 if (hif_dev->tx.flags & HIF_USB_TX_FLUSH) {
162 spin_unlock(&hif_dev->tx.tx_lock);
163 dev_kfree_skb_any(cmd->skb);
164 kfree(cmd);
165 return;
166 }
167 spin_unlock(&hif_dev->tx.tx_lock);
168
169 break;
170 default:
171 txok = false;
172 break;
173 }
174
175 skb_pull(cmd->skb, 4);
176 ath9k_htc_txcompletion_cb(cmd->hif_dev->htc_handle,
177 cmd->skb, txok);
178 kfree(cmd);
179}
180
181static int hif_usb_send_mgmt(struct hif_device_usb *hif_dev,
182 struct sk_buff *skb)
183{
184 struct urb *urb;
185 struct cmd_buf *cmd;
186 int ret = 0;
187 __le16 *hdr;
188
189 urb = usb_alloc_urb(0, GFP_ATOMIC);
190 if (urb == NULL)
191 return -ENOMEM;
192
193 cmd = kzalloc(sizeof(*cmd), GFP_ATOMIC);
194 if (cmd == NULL) {
195 usb_free_urb(urb);
196 return -ENOMEM;
197 }
198
199 cmd->skb = skb;
200 cmd->hif_dev = hif_dev;
201
202 hdr = (__le16 *) skb_push(skb, 4);
203 *hdr++ = cpu_to_le16(skb->len - 4);
204 *hdr++ = cpu_to_le16(ATH_USB_TX_STREAM_MODE_TAG);
205
206 usb_fill_bulk_urb(urb, hif_dev->udev,
207 usb_sndbulkpipe(hif_dev->udev, USB_WLAN_TX_PIPE),
208 skb->data, skb->len,
209 hif_usb_mgmt_cb, cmd);
210
211 usb_anchor_urb(urb, &hif_dev->mgmt_submitted);
212 ret = usb_submit_urb(urb, GFP_ATOMIC);
213 if (ret) {
214 usb_unanchor_urb(urb);
215 kfree(cmd);
216 }
217 usb_free_urb(urb);
218
219 return ret;
220}
221
222static inline void ath9k_skb_queue_purge(struct hif_device_usb *hif_dev,
223 struct sk_buff_head *list)
224{
225 struct sk_buff *skb;
226
227 while ((skb = __skb_dequeue(list)) != NULL) {
228 dev_kfree_skb_any(skb);
229 }
230}
231
232static inline void ath9k_skb_queue_complete(struct hif_device_usb *hif_dev,
233 struct sk_buff_head *queue,
234 bool txok)
235{
236 struct sk_buff *skb;
237
238 while ((skb = __skb_dequeue(queue)) != NULL) {
239#ifdef CONFIG_ATH9K_HTC_DEBUGFS
240 int ln = skb->len;
241#endif
242 ath9k_htc_txcompletion_cb(hif_dev->htc_handle,
243 skb, txok);
244 if (txok) {
245 TX_STAT_INC(skb_success);
246 TX_STAT_ADD(skb_success_bytes, ln);
247 }
248 else
249 TX_STAT_INC(skb_failed);
250 }
251}
252
253static void hif_usb_tx_cb(struct urb *urb)
254{
255 struct tx_buf *tx_buf = (struct tx_buf *) urb->context;
256 struct hif_device_usb *hif_dev;
257 bool txok = true;
258
259 if (!tx_buf || !tx_buf->hif_dev)
260 return;
261
262 hif_dev = tx_buf->hif_dev;
263
264 switch (urb->status) {
265 case 0:
266 break;
267 case -ENOENT:
268 case -ECONNRESET:
269 case -ENODEV:
270 case -ESHUTDOWN:
271 txok = false;
272
273 /*
274 * If the URBs are being flushed, no need to add this
275 * URB to the free list.
276 */
277 spin_lock(&hif_dev->tx.tx_lock);
278 if (hif_dev->tx.flags & HIF_USB_TX_FLUSH) {
279 spin_unlock(&hif_dev->tx.tx_lock);
280 ath9k_skb_queue_purge(hif_dev, &tx_buf->skb_queue);
281 return;
282 }
283 spin_unlock(&hif_dev->tx.tx_lock);
284
285 break;
286 default:
287 txok = false;
288 break;
289 }
290
291 ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, txok);
292
293 /* Re-initialize the SKB queue */
294 tx_buf->len = tx_buf->offset = 0;
295 __skb_queue_head_init(&tx_buf->skb_queue);
296
297 /* Add this TX buffer to the free list */
298 spin_lock(&hif_dev->tx.tx_lock);
299 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
300 hif_dev->tx.tx_buf_cnt++;
301 if (!(hif_dev->tx.flags & HIF_USB_TX_STOP))
302 __hif_usb_tx(hif_dev); /* Check for pending SKBs */
303 TX_STAT_INC(buf_completed);
304 spin_unlock(&hif_dev->tx.tx_lock);
305}
306
307/* TX lock has to be taken */
308static int __hif_usb_tx(struct hif_device_usb *hif_dev)
309{
310 struct tx_buf *tx_buf = NULL;
311 struct sk_buff *nskb = NULL;
312 int ret = 0, i;
313 u16 tx_skb_cnt = 0;
314 u8 *buf;
315 __le16 *hdr;
316
317 if (hif_dev->tx.tx_skb_cnt == 0)
318 return 0;
319
320 /* Check if a free TX buffer is available */
321 if (list_empty(&hif_dev->tx.tx_buf))
322 return 0;
323
324 tx_buf = list_first_entry(&hif_dev->tx.tx_buf, struct tx_buf, list);
325 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_pending);
326 hif_dev->tx.tx_buf_cnt--;
327
328 tx_skb_cnt = min_t(u16, hif_dev->tx.tx_skb_cnt, MAX_TX_AGGR_NUM);
329
330 for (i = 0; i < tx_skb_cnt; i++) {
331 nskb = __skb_dequeue(&hif_dev->tx.tx_skb_queue);
332
333 /* Should never be NULL */
334 BUG_ON(!nskb);
335
336 hif_dev->tx.tx_skb_cnt--;
337
338 buf = tx_buf->buf;
339 buf += tx_buf->offset;
340 hdr = (__le16 *)buf;
341 *hdr++ = cpu_to_le16(nskb->len);
342 *hdr++ = cpu_to_le16(ATH_USB_TX_STREAM_MODE_TAG);
343 buf += 4;
344 memcpy(buf, nskb->data, nskb->len);
345 tx_buf->len = nskb->len + 4;
346
347 if (i < (tx_skb_cnt - 1))
348 tx_buf->offset += (((tx_buf->len - 1) / 4) + 1) * 4;
349
350 if (i == (tx_skb_cnt - 1))
351 tx_buf->len += tx_buf->offset;
352
353 __skb_queue_tail(&tx_buf->skb_queue, nskb);
354 TX_STAT_INC(skb_queued);
355 }
356
357 usb_fill_bulk_urb(tx_buf->urb, hif_dev->udev,
358 usb_sndbulkpipe(hif_dev->udev, USB_WLAN_TX_PIPE),
359 tx_buf->buf, tx_buf->len,
360 hif_usb_tx_cb, tx_buf);
361
362 ret = usb_submit_urb(tx_buf->urb, GFP_ATOMIC);
363 if (ret) {
364 tx_buf->len = tx_buf->offset = 0;
365 ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, false);
366 __skb_queue_head_init(&tx_buf->skb_queue);
367 list_move_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
368 hif_dev->tx.tx_buf_cnt++;
369 }
370
371 if (!ret)
372 TX_STAT_INC(buf_queued);
373
374 return ret;
375}
376
377static int hif_usb_send_tx(struct hif_device_usb *hif_dev, struct sk_buff *skb)
378{
379 struct ath9k_htc_tx_ctl *tx_ctl;
380 unsigned long flags;
381 int ret = 0;
382
383 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
384
385 if (hif_dev->tx.flags & HIF_USB_TX_STOP) {
386 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
387 return -ENODEV;
388 }
389
390 /* Check if the max queue count has been reached */
391 if (hif_dev->tx.tx_skb_cnt > MAX_TX_BUF_NUM) {
392 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
393 return -ENOMEM;
394 }
395
396 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
397
398 tx_ctl = HTC_SKB_CB(skb);
399
400 /* Mgmt/Beacon frames don't use the TX buffer pool */
401 if ((tx_ctl->type == ATH9K_HTC_MGMT) ||
402 (tx_ctl->type == ATH9K_HTC_BEACON)) {
403 ret = hif_usb_send_mgmt(hif_dev, skb);
404 }
405
406 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
407
408 if ((tx_ctl->type == ATH9K_HTC_NORMAL) ||
409 (tx_ctl->type == ATH9K_HTC_AMPDU)) {
410 __skb_queue_tail(&hif_dev->tx.tx_skb_queue, skb);
411 hif_dev->tx.tx_skb_cnt++;
412 }
413
414 /* Check if AMPDUs have to be sent immediately */
415 if ((hif_dev->tx.tx_buf_cnt == MAX_TX_URB_NUM) &&
416 (hif_dev->tx.tx_skb_cnt < 2)) {
417 __hif_usb_tx(hif_dev);
418 }
419
420 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
421
422 return ret;
423}
424
425static void hif_usb_start(void *hif_handle)
426{
427 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
428 unsigned long flags;
429
430 hif_dev->flags |= HIF_USB_START;
431
432 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
433 hif_dev->tx.flags &= ~HIF_USB_TX_STOP;
434 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
435}
436
437static void hif_usb_stop(void *hif_handle)
438{
439 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
440 struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL;
441 unsigned long flags;
442
443 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
444 ath9k_skb_queue_complete(hif_dev, &hif_dev->tx.tx_skb_queue, false);
445 hif_dev->tx.tx_skb_cnt = 0;
446 hif_dev->tx.flags |= HIF_USB_TX_STOP;
447 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
448
449 /* The pending URBs have to be canceled. */
450 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
451 &hif_dev->tx.tx_pending, list) {
452 usb_kill_urb(tx_buf->urb);
453 }
454
455 usb_kill_anchored_urbs(&hif_dev->mgmt_submitted);
456}
457
458static int hif_usb_send(void *hif_handle, u8 pipe_id, struct sk_buff *skb)
459{
460 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
461 int ret = 0;
462
463 switch (pipe_id) {
464 case USB_WLAN_TX_PIPE:
465 ret = hif_usb_send_tx(hif_dev, skb);
466 break;
467 case USB_REG_OUT_PIPE:
468 ret = hif_usb_send_regout(hif_dev, skb);
469 break;
470 default:
471 dev_err(&hif_dev->udev->dev,
472 "ath9k_htc: Invalid TX pipe: %d\n", pipe_id);
473 ret = -EINVAL;
474 break;
475 }
476
477 return ret;
478}
479
480static inline bool check_index(struct sk_buff *skb, u8 idx)
481{
482 struct ath9k_htc_tx_ctl *tx_ctl;
483
484 tx_ctl = HTC_SKB_CB(skb);
485
486 if ((tx_ctl->type == ATH9K_HTC_AMPDU) &&
487 (tx_ctl->sta_idx == idx))
488 return true;
489
490 return false;
491}
492
493static void hif_usb_sta_drain(void *hif_handle, u8 idx)
494{
495 struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle;
496 struct sk_buff *skb, *tmp;
497 unsigned long flags;
498
499 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
500
501 skb_queue_walk_safe(&hif_dev->tx.tx_skb_queue, skb, tmp) {
502 if (check_index(skb, idx)) {
503 __skb_unlink(skb, &hif_dev->tx.tx_skb_queue);
504 ath9k_htc_txcompletion_cb(hif_dev->htc_handle,
505 skb, false);
506 hif_dev->tx.tx_skb_cnt--;
507 TX_STAT_INC(skb_failed);
508 }
509 }
510
511 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
512}
513
514static struct ath9k_htc_hif hif_usb = {
515 .transport = ATH9K_HIF_USB,
516 .name = "ath9k_hif_usb",
517
518 .control_ul_pipe = USB_REG_OUT_PIPE,
519 .control_dl_pipe = USB_REG_IN_PIPE,
520
521 .start = hif_usb_start,
522 .stop = hif_usb_stop,
523 .sta_drain = hif_usb_sta_drain,
524 .send = hif_usb_send,
525};
526
527static void ath9k_hif_usb_rx_stream(struct hif_device_usb *hif_dev,
528 struct sk_buff *skb)
529{
530 struct sk_buff *nskb, *skb_pool[MAX_PKT_NUM_IN_TRANSFER];
531 int index = 0, i = 0, len = skb->len;
532 int rx_remain_len, rx_pkt_len;
533 u16 pool_index = 0;
534 u8 *ptr;
535
536 spin_lock(&hif_dev->rx_lock);
537
538 rx_remain_len = hif_dev->rx_remain_len;
539 rx_pkt_len = hif_dev->rx_transfer_len;
540
541 if (rx_remain_len != 0) {
542 struct sk_buff *remain_skb = hif_dev->remain_skb;
543
544 if (remain_skb) {
545 ptr = (u8 *) remain_skb->data;
546
547 index = rx_remain_len;
548 rx_remain_len -= hif_dev->rx_pad_len;
549 ptr += rx_pkt_len;
550
551 memcpy(ptr, skb->data, rx_remain_len);
552
553 rx_pkt_len += rx_remain_len;
554 hif_dev->rx_remain_len = 0;
555 skb_put(remain_skb, rx_pkt_len);
556
557 skb_pool[pool_index++] = remain_skb;
558
559 } else {
560 index = rx_remain_len;
561 }
562 }
563
564 spin_unlock(&hif_dev->rx_lock);
565
566 while (index < len) {
567 u16 pkt_len;
568 u16 pkt_tag;
569 u16 pad_len;
570 int chk_idx;
571
572 ptr = (u8 *) skb->data;
573
574 pkt_len = get_unaligned_le16(ptr + index);
575 pkt_tag = get_unaligned_le16(ptr + index + 2);
576
577 if (pkt_tag != ATH_USB_RX_STREAM_MODE_TAG) {
578 RX_STAT_INC(skb_dropped);
579 return;
580 }
581
582 pad_len = 4 - (pkt_len & 0x3);
583 if (pad_len == 4)
584 pad_len = 0;
585
586 chk_idx = index;
587 index = index + 4 + pkt_len + pad_len;
588
589 if (index > MAX_RX_BUF_SIZE) {
590 spin_lock(&hif_dev->rx_lock);
591 hif_dev->rx_remain_len = index - MAX_RX_BUF_SIZE;
592 hif_dev->rx_transfer_len =
593 MAX_RX_BUF_SIZE - chk_idx - 4;
594 hif_dev->rx_pad_len = pad_len;
595
596 nskb = __dev_alloc_skb(pkt_len + 32, GFP_ATOMIC);
597 if (!nskb) {
598 dev_err(&hif_dev->udev->dev,
599 "ath9k_htc: RX memory allocation error\n");
600 spin_unlock(&hif_dev->rx_lock);
601 goto err;
602 }
603 skb_reserve(nskb, 32);
604 RX_STAT_INC(skb_allocated);
605
606 memcpy(nskb->data, &(skb->data[chk_idx+4]),
607 hif_dev->rx_transfer_len);
608
609 /* Record the buffer pointer */
610 hif_dev->remain_skb = nskb;
611 spin_unlock(&hif_dev->rx_lock);
612 } else {
613 nskb = __dev_alloc_skb(pkt_len + 32, GFP_ATOMIC);
614 if (!nskb) {
615 dev_err(&hif_dev->udev->dev,
616 "ath9k_htc: RX memory allocation error\n");
617 goto err;
618 }
619 skb_reserve(nskb, 32);
620 RX_STAT_INC(skb_allocated);
621
622 memcpy(nskb->data, &(skb->data[chk_idx+4]), pkt_len);
623 skb_put(nskb, pkt_len);
624 skb_pool[pool_index++] = nskb;
625 }
626 }
627
628err:
629 for (i = 0; i < pool_index; i++) {
630 RX_STAT_ADD(skb_completed_bytes, skb_pool[i]->len);
631 ath9k_htc_rx_msg(hif_dev->htc_handle, skb_pool[i],
632 skb_pool[i]->len, USB_WLAN_RX_PIPE);
633 RX_STAT_INC(skb_completed);
634 }
635}
636
637static void ath9k_hif_usb_rx_cb(struct urb *urb)
638{
639 struct sk_buff *skb = (struct sk_buff *) urb->context;
640 struct hif_device_usb *hif_dev =
641 usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
642 int ret;
643
644 if (!skb)
645 return;
646
647 if (!hif_dev)
648 goto free;
649
650 switch (urb->status) {
651 case 0:
652 break;
653 case -ENOENT:
654 case -ECONNRESET:
655 case -ENODEV:
656 case -ESHUTDOWN:
657 goto free;
658 default:
659 goto resubmit;
660 }
661
662 if (likely(urb->actual_length != 0)) {
663 skb_put(skb, urb->actual_length);
664 ath9k_hif_usb_rx_stream(hif_dev, skb);
665 }
666
667resubmit:
668 skb_reset_tail_pointer(skb);
669 skb_trim(skb, 0);
670
671 usb_anchor_urb(urb, &hif_dev->rx_submitted);
672 ret = usb_submit_urb(urb, GFP_ATOMIC);
673 if (ret) {
674 usb_unanchor_urb(urb);
675 goto free;
676 }
677
678 return;
679free:
680 kfree_skb(skb);
681}
682
683static void ath9k_hif_usb_reg_in_cb(struct urb *urb)
684{
685 struct sk_buff *skb = (struct sk_buff *) urb->context;
686 struct sk_buff *nskb;
687 struct hif_device_usb *hif_dev =
688 usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0));
689 int ret;
690
691 if (!skb)
692 return;
693
694 if (!hif_dev)
695 goto free;
696
697 switch (urb->status) {
698 case 0:
699 break;
700 case -ENOENT:
701 case -ECONNRESET:
702 case -ENODEV:
703 case -ESHUTDOWN:
704 goto free;
705 default:
706 skb_reset_tail_pointer(skb);
707 skb_trim(skb, 0);
708
709 goto resubmit;
710 }
711
712 if (likely(urb->actual_length != 0)) {
713 skb_put(skb, urb->actual_length);
714
715 /* Process the command first */
716 ath9k_htc_rx_msg(hif_dev->htc_handle, skb,
717 skb->len, USB_REG_IN_PIPE);
718
719
720 nskb = alloc_skb(MAX_REG_IN_BUF_SIZE, GFP_ATOMIC);
721 if (!nskb) {
722 dev_err(&hif_dev->udev->dev,
723 "ath9k_htc: REG_IN memory allocation failure\n");
724 urb->context = NULL;
725 return;
726 }
727
728 usb_fill_int_urb(urb, hif_dev->udev,
729 usb_rcvintpipe(hif_dev->udev,
730 USB_REG_IN_PIPE),
731 nskb->data, MAX_REG_IN_BUF_SIZE,
732 ath9k_hif_usb_reg_in_cb, nskb, 1);
733 }
734
735resubmit:
736 usb_anchor_urb(urb, &hif_dev->reg_in_submitted);
737 ret = usb_submit_urb(urb, GFP_ATOMIC);
738 if (ret) {
739 usb_unanchor_urb(urb);
740 goto free;
741 }
742
743 return;
744free:
745 kfree_skb(skb);
746 urb->context = NULL;
747}
748
749static void ath9k_hif_usb_dealloc_tx_urbs(struct hif_device_usb *hif_dev)
750{
751 struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL;
752 unsigned long flags;
753
754 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
755 &hif_dev->tx.tx_buf, list) {
756 usb_kill_urb(tx_buf->urb);
757 list_del(&tx_buf->list);
758 usb_free_urb(tx_buf->urb);
759 kfree(tx_buf->buf);
760 kfree(tx_buf);
761 }
762
763 spin_lock_irqsave(&hif_dev->tx.tx_lock, flags);
764 hif_dev->tx.flags |= HIF_USB_TX_FLUSH;
765 spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags);
766
767 list_for_each_entry_safe(tx_buf, tx_buf_tmp,
768 &hif_dev->tx.tx_pending, list) {
769 usb_kill_urb(tx_buf->urb);
770 list_del(&tx_buf->list);
771 usb_free_urb(tx_buf->urb);
772 kfree(tx_buf->buf);
773 kfree(tx_buf);
774 }
775
776 usb_kill_anchored_urbs(&hif_dev->mgmt_submitted);
777}
778
779static int ath9k_hif_usb_alloc_tx_urbs(struct hif_device_usb *hif_dev)
780{
781 struct tx_buf *tx_buf;
782 int i;
783
784 INIT_LIST_HEAD(&hif_dev->tx.tx_buf);
785 INIT_LIST_HEAD(&hif_dev->tx.tx_pending);
786 spin_lock_init(&hif_dev->tx.tx_lock);
787 __skb_queue_head_init(&hif_dev->tx.tx_skb_queue);
788 init_usb_anchor(&hif_dev->mgmt_submitted);
789
790 for (i = 0; i < MAX_TX_URB_NUM; i++) {
791 tx_buf = kzalloc(sizeof(struct tx_buf), GFP_KERNEL);
792 if (!tx_buf)
793 goto err;
794
795 tx_buf->buf = kzalloc(MAX_TX_BUF_SIZE, GFP_KERNEL);
796 if (!tx_buf->buf)
797 goto err;
798
799 tx_buf->urb = usb_alloc_urb(0, GFP_KERNEL);
800 if (!tx_buf->urb)
801 goto err;
802
803 tx_buf->hif_dev = hif_dev;
804 __skb_queue_head_init(&tx_buf->skb_queue);
805
806 list_add_tail(&tx_buf->list, &hif_dev->tx.tx_buf);
807 }
808
809 hif_dev->tx.tx_buf_cnt = MAX_TX_URB_NUM;
810
811 return 0;
812err:
813 if (tx_buf) {
814 kfree(tx_buf->buf);
815 kfree(tx_buf);
816 }
817 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
818 return -ENOMEM;
819}
820
821static void ath9k_hif_usb_dealloc_rx_urbs(struct hif_device_usb *hif_dev)
822{
823 usb_kill_anchored_urbs(&hif_dev->rx_submitted);
824}
825
826static int ath9k_hif_usb_alloc_rx_urbs(struct hif_device_usb *hif_dev)
827{
828 struct urb *urb = NULL;
829 struct sk_buff *skb = NULL;
830 int i, ret;
831
832 init_usb_anchor(&hif_dev->rx_submitted);
833 spin_lock_init(&hif_dev->rx_lock);
834
835 for (i = 0; i < MAX_RX_URB_NUM; i++) {
836
837 /* Allocate URB */
838 urb = usb_alloc_urb(0, GFP_KERNEL);
839 if (urb == NULL) {
840 ret = -ENOMEM;
841 goto err_urb;
842 }
843
844 /* Allocate buffer */
845 skb = alloc_skb(MAX_RX_BUF_SIZE, GFP_KERNEL);
846 if (!skb) {
847 ret = -ENOMEM;
848 goto err_skb;
849 }
850
851 usb_fill_bulk_urb(urb, hif_dev->udev,
852 usb_rcvbulkpipe(hif_dev->udev,
853 USB_WLAN_RX_PIPE),
854 skb->data, MAX_RX_BUF_SIZE,
855 ath9k_hif_usb_rx_cb, skb);
856
857 /* Anchor URB */
858 usb_anchor_urb(urb, &hif_dev->rx_submitted);
859
860 /* Submit URB */
861 ret = usb_submit_urb(urb, GFP_KERNEL);
862 if (ret) {
863 usb_unanchor_urb(urb);
864 goto err_submit;
865 }
866
867 /*
868 * Drop reference count.
869 * This ensures that the URB is freed when killing them.
870 */
871 usb_free_urb(urb);
872 }
873
874 return 0;
875
876err_submit:
877 kfree_skb(skb);
878err_skb:
879 usb_free_urb(urb);
880err_urb:
881 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
882 return ret;
883}
884
885static void ath9k_hif_usb_dealloc_reg_in_urbs(struct hif_device_usb *hif_dev)
886{
887 usb_kill_anchored_urbs(&hif_dev->reg_in_submitted);
888}
889
890static int ath9k_hif_usb_alloc_reg_in_urbs(struct hif_device_usb *hif_dev)
891{
892 struct urb *urb = NULL;
893 struct sk_buff *skb = NULL;
894 int i, ret;
895
896 init_usb_anchor(&hif_dev->reg_in_submitted);
897
898 for (i = 0; i < MAX_REG_IN_URB_NUM; i++) {
899
900 /* Allocate URB */
901 urb = usb_alloc_urb(0, GFP_KERNEL);
902 if (urb == NULL) {
903 ret = -ENOMEM;
904 goto err_urb;
905 }
906
907 /* Allocate buffer */
908 skb = alloc_skb(MAX_REG_IN_BUF_SIZE, GFP_KERNEL);
909 if (!skb) {
910 ret = -ENOMEM;
911 goto err_skb;
912 }
913
914 usb_fill_int_urb(urb, hif_dev->udev,
915 usb_rcvintpipe(hif_dev->udev,
916 USB_REG_IN_PIPE),
917 skb->data, MAX_REG_IN_BUF_SIZE,
918 ath9k_hif_usb_reg_in_cb, skb, 1);
919
920 /* Anchor URB */
921 usb_anchor_urb(urb, &hif_dev->reg_in_submitted);
922
923 /* Submit URB */
924 ret = usb_submit_urb(urb, GFP_KERNEL);
925 if (ret) {
926 usb_unanchor_urb(urb);
927 goto err_submit;
928 }
929
930 /*
931 * Drop reference count.
932 * This ensures that the URB is freed when killing them.
933 */
934 usb_free_urb(urb);
935 }
936
937 return 0;
938
939err_submit:
940 kfree_skb(skb);
941err_skb:
942 usb_free_urb(urb);
943err_urb:
944 ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev);
945 return ret;
946}
947
948static int ath9k_hif_usb_alloc_urbs(struct hif_device_usb *hif_dev)
949{
950 /* Register Write */
951 init_usb_anchor(&hif_dev->regout_submitted);
952
953 /* TX */
954 if (ath9k_hif_usb_alloc_tx_urbs(hif_dev) < 0)
955 goto err;
956
957 /* RX */
958 if (ath9k_hif_usb_alloc_rx_urbs(hif_dev) < 0)
959 goto err_rx;
960
961 /* Register Read */
962 if (ath9k_hif_usb_alloc_reg_in_urbs(hif_dev) < 0)
963 goto err_reg;
964
965 return 0;
966err_reg:
967 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
968err_rx:
969 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
970err:
971 return -ENOMEM;
972}
973
974static void ath9k_hif_usb_dealloc_urbs(struct hif_device_usb *hif_dev)
975{
976 usb_kill_anchored_urbs(&hif_dev->regout_submitted);
977 ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev);
978 ath9k_hif_usb_dealloc_tx_urbs(hif_dev);
979 ath9k_hif_usb_dealloc_rx_urbs(hif_dev);
980}
981
982static int ath9k_hif_usb_download_fw(struct hif_device_usb *hif_dev)
983{
984 int transfer, err;
985 const void *data = hif_dev->fw_data;
986 size_t len = hif_dev->fw_size;
987 u32 addr = AR9271_FIRMWARE;
988 u8 *buf = kzalloc(4096, GFP_KERNEL);
989 u32 firm_offset;
990
991 if (!buf)
992 return -ENOMEM;
993
994 while (len) {
995 transfer = min_t(size_t, len, 4096);
996 memcpy(buf, data, transfer);
997
998 err = usb_control_msg(hif_dev->udev,
999 usb_sndctrlpipe(hif_dev->udev, 0),
1000 FIRMWARE_DOWNLOAD, 0x40 | USB_DIR_OUT,
1001 addr >> 8, 0, buf, transfer, HZ);
1002 if (err < 0) {
1003 kfree(buf);
1004 return err;
1005 }
1006
1007 len -= transfer;
1008 data += transfer;
1009 addr += transfer;
1010 }
1011 kfree(buf);
1012
1013 if (IS_AR7010_DEVICE(hif_dev->usb_device_id->driver_info))
1014 firm_offset = AR7010_FIRMWARE_TEXT;
1015 else
1016 firm_offset = AR9271_FIRMWARE_TEXT;
1017
1018 /*
1019 * Issue FW download complete command to firmware.
1020 */
1021 err = usb_control_msg(hif_dev->udev, usb_sndctrlpipe(hif_dev->udev, 0),
1022 FIRMWARE_DOWNLOAD_COMP,
1023 0x40 | USB_DIR_OUT,
1024 firm_offset >> 8, 0, NULL, 0, HZ);
1025 if (err)
1026 return -EIO;
1027
1028 dev_info(&hif_dev->udev->dev, "ath9k_htc: Transferred FW: %s, size: %ld\n",
1029 hif_dev->fw_name, (unsigned long) hif_dev->fw_size);
1030
1031 return 0;
1032}
1033
1034static int ath9k_hif_usb_dev_init(struct hif_device_usb *hif_dev)
1035{
1036 int ret;
1037
1038 ret = ath9k_hif_usb_download_fw(hif_dev);
1039 if (ret) {
1040 dev_err(&hif_dev->udev->dev,
1041 "ath9k_htc: Firmware - %s download failed\n",
1042 hif_dev->fw_name);
1043 return ret;
1044 }
1045
1046 /* Alloc URBs */
1047 ret = ath9k_hif_usb_alloc_urbs(hif_dev);
1048 if (ret) {
1049 dev_err(&hif_dev->udev->dev,
1050 "ath9k_htc: Unable to allocate URBs\n");
1051 return ret;
1052 }
1053
1054 return 0;
1055}
1056
1057static void ath9k_hif_usb_dev_deinit(struct hif_device_usb *hif_dev)
1058{
1059 ath9k_hif_usb_dealloc_urbs(hif_dev);
1060}
1061
1062/*
1063 * If initialization fails or the FW cannot be retrieved,
1064 * detach the device.
1065 */
1066static void ath9k_hif_usb_firmware_fail(struct hif_device_usb *hif_dev)
1067{
1068 struct device *dev = &hif_dev->udev->dev;
1069 struct device *parent = dev->parent;
1070
1071 complete_all(&hif_dev->fw_done);
1072
1073 if (parent)
1074 device_lock(parent);
1075
1076 device_release_driver(dev);
1077
1078 if (parent)
1079 device_unlock(parent);
1080}
1081
1082static void ath9k_hif_usb_firmware_cb(const struct firmware *fw, void *context)
1083{
1084 struct hif_device_usb *hif_dev = context;
1085 int ret;
1086
1087 if (!fw) {
1088 dev_err(&hif_dev->udev->dev,
1089 "ath9k_htc: Failed to get firmware %s\n",
1090 hif_dev->fw_name);
1091 goto err_fw;
1092 }
1093
1094 hif_dev->htc_handle = ath9k_htc_hw_alloc(hif_dev, &hif_usb,
1095 &hif_dev->udev->dev);
1096 if (hif_dev->htc_handle == NULL)
1097 goto err_dev_alloc;
1098
1099 hif_dev->fw_data = fw->data;
1100 hif_dev->fw_size = fw->size;
1101
1102 /* Proceed with initialization */
1103
1104 ret = ath9k_hif_usb_dev_init(hif_dev);
1105 if (ret)
1106 goto err_dev_init;
1107
1108 ret = ath9k_htc_hw_init(hif_dev->htc_handle,
1109 &hif_dev->interface->dev,
1110 hif_dev->usb_device_id->idProduct,
1111 hif_dev->udev->product,
1112 hif_dev->usb_device_id->driver_info);
1113 if (ret) {
1114 ret = -EINVAL;
1115 goto err_htc_hw_init;
1116 }
1117
1118 release_firmware(fw);
1119 hif_dev->flags |= HIF_USB_READY;
1120 complete_all(&hif_dev->fw_done);
1121
1122 return;
1123
1124err_htc_hw_init:
1125 ath9k_hif_usb_dev_deinit(hif_dev);
1126err_dev_init:
1127 ath9k_htc_hw_free(hif_dev->htc_handle);
1128err_dev_alloc:
1129 release_firmware(fw);
1130err_fw:
1131 ath9k_hif_usb_firmware_fail(hif_dev);
1132}
1133
1134/*
1135 * An exact copy of the function from zd1211rw.
1136 */
1137static int send_eject_command(struct usb_interface *interface)
1138{
1139 struct usb_device *udev = interface_to_usbdev(interface);
1140 struct usb_host_interface *iface_desc = &interface->altsetting[0];
1141 struct usb_endpoint_descriptor *endpoint;
1142 unsigned char *cmd;
1143 u8 bulk_out_ep;
1144 int r;
1145
1146 /* Find bulk out endpoint */
1147 for (r = 1; r >= 0; r--) {
1148 endpoint = &iface_desc->endpoint[r].desc;
1149 if (usb_endpoint_dir_out(endpoint) &&
1150 usb_endpoint_xfer_bulk(endpoint)) {
1151 bulk_out_ep = endpoint->bEndpointAddress;
1152 break;
1153 }
1154 }
1155 if (r == -1) {
1156 dev_err(&udev->dev,
1157 "ath9k_htc: Could not find bulk out endpoint\n");
1158 return -ENODEV;
1159 }
1160
1161 cmd = kzalloc(31, GFP_KERNEL);
1162 if (cmd == NULL)
1163 return -ENODEV;
1164
1165 /* USB bulk command block */
1166 cmd[0] = 0x55; /* bulk command signature */
1167 cmd[1] = 0x53; /* bulk command signature */
1168 cmd[2] = 0x42; /* bulk command signature */
1169 cmd[3] = 0x43; /* bulk command signature */
1170 cmd[14] = 6; /* command length */
1171
1172 cmd[15] = 0x1b; /* SCSI command: START STOP UNIT */
1173 cmd[19] = 0x2; /* eject disc */
1174
1175 dev_info(&udev->dev, "Ejecting storage device...\n");
1176 r = usb_bulk_msg(udev, usb_sndbulkpipe(udev, bulk_out_ep),
1177 cmd, 31, NULL, 2000);
1178 kfree(cmd);
1179 if (r)
1180 return r;
1181
1182 /* At this point, the device disconnects and reconnects with the real
1183 * ID numbers. */
1184
1185 usb_set_intfdata(interface, NULL);
1186 return 0;
1187}
1188
1189static int ath9k_hif_usb_probe(struct usb_interface *interface,
1190 const struct usb_device_id *id)
1191{
1192 struct usb_device *udev = interface_to_usbdev(interface);
1193 struct hif_device_usb *hif_dev;
1194 int ret = 0;
1195
1196 if (id->driver_info == STORAGE_DEVICE)
1197 return send_eject_command(interface);
1198
1199 hif_dev = kzalloc(sizeof(struct hif_device_usb), GFP_KERNEL);
1200 if (!hif_dev) {
1201 ret = -ENOMEM;
1202 goto err_alloc;
1203 }
1204
1205 usb_get_dev(udev);
1206
1207 hif_dev->udev = udev;
1208 hif_dev->interface = interface;
1209 hif_dev->usb_device_id = id;
1210#ifdef CONFIG_PM
1211 udev->reset_resume = 1;
1212#endif
1213 usb_set_intfdata(interface, hif_dev);
1214
1215 init_completion(&hif_dev->fw_done);
1216
1217 /* Find out which firmware to load */
1218
1219 if (IS_AR7010_DEVICE(id->driver_info))
1220 hif_dev->fw_name = FIRMWARE_AR7010_1_1;
1221 else
1222 hif_dev->fw_name = FIRMWARE_AR9271;
1223
1224 ret = request_firmware_nowait(THIS_MODULE, true, hif_dev->fw_name,
1225 &hif_dev->udev->dev, GFP_KERNEL,
1226 hif_dev, ath9k_hif_usb_firmware_cb);
1227 if (ret) {
1228 dev_err(&hif_dev->udev->dev,
1229 "ath9k_htc: Async request for firmware %s failed\n",
1230 hif_dev->fw_name);
1231 goto err_fw_req;
1232 }
1233
1234 dev_info(&hif_dev->udev->dev, "ath9k_htc: Firmware %s requested\n",
1235 hif_dev->fw_name);
1236
1237 return 0;
1238
1239err_fw_req:
1240 usb_set_intfdata(interface, NULL);
1241 kfree(hif_dev);
1242 usb_put_dev(udev);
1243err_alloc:
1244 return ret;
1245}
1246
1247static void ath9k_hif_usb_reboot(struct usb_device *udev)
1248{
1249 u32 reboot_cmd = 0xffffffff;
1250 void *buf;
1251 int ret;
1252
1253 buf = kmemdup(&reboot_cmd, 4, GFP_KERNEL);
1254 if (!buf)
1255 return;
1256
1257 ret = usb_interrupt_msg(udev, usb_sndintpipe(udev, USB_REG_OUT_PIPE),
1258 buf, 4, NULL, HZ);
1259 if (ret)
1260 dev_err(&udev->dev, "ath9k_htc: USB reboot failed\n");
1261
1262 kfree(buf);
1263}
1264
1265static void ath9k_hif_usb_disconnect(struct usb_interface *interface)
1266{
1267 struct usb_device *udev = interface_to_usbdev(interface);
1268 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1269 bool unplugged = (udev->state == USB_STATE_NOTATTACHED) ? true : false;
1270
1271 if (!hif_dev)
1272 return;
1273
1274 wait_for_completion(&hif_dev->fw_done);
1275
1276 if (hif_dev->flags & HIF_USB_READY) {
1277 ath9k_htc_hw_deinit(hif_dev->htc_handle, unplugged);
1278 ath9k_htc_hw_free(hif_dev->htc_handle);
1279 ath9k_hif_usb_dev_deinit(hif_dev);
1280 }
1281
1282 usb_set_intfdata(interface, NULL);
1283
1284 /* If firmware was loaded we should drop it
1285 * go back to first stage bootloader. */
1286 if (!unplugged && (hif_dev->flags & HIF_USB_READY))
1287 ath9k_hif_usb_reboot(udev);
1288
1289 kfree(hif_dev);
1290 dev_info(&udev->dev, "ath9k_htc: USB layer deinitialized\n");
1291 usb_put_dev(udev);
1292}
1293
1294#ifdef CONFIG_PM
1295static int ath9k_hif_usb_suspend(struct usb_interface *interface,
1296 pm_message_t message)
1297{
1298 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1299
1300 /*
1301 * The device has to be set to FULLSLEEP mode in case no
1302 * interface is up.
1303 */
1304 if (!(hif_dev->flags & HIF_USB_START))
1305 ath9k_htc_suspend(hif_dev->htc_handle);
1306
1307 wait_for_completion(&hif_dev->fw_done);
1308
1309 if (hif_dev->flags & HIF_USB_READY)
1310 ath9k_hif_usb_dealloc_urbs(hif_dev);
1311
1312 return 0;
1313}
1314
1315static int ath9k_hif_usb_resume(struct usb_interface *interface)
1316{
1317 struct hif_device_usb *hif_dev = usb_get_intfdata(interface);
1318 struct htc_target *htc_handle = hif_dev->htc_handle;
1319 int ret;
1320 const struct firmware *fw;
1321
1322 ret = ath9k_hif_usb_alloc_urbs(hif_dev);
1323 if (ret)
1324 return ret;
1325
1326 if (hif_dev->flags & HIF_USB_READY) {
1327 /* request cached firmware during suspend/resume cycle */
1328 ret = request_firmware(&fw, hif_dev->fw_name,
1329 &hif_dev->udev->dev);
1330 if (ret)
1331 goto fail_resume;
1332
1333 hif_dev->fw_data = fw->data;
1334 hif_dev->fw_size = fw->size;
1335 ret = ath9k_hif_usb_download_fw(hif_dev);
1336 release_firmware(fw);
1337 if (ret)
1338 goto fail_resume;
1339 } else {
1340 ath9k_hif_usb_dealloc_urbs(hif_dev);
1341 return -EIO;
1342 }
1343
1344 mdelay(100);
1345
1346 ret = ath9k_htc_resume(htc_handle);
1347
1348 if (ret)
1349 goto fail_resume;
1350
1351 return 0;
1352
1353fail_resume:
1354 ath9k_hif_usb_dealloc_urbs(hif_dev);
1355
1356 return ret;
1357}
1358#endif
1359
1360static struct usb_driver ath9k_hif_usb_driver = {
1361 .name = KBUILD_MODNAME,
1362 .probe = ath9k_hif_usb_probe,
1363 .disconnect = ath9k_hif_usb_disconnect,
1364#ifdef CONFIG_PM
1365 .suspend = ath9k_hif_usb_suspend,
1366 .resume = ath9k_hif_usb_resume,
1367 .reset_resume = ath9k_hif_usb_resume,
1368#endif
1369 .id_table = ath9k_hif_usb_ids,
1370 .soft_unbind = 1,
1371 .disable_hub_initiated_lpm = 1,
1372};
1373
1374int ath9k_hif_usb_init(void)
1375{
1376 return usb_register(&ath9k_hif_usb_driver);
1377}
1378
1379void ath9k_hif_usb_exit(void)
1380{
1381 usb_deregister(&ath9k_hif_usb_driver);
1382}