1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Datapath 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
wfx_rx_handle_ba(struct wfx_vif * wvif,struct ieee80211_mgmt * mgmt)16 static void wfx_rx_handle_ba(struct wfx_vif *wvif, struct ieee80211_mgmt *mgmt)
17 {
18 int params, tid;
19
20 if (wfx_api_older_than(wvif->wdev, 3, 6))
21 return;
22
23 switch (mgmt->u.action.u.addba_req.action_code) {
24 case WLAN_ACTION_ADDBA_REQ:
25 params = le16_to_cpu(mgmt->u.action.u.addba_req.capab);
26 tid = (params & IEEE80211_ADDBA_PARAM_TID_MASK) >> 2;
27 ieee80211_start_rx_ba_session_offl(wvif->vif, mgmt->sa, tid);
28 break;
29 case WLAN_ACTION_DELBA:
30 params = le16_to_cpu(mgmt->u.action.u.delba.params);
31 tid = (params & IEEE80211_DELBA_PARAM_TID_MASK) >> 12;
32 ieee80211_stop_rx_ba_session_offl(wvif->vif, mgmt->sa, tid);
33 break;
34 }
35 }
36
wfx_rx_cb(struct wfx_vif * wvif,const struct hif_ind_rx * arg,struct sk_buff * skb)37 void wfx_rx_cb(struct wfx_vif *wvif,
38 const struct 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,
58 hdr->band);
59
60 if (arg->rxed_rate >= 14) {
61 hdr->encoding = RX_ENC_HT;
62 hdr->rate_idx = arg->rxed_rate - 14;
63 } else if (arg->rxed_rate >= 4) {
64 hdr->rate_idx = arg->rxed_rate - 2;
65 } else {
66 hdr->rate_idx = arg->rxed_rate;
67 }
68
69 if (!arg->rcpi_rssi) {
70 hdr->flag |= RX_FLAG_NO_SIGNAL_VAL;
71 dev_info(wvif->wdev->dev, "received frame without RSSI data\n");
72 }
73 hdr->signal = arg->rcpi_rssi / 2 - 110;
74 hdr->antenna = 0;
75
76 if (arg->encryp)
77 hdr->flag |= RX_FLAG_DECRYPTED;
78
79 // Block ack negotiation is offloaded by the firmware. However,
80 // re-ordering must be done by the mac80211.
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 }
94