drivers/net/wireless/silabs/wfx/data_rx.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Data receiving implementation.
   4  *
   5  * Copyright (c) 2017-2020, Silicon Laboratories, Inc.
   6  * Copyright (c) 2010, ST-Ericsson
   7  */
   8 #include <linux/etherdevice.h>
   9 #include <net/mac80211.h>
  10
  11 #include "data_rx.h"
  12 #include "wfx.h"
  13 #include "bh.h"
  14 #include "sta.h"
  15
  16 static void wfx_rx_handle_ba(struct wfx_vif *wvif, struct ieee80211_mgmt *mgmt)
  17 {
  18         struct ieee80211_vif *vif = wvif_to_vif(wvif);
  19         int params, tid;
  20
  21         if (wfx_api_older_than(wvif->wdev, 3, 6))
  22                 return;
  23
  24         switch (mgmt->u.action.u.addba_req.action_code) {
  25         case WLAN_ACTION_ADDBA_REQ:
  26                 params = le16_to_cpu(mgmt->u.action.u.addba_req.capab);
  27                 tid = (params & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2;
  28                 ieee80211_start_rx_ba_session_offl(vif, mgmt->sa, tid);
  29                 break;
  30         case WLAN_ACTION_DELBA:
  31                 params = le16_to_cpu(mgmt->u.action.u.delba.params);
  32                 tid = (params &  IEEE80211_DELBA_PARAM_TID_MASK) >> 12;
  33                 ieee80211_stop_rx_ba_session_offl(vif, mgmt->sa, tid);
  34                 break;
  35         }
  36 }
  37
  38 void wfx_rx_cb(struct wfx_vif *wvif, const struct wfx_hif_ind_rx *arg, struct sk_buff *skb)
  39 {
  40         struct ieee80211_rx_status *hdr = IEEE80211_SKB_RXCB(skb);
  41         struct ieee80211_hdr *frame = (struct ieee80211_hdr *)skb->data;
  42         struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)skb->data;
  43
  44         memset(hdr, 0, sizeof(*hdr));
  45
  46         if (arg->status == HIF_STATUS_RX_FAIL_MIC)
  47                 hdr->flag |= RX_FLAG_MMIC_ERROR | RX_FLAG_IV_STRIPPED;
  48         else if (arg->status)
  49                 goto drop;
  50
  51         if (skb->len < sizeof(struct ieee80211_pspoll)) {
  52                 dev_warn(wvif->wdev->dev, "malformed SDU received\n");
  53                 goto drop;
  54         }
  55
  56         hdr->band = NL80211_BAND_2GHZ;
  57         hdr->freq = ieee80211_channel_to_frequency(arg->channel_number, hdr->band);
  58
  59         if (arg->rxed_rate >= 14) {
  60                 hdr->encoding = RX_ENC_HT;
  61                 hdr->rate_idx = arg->rxed_rate - 14;
  62         } else if (arg->rxed_rate >= 4) {
  63                 hdr->rate_idx = arg->rxed_rate - 2;
  64         } else {
  65                 hdr->rate_idx = arg->rxed_rate;
  66         }
  67
  68         if (!arg->rcpi_rssi) {
  69                 hdr->flag |= RX_FLAG_NO_SIGNAL_VAL;
  70                 dev_info(wvif->wdev->dev, "received frame without RSSI data\n");
  71         }
  72         hdr->signal = arg->rcpi_rssi / 2 - 110;
  73         hdr->antenna = 0;
  74
  75         if (arg->encryp)
  76                 hdr->flag |= RX_FLAG_DECRYPTED;
  77
  78         /* Block ack negotiation is offloaded by the firmware. However, re-ordering must be done by
  79          * the mac80211.
  80          */
  81         if (ieee80211_is_action(frame->frame_control) &&
  82             mgmt->u.action.category == WLAN_CATEGORY_BACK &&
  83             skb->len > IEEE80211_MIN_ACTION_SIZE) {
  84                 wfx_rx_handle_ba(wvif, mgmt);
  85                 goto drop;
  86         }
  87
  88         ieee80211_rx_irqsafe(wvif->wdev->hw, skb);
  89         return;
  90
  91 drop:
  92         dev_kfree_skb(skb);
  93 }