Commit | Line | Data |
---|---|---|
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 | ||
d0ee0ebe | 20 | /* identify firmware images */ |
ce18f391 SM |
21 | #define FIRMWARE_AR7010_1_1 "htc_7010.fw" |
22 | #define FIRMWARE_AR9271 "htc_9271.fw" | |
d0ee0ebe | 23 | |
d0ee0ebe JL |
24 | MODULE_FIRMWARE(FIRMWARE_AR7010_1_1); |
25 | MODULE_FIRMWARE(FIRMWARE_AR9271); | |
26 | ||
fb9987d0 | 27 | static struct usb_device_id ath9k_hif_usb_ids[] = { |
4e63f768 S |
28 | { USB_DEVICE(0x0cf3, 0x9271) }, /* Atheros */ |
29 | { USB_DEVICE(0x0cf3, 0x1006) }, /* Atheros */ | |
4e63f768 | 30 | { USB_DEVICE(0x0846, 0x9030) }, /* Netgear N150 */ |
4e63f768 S |
31 | { USB_DEVICE(0x07D1, 0x3A10) }, /* Dlink Wireless 150 */ |
32 | { USB_DEVICE(0x13D3, 0x3327) }, /* Azurewave */ | |
33 | { USB_DEVICE(0x13D3, 0x3328) }, /* Azurewave */ | |
ac618d70 | 34 | { USB_DEVICE(0x13D3, 0x3346) }, /* IMC Networks */ |
32b08955 RM |
35 | { USB_DEVICE(0x13D3, 0x3348) }, /* Azurewave */ |
36 | { USB_DEVICE(0x13D3, 0x3349) }, /* Azurewave */ | |
37 | { USB_DEVICE(0x13D3, 0x3350) }, /* Azurewave */ | |
4e63f768 | 38 | { USB_DEVICE(0x04CA, 0x4605) }, /* Liteon */ |
32b08955 | 39 | { USB_DEVICE(0x040D, 0x3801) }, /* VIA */ |
452d7dd8 | 40 | { USB_DEVICE(0x0cf3, 0xb003) }, /* Ubiquiti WifiStation Ext */ |
763cbac0 | 41 | { USB_DEVICE(0x0cf3, 0xb002) }, /* Ubiquiti WifiStation */ |
8c34559b | 42 | { USB_DEVICE(0x057c, 0x8403) }, /* AVM FRITZ!WLAN 11N v2 USB */ |
0b5ead91 SM |
43 | |
44 | { USB_DEVICE(0x0cf3, 0x7015), | |
45 | .driver_info = AR9287_USB }, /* Atheros */ | |
64f12170 | 46 | { USB_DEVICE(0x1668, 0x1200), |
0b5ead91 SM |
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 */ | |
5cf6fa78 MSS |
55 | { USB_DEVICE(0x0411, 0x017f), |
56 | .driver_info = AR9280_USB }, /* Sony UWA-BR100 */ | |
98f99eea MT |
57 | { USB_DEVICE(0x0411, 0x0197), |
58 | .driver_info = AR9280_USB }, /* Buffalo WLI-UV-AG300P */ | |
d90b5708 SM |
59 | { USB_DEVICE(0x04da, 0x3904), |
60 | .driver_info = AR9280_USB }, | |
0b5ead91 | 61 | |
36bcce43 SM |
62 | { USB_DEVICE(0x0cf3, 0x20ff), |
63 | .driver_info = STORAGE_DEVICE }, | |
64 | ||
fb9987d0 S |
65 | { }, |
66 | }; | |
67 | ||
68 | MODULE_DEVICE_TABLE(usb, ath9k_hif_usb_ids); | |
69 | ||
70 | static int __hif_usb_tx(struct hif_device_usb *hif_dev); | |
71 | ||
72 | static void hif_usb_regout_cb(struct urb *urb) | |
73 | { | |
74 | struct cmd_buf *cmd = (struct cmd_buf *)urb->context; | |
fb9987d0 S |
75 | |
76 | switch (urb->status) { | |
77 | case 0: | |
78 | break; | |
79 | case -ENOENT: | |
80 | case -ECONNRESET: | |
fb9987d0 S |
81 | case -ENODEV: |
82 | case -ESHUTDOWN: | |
6f0f2669 | 83 | goto free; |
fb9987d0 S |
84 | default: |
85 | break; | |
86 | } | |
87 | ||
88 | if (cmd) { | |
89 | ath9k_htc_txcompletion_cb(cmd->hif_dev->htc_handle, | |
2f80194c | 90 | cmd->skb, true); |
fb9987d0 | 91 | kfree(cmd); |
fb9987d0 | 92 | } |
6f0f2669 S |
93 | |
94 | return; | |
95 | free: | |
0fa35a58 | 96 | kfree_skb(cmd->skb); |
6f0f2669 | 97 | kfree(cmd); |
fb9987d0 S |
98 | } |
99 | ||
100 | static 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 | ||
2b721118 OR |
120 | usb_fill_int_urb(urb, hif_dev->udev, |
121 | usb_sndintpipe(hif_dev->udev, USB_REG_OUT_PIPE), | |
fb9987d0 | 122 | skb->data, skb->len, |
2b721118 | 123 | hif_usb_regout_cb, cmd, 1); |
fb9987d0 | 124 | |
6f0f2669 | 125 | usb_anchor_urb(urb, &hif_dev->regout_submitted); |
fb9987d0 S |
126 | ret = usb_submit_urb(urb, GFP_KERNEL); |
127 | if (ret) { | |
6f0f2669 | 128 | usb_unanchor_urb(urb); |
fb9987d0 S |
129 | kfree(cmd); |
130 | } | |
6f0f2669 | 131 | usb_free_urb(urb); |
fb9987d0 S |
132 | |
133 | return ret; | |
134 | } | |
135 | ||
2f80194c SM |
136 | static void hif_usb_mgmt_cb(struct urb *urb) |
137 | { | |
138 | struct cmd_buf *cmd = (struct cmd_buf *)urb->context; | |
02c5172c | 139 | struct hif_device_usb *hif_dev; |
2f80194c SM |
140 | bool txok = true; |
141 | ||
142 | if (!cmd || !cmd->skb || !cmd->hif_dev) | |
143 | return; | |
144 | ||
02c5172c RM |
145 | hif_dev = cmd->hif_dev; |
146 | ||
2f80194c SM |
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 | ||
181 | static 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 | ||
c11d8f89 S |
222 | static 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); | |
b587fc81 SM |
229 | } |
230 | } | |
231 | ||
232 | static 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) { | |
68185a4b BG |
239 | #ifdef CONFIG_ATH9K_HTC_DEBUGFS |
240 | int ln = skb->len; | |
241 | #endif | |
b587fc81 SM |
242 | ath9k_htc_txcompletion_cb(hif_dev->htc_handle, |
243 | skb, txok); | |
68185a4b | 244 | if (txok) { |
dfa8fc69 | 245 | TX_STAT_INC(skb_success); |
68185a4b BG |
246 | TX_STAT_ADD(skb_success_bytes, ln); |
247 | } | |
dfa8fc69 JL |
248 | else |
249 | TX_STAT_INC(skb_failed); | |
c11d8f89 S |
250 | } |
251 | } | |
252 | ||
fb9987d0 S |
253 | static void hif_usb_tx_cb(struct urb *urb) |
254 | { | |
255 | struct tx_buf *tx_buf = (struct tx_buf *) urb->context; | |
690e781c | 256 | struct hif_device_usb *hif_dev; |
b587fc81 | 257 | bool txok = true; |
fb9987d0 | 258 | |
690e781c | 259 | if (!tx_buf || !tx_buf->hif_dev) |
fb9987d0 S |
260 | return; |
261 | ||
690e781c DC |
262 | hif_dev = tx_buf->hif_dev; |
263 | ||
fb9987d0 S |
264 | switch (urb->status) { |
265 | case 0: | |
266 | break; | |
267 | case -ENOENT: | |
268 | case -ECONNRESET: | |
fb9987d0 S |
269 | case -ENODEV: |
270 | case -ESHUTDOWN: | |
b587fc81 | 271 | txok = false; |
ff8f59b5 SM |
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); | |
b587fc81 | 280 | ath9k_skb_queue_purge(hif_dev, &tx_buf->skb_queue); |
ff8f59b5 SM |
281 | return; |
282 | } | |
283 | spin_unlock(&hif_dev->tx.tx_lock); | |
284 | ||
b587fc81 | 285 | break; |
fb9987d0 | 286 | default: |
b587fc81 | 287 | txok = false; |
fb9987d0 S |
288 | break; |
289 | } | |
290 | ||
b587fc81 | 291 | ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, txok); |
c11d8f89 | 292 | |
c11d8f89 S |
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); | |
f8e1d080 ML |
305 | } |
306 | ||
fb9987d0 S |
307 | /* TX lock has to be taken */ |
308 | static 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; | |
2c27392d | 313 | u16 tx_skb_cnt = 0; |
fb9987d0 | 314 | u8 *buf; |
2c27392d | 315 | __le16 *hdr; |
fb9987d0 S |
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); | |
c11d8f89 | 325 | list_move_tail(&tx_buf->list, &hif_dev->tx.tx_pending); |
fb9987d0 S |
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; | |
2c27392d SM |
340 | hdr = (__le16 *)buf; |
341 | *hdr++ = cpu_to_le16(nskb->len); | |
342 | *hdr++ = cpu_to_le16(ATH_USB_TX_STREAM_MODE_TAG); | |
fb9987d0 S |
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; | |
b587fc81 | 365 | ath9k_skb_queue_complete(hif_dev, &tx_buf->skb_queue, false); |
fb9987d0 S |
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 | ||
40dc9e4b | 377 | static int hif_usb_send_tx(struct hif_device_usb *hif_dev, struct sk_buff *skb) |
fb9987d0 | 378 | { |
40dc9e4b | 379 | struct ath9k_htc_tx_ctl *tx_ctl; |
fb9987d0 | 380 | unsigned long flags; |
2f80194c | 381 | int ret = 0; |
fb9987d0 S |
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 | ||
2f80194c | 396 | spin_unlock_irqrestore(&hif_dev->tx.tx_lock, flags); |
fb9987d0 | 397 | |
40dc9e4b SM |
398 | tx_ctl = HTC_SKB_CB(skb); |
399 | ||
2f80194c SM |
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 | } | |
fb9987d0 S |
413 | |
414 | /* Check if AMPDUs have to be sent immediately */ | |
2f80194c | 415 | if ((hif_dev->tx.tx_buf_cnt == MAX_TX_URB_NUM) && |
fb9987d0 S |
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 | ||
2f80194c | 422 | return ret; |
fb9987d0 S |
423 | } |
424 | ||
e1fe7c38 | 425 | static void hif_usb_start(void *hif_handle) |
fb9987d0 S |
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 | ||
e1fe7c38 | 437 | static void hif_usb_stop(void *hif_handle) |
fb9987d0 S |
438 | { |
439 | struct hif_device_usb *hif_dev = (struct hif_device_usb *)hif_handle; | |
ff8f59b5 | 440 | struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL; |
fb9987d0 S |
441 | unsigned long flags; |
442 | ||
443 | spin_lock_irqsave(&hif_dev->tx.tx_lock, flags); | |
b587fc81 | 444 | ath9k_skb_queue_complete(hif_dev, &hif_dev->tx.tx_skb_queue, false); |
fb9987d0 S |
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); | |
ff8f59b5 SM |
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 | } | |
2f80194c SM |
454 | |
455 | usb_kill_anchored_urbs(&hif_dev->mgmt_submitted); | |
fb9987d0 S |
456 | } |
457 | ||
40dc9e4b | 458 | static int hif_usb_send(void *hif_handle, u8 pipe_id, struct sk_buff *skb) |
fb9987d0 S |
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: | |
40dc9e4b | 465 | ret = hif_usb_send_tx(hif_dev, skb); |
fb9987d0 S |
466 | break; |
467 | case USB_REG_OUT_PIPE: | |
468 | ret = hif_usb_send_regout(hif_dev, skb); | |
469 | break; | |
470 | default: | |
6335ed0f S |
471 | dev_err(&hif_dev->udev->dev, |
472 | "ath9k_htc: Invalid TX pipe: %d\n", pipe_id); | |
fb9987d0 S |
473 | ret = -EINVAL; |
474 | break; | |
475 | } | |
476 | ||
477 | return ret; | |
478 | } | |
479 | ||
84c9e164 SM |
480 | static 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 | ||
493 | static 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 | ||
fb9987d0 S |
514 | static 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, | |
84c9e164 | 523 | .sta_drain = hif_usb_sta_drain, |
fb9987d0 S |
524 | .send = hif_usb_send, |
525 | }; | |
526 | ||
527 | static void ath9k_hif_usb_rx_stream(struct hif_device_usb *hif_dev, | |
528 | struct sk_buff *skb) | |
529 | { | |
c503269a | 530 | struct sk_buff *nskb, *skb_pool[MAX_PKT_NUM_IN_TRANSFER]; |
44b23b48 JP |
531 | int index = 0, i = 0, len = skb->len; |
532 | int rx_remain_len, rx_pkt_len; | |
533 | u16 pool_index = 0; | |
fb9987d0 S |
534 | u8 *ptr; |
535 | ||
46baa1a2 S |
536 | spin_lock(&hif_dev->rx_lock); |
537 | ||
fb9987d0 S |
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 | ||
46baa1a2 S |
564 | spin_unlock(&hif_dev->rx_lock); |
565 | ||
fb9987d0 | 566 | while (index < len) { |
44b23b48 JP |
567 | u16 pkt_len; |
568 | u16 pkt_tag; | |
569 | u16 pad_len; | |
570 | int chk_idx; | |
571 | ||
fb9987d0 S |
572 | ptr = (u8 *) skb->data; |
573 | ||
78fa99ab PR |
574 | pkt_len = get_unaligned_le16(ptr + index); |
575 | pkt_tag = get_unaligned_le16(ptr + index + 2); | |
fb9987d0 | 576 | |
44b23b48 JP |
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"); | |
46baa1a2 | 600 | spin_unlock(&hif_dev->rx_lock); |
44b23b48 | 601 | goto err; |
fb9987d0 | 602 | } |
44b23b48 JP |
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); | |
fb9987d0 | 612 | } else { |
44b23b48 JP |
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; | |
fb9987d0 S |
625 | } |
626 | } | |
627 | ||
628 | err: | |
fb9987d0 | 629 | for (i = 0; i < pool_index; i++) { |
68185a4b | 630 | RX_STAT_ADD(skb_completed_bytes, skb_pool[i]->len); |
fb9987d0 S |
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 | ||
637 | static void ath9k_hif_usb_rx_cb(struct urb *urb) | |
638 | { | |
639 | struct sk_buff *skb = (struct sk_buff *) urb->context; | |
b2767363 | 640 | struct hif_device_usb *hif_dev = |
fb9987d0 S |
641 | usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0)); |
642 | int ret; | |
643 | ||
6335ed0f S |
644 | if (!skb) |
645 | return; | |
646 | ||
fb9987d0 S |
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); | |
fb9987d0 | 664 | ath9k_hif_usb_rx_stream(hif_dev, skb); |
fb9987d0 S |
665 | } |
666 | ||
667 | resubmit: | |
668 | skb_reset_tail_pointer(skb); | |
669 | skb_trim(skb, 0); | |
670 | ||
6335ed0f | 671 | usb_anchor_urb(urb, &hif_dev->rx_submitted); |
fb9987d0 | 672 | ret = usb_submit_urb(urb, GFP_ATOMIC); |
6335ed0f S |
673 | if (ret) { |
674 | usb_unanchor_urb(urb); | |
fb9987d0 | 675 | goto free; |
6335ed0f | 676 | } |
fb9987d0 S |
677 | |
678 | return; | |
679 | free: | |
f28a7b30 | 680 | kfree_skb(skb); |
fb9987d0 S |
681 | } |
682 | ||
683 | static 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; | |
b2767363 | 687 | struct hif_device_usb *hif_dev = |
fb9987d0 S |
688 | usb_get_intfdata(usb_ifnum_to_if(urb->dev, 0)); |
689 | int ret; | |
690 | ||
6335ed0f S |
691 | if (!skb) |
692 | return; | |
693 | ||
fb9987d0 S |
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: | |
3deff760 SM |
706 | skb_reset_tail_pointer(skb); |
707 | skb_trim(skb, 0); | |
708 | ||
fb9987d0 S |
709 | goto resubmit; |
710 | } | |
711 | ||
712 | if (likely(urb->actual_length != 0)) { | |
713 | skb_put(skb, urb->actual_length); | |
714 | ||
5ab0af32 S |
715 | /* Process the command first */ |
716 | ath9k_htc_rx_msg(hif_dev->htc_handle, skb, | |
717 | skb->len, USB_REG_IN_PIPE); | |
718 | ||
719 | ||
e6c6d33c | 720 | nskb = alloc_skb(MAX_REG_IN_BUF_SIZE, GFP_ATOMIC); |
5ab0af32 S |
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 | } | |
fb9987d0 | 727 | |
2b721118 OR |
728 | usb_fill_int_urb(urb, hif_dev->udev, |
729 | usb_rcvintpipe(hif_dev->udev, | |
0f529e98 | 730 | USB_REG_IN_PIPE), |
fb9987d0 | 731 | nskb->data, MAX_REG_IN_BUF_SIZE, |
2b721118 | 732 | ath9k_hif_usb_reg_in_cb, nskb, 1); |
fb9987d0 S |
733 | } |
734 | ||
735 | resubmit: | |
3deff760 | 736 | usb_anchor_urb(urb, &hif_dev->reg_in_submitted); |
fb9987d0 | 737 | ret = usb_submit_urb(urb, GFP_ATOMIC); |
3deff760 SM |
738 | if (ret) { |
739 | usb_unanchor_urb(urb); | |
fb9987d0 | 740 | goto free; |
3deff760 | 741 | } |
fb9987d0 S |
742 | |
743 | return; | |
744 | free: | |
e6c6d33c | 745 | kfree_skb(skb); |
6335ed0f | 746 | urb->context = NULL; |
fb9987d0 S |
747 | } |
748 | ||
749 | static void ath9k_hif_usb_dealloc_tx_urbs(struct hif_device_usb *hif_dev) | |
750 | { | |
fb9987d0 | 751 | struct tx_buf *tx_buf = NULL, *tx_buf_tmp = NULL; |
ff8f59b5 | 752 | unsigned long flags; |
fb9987d0 | 753 | |
c11d8f89 S |
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); | |
fb9987d0 S |
757 | list_del(&tx_buf->list); |
758 | usb_free_urb(tx_buf->urb); | |
759 | kfree(tx_buf->buf); | |
760 | kfree(tx_buf); | |
761 | } | |
762 | ||
ff8f59b5 SM |
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 | ||
fb9987d0 S |
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 | } | |
2f80194c SM |
775 | |
776 | usb_kill_anchored_urbs(&hif_dev->mgmt_submitted); | |
fb9987d0 S |
777 | } |
778 | ||
779 | static 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); | |
2f80194c | 788 | init_usb_anchor(&hif_dev->mgmt_submitted); |
fb9987d0 S |
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; | |
812 | err: | |
7606688a DC |
813 | if (tx_buf) { |
814 | kfree(tx_buf->buf); | |
815 | kfree(tx_buf); | |
816 | } | |
fb9987d0 S |
817 | ath9k_hif_usb_dealloc_tx_urbs(hif_dev); |
818 | return -ENOMEM; | |
819 | } | |
820 | ||
fb9987d0 S |
821 | static void ath9k_hif_usb_dealloc_rx_urbs(struct hif_device_usb *hif_dev) |
822 | { | |
6335ed0f | 823 | usb_kill_anchored_urbs(&hif_dev->rx_submitted); |
fb9987d0 S |
824 | } |
825 | ||
826 | static int ath9k_hif_usb_alloc_rx_urbs(struct hif_device_usb *hif_dev) | |
827 | { | |
6335ed0f S |
828 | struct urb *urb = NULL; |
829 | struct sk_buff *skb = NULL; | |
fb9987d0 S |
830 | int i, ret; |
831 | ||
6335ed0f | 832 | init_usb_anchor(&hif_dev->rx_submitted); |
46baa1a2 | 833 | spin_lock_init(&hif_dev->rx_lock); |
6335ed0f | 834 | |
fb9987d0 S |
835 | for (i = 0; i < MAX_RX_URB_NUM; i++) { |
836 | ||
837 | /* Allocate URB */ | |
6335ed0f S |
838 | urb = usb_alloc_urb(0, GFP_KERNEL); |
839 | if (urb == NULL) { | |
fb9987d0 | 840 | ret = -ENOMEM; |
6335ed0f | 841 | goto err_urb; |
fb9987d0 S |
842 | } |
843 | ||
844 | /* Allocate buffer */ | |
f28a7b30 | 845 | skb = alloc_skb(MAX_RX_BUF_SIZE, GFP_KERNEL); |
6335ed0f S |
846 | if (!skb) { |
847 | ret = -ENOMEM; | |
848 | goto err_skb; | |
849 | } | |
fb9987d0 | 850 | |
6335ed0f S |
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); | |
fb9987d0 | 859 | |
6335ed0f S |
860 | /* Submit URB */ |
861 | ret = usb_submit_urb(urb, GFP_KERNEL); | |
862 | if (ret) { | |
863 | usb_unanchor_urb(urb); | |
864 | goto err_submit; | |
865 | } | |
66b10e33 S |
866 | |
867 | /* | |
868 | * Drop reference count. | |
869 | * This ensures that the URB is freed when killing them. | |
870 | */ | |
871 | usb_free_urb(urb); | |
fb9987d0 S |
872 | } |
873 | ||
874 | return 0; | |
875 | ||
6335ed0f | 876 | err_submit: |
f28a7b30 | 877 | kfree_skb(skb); |
6335ed0f S |
878 | err_skb: |
879 | usb_free_urb(urb); | |
880 | err_urb: | |
fb9987d0 S |
881 | ath9k_hif_usb_dealloc_rx_urbs(hif_dev); |
882 | return ret; | |
883 | } | |
884 | ||
3deff760 | 885 | static void ath9k_hif_usb_dealloc_reg_in_urbs(struct hif_device_usb *hif_dev) |
fb9987d0 | 886 | { |
3deff760 | 887 | usb_kill_anchored_urbs(&hif_dev->reg_in_submitted); |
fb9987d0 S |
888 | } |
889 | ||
3deff760 | 890 | static int ath9k_hif_usb_alloc_reg_in_urbs(struct hif_device_usb *hif_dev) |
fb9987d0 | 891 | { |
3deff760 SM |
892 | struct urb *urb = NULL; |
893 | struct sk_buff *skb = NULL; | |
894 | int i, ret; | |
fb9987d0 | 895 | |
3deff760 | 896 | init_usb_anchor(&hif_dev->reg_in_submitted); |
fb9987d0 | 897 | |
3deff760 | 898 | for (i = 0; i < MAX_REG_IN_URB_NUM; i++) { |
fb9987d0 | 899 | |
3deff760 SM |
900 | /* Allocate URB */ |
901 | urb = usb_alloc_urb(0, GFP_KERNEL); | |
902 | if (urb == NULL) { | |
903 | ret = -ENOMEM; | |
904 | goto err_urb; | |
905 | } | |
fb9987d0 | 906 | |
3deff760 SM |
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 | ||
2b721118 OR |
914 | usb_fill_int_urb(urb, hif_dev->udev, |
915 | usb_rcvintpipe(hif_dev->udev, | |
3deff760 SM |
916 | USB_REG_IN_PIPE), |
917 | skb->data, MAX_REG_IN_BUF_SIZE, | |
2b721118 | 918 | ath9k_hif_usb_reg_in_cb, skb, 1); |
3deff760 SM |
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 | } | |
fb9987d0 S |
936 | |
937 | return 0; | |
938 | ||
3deff760 SM |
939 | err_submit: |
940 | kfree_skb(skb); | |
941 | err_skb: | |
942 | usb_free_urb(urb); | |
943 | err_urb: | |
944 | ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev); | |
945 | return ret; | |
fb9987d0 S |
946 | } |
947 | ||
948 | static int ath9k_hif_usb_alloc_urbs(struct hif_device_usb *hif_dev) | |
949 | { | |
6f0f2669 S |
950 | /* Register Write */ |
951 | init_usb_anchor(&hif_dev->regout_submitted); | |
952 | ||
fb9987d0 S |
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) | |
f8036965 | 959 | goto err_rx; |
fb9987d0 | 960 | |
6f0f2669 | 961 | /* Register Read */ |
3deff760 | 962 | if (ath9k_hif_usb_alloc_reg_in_urbs(hif_dev) < 0) |
f8036965 | 963 | goto err_reg; |
fb9987d0 S |
964 | |
965 | return 0; | |
f8036965 RM |
966 | err_reg: |
967 | ath9k_hif_usb_dealloc_rx_urbs(hif_dev); | |
968 | err_rx: | |
969 | ath9k_hif_usb_dealloc_tx_urbs(hif_dev); | |
fb9987d0 S |
970 | err: |
971 | return -ENOMEM; | |
972 | } | |
973 | ||
1d8af8ca SM |
974 | static void ath9k_hif_usb_dealloc_urbs(struct hif_device_usb *hif_dev) |
975 | { | |
976 | usb_kill_anchored_urbs(&hif_dev->regout_submitted); | |
3deff760 | 977 | ath9k_hif_usb_dealloc_reg_in_urbs(hif_dev); |
1d8af8ca SM |
978 | ath9k_hif_usb_dealloc_tx_urbs(hif_dev); |
979 | ath9k_hif_usb_dealloc_rx_urbs(hif_dev); | |
980 | } | |
981 | ||
0ed7b93e | 982 | static int ath9k_hif_usb_download_fw(struct hif_device_usb *hif_dev) |
fb9987d0 S |
983 | { |
984 | int transfer, err; | |
32e31de5 ML |
985 | const void *data = hif_dev->fw_data; |
986 | size_t len = hif_dev->fw_size; | |
fb9987d0 S |
987 | u32 addr = AR9271_FIRMWARE; |
988 | u8 *buf = kzalloc(4096, GFP_KERNEL); | |
b1762862 | 989 | u32 firm_offset; |
fb9987d0 S |
990 | |
991 | if (!buf) | |
992 | return -ENOMEM; | |
993 | ||
994 | while (len) { | |
291689fc | 995 | transfer = min_t(size_t, len, 4096); |
fb9987d0 S |
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 | ||
0ed7b93e | 1013 | if (IS_AR7010_DEVICE(hif_dev->usb_device_id->driver_info)) |
b1762862 | 1014 | firm_offset = AR7010_FIRMWARE_TEXT; |
fa6e15e0 | 1015 | else |
b1762862 S |
1016 | firm_offset = AR9271_FIRMWARE_TEXT; |
1017 | ||
fb9987d0 S |
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, | |
b1762862 | 1024 | firm_offset >> 8, 0, NULL, 0, HZ); |
fb9987d0 S |
1025 | if (err) |
1026 | return -EIO; | |
1027 | ||
1028 | dev_info(&hif_dev->udev->dev, "ath9k_htc: Transferred FW: %s, size: %ld\n", | |
32e31de5 | 1029 | hif_dev->fw_name, (unsigned long) hif_dev->fw_size); |
fb9987d0 S |
1030 | |
1031 | return 0; | |
1032 | } | |
1033 | ||
0ed7b93e | 1034 | static int ath9k_hif_usb_dev_init(struct hif_device_usb *hif_dev) |
fb9987d0 | 1035 | { |
2b721118 | 1036 | int ret; |
fb9987d0 | 1037 | |
0ed7b93e | 1038 | ret = ath9k_hif_usb_download_fw(hif_dev); |
1d8af8ca SM |
1039 | if (ret) { |
1040 | dev_err(&hif_dev->udev->dev, | |
ce43cee5 S |
1041 | "ath9k_htc: Firmware - %s download failed\n", |
1042 | hif_dev->fw_name); | |
0ed7b93e | 1043 | return ret; |
1d8af8ca SM |
1044 | } |
1045 | ||
490b3f4e RM |
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"); | |
0ed7b93e | 1051 | return ret; |
490b3f4e RM |
1052 | } |
1053 | ||
fb9987d0 | 1054 | return 0; |
fb9987d0 S |
1055 | } |
1056 | ||
fb9987d0 S |
1057 | static void ath9k_hif_usb_dev_deinit(struct hif_device_usb *hif_dev) |
1058 | { | |
1059 | ath9k_hif_usb_dealloc_urbs(hif_dev); | |
0ed7b93e SM |
1060 | } |
1061 | ||
1062 | /* | |
1063 | * If initialization fails or the FW cannot be retrieved, | |
1064 | * detach the device. | |
1065 | */ | |
1066 | static void ath9k_hif_usb_firmware_fail(struct hif_device_usb *hif_dev) | |
1067 | { | |
e962610f ML |
1068 | struct device *dev = &hif_dev->udev->dev; |
1069 | struct device *parent = dev->parent; | |
0ed7b93e | 1070 | |
9494849e | 1071 | complete_all(&hif_dev->fw_done); |
0ed7b93e SM |
1072 | |
1073 | if (parent) | |
1074 | device_lock(parent); | |
1075 | ||
e962610f | 1076 | device_release_driver(dev); |
0ed7b93e SM |
1077 | |
1078 | if (parent) | |
1079 | device_unlock(parent); | |
1080 | } | |
1081 | ||
1082 | static 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); | |
32e31de5 ML |
1096 | if (hif_dev->htc_handle == NULL) |
1097 | goto err_dev_alloc; | |
0ed7b93e | 1098 | |
32e31de5 ML |
1099 | hif_dev->fw_data = fw->data; |
1100 | hif_dev->fw_size = fw->size; | |
0ed7b93e SM |
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 | ||
32e31de5 ML |
1118 | release_firmware(fw); |
1119 | hif_dev->flags |= HIF_USB_READY; | |
9494849e | 1120 | complete_all(&hif_dev->fw_done); |
0ed7b93e SM |
1121 | |
1122 | return; | |
1123 | ||
1124 | err_htc_hw_init: | |
1125 | ath9k_hif_usb_dev_deinit(hif_dev); | |
1126 | err_dev_init: | |
1127 | ath9k_htc_hw_free(hif_dev->htc_handle); | |
32e31de5 | 1128 | err_dev_alloc: |
0ed7b93e | 1129 | release_firmware(fw); |
0ed7b93e SM |
1130 | err_fw: |
1131 | ath9k_hif_usb_firmware_fail(hif_dev); | |
fb9987d0 S |
1132 | } |
1133 | ||
36bcce43 SM |
1134 | /* |
1135 | * An exact copy of the function from zd1211rw. | |
1136 | */ | |
1137 | static 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 | ||
fb9987d0 S |
1189 | static 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; | |
fb9987d0 S |
1194 | int ret = 0; |
1195 | ||
36bcce43 SM |
1196 | if (id->driver_info == STORAGE_DEVICE) |
1197 | return send_eject_command(interface); | |
1198 | ||
fb9987d0 S |
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); | |
0ed7b93e | 1206 | |
fb9987d0 S |
1207 | hif_dev->udev = udev; |
1208 | hif_dev->interface = interface; | |
0ed7b93e | 1209 | hif_dev->usb_device_id = id; |
fb9987d0 S |
1210 | #ifdef CONFIG_PM |
1211 | udev->reset_resume = 1; | |
1212 | #endif | |
1213 | usb_set_intfdata(interface, hif_dev); | |
1214 | ||
0ed7b93e | 1215 | init_completion(&hif_dev->fw_done); |
47fce026 | 1216 | |
ce43cee5 S |
1217 | /* Find out which firmware to load */ |
1218 | ||
0b5ead91 | 1219 | if (IS_AR7010_DEVICE(id->driver_info)) |
9efabad2 | 1220 | hif_dev->fw_name = FIRMWARE_AR7010_1_1; |
fa6e15e0 | 1221 | else |
d0ee0ebe | 1222 | hif_dev->fw_name = FIRMWARE_AR9271; |
ce43cee5 | 1223 | |
0ed7b93e SM |
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); | |
fb9987d0 | 1227 | if (ret) { |
0ed7b93e SM |
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; | |
fb9987d0 S |
1232 | } |
1233 | ||
0ed7b93e SM |
1234 | dev_info(&hif_dev->udev->dev, "ath9k_htc: Firmware %s requested\n", |
1235 | hif_dev->fw_name); | |
fb9987d0 S |
1236 | |
1237 | return 0; | |
1238 | ||
0ed7b93e | 1239 | err_fw_req: |
fb9987d0 S |
1240 | usb_set_intfdata(interface, NULL); |
1241 | kfree(hif_dev); | |
1242 | usb_put_dev(udev); | |
1243 | err_alloc: | |
1244 | return ret; | |
1245 | } | |
1246 | ||
62e4716a S |
1247 | static void ath9k_hif_usb_reboot(struct usb_device *udev) |
1248 | { | |
1249 | u32 reboot_cmd = 0xffffffff; | |
1250 | void *buf; | |
1251 | int ret; | |
1252 | ||
a465a2cc | 1253 | buf = kmemdup(&reboot_cmd, 4, GFP_KERNEL); |
62e4716a S |
1254 | if (!buf) |
1255 | return; | |
1256 | ||
2b721118 | 1257 | ret = usb_interrupt_msg(udev, usb_sndintpipe(udev, USB_REG_OUT_PIPE), |
62e4716a S |
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 | ||
fb9987d0 S |
1265 | static void ath9k_hif_usb_disconnect(struct usb_interface *interface) |
1266 | { | |
1267 | struct usb_device *udev = interface_to_usbdev(interface); | |
b2767363 | 1268 | struct hif_device_usb *hif_dev = usb_get_intfdata(interface); |
97dcec57 | 1269 | bool unplugged = (udev->state == USB_STATE_NOTATTACHED) ? true : false; |
fb9987d0 | 1270 | |
36bcce43 SM |
1271 | if (!hif_dev) |
1272 | return; | |
1273 | ||
0ed7b93e SM |
1274 | wait_for_completion(&hif_dev->fw_done); |
1275 | ||
32e31de5 | 1276 | if (hif_dev->flags & HIF_USB_READY) { |
0ed7b93e SM |
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); | |
0ed7b93e SM |
1280 | } |
1281 | ||
36bcce43 | 1282 | usb_set_intfdata(interface, NULL); |
fb9987d0 | 1283 | |
4928bd2e OR |
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)) | |
62e4716a | 1287 | ath9k_hif_usb_reboot(udev); |
fb9987d0 S |
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 | |
1295 | static int ath9k_hif_usb_suspend(struct usb_interface *interface, | |
1296 | pm_message_t message) | |
1297 | { | |
b2767363 | 1298 | struct hif_device_usb *hif_dev = usb_get_intfdata(interface); |
fb9987d0 | 1299 | |
f933ebed SM |
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 | ||
9494849e AK |
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); | |
fb9987d0 S |
1311 | |
1312 | return 0; | |
1313 | } | |
1314 | ||
1315 | static int ath9k_hif_usb_resume(struct usb_interface *interface) | |
1316 | { | |
b2767363 | 1317 | struct hif_device_usb *hif_dev = usb_get_intfdata(interface); |
fa6e15e0 | 1318 | struct htc_target *htc_handle = hif_dev->htc_handle; |
fb9987d0 | 1319 | int ret; |
32e31de5 | 1320 | const struct firmware *fw; |
fb9987d0 S |
1321 | |
1322 | ret = ath9k_hif_usb_alloc_urbs(hif_dev); | |
1323 | if (ret) | |
1324 | return ret; | |
1325 | ||
32e31de5 ML |
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; | |
0ed7b93e | 1335 | ret = ath9k_hif_usb_download_fw(hif_dev); |
32e31de5 | 1336 | release_firmware(fw); |
fb9987d0 S |
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 | ||
fa6e15e0 | 1346 | ret = ath9k_htc_resume(htc_handle); |
fb9987d0 S |
1347 | |
1348 | if (ret) | |
1349 | goto fail_resume; | |
1350 | ||
1351 | return 0; | |
1352 | ||
1353 | fail_resume: | |
1354 | ath9k_hif_usb_dealloc_urbs(hif_dev); | |
1355 | ||
1356 | return ret; | |
1357 | } | |
1358 | #endif | |
1359 | ||
1360 | static struct usb_driver ath9k_hif_usb_driver = { | |
50f68712 | 1361 | .name = KBUILD_MODNAME, |
fb9987d0 S |
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, | |
e1f12eb6 | 1371 | .disable_hub_initiated_lpm = 1, |
fb9987d0 S |
1372 | }; |
1373 | ||
1374 | int ath9k_hif_usb_init(void) | |
1375 | { | |
1376 | return usb_register(&ath9k_hif_usb_driver); | |
1377 | } | |
1378 | ||
1379 | void ath9k_hif_usb_exit(void) | |
1380 | { | |
1381 | usb_deregister(&ath9k_hif_usb_driver); | |
1382 | } |