1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019 Realtek Corporation
3 */
4
5 #include "main.h"
6 #include "tx.h"
7 #include "fw.h"
8 #include "ps.h"
9
10 static
rtw_tx_stats(struct rtw_dev * rtwdev,struct ieee80211_vif * vif,struct sk_buff * skb)11 void rtw_tx_stats(struct rtw_dev *rtwdev, struct ieee80211_vif *vif,
12 struct sk_buff *skb)
13 {
14 struct ieee80211_hdr *hdr;
15 struct rtw_vif *rtwvif;
16
17 hdr = (struct ieee80211_hdr *)skb->data;
18
19 if (!ieee80211_is_data(hdr->frame_control))
20 return;
21
22 if (!is_broadcast_ether_addr(hdr->addr1) &&
23 !is_multicast_ether_addr(hdr->addr1)) {
24 rtwdev->stats.tx_unicast += skb->len;
25 rtwdev->stats.tx_cnt++;
26 if (vif) {
27 rtwvif = (struct rtw_vif *)vif->drv_priv;
28 rtwvif->stats.tx_unicast += skb->len;
29 rtwvif->stats.tx_cnt++;
30 if (rtwvif->stats.tx_cnt > RTW_LPS_THRESHOLD)
31 rtw_leave_lps_irqsafe(rtwdev, rtwvif);
32 }
33 }
34 }
35
rtw_tx_fill_tx_desc(struct rtw_tx_pkt_info * pkt_info,struct sk_buff * skb)36 void rtw_tx_fill_tx_desc(struct rtw_tx_pkt_info *pkt_info, struct sk_buff *skb)
37 {
38 __le32 *txdesc = (__le32 *)skb->data;
39
40 SET_TX_DESC_TXPKTSIZE(txdesc, pkt_info->tx_pkt_size);
41 SET_TX_DESC_OFFSET(txdesc, pkt_info->offset);
42 SET_TX_DESC_PKT_OFFSET(txdesc, pkt_info->pkt_offset);
43 SET_TX_DESC_QSEL(txdesc, pkt_info->qsel);
44 SET_TX_DESC_BMC(txdesc, pkt_info->bmc);
45 SET_TX_DESC_RATE_ID(txdesc, pkt_info->rate_id);
46 SET_TX_DESC_DATARATE(txdesc, pkt_info->rate);
47 SET_TX_DESC_DISDATAFB(txdesc, pkt_info->dis_rate_fallback);
48 SET_TX_DESC_USE_RATE(txdesc, pkt_info->use_rate);
49 SET_TX_DESC_SEC_TYPE(txdesc, pkt_info->sec_type);
50 SET_TX_DESC_DATA_BW(txdesc, pkt_info->bw);
51 SET_TX_DESC_SW_SEQ(txdesc, pkt_info->seq);
52 SET_TX_DESC_MAX_AGG_NUM(txdesc, pkt_info->ampdu_factor);
53 SET_TX_DESC_AMPDU_DENSITY(txdesc, pkt_info->ampdu_density);
54 SET_TX_DESC_DATA_STBC(txdesc, pkt_info->stbc);
55 SET_TX_DESC_DATA_LDPC(txdesc, pkt_info->ldpc);
56 SET_TX_DESC_AGG_EN(txdesc, pkt_info->ampdu_en);
57 SET_TX_DESC_LS(txdesc, pkt_info->ls);
58 SET_TX_DESC_DATA_SHORT(txdesc, pkt_info->short_gi);
59 SET_TX_DESC_SPE_RPT(txdesc, pkt_info->report);
60 SET_TX_DESC_SW_DEFINE(txdesc, pkt_info->sn);
61 }
62 EXPORT_SYMBOL(rtw_tx_fill_tx_desc);
63
get_tx_ampdu_factor(struct ieee80211_sta * sta)64 static u8 get_tx_ampdu_factor(struct ieee80211_sta *sta)
65 {
66 u8 exp = sta->ht_cap.ampdu_factor;
67
68 /* the least ampdu factor is 8K, and the value in the tx desc is the
69 * max aggregation num, which represents val * 2 packets can be
70 * aggregated in an AMPDU, so here we should use 8/2=4 as the base
71 */
72 return (BIT(2) << exp) - 1;
73 }
74
get_tx_ampdu_density(struct ieee80211_sta * sta)75 static u8 get_tx_ampdu_density(struct ieee80211_sta *sta)
76 {
77 return sta->ht_cap.ampdu_density;
78 }
79
get_highest_ht_tx_rate(struct rtw_dev * rtwdev,struct ieee80211_sta * sta)80 static u8 get_highest_ht_tx_rate(struct rtw_dev *rtwdev,
81 struct ieee80211_sta *sta)
82 {
83 u8 rate;
84
85 if (rtwdev->hal.rf_type == RF_2T2R && sta->ht_cap.mcs.rx_mask[1] != 0)
86 rate = DESC_RATEMCS15;
87 else
88 rate = DESC_RATEMCS7;
89
90 return rate;
91 }
92
get_highest_vht_tx_rate(struct rtw_dev * rtwdev,struct ieee80211_sta * sta)93 static u8 get_highest_vht_tx_rate(struct rtw_dev *rtwdev,
94 struct ieee80211_sta *sta)
95 {
96 struct rtw_efuse *efuse = &rtwdev->efuse;
97 u8 rate;
98 u16 tx_mcs_map;
99
100 tx_mcs_map = le16_to_cpu(sta->vht_cap.vht_mcs.tx_mcs_map);
101 if (efuse->hw_cap.nss == 1) {
102 switch (tx_mcs_map & 0x3) {
103 case IEEE80211_VHT_MCS_SUPPORT_0_7:
104 rate = DESC_RATEVHT1SS_MCS7;
105 break;
106 case IEEE80211_VHT_MCS_SUPPORT_0_8:
107 rate = DESC_RATEVHT1SS_MCS8;
108 break;
109 default:
110 case IEEE80211_VHT_MCS_SUPPORT_0_9:
111 rate = DESC_RATEVHT1SS_MCS9;
112 break;
113 }
114 } else if (efuse->hw_cap.nss >= 2) {
115 switch ((tx_mcs_map & 0xc) >> 2) {
116 case IEEE80211_VHT_MCS_SUPPORT_0_7:
117 rate = DESC_RATEVHT2SS_MCS7;
118 break;
119 case IEEE80211_VHT_MCS_SUPPORT_0_8:
120 rate = DESC_RATEVHT2SS_MCS8;
121 break;
122 default:
123 case IEEE80211_VHT_MCS_SUPPORT_0_9:
124 rate = DESC_RATEVHT2SS_MCS9;
125 break;
126 }
127 } else {
128 rate = DESC_RATEVHT1SS_MCS9;
129 }
130
131 return rate;
132 }
133
rtw_tx_report_enable(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info)134 static void rtw_tx_report_enable(struct rtw_dev *rtwdev,
135 struct rtw_tx_pkt_info *pkt_info)
136 {
137 struct rtw_tx_report *tx_report = &rtwdev->tx_report;
138
139 /* [11:8], reserved, fills with zero
140 * [7:2], tx report sequence number
141 * [1:0], firmware use, fills with zero
142 */
143 pkt_info->sn = (atomic_inc_return(&tx_report->sn) << 2) & 0xfc;
144 pkt_info->report = true;
145 }
146
rtw_tx_report_purge_timer(struct timer_list * t)147 void rtw_tx_report_purge_timer(struct timer_list *t)
148 {
149 struct rtw_dev *rtwdev = from_timer(rtwdev, t, tx_report.purge_timer);
150 struct rtw_tx_report *tx_report = &rtwdev->tx_report;
151 unsigned long flags;
152
153 if (skb_queue_len(&tx_report->queue) == 0)
154 return;
155
156 WARN(1, "purge skb(s) not reported by firmware\n");
157
158 spin_lock_irqsave(&tx_report->q_lock, flags);
159 skb_queue_purge(&tx_report->queue);
160 spin_unlock_irqrestore(&tx_report->q_lock, flags);
161 }
162
rtw_tx_report_enqueue(struct rtw_dev * rtwdev,struct sk_buff * skb,u8 sn)163 void rtw_tx_report_enqueue(struct rtw_dev *rtwdev, struct sk_buff *skb, u8 sn)
164 {
165 struct rtw_tx_report *tx_report = &rtwdev->tx_report;
166 unsigned long flags;
167 u8 *drv_data;
168
169 /* pass sn to tx report handler through driver data */
170 drv_data = (u8 *)IEEE80211_SKB_CB(skb)->status.status_driver_data;
171 *drv_data = sn;
172
173 spin_lock_irqsave(&tx_report->q_lock, flags);
174 __skb_queue_tail(&tx_report->queue, skb);
175 spin_unlock_irqrestore(&tx_report->q_lock, flags);
176
177 mod_timer(&tx_report->purge_timer, jiffies + RTW_TX_PROBE_TIMEOUT);
178 }
179 EXPORT_SYMBOL(rtw_tx_report_enqueue);
180
rtw_tx_report_tx_status(struct rtw_dev * rtwdev,struct sk_buff * skb,bool acked)181 static void rtw_tx_report_tx_status(struct rtw_dev *rtwdev,
182 struct sk_buff *skb, bool acked)
183 {
184 struct ieee80211_tx_info *info;
185
186 info = IEEE80211_SKB_CB(skb);
187 ieee80211_tx_info_clear_status(info);
188 if (acked)
189 info->flags |= IEEE80211_TX_STAT_ACK;
190 else
191 info->flags &= ~IEEE80211_TX_STAT_ACK;
192
193 ieee80211_tx_status_irqsafe(rtwdev->hw, skb);
194 }
195
rtw_tx_report_handle(struct rtw_dev * rtwdev,struct sk_buff * skb)196 void rtw_tx_report_handle(struct rtw_dev *rtwdev, struct sk_buff *skb)
197 {
198 struct rtw_tx_report *tx_report = &rtwdev->tx_report;
199 struct rtw_c2h_cmd *c2h;
200 struct sk_buff *cur, *tmp;
201 unsigned long flags;
202 u8 sn, st;
203 u8 *n;
204
205 c2h = get_c2h_from_skb(skb);
206
207 sn = GET_CCX_REPORT_SEQNUM(c2h->payload);
208 st = GET_CCX_REPORT_STATUS(c2h->payload);
209
210 spin_lock_irqsave(&tx_report->q_lock, flags);
211 skb_queue_walk_safe(&tx_report->queue, cur, tmp) {
212 n = (u8 *)IEEE80211_SKB_CB(cur)->status.status_driver_data;
213 if (*n == sn) {
214 __skb_unlink(cur, &tx_report->queue);
215 rtw_tx_report_tx_status(rtwdev, cur, st == 0);
216 break;
217 }
218 }
219 spin_unlock_irqrestore(&tx_report->q_lock, flags);
220 }
221
rtw_tx_mgmt_pkt_info_update(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info,struct ieee80211_tx_control * control,struct sk_buff * skb)222 static void rtw_tx_mgmt_pkt_info_update(struct rtw_dev *rtwdev,
223 struct rtw_tx_pkt_info *pkt_info,
224 struct ieee80211_tx_control *control,
225 struct sk_buff *skb)
226 {
227 pkt_info->use_rate = true;
228 pkt_info->rate_id = 6;
229 pkt_info->dis_rate_fallback = true;
230 }
231
rtw_tx_data_pkt_info_update(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info,struct ieee80211_tx_control * control,struct sk_buff * skb)232 static void rtw_tx_data_pkt_info_update(struct rtw_dev *rtwdev,
233 struct rtw_tx_pkt_info *pkt_info,
234 struct ieee80211_tx_control *control,
235 struct sk_buff *skb)
236 {
237 struct ieee80211_sta *sta = control->sta;
238 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
239 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
240 struct rtw_sta_info *si;
241 u16 seq;
242 u8 ampdu_factor = 0;
243 u8 ampdu_density = 0;
244 bool ampdu_en = false;
245 u8 rate = DESC_RATE6M;
246 u8 rate_id = 6;
247 u8 bw = RTW_CHANNEL_WIDTH_20;
248 bool stbc = false;
249 bool ldpc = false;
250
251 seq = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
252
253 /* for broadcast/multicast, use default values */
254 if (!sta)
255 goto out;
256
257 if (info->flags & IEEE80211_TX_CTL_AMPDU) {
258 ampdu_en = true;
259 ampdu_factor = get_tx_ampdu_factor(sta);
260 ampdu_density = get_tx_ampdu_density(sta);
261 }
262
263 if (sta->vht_cap.vht_supported)
264 rate = get_highest_vht_tx_rate(rtwdev, sta);
265 else if (sta->ht_cap.ht_supported)
266 rate = get_highest_ht_tx_rate(rtwdev, sta);
267 else if (sta->supp_rates[0] <= 0xf)
268 rate = DESC_RATE11M;
269 else
270 rate = DESC_RATE54M;
271
272 si = (struct rtw_sta_info *)sta->drv_priv;
273
274 bw = si->bw_mode;
275 rate_id = si->rate_id;
276 stbc = si->stbc_en;
277 ldpc = si->ldpc_en;
278
279 out:
280 pkt_info->seq = seq;
281 pkt_info->ampdu_factor = ampdu_factor;
282 pkt_info->ampdu_density = ampdu_density;
283 pkt_info->ampdu_en = ampdu_en;
284 pkt_info->rate = rate;
285 pkt_info->rate_id = rate_id;
286 pkt_info->bw = bw;
287 pkt_info->stbc = stbc;
288 pkt_info->ldpc = ldpc;
289 }
290
rtw_tx_pkt_info_update(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info,struct ieee80211_tx_control * control,struct sk_buff * skb)291 void rtw_tx_pkt_info_update(struct rtw_dev *rtwdev,
292 struct rtw_tx_pkt_info *pkt_info,
293 struct ieee80211_tx_control *control,
294 struct sk_buff *skb)
295 {
296 struct rtw_chip_info *chip = rtwdev->chip;
297 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
298 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
299 struct rtw_sta_info *si;
300 struct ieee80211_vif *vif = NULL;
301 __le16 fc = hdr->frame_control;
302 u8 sec_type = 0;
303 bool bmc;
304
305 if (control->sta) {
306 si = (struct rtw_sta_info *)control->sta->drv_priv;
307 vif = si->vif;
308 }
309
310 if (ieee80211_is_mgmt(fc) || ieee80211_is_nullfunc(fc))
311 rtw_tx_mgmt_pkt_info_update(rtwdev, pkt_info, control, skb);
312 else if (ieee80211_is_data(fc))
313 rtw_tx_data_pkt_info_update(rtwdev, pkt_info, control, skb);
314
315 if (info->control.hw_key) {
316 struct ieee80211_key_conf *key = info->control.hw_key;
317
318 switch (key->cipher) {
319 case WLAN_CIPHER_SUITE_WEP40:
320 case WLAN_CIPHER_SUITE_WEP104:
321 case WLAN_CIPHER_SUITE_TKIP:
322 sec_type = 0x01;
323 break;
324 case WLAN_CIPHER_SUITE_CCMP:
325 sec_type = 0x03;
326 break;
327 default:
328 break;
329 }
330 }
331
332 bmc = is_broadcast_ether_addr(hdr->addr1) ||
333 is_multicast_ether_addr(hdr->addr1);
334
335 if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS)
336 rtw_tx_report_enable(rtwdev, pkt_info);
337
338 pkt_info->bmc = bmc;
339 pkt_info->sec_type = sec_type;
340 pkt_info->tx_pkt_size = skb->len;
341 pkt_info->offset = chip->tx_pkt_desc_sz;
342 pkt_info->qsel = skb->priority;
343 pkt_info->ls = true;
344
345 /* maybe merge with tx status ? */
346 rtw_tx_stats(rtwdev, vif, skb);
347 }
348
rtw_rsvd_page_pkt_info_update(struct rtw_dev * rtwdev,struct rtw_tx_pkt_info * pkt_info,struct sk_buff * skb)349 void rtw_rsvd_page_pkt_info_update(struct rtw_dev *rtwdev,
350 struct rtw_tx_pkt_info *pkt_info,
351 struct sk_buff *skb)
352 {
353 struct rtw_chip_info *chip = rtwdev->chip;
354 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
355 bool bmc;
356
357 bmc = is_broadcast_ether_addr(hdr->addr1) ||
358 is_multicast_ether_addr(hdr->addr1);
359 pkt_info->use_rate = true;
360 pkt_info->rate_id = 6;
361 pkt_info->dis_rate_fallback = true;
362 pkt_info->bmc = bmc;
363 pkt_info->tx_pkt_size = skb->len;
364 pkt_info->offset = chip->tx_pkt_desc_sz;
365 pkt_info->qsel = TX_DESC_QSEL_MGMT;
366 pkt_info->ls = true;
367 }
368
