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