orinoco_usb: use USB API functions rather than constants
[sfrench/cifs-2.6.git] / drivers / net / wireless / ath / ath10k / htt_rx.c
1 /*
2  * Copyright (c) 2005-2011 Atheros Communications Inc.
3  * Copyright (c) 2011-2013 Qualcomm Atheros, Inc.
4  *
5  * Permission to use, copy, modify, and/or distribute this software for any
6  * purpose with or without fee is hereby granted, provided that the above
7  * copyright notice and this permission notice appear in all copies.
8  *
9  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16  */
17
18 #include "core.h"
19 #include "htc.h"
20 #include "htt.h"
21 #include "txrx.h"
22 #include "debug.h"
23 #include "trace.h"
24 #include "mac.h"
25
26 #include <linux/log2.h>
27
28 /* slightly larger than one large A-MPDU */
29 #define HTT_RX_RING_SIZE_MIN 128
30
31 /* roughly 20 ms @ 1 Gbps of 1500B MSDUs */
32 #define HTT_RX_RING_SIZE_MAX 2048
33
34 #define HTT_RX_AVG_FRM_BYTES 1000
35
36 /* ms, very conservative */
37 #define HTT_RX_HOST_LATENCY_MAX_MS 20
38
39 /* ms, conservative */
40 #define HTT_RX_HOST_LATENCY_WORST_LIKELY_MS 10
41
42 /* when under memory pressure rx ring refill may fail and needs a retry */
43 #define HTT_RX_RING_REFILL_RETRY_MS 50
44
45
46 static int ath10k_htt_rx_get_csum_state(struct sk_buff *skb);
47 static void ath10k_htt_txrx_compl_task(unsigned long ptr);
48
49 static int ath10k_htt_rx_ring_size(struct ath10k_htt *htt)
50 {
51         int size;
52
53         /*
54          * It is expected that the host CPU will typically be able to
55          * service the rx indication from one A-MPDU before the rx
56          * indication from the subsequent A-MPDU happens, roughly 1-2 ms
57          * later. However, the rx ring should be sized very conservatively,
58          * to accomodate the worst reasonable delay before the host CPU
59          * services a rx indication interrupt.
60          *
61          * The rx ring need not be kept full of empty buffers. In theory,
62          * the htt host SW can dynamically track the low-water mark in the
63          * rx ring, and dynamically adjust the level to which the rx ring
64          * is filled with empty buffers, to dynamically meet the desired
65          * low-water mark.
66          *
67          * In contrast, it's difficult to resize the rx ring itself, once
68          * it's in use. Thus, the ring itself should be sized very
69          * conservatively, while the degree to which the ring is filled
70          * with empty buffers should be sized moderately conservatively.
71          */
72
73         /* 1e6 bps/mbps / 1e3 ms per sec = 1000 */
74         size =
75             htt->max_throughput_mbps +
76             1000  /
77             (8 * HTT_RX_AVG_FRM_BYTES) * HTT_RX_HOST_LATENCY_MAX_MS;
78
79         if (size < HTT_RX_RING_SIZE_MIN)
80                 size = HTT_RX_RING_SIZE_MIN;
81
82         if (size > HTT_RX_RING_SIZE_MAX)
83                 size = HTT_RX_RING_SIZE_MAX;
84
85         size = roundup_pow_of_two(size);
86
87         return size;
88 }
89
90 static int ath10k_htt_rx_ring_fill_level(struct ath10k_htt *htt)
91 {
92         int size;
93
94         /* 1e6 bps/mbps / 1e3 ms per sec = 1000 */
95         size =
96             htt->max_throughput_mbps *
97             1000  /
98             (8 * HTT_RX_AVG_FRM_BYTES) * HTT_RX_HOST_LATENCY_WORST_LIKELY_MS;
99
100         /*
101          * Make sure the fill level is at least 1 less than the ring size.
102          * Leaving 1 element empty allows the SW to easily distinguish
103          * between a full ring vs. an empty ring.
104          */
105         if (size >= htt->rx_ring.size)
106                 size = htt->rx_ring.size - 1;
107
108         return size;
109 }
110
111 static void ath10k_htt_rx_ring_free(struct ath10k_htt *htt)
112 {
113         struct sk_buff *skb;
114         struct ath10k_skb_cb *cb;
115         int i;
116
117         for (i = 0; i < htt->rx_ring.fill_cnt; i++) {
118                 skb = htt->rx_ring.netbufs_ring[i];
119                 cb = ATH10K_SKB_CB(skb);
120                 dma_unmap_single(htt->ar->dev, cb->paddr,
121                                  skb->len + skb_tailroom(skb),
122                                  DMA_FROM_DEVICE);
123                 dev_kfree_skb_any(skb);
124         }
125
126         htt->rx_ring.fill_cnt = 0;
127 }
128
129 static int __ath10k_htt_rx_ring_fill_n(struct ath10k_htt *htt, int num)
130 {
131         struct htt_rx_desc *rx_desc;
132         struct sk_buff *skb;
133         dma_addr_t paddr;
134         int ret = 0, idx;
135
136         idx = __le32_to_cpu(*(htt->rx_ring.alloc_idx.vaddr));
137         while (num > 0) {
138                 skb = dev_alloc_skb(HTT_RX_BUF_SIZE + HTT_RX_DESC_ALIGN);
139                 if (!skb) {
140                         ret = -ENOMEM;
141                         goto fail;
142                 }
143
144                 if (!IS_ALIGNED((unsigned long)skb->data, HTT_RX_DESC_ALIGN))
145                         skb_pull(skb,
146                                  PTR_ALIGN(skb->data, HTT_RX_DESC_ALIGN) -
147                                  skb->data);
148
149                 /* Clear rx_desc attention word before posting to Rx ring */
150                 rx_desc = (struct htt_rx_desc *)skb->data;
151                 rx_desc->attention.flags = __cpu_to_le32(0);
152
153                 paddr = dma_map_single(htt->ar->dev, skb->data,
154                                        skb->len + skb_tailroom(skb),
155                                        DMA_FROM_DEVICE);
156
157                 if (unlikely(dma_mapping_error(htt->ar->dev, paddr))) {
158                         dev_kfree_skb_any(skb);
159                         ret = -ENOMEM;
160                         goto fail;
161                 }
162
163                 ATH10K_SKB_CB(skb)->paddr = paddr;
164                 htt->rx_ring.netbufs_ring[idx] = skb;
165                 htt->rx_ring.paddrs_ring[idx] = __cpu_to_le32(paddr);
166                 htt->rx_ring.fill_cnt++;
167
168                 num--;
169                 idx++;
170                 idx &= htt->rx_ring.size_mask;
171         }
172
173 fail:
174         *(htt->rx_ring.alloc_idx.vaddr) = __cpu_to_le32(idx);
175         return ret;
176 }
177
178 static int ath10k_htt_rx_ring_fill_n(struct ath10k_htt *htt, int num)
179 {
180         lockdep_assert_held(&htt->rx_ring.lock);
181         return __ath10k_htt_rx_ring_fill_n(htt, num);
182 }
183
184 static void ath10k_htt_rx_msdu_buff_replenish(struct ath10k_htt *htt)
185 {
186         int ret, num_deficit, num_to_fill;
187
188         /* Refilling the whole RX ring buffer proves to be a bad idea. The
189          * reason is RX may take up significant amount of CPU cycles and starve
190          * other tasks, e.g. TX on an ethernet device while acting as a bridge
191          * with ath10k wlan interface. This ended up with very poor performance
192          * once CPU the host system was overwhelmed with RX on ath10k.
193          *
194          * By limiting the number of refills the replenishing occurs
195          * progressively. This in turns makes use of the fact tasklets are
196          * processed in FIFO order. This means actual RX processing can starve
197          * out refilling. If there's not enough buffers on RX ring FW will not
198          * report RX until it is refilled with enough buffers. This
199          * automatically balances load wrt to CPU power.
200          *
201          * This probably comes at a cost of lower maximum throughput but
202          * improves the avarage and stability. */
203         spin_lock_bh(&htt->rx_ring.lock);
204         num_deficit = htt->rx_ring.fill_level - htt->rx_ring.fill_cnt;
205         num_to_fill = min(ATH10K_HTT_MAX_NUM_REFILL, num_deficit);
206         num_deficit -= num_to_fill;
207         ret = ath10k_htt_rx_ring_fill_n(htt, num_to_fill);
208         if (ret == -ENOMEM) {
209                 /*
210                  * Failed to fill it to the desired level -
211                  * we'll start a timer and try again next time.
212                  * As long as enough buffers are left in the ring for
213                  * another A-MPDU rx, no special recovery is needed.
214                  */
215                 mod_timer(&htt->rx_ring.refill_retry_timer, jiffies +
216                           msecs_to_jiffies(HTT_RX_RING_REFILL_RETRY_MS));
217         } else if (num_deficit > 0) {
218                 tasklet_schedule(&htt->rx_replenish_task);
219         }
220         spin_unlock_bh(&htt->rx_ring.lock);
221 }
222
223 static void ath10k_htt_rx_ring_refill_retry(unsigned long arg)
224 {
225         struct ath10k_htt *htt = (struct ath10k_htt *)arg;
226         ath10k_htt_rx_msdu_buff_replenish(htt);
227 }
228
229 static void ath10k_htt_rx_ring_clean_up(struct ath10k_htt *htt)
230 {
231         struct sk_buff *skb;
232         int i;
233
234         for (i = 0; i < htt->rx_ring.size; i++) {
235                 skb = htt->rx_ring.netbufs_ring[i];
236                 if (!skb)
237                         continue;
238
239                 dma_unmap_single(htt->ar->dev, ATH10K_SKB_CB(skb)->paddr,
240                                  skb->len + skb_tailroom(skb),
241                                  DMA_FROM_DEVICE);
242                 dev_kfree_skb_any(skb);
243                 htt->rx_ring.netbufs_ring[i] = NULL;
244         }
245 }
246
247 void ath10k_htt_rx_free(struct ath10k_htt *htt)
248 {
249         del_timer_sync(&htt->rx_ring.refill_retry_timer);
250         tasklet_kill(&htt->rx_replenish_task);
251         tasklet_kill(&htt->txrx_compl_task);
252
253         skb_queue_purge(&htt->tx_compl_q);
254         skb_queue_purge(&htt->rx_compl_q);
255
256         ath10k_htt_rx_ring_clean_up(htt);
257
258         dma_free_coherent(htt->ar->dev,
259                           (htt->rx_ring.size *
260                            sizeof(htt->rx_ring.paddrs_ring)),
261                           htt->rx_ring.paddrs_ring,
262                           htt->rx_ring.base_paddr);
263
264         dma_free_coherent(htt->ar->dev,
265                           sizeof(*htt->rx_ring.alloc_idx.vaddr),
266                           htt->rx_ring.alloc_idx.vaddr,
267                           htt->rx_ring.alloc_idx.paddr);
268
269         kfree(htt->rx_ring.netbufs_ring);
270 }
271
272 static inline struct sk_buff *ath10k_htt_rx_netbuf_pop(struct ath10k_htt *htt)
273 {
274         int idx;
275         struct sk_buff *msdu;
276
277         lockdep_assert_held(&htt->rx_ring.lock);
278
279         if (htt->rx_ring.fill_cnt == 0) {
280                 ath10k_warn("tried to pop sk_buff from an empty rx ring\n");
281                 return NULL;
282         }
283
284         idx = htt->rx_ring.sw_rd_idx.msdu_payld;
285         msdu = htt->rx_ring.netbufs_ring[idx];
286         htt->rx_ring.netbufs_ring[idx] = NULL;
287
288         idx++;
289         idx &= htt->rx_ring.size_mask;
290         htt->rx_ring.sw_rd_idx.msdu_payld = idx;
291         htt->rx_ring.fill_cnt--;
292
293         return msdu;
294 }
295
296 static void ath10k_htt_rx_free_msdu_chain(struct sk_buff *skb)
297 {
298         struct sk_buff *next;
299
300         while (skb) {
301                 next = skb->next;
302                 dev_kfree_skb_any(skb);
303                 skb = next;
304         }
305 }
306
307 /* return: < 0 fatal error, 0 - non chained msdu, 1 chained msdu */
308 static int ath10k_htt_rx_amsdu_pop(struct ath10k_htt *htt,
309                                    u8 **fw_desc, int *fw_desc_len,
310                                    struct sk_buff **head_msdu,
311                                    struct sk_buff **tail_msdu,
312                                    u32 *attention)
313 {
314         int msdu_len, msdu_chaining = 0;
315         struct sk_buff *msdu;
316         struct htt_rx_desc *rx_desc;
317
318         lockdep_assert_held(&htt->rx_ring.lock);
319
320         if (htt->rx_confused) {
321                 ath10k_warn("htt is confused. refusing rx\n");
322                 return -1;
323         }
324
325         msdu = *head_msdu = ath10k_htt_rx_netbuf_pop(htt);
326         while (msdu) {
327                 int last_msdu, msdu_len_invalid, msdu_chained;
328
329                 dma_unmap_single(htt->ar->dev,
330                                  ATH10K_SKB_CB(msdu)->paddr,
331                                  msdu->len + skb_tailroom(msdu),
332                                  DMA_FROM_DEVICE);
333
334                 ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "htt rx pop: ",
335                                 msdu->data, msdu->len + skb_tailroom(msdu));
336
337                 rx_desc = (struct htt_rx_desc *)msdu->data;
338
339                 /* FIXME: we must report msdu payload since this is what caller
340                  *        expects now */
341                 skb_put(msdu, offsetof(struct htt_rx_desc, msdu_payload));
342                 skb_pull(msdu, offsetof(struct htt_rx_desc, msdu_payload));
343
344                 /*
345                  * Sanity check - confirm the HW is finished filling in the
346                  * rx data.
347                  * If the HW and SW are working correctly, then it's guaranteed
348                  * that the HW's MAC DMA is done before this point in the SW.
349                  * To prevent the case that we handle a stale Rx descriptor,
350                  * just assert for now until we have a way to recover.
351                  */
352                 if (!(__le32_to_cpu(rx_desc->attention.flags)
353                                 & RX_ATTENTION_FLAGS_MSDU_DONE)) {
354                         ath10k_htt_rx_free_msdu_chain(*head_msdu);
355                         *head_msdu = NULL;
356                         msdu = NULL;
357                         ath10k_err("htt rx stopped. cannot recover\n");
358                         htt->rx_confused = true;
359                         break;
360                 }
361
362                 *attention |= __le32_to_cpu(rx_desc->attention.flags) &
363                                             (RX_ATTENTION_FLAGS_TKIP_MIC_ERR |
364                                              RX_ATTENTION_FLAGS_DECRYPT_ERR |
365                                              RX_ATTENTION_FLAGS_FCS_ERR |
366                                              RX_ATTENTION_FLAGS_MGMT_TYPE);
367                 /*
368                  * Copy the FW rx descriptor for this MSDU from the rx
369                  * indication message into the MSDU's netbuf. HL uses the
370                  * same rx indication message definition as LL, and simply
371                  * appends new info (fields from the HW rx desc, and the
372                  * MSDU payload itself). So, the offset into the rx
373                  * indication message only has to account for the standard
374                  * offset of the per-MSDU FW rx desc info within the
375                  * message, and how many bytes of the per-MSDU FW rx desc
376                  * info have already been consumed. (And the endianness of
377                  * the host, since for a big-endian host, the rx ind
378                  * message contents, including the per-MSDU rx desc bytes,
379                  * were byteswapped during upload.)
380                  */
381                 if (*fw_desc_len > 0) {
382                         rx_desc->fw_desc.info0 = **fw_desc;
383                         /*
384                          * The target is expected to only provide the basic
385                          * per-MSDU rx descriptors. Just to be sure, verify
386                          * that the target has not attached extension data
387                          * (e.g. LRO flow ID).
388                          */
389
390                         /* or more, if there's extension data */
391                         (*fw_desc)++;
392                         (*fw_desc_len)--;
393                 } else {
394                         /*
395                          * When an oversized AMSDU happened, FW will lost
396                          * some of MSDU status - in this case, the FW
397                          * descriptors provided will be less than the
398                          * actual MSDUs inside this MPDU. Mark the FW
399                          * descriptors so that it will still deliver to
400                          * upper stack, if no CRC error for this MPDU.
401                          *
402                          * FIX THIS - the FW descriptors are actually for
403                          * MSDUs in the end of this A-MSDU instead of the
404                          * beginning.
405                          */
406                         rx_desc->fw_desc.info0 = 0;
407                 }
408
409                 msdu_len_invalid = !!(__le32_to_cpu(rx_desc->attention.flags)
410                                         & (RX_ATTENTION_FLAGS_MPDU_LENGTH_ERR |
411                                            RX_ATTENTION_FLAGS_MSDU_LENGTH_ERR));
412                 msdu_len = MS(__le32_to_cpu(rx_desc->msdu_start.info0),
413                               RX_MSDU_START_INFO0_MSDU_LENGTH);
414                 msdu_chained = rx_desc->frag_info.ring2_more_count;
415
416                 if (msdu_len_invalid)
417                         msdu_len = 0;
418
419                 skb_trim(msdu, 0);
420                 skb_put(msdu, min(msdu_len, HTT_RX_MSDU_SIZE));
421                 msdu_len -= msdu->len;
422
423                 /* FIXME: Do chained buffers include htt_rx_desc or not? */
424                 while (msdu_chained--) {
425                         struct sk_buff *next = ath10k_htt_rx_netbuf_pop(htt);
426
427                         dma_unmap_single(htt->ar->dev,
428                                          ATH10K_SKB_CB(next)->paddr,
429                                          next->len + skb_tailroom(next),
430                                          DMA_FROM_DEVICE);
431
432                         ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL,
433                                         "htt rx chained: ", next->data,
434                                         next->len + skb_tailroom(next));
435
436                         skb_trim(next, 0);
437                         skb_put(next, min(msdu_len, HTT_RX_BUF_SIZE));
438                         msdu_len -= next->len;
439
440                         msdu->next = next;
441                         msdu = next;
442                         msdu_chaining = 1;
443                 }
444
445                 last_msdu = __le32_to_cpu(rx_desc->msdu_end.info0) &
446                                 RX_MSDU_END_INFO0_LAST_MSDU;
447
448                 if (last_msdu) {
449                         msdu->next = NULL;
450                         break;
451                 } else {
452                         struct sk_buff *next = ath10k_htt_rx_netbuf_pop(htt);
453                         msdu->next = next;
454                         msdu = next;
455                 }
456         }
457         *tail_msdu = msdu;
458
459         if (*head_msdu == NULL)
460                 msdu_chaining = -1;
461
462         /*
463          * Don't refill the ring yet.
464          *
465          * First, the elements popped here are still in use - it is not
466          * safe to overwrite them until the matching call to
467          * mpdu_desc_list_next. Second, for efficiency it is preferable to
468          * refill the rx ring with 1 PPDU's worth of rx buffers (something
469          * like 32 x 3 buffers), rather than one MPDU's worth of rx buffers
470          * (something like 3 buffers). Consequently, we'll rely on the txrx
471          * SW to tell us when it is done pulling all the PPDU's rx buffers
472          * out of the rx ring, and then refill it just once.
473          */
474
475         return msdu_chaining;
476 }
477
478 static void ath10k_htt_rx_replenish_task(unsigned long ptr)
479 {
480         struct ath10k_htt *htt = (struct ath10k_htt *)ptr;
481         ath10k_htt_rx_msdu_buff_replenish(htt);
482 }
483
484 int ath10k_htt_rx_alloc(struct ath10k_htt *htt)
485 {
486         dma_addr_t paddr;
487         void *vaddr;
488         struct timer_list *timer = &htt->rx_ring.refill_retry_timer;
489
490         htt->rx_ring.size = ath10k_htt_rx_ring_size(htt);
491         if (!is_power_of_2(htt->rx_ring.size)) {
492                 ath10k_warn("htt rx ring size is not power of 2\n");
493                 return -EINVAL;
494         }
495
496         htt->rx_ring.size_mask = htt->rx_ring.size - 1;
497
498         /*
499          * Set the initial value for the level to which the rx ring
500          * should be filled, based on the max throughput and the
501          * worst likely latency for the host to fill the rx ring
502          * with new buffers. In theory, this fill level can be
503          * dynamically adjusted from the initial value set here, to
504          * reflect the actual host latency rather than a
505          * conservative assumption about the host latency.
506          */
507         htt->rx_ring.fill_level = ath10k_htt_rx_ring_fill_level(htt);
508
509         htt->rx_ring.netbufs_ring =
510                 kzalloc(htt->rx_ring.size * sizeof(struct sk_buff *),
511                         GFP_KERNEL);
512         if (!htt->rx_ring.netbufs_ring)
513                 goto err_netbuf;
514
515         vaddr = dma_alloc_coherent(htt->ar->dev,
516                    (htt->rx_ring.size * sizeof(htt->rx_ring.paddrs_ring)),
517                    &paddr, GFP_DMA);
518         if (!vaddr)
519                 goto err_dma_ring;
520
521         htt->rx_ring.paddrs_ring = vaddr;
522         htt->rx_ring.base_paddr = paddr;
523
524         vaddr = dma_alloc_coherent(htt->ar->dev,
525                                    sizeof(*htt->rx_ring.alloc_idx.vaddr),
526                                    &paddr, GFP_DMA);
527         if (!vaddr)
528                 goto err_dma_idx;
529
530         htt->rx_ring.alloc_idx.vaddr = vaddr;
531         htt->rx_ring.alloc_idx.paddr = paddr;
532         htt->rx_ring.sw_rd_idx.msdu_payld = 0;
533         *htt->rx_ring.alloc_idx.vaddr = 0;
534
535         /* Initialize the Rx refill retry timer */
536         setup_timer(timer, ath10k_htt_rx_ring_refill_retry, (unsigned long)htt);
537
538         spin_lock_init(&htt->rx_ring.lock);
539
540         htt->rx_ring.fill_cnt = 0;
541         if (__ath10k_htt_rx_ring_fill_n(htt, htt->rx_ring.fill_level))
542                 goto err_fill_ring;
543
544         tasklet_init(&htt->rx_replenish_task, ath10k_htt_rx_replenish_task,
545                      (unsigned long)htt);
546
547         skb_queue_head_init(&htt->tx_compl_q);
548         skb_queue_head_init(&htt->rx_compl_q);
549
550         tasklet_init(&htt->txrx_compl_task, ath10k_htt_txrx_compl_task,
551                      (unsigned long)htt);
552
553         ath10k_dbg(ATH10K_DBG_BOOT, "htt rx ring size %d fill_level %d\n",
554                    htt->rx_ring.size, htt->rx_ring.fill_level);
555         return 0;
556
557 err_fill_ring:
558         ath10k_htt_rx_ring_free(htt);
559         dma_free_coherent(htt->ar->dev,
560                           sizeof(*htt->rx_ring.alloc_idx.vaddr),
561                           htt->rx_ring.alloc_idx.vaddr,
562                           htt->rx_ring.alloc_idx.paddr);
563 err_dma_idx:
564         dma_free_coherent(htt->ar->dev,
565                           (htt->rx_ring.size *
566                            sizeof(htt->rx_ring.paddrs_ring)),
567                           htt->rx_ring.paddrs_ring,
568                           htt->rx_ring.base_paddr);
569 err_dma_ring:
570         kfree(htt->rx_ring.netbufs_ring);
571 err_netbuf:
572         return -ENOMEM;
573 }
574
575 static int ath10k_htt_rx_crypto_param_len(enum htt_rx_mpdu_encrypt_type type)
576 {
577         switch (type) {
578         case HTT_RX_MPDU_ENCRYPT_WEP40:
579         case HTT_RX_MPDU_ENCRYPT_WEP104:
580                 return 4;
581         case HTT_RX_MPDU_ENCRYPT_TKIP_WITHOUT_MIC:
582         case HTT_RX_MPDU_ENCRYPT_WEP128: /* not tested */
583         case HTT_RX_MPDU_ENCRYPT_TKIP_WPA:
584         case HTT_RX_MPDU_ENCRYPT_WAPI: /* not tested */
585         case HTT_RX_MPDU_ENCRYPT_AES_CCM_WPA2:
586                 return 8;
587         case HTT_RX_MPDU_ENCRYPT_NONE:
588                 return 0;
589         }
590
591         ath10k_warn("unknown encryption type %d\n", type);
592         return 0;
593 }
594
595 static int ath10k_htt_rx_crypto_tail_len(enum htt_rx_mpdu_encrypt_type type)
596 {
597         switch (type) {
598         case HTT_RX_MPDU_ENCRYPT_NONE:
599         case HTT_RX_MPDU_ENCRYPT_WEP40:
600         case HTT_RX_MPDU_ENCRYPT_WEP104:
601         case HTT_RX_MPDU_ENCRYPT_WEP128:
602         case HTT_RX_MPDU_ENCRYPT_WAPI:
603                 return 0;
604         case HTT_RX_MPDU_ENCRYPT_TKIP_WITHOUT_MIC:
605         case HTT_RX_MPDU_ENCRYPT_TKIP_WPA:
606                 return 4;
607         case HTT_RX_MPDU_ENCRYPT_AES_CCM_WPA2:
608                 return 8;
609         }
610
611         ath10k_warn("unknown encryption type %d\n", type);
612         return 0;
613 }
614
615 /* Applies for first msdu in chain, before altering it. */
616 static struct ieee80211_hdr *ath10k_htt_rx_skb_get_hdr(struct sk_buff *skb)
617 {
618         struct htt_rx_desc *rxd;
619         enum rx_msdu_decap_format fmt;
620
621         rxd = (void *)skb->data - sizeof(*rxd);
622         fmt = MS(__le32_to_cpu(rxd->msdu_start.info1),
623                         RX_MSDU_START_INFO1_DECAP_FORMAT);
624
625         if (fmt == RX_MSDU_DECAP_RAW)
626                 return (void *)skb->data;
627         else
628                 return (void *)skb->data - RX_HTT_HDR_STATUS_LEN;
629 }
630
631 /* This function only applies for first msdu in an msdu chain */
632 static bool ath10k_htt_rx_hdr_is_amsdu(struct ieee80211_hdr *hdr)
633 {
634         if (ieee80211_is_data_qos(hdr->frame_control)) {
635                 u8 *qc = ieee80211_get_qos_ctl(hdr);
636                 if (qc[0] & 0x80)
637                         return true;
638         }
639         return false;
640 }
641
642 struct rfc1042_hdr {
643         u8 llc_dsap;
644         u8 llc_ssap;
645         u8 llc_ctrl;
646         u8 snap_oui[3];
647         __be16 snap_type;
648 } __packed;
649
650 struct amsdu_subframe_hdr {
651         u8 dst[ETH_ALEN];
652         u8 src[ETH_ALEN];
653         __be16 len;
654 } __packed;
655
656 static const u8 rx_legacy_rate_idx[] = {
657         3,      /* 0x00  - 11Mbps  */
658         2,      /* 0x01  - 5.5Mbps */
659         1,      /* 0x02  - 2Mbps   */
660         0,      /* 0x03  - 1Mbps   */
661         3,      /* 0x04  - 11Mbps  */
662         2,      /* 0x05  - 5.5Mbps */
663         1,      /* 0x06  - 2Mbps   */
664         0,      /* 0x07  - 1Mbps   */
665         10,     /* 0x08  - 48Mbps  */
666         8,      /* 0x09  - 24Mbps  */
667         6,      /* 0x0A  - 12Mbps  */
668         4,      /* 0x0B  - 6Mbps   */
669         11,     /* 0x0C  - 54Mbps  */
670         9,      /* 0x0D  - 36Mbps  */
671         7,      /* 0x0E  - 18Mbps  */
672         5,      /* 0x0F  - 9Mbps   */
673 };
674
675 static void ath10k_htt_rx_h_rates(struct ath10k *ar,
676                                   enum ieee80211_band band,
677                                   u8 info0, u32 info1, u32 info2,
678                                   struct ieee80211_rx_status *status)
679 {
680         u8 cck, rate, rate_idx, bw, sgi, mcs, nss;
681         u8 preamble = 0;
682
683         /* Check if valid fields */
684         if (!(info0 & HTT_RX_INDICATION_INFO0_START_VALID))
685                 return;
686
687         preamble = MS(info1, HTT_RX_INDICATION_INFO1_PREAMBLE_TYPE);
688
689         switch (preamble) {
690         case HTT_RX_LEGACY:
691                 cck = info0 & HTT_RX_INDICATION_INFO0_LEGACY_RATE_CCK;
692                 rate = MS(info0, HTT_RX_INDICATION_INFO0_LEGACY_RATE);
693                 rate_idx = 0;
694
695                 if (rate < 0x08 || rate > 0x0F)
696                         break;
697
698                 switch (band) {
699                 case IEEE80211_BAND_2GHZ:
700                         if (cck)
701                                 rate &= ~BIT(3);
702                         rate_idx = rx_legacy_rate_idx[rate];
703                         break;
704                 case IEEE80211_BAND_5GHZ:
705                         rate_idx = rx_legacy_rate_idx[rate];
706                         /* We are using same rate table registering
707                            HW - ath10k_rates[]. In case of 5GHz skip
708                            CCK rates, so -4 here */
709                         rate_idx -= 4;
710                         break;
711                 default:
712                         break;
713                 }
714
715                 status->rate_idx = rate_idx;
716                 break;
717         case HTT_RX_HT:
718         case HTT_RX_HT_WITH_TXBF:
719                 /* HT-SIG - Table 20-11 in info1 and info2 */
720                 mcs = info1 & 0x1F;
721                 nss = mcs >> 3;
722                 bw = (info1 >> 7) & 1;
723                 sgi = (info2 >> 7) & 1;
724
725                 status->rate_idx = mcs;
726                 status->flag |= RX_FLAG_HT;
727                 if (sgi)
728                         status->flag |= RX_FLAG_SHORT_GI;
729                 if (bw)
730                         status->flag |= RX_FLAG_40MHZ;
731                 break;
732         case HTT_RX_VHT:
733         case HTT_RX_VHT_WITH_TXBF:
734                 /* VHT-SIG-A1 in info 1, VHT-SIG-A2 in info2
735                    TODO check this */
736                 mcs = (info2 >> 4) & 0x0F;
737                 nss = ((info1 >> 10) & 0x07) + 1;
738                 bw = info1 & 3;
739                 sgi = info2 & 1;
740
741                 status->rate_idx = mcs;
742                 status->vht_nss = nss;
743
744                 if (sgi)
745                         status->flag |= RX_FLAG_SHORT_GI;
746
747                 switch (bw) {
748                 /* 20MHZ */
749                 case 0:
750                         break;
751                 /* 40MHZ */
752                 case 1:
753                         status->flag |= RX_FLAG_40MHZ;
754                         break;
755                 /* 80MHZ */
756                 case 2:
757                         status->vht_flag |= RX_VHT_FLAG_80MHZ;
758                 }
759
760                 status->flag |= RX_FLAG_VHT;
761                 break;
762         default:
763                 break;
764         }
765 }
766
767 static void ath10k_htt_rx_h_protected(struct ath10k_htt *htt,
768                                       struct ieee80211_rx_status *rx_status,
769                                       struct sk_buff *skb,
770                                       enum htt_rx_mpdu_encrypt_type enctype,
771                                       enum rx_msdu_decap_format fmt,
772                                       bool dot11frag)
773 {
774         struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
775
776         rx_status->flag &= ~(RX_FLAG_DECRYPTED |
777                              RX_FLAG_IV_STRIPPED |
778                              RX_FLAG_MMIC_STRIPPED);
779
780         if (enctype == HTT_RX_MPDU_ENCRYPT_NONE)
781                 return;
782
783         /*
784          * There's no explicit rx descriptor flag to indicate whether a given
785          * frame has been decrypted or not. We're forced to use the decap
786          * format as an implicit indication. However fragmentation rx is always
787          * raw and it probably never reports undecrypted raws.
788          *
789          * This makes sure sniffed frames are reported as-is without stripping
790          * the protected flag.
791          */
792         if (fmt == RX_MSDU_DECAP_RAW && !dot11frag)
793                 return;
794
795         rx_status->flag |= RX_FLAG_DECRYPTED |
796                            RX_FLAG_IV_STRIPPED |
797                            RX_FLAG_MMIC_STRIPPED;
798         hdr->frame_control = __cpu_to_le16(__le16_to_cpu(hdr->frame_control) &
799                                            ~IEEE80211_FCTL_PROTECTED);
800 }
801
802 static bool ath10k_htt_rx_h_channel(struct ath10k *ar,
803                                     struct ieee80211_rx_status *status)
804 {
805         struct ieee80211_channel *ch;
806
807         spin_lock_bh(&ar->data_lock);
808         ch = ar->scan_channel;
809         if (!ch)
810                 ch = ar->rx_channel;
811         spin_unlock_bh(&ar->data_lock);
812
813         if (!ch)
814                 return false;
815
816         status->band = ch->band;
817         status->freq = ch->center_freq;
818
819         return true;
820 }
821
822 static void ath10k_process_rx(struct ath10k *ar,
823                               struct ieee80211_rx_status *rx_status,
824                               struct sk_buff *skb)
825 {
826         struct ieee80211_rx_status *status;
827
828         status = IEEE80211_SKB_RXCB(skb);
829         *status = *rx_status;
830
831         ath10k_dbg(ATH10K_DBG_DATA,
832                    "rx skb %p len %u %s%s%s%s%s %srate_idx %u vht_nss %u freq %u band %u flag 0x%x fcs-err %imic-err %i\n",
833                    skb,
834                    skb->len,
835                    status->flag == 0 ? "legacy" : "",
836                    status->flag & RX_FLAG_HT ? "ht" : "",
837                    status->flag & RX_FLAG_VHT ? "vht" : "",
838                    status->flag & RX_FLAG_40MHZ ? "40" : "",
839                    status->vht_flag & RX_VHT_FLAG_80MHZ ? "80" : "",
840                    status->flag & RX_FLAG_SHORT_GI ? "sgi " : "",
841                    status->rate_idx,
842                    status->vht_nss,
843                    status->freq,
844                    status->band, status->flag,
845                    !!(status->flag & RX_FLAG_FAILED_FCS_CRC),
846                    !!(status->flag & RX_FLAG_MMIC_ERROR));
847         ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "rx skb: ",
848                         skb->data, skb->len);
849
850         ieee80211_rx(ar->hw, skb);
851 }
852
853 static int ath10k_htt_rx_nwifi_hdrlen(struct ieee80211_hdr *hdr)
854 {
855         /* nwifi header is padded to 4 bytes. this fixes 4addr rx */
856         return round_up(ieee80211_hdrlen(hdr->frame_control), 4);
857 }
858
859 static void ath10k_htt_rx_amsdu(struct ath10k_htt *htt,
860                                 struct ieee80211_rx_status *rx_status,
861                                 struct sk_buff *skb_in)
862 {
863         struct htt_rx_desc *rxd;
864         struct sk_buff *skb = skb_in;
865         struct sk_buff *first;
866         enum rx_msdu_decap_format fmt;
867         enum htt_rx_mpdu_encrypt_type enctype;
868         struct ieee80211_hdr *hdr;
869         u8 hdr_buf[64], addr[ETH_ALEN], *qos;
870         unsigned int hdr_len;
871
872         rxd = (void *)skb->data - sizeof(*rxd);
873         enctype = MS(__le32_to_cpu(rxd->mpdu_start.info0),
874                         RX_MPDU_START_INFO0_ENCRYPT_TYPE);
875
876         hdr = (struct ieee80211_hdr *)rxd->rx_hdr_status;
877         hdr_len = ieee80211_hdrlen(hdr->frame_control);
878         memcpy(hdr_buf, hdr, hdr_len);
879         hdr = (struct ieee80211_hdr *)hdr_buf;
880
881         first = skb;
882         while (skb) {
883                 void *decap_hdr;
884                 int len;
885
886                 rxd = (void *)skb->data - sizeof(*rxd);
887                 fmt = MS(__le32_to_cpu(rxd->msdu_start.info1),
888                          RX_MSDU_START_INFO1_DECAP_FORMAT);
889                 decap_hdr = (void *)rxd->rx_hdr_status;
890
891                 skb->ip_summed = ath10k_htt_rx_get_csum_state(skb);
892
893                 /* First frame in an A-MSDU chain has more decapped data. */
894                 if (skb == first) {
895                         len = round_up(ieee80211_hdrlen(hdr->frame_control), 4);
896                         len += round_up(ath10k_htt_rx_crypto_param_len(enctype),
897                                         4);
898                         decap_hdr += len;
899                 }
900
901                 switch (fmt) {
902                 case RX_MSDU_DECAP_RAW:
903                         /* remove trailing FCS */
904                         skb_trim(skb, skb->len - FCS_LEN);
905                         break;
906                 case RX_MSDU_DECAP_NATIVE_WIFI:
907                         /* pull decapped header and copy DA */
908                         hdr = (struct ieee80211_hdr *)skb->data;
909                         hdr_len = ath10k_htt_rx_nwifi_hdrlen(hdr);
910                         memcpy(addr, ieee80211_get_DA(hdr), ETH_ALEN);
911                         skb_pull(skb, hdr_len);
912
913                         /* push original 802.11 header */
914                         hdr = (struct ieee80211_hdr *)hdr_buf;
915                         hdr_len = ieee80211_hdrlen(hdr->frame_control);
916                         memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
917
918                         /* original A-MSDU header has the bit set but we're
919                          * not including A-MSDU subframe header */
920                         hdr = (struct ieee80211_hdr *)skb->data;
921                         qos = ieee80211_get_qos_ctl(hdr);
922                         qos[0] &= ~IEEE80211_QOS_CTL_A_MSDU_PRESENT;
923
924                         /* original 802.11 header has a different DA */
925                         memcpy(ieee80211_get_DA(hdr), addr, ETH_ALEN);
926                         break;
927                 case RX_MSDU_DECAP_ETHERNET2_DIX:
928                         /* strip ethernet header and insert decapped 802.11
929                          * header, amsdu subframe header and rfc1042 header */
930
931                         len = 0;
932                         len += sizeof(struct rfc1042_hdr);
933                         len += sizeof(struct amsdu_subframe_hdr);
934
935                         skb_pull(skb, sizeof(struct ethhdr));
936                         memcpy(skb_push(skb, len), decap_hdr, len);
937                         memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
938                         break;
939                 case RX_MSDU_DECAP_8023_SNAP_LLC:
940                         /* insert decapped 802.11 header making a singly
941                          * A-MSDU */
942                         memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
943                         break;
944                 }
945
946                 skb_in = skb;
947                 ath10k_htt_rx_h_protected(htt, rx_status, skb_in, enctype, fmt,
948                                           false);
949                 skb = skb->next;
950                 skb_in->next = NULL;
951
952                 if (skb)
953                         rx_status->flag |= RX_FLAG_AMSDU_MORE;
954                 else
955                         rx_status->flag &= ~RX_FLAG_AMSDU_MORE;
956
957                 ath10k_process_rx(htt->ar, rx_status, skb_in);
958         }
959
960         /* FIXME: It might be nice to re-assemble the A-MSDU when there's a
961          * monitor interface active for sniffing purposes. */
962 }
963
964 static void ath10k_htt_rx_msdu(struct ath10k_htt *htt,
965                                struct ieee80211_rx_status *rx_status,
966                                struct sk_buff *skb)
967 {
968         struct htt_rx_desc *rxd;
969         struct ieee80211_hdr *hdr;
970         enum rx_msdu_decap_format fmt;
971         enum htt_rx_mpdu_encrypt_type enctype;
972         int hdr_len;
973         void *rfc1042;
974
975         /* This shouldn't happen. If it does than it may be a FW bug. */
976         if (skb->next) {
977                 ath10k_warn("htt rx received chained non A-MSDU frame\n");
978                 ath10k_htt_rx_free_msdu_chain(skb->next);
979                 skb->next = NULL;
980         }
981
982         rxd = (void *)skb->data - sizeof(*rxd);
983         fmt = MS(__le32_to_cpu(rxd->msdu_start.info1),
984                         RX_MSDU_START_INFO1_DECAP_FORMAT);
985         enctype = MS(__le32_to_cpu(rxd->mpdu_start.info0),
986                         RX_MPDU_START_INFO0_ENCRYPT_TYPE);
987         hdr = (struct ieee80211_hdr *)rxd->rx_hdr_status;
988         hdr_len = ieee80211_hdrlen(hdr->frame_control);
989
990         skb->ip_summed = ath10k_htt_rx_get_csum_state(skb);
991
992         switch (fmt) {
993         case RX_MSDU_DECAP_RAW:
994                 /* remove trailing FCS */
995                 skb_trim(skb, skb->len - FCS_LEN);
996                 break;
997         case RX_MSDU_DECAP_NATIVE_WIFI:
998                 /* Pull decapped header */
999                 hdr = (struct ieee80211_hdr *)skb->data;
1000                 hdr_len = ath10k_htt_rx_nwifi_hdrlen(hdr);
1001                 skb_pull(skb, hdr_len);
1002
1003                 /* Push original header */
1004                 hdr = (struct ieee80211_hdr *)rxd->rx_hdr_status;
1005                 hdr_len = ieee80211_hdrlen(hdr->frame_control);
1006                 memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
1007                 break;
1008         case RX_MSDU_DECAP_ETHERNET2_DIX:
1009                 /* strip ethernet header and insert decapped 802.11 header and
1010                  * rfc1042 header */
1011
1012                 rfc1042 = hdr;
1013                 rfc1042 += roundup(hdr_len, 4);
1014                 rfc1042 += roundup(ath10k_htt_rx_crypto_param_len(enctype), 4);
1015
1016                 skb_pull(skb, sizeof(struct ethhdr));
1017                 memcpy(skb_push(skb, sizeof(struct rfc1042_hdr)),
1018                        rfc1042, sizeof(struct rfc1042_hdr));
1019                 memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
1020                 break;
1021         case RX_MSDU_DECAP_8023_SNAP_LLC:
1022                 /* remove A-MSDU subframe header and insert
1023                  * decapped 802.11 header. rfc1042 header is already there */
1024
1025                 skb_pull(skb, sizeof(struct amsdu_subframe_hdr));
1026                 memcpy(skb_push(skb, hdr_len), hdr, hdr_len);
1027                 break;
1028         }
1029
1030         ath10k_htt_rx_h_protected(htt, rx_status, skb, enctype, fmt, false);
1031
1032         ath10k_process_rx(htt->ar, rx_status, skb);
1033 }
1034
1035 static int ath10k_htt_rx_get_csum_state(struct sk_buff *skb)
1036 {
1037         struct htt_rx_desc *rxd;
1038         u32 flags, info;
1039         bool is_ip4, is_ip6;
1040         bool is_tcp, is_udp;
1041         bool ip_csum_ok, tcpudp_csum_ok;
1042
1043         rxd = (void *)skb->data - sizeof(*rxd);
1044         flags = __le32_to_cpu(rxd->attention.flags);
1045         info = __le32_to_cpu(rxd->msdu_start.info1);
1046
1047         is_ip4 = !!(info & RX_MSDU_START_INFO1_IPV4_PROTO);
1048         is_ip6 = !!(info & RX_MSDU_START_INFO1_IPV6_PROTO);
1049         is_tcp = !!(info & RX_MSDU_START_INFO1_TCP_PROTO);
1050         is_udp = !!(info & RX_MSDU_START_INFO1_UDP_PROTO);
1051         ip_csum_ok = !(flags & RX_ATTENTION_FLAGS_IP_CHKSUM_FAIL);
1052         tcpudp_csum_ok = !(flags & RX_ATTENTION_FLAGS_TCP_UDP_CHKSUM_FAIL);
1053
1054         if (!is_ip4 && !is_ip6)
1055                 return CHECKSUM_NONE;
1056         if (!is_tcp && !is_udp)
1057                 return CHECKSUM_NONE;
1058         if (!ip_csum_ok)
1059                 return CHECKSUM_NONE;
1060         if (!tcpudp_csum_ok)
1061                 return CHECKSUM_NONE;
1062
1063         return CHECKSUM_UNNECESSARY;
1064 }
1065
1066 static int ath10k_unchain_msdu(struct sk_buff *msdu_head)
1067 {
1068         struct sk_buff *next = msdu_head->next;
1069         struct sk_buff *to_free = next;
1070         int space;
1071         int total_len = 0;
1072
1073         /* TODO:  Might could optimize this by using
1074          * skb_try_coalesce or similar method to
1075          * decrease copying, or maybe get mac80211 to
1076          * provide a way to just receive a list of
1077          * skb?
1078          */
1079
1080         msdu_head->next = NULL;
1081
1082         /* Allocate total length all at once. */
1083         while (next) {
1084                 total_len += next->len;
1085                 next = next->next;
1086         }
1087
1088         space = total_len - skb_tailroom(msdu_head);
1089         if ((space > 0) &&
1090             (pskb_expand_head(msdu_head, 0, space, GFP_ATOMIC) < 0)) {
1091                 /* TODO:  bump some rx-oom error stat */
1092                 /* put it back together so we can free the
1093                  * whole list at once.
1094                  */
1095                 msdu_head->next = to_free;
1096                 return -1;
1097         }
1098
1099         /* Walk list again, copying contents into
1100          * msdu_head
1101          */
1102         next = to_free;
1103         while (next) {
1104                 skb_copy_from_linear_data(next, skb_put(msdu_head, next->len),
1105                                           next->len);
1106                 next = next->next;
1107         }
1108
1109         /* If here, we have consolidated skb.  Free the
1110          * fragments and pass the main skb on up the
1111          * stack.
1112          */
1113         ath10k_htt_rx_free_msdu_chain(to_free);
1114         return 0;
1115 }
1116
1117 static bool ath10k_htt_rx_amsdu_allowed(struct ath10k_htt *htt,
1118                                         struct sk_buff *head,
1119                                         enum htt_rx_mpdu_status status,
1120                                         bool channel_set,
1121                                         u32 attention)
1122 {
1123         if (head->len == 0) {
1124                 ath10k_dbg(ATH10K_DBG_HTT,
1125                            "htt rx dropping due to zero-len\n");
1126                 return false;
1127         }
1128
1129         if (attention & RX_ATTENTION_FLAGS_DECRYPT_ERR) {
1130                 ath10k_dbg(ATH10K_DBG_HTT,
1131                            "htt rx dropping due to decrypt-err\n");
1132                 return false;
1133         }
1134
1135         if (!channel_set) {
1136                 ath10k_warn("no channel configured; ignoring frame!\n");
1137                 return false;
1138         }
1139
1140         /* Skip mgmt frames while we handle this in WMI */
1141         if (status == HTT_RX_IND_MPDU_STATUS_MGMT_CTRL ||
1142             attention & RX_ATTENTION_FLAGS_MGMT_TYPE) {
1143                 ath10k_dbg(ATH10K_DBG_HTT, "htt rx mgmt ctrl\n");
1144                 return false;
1145         }
1146
1147         if (status != HTT_RX_IND_MPDU_STATUS_OK &&
1148             status != HTT_RX_IND_MPDU_STATUS_TKIP_MIC_ERR &&
1149             status != HTT_RX_IND_MPDU_STATUS_ERR_INV_PEER &&
1150             !htt->ar->monitor_started) {
1151                 ath10k_dbg(ATH10K_DBG_HTT,
1152                            "htt rx ignoring frame w/ status %d\n",
1153                            status);
1154                 return false;
1155         }
1156
1157         if (test_bit(ATH10K_CAC_RUNNING, &htt->ar->dev_flags)) {
1158                 ath10k_dbg(ATH10K_DBG_HTT,
1159                            "htt rx CAC running\n");
1160                 return false;
1161         }
1162
1163         return true;
1164 }
1165
1166 static void ath10k_htt_rx_handler(struct ath10k_htt *htt,
1167                                   struct htt_rx_indication *rx)
1168 {
1169         struct ieee80211_rx_status *rx_status = &htt->rx_status;
1170         struct htt_rx_indication_mpdu_range *mpdu_ranges;
1171         struct htt_rx_desc *rxd;
1172         enum htt_rx_mpdu_status status;
1173         struct ieee80211_hdr *hdr;
1174         int num_mpdu_ranges;
1175         u32 attention;
1176         int fw_desc_len;
1177         u8 *fw_desc;
1178         bool channel_set;
1179         int i, j;
1180         int ret;
1181
1182         lockdep_assert_held(&htt->rx_ring.lock);
1183
1184         fw_desc_len = __le16_to_cpu(rx->prefix.fw_rx_desc_bytes);
1185         fw_desc = (u8 *)&rx->fw_desc;
1186
1187         num_mpdu_ranges = MS(__le32_to_cpu(rx->hdr.info1),
1188                              HTT_RX_INDICATION_INFO1_NUM_MPDU_RANGES);
1189         mpdu_ranges = htt_rx_ind_get_mpdu_ranges(rx);
1190
1191         /* Fill this once, while this is per-ppdu */
1192         if (rx->ppdu.info0 & HTT_RX_INDICATION_INFO0_START_VALID) {
1193                 memset(rx_status, 0, sizeof(*rx_status));
1194                 rx_status->signal  = ATH10K_DEFAULT_NOISE_FLOOR +
1195                                      rx->ppdu.combined_rssi;
1196         }
1197
1198         if (rx->ppdu.info0 & HTT_RX_INDICATION_INFO0_END_VALID) {
1199                 /* TSF available only in 32-bit */
1200                 rx_status->mactime = __le32_to_cpu(rx->ppdu.tsf) & 0xffffffff;
1201                 rx_status->flag |= RX_FLAG_MACTIME_END;
1202         }
1203
1204         channel_set = ath10k_htt_rx_h_channel(htt->ar, rx_status);
1205
1206         if (channel_set) {
1207                 ath10k_htt_rx_h_rates(htt->ar, rx_status->band,
1208                                       rx->ppdu.info0,
1209                                       __le32_to_cpu(rx->ppdu.info1),
1210                                       __le32_to_cpu(rx->ppdu.info2),
1211                                       rx_status);
1212         }
1213
1214         ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "htt rx ind: ",
1215                         rx, sizeof(*rx) +
1216                         (sizeof(struct htt_rx_indication_mpdu_range) *
1217                                 num_mpdu_ranges));
1218
1219         for (i = 0; i < num_mpdu_ranges; i++) {
1220                 status = mpdu_ranges[i].mpdu_range_status;
1221
1222                 for (j = 0; j < mpdu_ranges[i].mpdu_count; j++) {
1223                         struct sk_buff *msdu_head, *msdu_tail;
1224
1225                         attention = 0;
1226                         msdu_head = NULL;
1227                         msdu_tail = NULL;
1228                         ret = ath10k_htt_rx_amsdu_pop(htt,
1229                                                       &fw_desc,
1230                                                       &fw_desc_len,
1231                                                       &msdu_head,
1232                                                       &msdu_tail,
1233                                                       &attention);
1234
1235                         if (ret < 0) {
1236                                 ath10k_warn("failed to pop amsdu from htt rx ring %d\n",
1237                                             ret);
1238                                 ath10k_htt_rx_free_msdu_chain(msdu_head);
1239                                 continue;
1240                         }
1241
1242                         rxd = container_of((void *)msdu_head->data,
1243                                            struct htt_rx_desc,
1244                                            msdu_payload);
1245
1246                         if (!ath10k_htt_rx_amsdu_allowed(htt, msdu_head,
1247                                                          status,
1248                                                          channel_set,
1249                                                          attention)) {
1250                                 ath10k_htt_rx_free_msdu_chain(msdu_head);
1251                                 continue;
1252                         }
1253
1254                         if (ret > 0 &&
1255                             ath10k_unchain_msdu(msdu_head) < 0) {
1256                                 ath10k_htt_rx_free_msdu_chain(msdu_head);
1257                                 continue;
1258                         }
1259
1260                         if (attention & RX_ATTENTION_FLAGS_FCS_ERR)
1261                                 rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
1262                         else
1263                                 rx_status->flag &= ~RX_FLAG_FAILED_FCS_CRC;
1264
1265                         if (attention & RX_ATTENTION_FLAGS_TKIP_MIC_ERR)
1266                                 rx_status->flag |= RX_FLAG_MMIC_ERROR;
1267                         else
1268                                 rx_status->flag &= ~RX_FLAG_MMIC_ERROR;
1269
1270                         hdr = ath10k_htt_rx_skb_get_hdr(msdu_head);
1271
1272                         if (ath10k_htt_rx_hdr_is_amsdu(hdr))
1273                                 ath10k_htt_rx_amsdu(htt, rx_status, msdu_head);
1274                         else
1275                                 ath10k_htt_rx_msdu(htt, rx_status, msdu_head);
1276                 }
1277         }
1278
1279         tasklet_schedule(&htt->rx_replenish_task);
1280 }
1281
1282 static void ath10k_htt_rx_frag_handler(struct ath10k_htt *htt,
1283                                 struct htt_rx_fragment_indication *frag)
1284 {
1285         struct sk_buff *msdu_head, *msdu_tail;
1286         enum htt_rx_mpdu_encrypt_type enctype;
1287         struct htt_rx_desc *rxd;
1288         enum rx_msdu_decap_format fmt;
1289         struct ieee80211_rx_status *rx_status = &htt->rx_status;
1290         struct ieee80211_hdr *hdr;
1291         int ret;
1292         bool tkip_mic_err;
1293         bool decrypt_err;
1294         u8 *fw_desc;
1295         int fw_desc_len, hdrlen, paramlen;
1296         int trim;
1297         u32 attention = 0;
1298
1299         fw_desc_len = __le16_to_cpu(frag->fw_rx_desc_bytes);
1300         fw_desc = (u8 *)frag->fw_msdu_rx_desc;
1301
1302         msdu_head = NULL;
1303         msdu_tail = NULL;
1304
1305         spin_lock_bh(&htt->rx_ring.lock);
1306         ret = ath10k_htt_rx_amsdu_pop(htt, &fw_desc, &fw_desc_len,
1307                                       &msdu_head, &msdu_tail,
1308                                       &attention);
1309         spin_unlock_bh(&htt->rx_ring.lock);
1310
1311         ath10k_dbg(ATH10K_DBG_HTT_DUMP, "htt rx frag ahead\n");
1312
1313         if (ret) {
1314                 ath10k_warn("failed to pop amsdu from httr rx ring for fragmented rx %d\n",
1315                             ret);
1316                 ath10k_htt_rx_free_msdu_chain(msdu_head);
1317                 return;
1318         }
1319
1320         /* FIXME: implement signal strength */
1321         rx_status->flag |= RX_FLAG_NO_SIGNAL_VAL;
1322
1323         hdr = (struct ieee80211_hdr *)msdu_head->data;
1324         rxd = (void *)msdu_head->data - sizeof(*rxd);
1325         tkip_mic_err = !!(attention & RX_ATTENTION_FLAGS_TKIP_MIC_ERR);
1326         decrypt_err = !!(attention & RX_ATTENTION_FLAGS_DECRYPT_ERR);
1327         fmt = MS(__le32_to_cpu(rxd->msdu_start.info1),
1328                         RX_MSDU_START_INFO1_DECAP_FORMAT);
1329
1330         if (fmt != RX_MSDU_DECAP_RAW) {
1331                 ath10k_warn("we dont support non-raw fragmented rx yet\n");
1332                 dev_kfree_skb_any(msdu_head);
1333                 goto end;
1334         }
1335
1336         enctype = MS(__le32_to_cpu(rxd->mpdu_start.info0),
1337                      RX_MPDU_START_INFO0_ENCRYPT_TYPE);
1338         ath10k_htt_rx_h_protected(htt, rx_status, msdu_head, enctype, fmt,
1339                                   true);
1340         msdu_head->ip_summed = ath10k_htt_rx_get_csum_state(msdu_head);
1341
1342         if (tkip_mic_err)
1343                 ath10k_warn("tkip mic error\n");
1344
1345         if (decrypt_err) {
1346                 ath10k_warn("decryption err in fragmented rx\n");
1347                 dev_kfree_skb_any(msdu_head);
1348                 goto end;
1349         }
1350
1351         if (enctype != HTT_RX_MPDU_ENCRYPT_NONE) {
1352                 hdrlen = ieee80211_hdrlen(hdr->frame_control);
1353                 paramlen = ath10k_htt_rx_crypto_param_len(enctype);
1354
1355                 /* It is more efficient to move the header than the payload */
1356                 memmove((void *)msdu_head->data + paramlen,
1357                         (void *)msdu_head->data,
1358                         hdrlen);
1359                 skb_pull(msdu_head, paramlen);
1360                 hdr = (struct ieee80211_hdr *)msdu_head->data;
1361         }
1362
1363         /* remove trailing FCS */
1364         trim  = 4;
1365
1366         /* remove crypto trailer */
1367         trim += ath10k_htt_rx_crypto_tail_len(enctype);
1368
1369         /* last fragment of TKIP frags has MIC */
1370         if (!ieee80211_has_morefrags(hdr->frame_control) &&
1371             enctype == HTT_RX_MPDU_ENCRYPT_TKIP_WPA)
1372                 trim += 8;
1373
1374         if (trim > msdu_head->len) {
1375                 ath10k_warn("htt rx fragment: trailer longer than the frame itself? drop\n");
1376                 dev_kfree_skb_any(msdu_head);
1377                 goto end;
1378         }
1379
1380         skb_trim(msdu_head, msdu_head->len - trim);
1381
1382         ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "htt rx frag mpdu: ",
1383                         msdu_head->data, msdu_head->len);
1384         ath10k_process_rx(htt->ar, rx_status, msdu_head);
1385
1386 end:
1387         if (fw_desc_len > 0) {
1388                 ath10k_dbg(ATH10K_DBG_HTT,
1389                            "expecting more fragmented rx in one indication %d\n",
1390                            fw_desc_len);
1391         }
1392 }
1393
1394 static void ath10k_htt_rx_frm_tx_compl(struct ath10k *ar,
1395                                        struct sk_buff *skb)
1396 {
1397         struct ath10k_htt *htt = &ar->htt;
1398         struct htt_resp *resp = (struct htt_resp *)skb->data;
1399         struct htt_tx_done tx_done = {};
1400         int status = MS(resp->data_tx_completion.flags, HTT_DATA_TX_STATUS);
1401         __le16 msdu_id;
1402         int i;
1403
1404         lockdep_assert_held(&htt->tx_lock);
1405
1406         switch (status) {
1407         case HTT_DATA_TX_STATUS_NO_ACK:
1408                 tx_done.no_ack = true;
1409                 break;
1410         case HTT_DATA_TX_STATUS_OK:
1411                 break;
1412         case HTT_DATA_TX_STATUS_DISCARD:
1413         case HTT_DATA_TX_STATUS_POSTPONE:
1414         case HTT_DATA_TX_STATUS_DOWNLOAD_FAIL:
1415                 tx_done.discard = true;
1416                 break;
1417         default:
1418                 ath10k_warn("unhandled tx completion status %d\n", status);
1419                 tx_done.discard = true;
1420                 break;
1421         }
1422
1423         ath10k_dbg(ATH10K_DBG_HTT, "htt tx completion num_msdus %d\n",
1424                    resp->data_tx_completion.num_msdus);
1425
1426         for (i = 0; i < resp->data_tx_completion.num_msdus; i++) {
1427                 msdu_id = resp->data_tx_completion.msdus[i];
1428                 tx_done.msdu_id = __le16_to_cpu(msdu_id);
1429                 ath10k_txrx_tx_unref(htt, &tx_done);
1430         }
1431 }
1432
1433 static void ath10k_htt_rx_addba(struct ath10k *ar, struct htt_resp *resp)
1434 {
1435         struct htt_rx_addba *ev = &resp->rx_addba;
1436         struct ath10k_peer *peer;
1437         struct ath10k_vif *arvif;
1438         u16 info0, tid, peer_id;
1439
1440         info0 = __le16_to_cpu(ev->info0);
1441         tid = MS(info0, HTT_RX_BA_INFO0_TID);
1442         peer_id = MS(info0, HTT_RX_BA_INFO0_PEER_ID);
1443
1444         ath10k_dbg(ATH10K_DBG_HTT,
1445                    "htt rx addba tid %hu peer_id %hu size %hhu\n",
1446                    tid, peer_id, ev->window_size);
1447
1448         spin_lock_bh(&ar->data_lock);
1449         peer = ath10k_peer_find_by_id(ar, peer_id);
1450         if (!peer) {
1451                 ath10k_warn("received addba event for invalid peer_id: %hu\n",
1452                             peer_id);
1453                 spin_unlock_bh(&ar->data_lock);
1454                 return;
1455         }
1456
1457         arvif = ath10k_get_arvif(ar, peer->vdev_id);
1458         if (!arvif) {
1459                 ath10k_warn("received addba event for invalid vdev_id: %u\n",
1460                             peer->vdev_id);
1461                 spin_unlock_bh(&ar->data_lock);
1462                 return;
1463         }
1464
1465         ath10k_dbg(ATH10K_DBG_HTT,
1466                    "htt rx start rx ba session sta %pM tid %hu size %hhu\n",
1467                    peer->addr, tid, ev->window_size);
1468
1469         ieee80211_start_rx_ba_session_offl(arvif->vif, peer->addr, tid);
1470         spin_unlock_bh(&ar->data_lock);
1471 }
1472
1473 static void ath10k_htt_rx_delba(struct ath10k *ar, struct htt_resp *resp)
1474 {
1475         struct htt_rx_delba *ev = &resp->rx_delba;
1476         struct ath10k_peer *peer;
1477         struct ath10k_vif *arvif;
1478         u16 info0, tid, peer_id;
1479
1480         info0 = __le16_to_cpu(ev->info0);
1481         tid = MS(info0, HTT_RX_BA_INFO0_TID);
1482         peer_id = MS(info0, HTT_RX_BA_INFO0_PEER_ID);
1483
1484         ath10k_dbg(ATH10K_DBG_HTT,
1485                    "htt rx delba tid %hu peer_id %hu\n",
1486                    tid, peer_id);
1487
1488         spin_lock_bh(&ar->data_lock);
1489         peer = ath10k_peer_find_by_id(ar, peer_id);
1490         if (!peer) {
1491                 ath10k_warn("received addba event for invalid peer_id: %hu\n",
1492                             peer_id);
1493                 spin_unlock_bh(&ar->data_lock);
1494                 return;
1495         }
1496
1497         arvif = ath10k_get_arvif(ar, peer->vdev_id);
1498         if (!arvif) {
1499                 ath10k_warn("received addba event for invalid vdev_id: %u\n",
1500                             peer->vdev_id);
1501                 spin_unlock_bh(&ar->data_lock);
1502                 return;
1503         }
1504
1505         ath10k_dbg(ATH10K_DBG_HTT,
1506                    "htt rx stop rx ba session sta %pM tid %hu\n",
1507                    peer->addr, tid);
1508
1509         ieee80211_stop_rx_ba_session_offl(arvif->vif, peer->addr, tid);
1510         spin_unlock_bh(&ar->data_lock);
1511 }
1512
1513 void ath10k_htt_t2h_msg_handler(struct ath10k *ar, struct sk_buff *skb)
1514 {
1515         struct ath10k_htt *htt = &ar->htt;
1516         struct htt_resp *resp = (struct htt_resp *)skb->data;
1517
1518         /* confirm alignment */
1519         if (!IS_ALIGNED((unsigned long)skb->data, 4))
1520                 ath10k_warn("unaligned htt message, expect trouble\n");
1521
1522         ath10k_dbg(ATH10K_DBG_HTT, "htt rx, msg_type: 0x%0X\n",
1523                    resp->hdr.msg_type);
1524         switch (resp->hdr.msg_type) {
1525         case HTT_T2H_MSG_TYPE_VERSION_CONF: {
1526                 htt->target_version_major = resp->ver_resp.major;
1527                 htt->target_version_minor = resp->ver_resp.minor;
1528                 complete(&htt->target_version_received);
1529                 break;
1530         }
1531         case HTT_T2H_MSG_TYPE_RX_IND:
1532                 spin_lock_bh(&htt->rx_ring.lock);
1533                 __skb_queue_tail(&htt->rx_compl_q, skb);
1534                 spin_unlock_bh(&htt->rx_ring.lock);
1535                 tasklet_schedule(&htt->txrx_compl_task);
1536                 return;
1537         case HTT_T2H_MSG_TYPE_PEER_MAP: {
1538                 struct htt_peer_map_event ev = {
1539                         .vdev_id = resp->peer_map.vdev_id,
1540                         .peer_id = __le16_to_cpu(resp->peer_map.peer_id),
1541                 };
1542                 memcpy(ev.addr, resp->peer_map.addr, sizeof(ev.addr));
1543                 ath10k_peer_map_event(htt, &ev);
1544                 break;
1545         }
1546         case HTT_T2H_MSG_TYPE_PEER_UNMAP: {
1547                 struct htt_peer_unmap_event ev = {
1548                         .peer_id = __le16_to_cpu(resp->peer_unmap.peer_id),
1549                 };
1550                 ath10k_peer_unmap_event(htt, &ev);
1551                 break;
1552         }
1553         case HTT_T2H_MSG_TYPE_MGMT_TX_COMPLETION: {
1554                 struct htt_tx_done tx_done = {};
1555                 int status = __le32_to_cpu(resp->mgmt_tx_completion.status);
1556
1557                 tx_done.msdu_id =
1558                         __le32_to_cpu(resp->mgmt_tx_completion.desc_id);
1559
1560                 switch (status) {
1561                 case HTT_MGMT_TX_STATUS_OK:
1562                         break;
1563                 case HTT_MGMT_TX_STATUS_RETRY:
1564                         tx_done.no_ack = true;
1565                         break;
1566                 case HTT_MGMT_TX_STATUS_DROP:
1567                         tx_done.discard = true;
1568                         break;
1569                 }
1570
1571                 spin_lock_bh(&htt->tx_lock);
1572                 ath10k_txrx_tx_unref(htt, &tx_done);
1573                 spin_unlock_bh(&htt->tx_lock);
1574                 break;
1575         }
1576         case HTT_T2H_MSG_TYPE_TX_COMPL_IND:
1577                 spin_lock_bh(&htt->tx_lock);
1578                 __skb_queue_tail(&htt->tx_compl_q, skb);
1579                 spin_unlock_bh(&htt->tx_lock);
1580                 tasklet_schedule(&htt->txrx_compl_task);
1581                 return;
1582         case HTT_T2H_MSG_TYPE_SEC_IND: {
1583                 struct ath10k *ar = htt->ar;
1584                 struct htt_security_indication *ev = &resp->security_indication;
1585
1586                 ath10k_dbg(ATH10K_DBG_HTT,
1587                            "sec ind peer_id %d unicast %d type %d\n",
1588                           __le16_to_cpu(ev->peer_id),
1589                           !!(ev->flags & HTT_SECURITY_IS_UNICAST),
1590                           MS(ev->flags, HTT_SECURITY_TYPE));
1591                 complete(&ar->install_key_done);
1592                 break;
1593         }
1594         case HTT_T2H_MSG_TYPE_RX_FRAG_IND: {
1595                 ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "htt event: ",
1596                                 skb->data, skb->len);
1597                 ath10k_htt_rx_frag_handler(htt, &resp->rx_frag_ind);
1598                 break;
1599         }
1600         case HTT_T2H_MSG_TYPE_TEST:
1601                 /* FIX THIS */
1602                 break;
1603         case HTT_T2H_MSG_TYPE_STATS_CONF:
1604                 trace_ath10k_htt_stats(skb->data, skb->len);
1605                 break;
1606         case HTT_T2H_MSG_TYPE_TX_INSPECT_IND:
1607                 /* Firmware can return tx frames if it's unable to fully
1608                  * process them and suspects host may be able to fix it. ath10k
1609                  * sends all tx frames as already inspected so this shouldn't
1610                  * happen unless fw has a bug.
1611                  */
1612                 ath10k_warn("received an unexpected htt tx inspect event\n");
1613                 break;
1614         case HTT_T2H_MSG_TYPE_RX_ADDBA:
1615                 ath10k_htt_rx_addba(ar, resp);
1616                 break;
1617         case HTT_T2H_MSG_TYPE_RX_DELBA:
1618                 ath10k_htt_rx_delba(ar, resp);
1619                 break;
1620         case HTT_T2H_MSG_TYPE_RX_FLUSH: {
1621                 /* Ignore this event because mac80211 takes care of Rx
1622                  * aggregation reordering.
1623                  */
1624                 break;
1625         }
1626         default:
1627                 ath10k_dbg(ATH10K_DBG_HTT, "htt event (%d) not handled\n",
1628                            resp->hdr.msg_type);
1629                 ath10k_dbg_dump(ATH10K_DBG_HTT_DUMP, NULL, "htt event: ",
1630                                 skb->data, skb->len);
1631                 break;
1632         };
1633
1634         /* Free the indication buffer */
1635         dev_kfree_skb_any(skb);
1636 }
1637
1638 static void ath10k_htt_txrx_compl_task(unsigned long ptr)
1639 {
1640         struct ath10k_htt *htt = (struct ath10k_htt *)ptr;
1641         struct htt_resp *resp;
1642         struct sk_buff *skb;
1643
1644         spin_lock_bh(&htt->tx_lock);
1645         while ((skb = __skb_dequeue(&htt->tx_compl_q))) {
1646                 ath10k_htt_rx_frm_tx_compl(htt->ar, skb);
1647                 dev_kfree_skb_any(skb);
1648         }
1649         spin_unlock_bh(&htt->tx_lock);
1650
1651         spin_lock_bh(&htt->rx_ring.lock);
1652         while ((skb = __skb_dequeue(&htt->rx_compl_q))) {
1653                 resp = (struct htt_resp *)skb->data;
1654                 ath10k_htt_rx_handler(htt, &resp->rx_ind);
1655                 dev_kfree_skb_any(skb);
1656         }
1657         spin_unlock_bh(&htt->rx_ring.lock);
1658 }