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