Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
818255ea MP |
2 | /* |
3 | * VHT handling | |
4 | * | |
23a1f8d4 | 5 | * Portions of this file |
65554d07 | 6 | * Copyright(c) 2015 - 2016 Intel Deutschland GmbH |
d0a9123e | 7 | * Copyright (C) 2018 - 2022 Intel Corporation |
818255ea MP |
8 | */ |
9 | ||
10 | #include <linux/ieee80211.h> | |
11 | #include <linux/export.h> | |
12 | #include <net/mac80211.h> | |
13 | #include "ieee80211_i.h" | |
0af83d3d | 14 | #include "rate.h" |
818255ea MP |
15 | |
16 | ||
dd5ecfea JB |
17 | static void __check_vhtcap_disable(struct ieee80211_sub_if_data *sdata, |
18 | struct ieee80211_sta_vht_cap *vht_cap, | |
19 | u32 flag) | |
20 | { | |
21 | __le32 le_flag = cpu_to_le32(flag); | |
22 | ||
23 | if (sdata->u.mgd.vht_capa_mask.vht_cap_info & le_flag && | |
24 | !(sdata->u.mgd.vht_capa.vht_cap_info & le_flag)) | |
25 | vht_cap->cap &= ~flag; | |
26 | } | |
27 | ||
28 | void ieee80211_apply_vhtcap_overrides(struct ieee80211_sub_if_data *sdata, | |
29 | struct ieee80211_sta_vht_cap *vht_cap) | |
30 | { | |
31 | int i; | |
32 | u16 rxmcs_mask, rxmcs_cap, rxmcs_n, txmcs_mask, txmcs_cap, txmcs_n; | |
33 | ||
34 | if (!vht_cap->vht_supported) | |
35 | return; | |
36 | ||
37 | if (sdata->vif.type != NL80211_IFTYPE_STATION) | |
38 | return; | |
39 | ||
40 | __check_vhtcap_disable(sdata, vht_cap, | |
41 | IEEE80211_VHT_CAP_RXLDPC); | |
42 | __check_vhtcap_disable(sdata, vht_cap, | |
43 | IEEE80211_VHT_CAP_SHORT_GI_80); | |
44 | __check_vhtcap_disable(sdata, vht_cap, | |
45 | IEEE80211_VHT_CAP_SHORT_GI_160); | |
46 | __check_vhtcap_disable(sdata, vht_cap, | |
47 | IEEE80211_VHT_CAP_TXSTBC); | |
48 | __check_vhtcap_disable(sdata, vht_cap, | |
49 | IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE); | |
50 | __check_vhtcap_disable(sdata, vht_cap, | |
51 | IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE); | |
52 | __check_vhtcap_disable(sdata, vht_cap, | |
53 | IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN); | |
54 | __check_vhtcap_disable(sdata, vht_cap, | |
55 | IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN); | |
56 | ||
57 | /* Allow user to decrease AMPDU length exponent */ | |
58 | if (sdata->u.mgd.vht_capa_mask.vht_cap_info & | |
59 | cpu_to_le32(IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK)) { | |
60 | u32 cap, n; | |
61 | ||
62 | n = le32_to_cpu(sdata->u.mgd.vht_capa.vht_cap_info) & | |
63 | IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK; | |
64 | n >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT; | |
65 | cap = vht_cap->cap & IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK; | |
66 | cap >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT; | |
67 | ||
68 | if (n < cap) { | |
69 | vht_cap->cap &= | |
70 | ~IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK; | |
71 | vht_cap->cap |= | |
72 | n << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT; | |
73 | } | |
74 | } | |
75 | ||
76 | /* Allow the user to decrease MCSes */ | |
77 | rxmcs_mask = | |
78 | le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.rx_mcs_map); | |
79 | rxmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.rx_mcs_map); | |
80 | rxmcs_n &= rxmcs_mask; | |
81 | rxmcs_cap = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map); | |
82 | ||
83 | txmcs_mask = | |
84 | le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.tx_mcs_map); | |
85 | txmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.tx_mcs_map); | |
86 | txmcs_n &= txmcs_mask; | |
87 | txmcs_cap = le16_to_cpu(vht_cap->vht_mcs.tx_mcs_map); | |
88 | for (i = 0; i < 8; i++) { | |
89 | u8 m, n, c; | |
90 | ||
91 | m = (rxmcs_mask >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
92 | n = (rxmcs_n >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
93 | c = (rxmcs_cap >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
94 | ||
95 | if (m && ((c != IEEE80211_VHT_MCS_NOT_SUPPORTED && n < c) || | |
96 | n == IEEE80211_VHT_MCS_NOT_SUPPORTED)) { | |
97 | rxmcs_cap &= ~(3 << 2*i); | |
98 | rxmcs_cap |= (rxmcs_n & (3 << 2*i)); | |
99 | } | |
100 | ||
101 | m = (txmcs_mask >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
102 | n = (txmcs_n >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
103 | c = (txmcs_cap >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
104 | ||
105 | if (m && ((c != IEEE80211_VHT_MCS_NOT_SUPPORTED && n < c) || | |
106 | n == IEEE80211_VHT_MCS_NOT_SUPPORTED)) { | |
107 | txmcs_cap &= ~(3 << 2*i); | |
108 | txmcs_cap |= (txmcs_n & (3 << 2*i)); | |
109 | } | |
110 | } | |
111 | vht_cap->vht_mcs.rx_mcs_map = cpu_to_le16(rxmcs_cap); | |
112 | vht_cap->vht_mcs.tx_mcs_map = cpu_to_le16(txmcs_cap); | |
113 | } | |
114 | ||
4a3cb702 JB |
115 | void |
116 | ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata, | |
117 | struct ieee80211_supported_band *sband, | |
118 | const struct ieee80211_vht_cap *vht_cap_ie, | |
c71420db | 119 | struct link_sta_info *link_sta) |
818255ea | 120 | { |
c71420db | 121 | struct ieee80211_sta_vht_cap *vht_cap = &link_sta->pub->vht_cap; |
55d942f4 JB |
122 | struct ieee80211_sta_vht_cap own_cap; |
123 | u32 cap_info, i; | |
52a45f38 | 124 | bool have_80mhz; |
818255ea MP |
125 | |
126 | memset(vht_cap, 0, sizeof(*vht_cap)); | |
127 | ||
c71420db | 128 | if (!link_sta->pub->ht_cap.ht_supported) |
4a34215e JB |
129 | return; |
130 | ||
818255ea MP |
131 | if (!vht_cap_ie || !sband->vht_cap.vht_supported) |
132 | return; | |
133 | ||
52a45f38 AN |
134 | /* Allow VHT if at least one channel on the sband supports 80 MHz */ |
135 | have_80mhz = false; | |
136 | for (i = 0; i < sband->n_channels; i++) { | |
137 | if (sband->channels[i].flags & (IEEE80211_CHAN_DISABLED | | |
138 | IEEE80211_CHAN_NO_80MHZ)) | |
139 | continue; | |
140 | ||
141 | have_80mhz = true; | |
142 | break; | |
143 | } | |
144 | ||
145 | if (!have_80mhz) | |
146 | return; | |
147 | ||
4a817aa7 JB |
148 | /* |
149 | * A VHT STA must support 40 MHz, but if we verify that here | |
150 | * then we break a few things - some APs (e.g. Netgear R6300v2 | |
151 | * and others based on the BCM4360 chipset) will unset this | |
152 | * capability bit when operating in 20 MHz. | |
153 | */ | |
e1a0c6b3 | 154 | |
818255ea MP |
155 | vht_cap->vht_supported = true; |
156 | ||
55d942f4 JB |
157 | own_cap = sband->vht_cap; |
158 | /* | |
159 | * If user has specified capability overrides, take care | |
160 | * of that if the station we're setting up is the AP that | |
161 | * we advertised a restricted capability set to. Override | |
162 | * our own capabilities and then use those below. | |
163 | */ | |
164 | if (sdata->vif.type == NL80211_IFTYPE_STATION && | |
c71420db | 165 | !test_sta_flag(link_sta->sta, WLAN_STA_TDLS_PEER)) |
55d942f4 JB |
166 | ieee80211_apply_vhtcap_overrides(sdata, &own_cap); |
167 | ||
168 | /* take some capabilities as-is */ | |
169 | cap_info = le32_to_cpu(vht_cap_ie->vht_cap_info); | |
170 | vht_cap->cap = cap_info; | |
3bd5c7a2 | 171 | vht_cap->cap &= IEEE80211_VHT_CAP_RXLDPC | |
55d942f4 JB |
172 | IEEE80211_VHT_CAP_VHT_TXOP_PS | |
173 | IEEE80211_VHT_CAP_HTC_VHT | | |
174 | IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK | | |
175 | IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_UNSOL_MFB | | |
176 | IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_MRQ_MFB | | |
177 | IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN | | |
178 | IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN; | |
179 | ||
3bd5c7a2 FF |
180 | vht_cap->cap |= min_t(u32, cap_info & IEEE80211_VHT_CAP_MAX_MPDU_MASK, |
181 | own_cap.cap & IEEE80211_VHT_CAP_MAX_MPDU_MASK); | |
182 | ||
55d942f4 JB |
183 | /* and some based on our own capabilities */ |
184 | switch (own_cap.cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) { | |
185 | case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ: | |
186 | vht_cap->cap |= cap_info & | |
187 | IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ; | |
188 | break; | |
189 | case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ: | |
190 | vht_cap->cap |= cap_info & | |
191 | IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; | |
192 | break; | |
193 | default: | |
194 | /* nothing */ | |
195 | break; | |
196 | } | |
197 | ||
198 | /* symmetric capabilities */ | |
199 | vht_cap->cap |= cap_info & own_cap.cap & | |
200 | (IEEE80211_VHT_CAP_SHORT_GI_80 | | |
201 | IEEE80211_VHT_CAP_SHORT_GI_160); | |
202 | ||
203 | /* remaining ones */ | |
fbdd90ea | 204 | if (own_cap.cap & IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE) |
55d942f4 JB |
205 | vht_cap->cap |= cap_info & |
206 | (IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE | | |
fbdd90ea | 207 | IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK); |
55d942f4 JB |
208 | |
209 | if (own_cap.cap & IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE) | |
210 | vht_cap->cap |= cap_info & | |
5eb7906b | 211 | (IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE | |
fbdd90ea | 212 | IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK); |
55d942f4 JB |
213 | |
214 | if (own_cap.cap & IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE) | |
215 | vht_cap->cap |= cap_info & | |
216 | IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE; | |
217 | ||
218 | if (own_cap.cap & IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE) | |
219 | vht_cap->cap |= cap_info & | |
220 | IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE; | |
221 | ||
222 | if (own_cap.cap & IEEE80211_VHT_CAP_TXSTBC) | |
223 | vht_cap->cap |= cap_info & IEEE80211_VHT_CAP_RXSTBC_MASK; | |
224 | ||
225 | if (own_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK) | |
226 | vht_cap->cap |= cap_info & IEEE80211_VHT_CAP_TXSTBC; | |
818255ea MP |
227 | |
228 | /* Copy peer MCS info, the driver might need them. */ | |
229 | memcpy(&vht_cap->vht_mcs, &vht_cap_ie->supp_mcs, | |
230 | sizeof(struct ieee80211_vht_mcs_info)); | |
e1a0c6b3 | 231 | |
e80d6425 JB |
232 | /* copy EXT_NSS_BW Support value or remove the capability */ |
233 | if (ieee80211_hw_check(&sdata->local->hw, SUPPORTS_VHT_EXT_NSS_BW)) | |
234 | vht_cap->cap |= (cap_info & IEEE80211_VHT_CAP_EXT_NSS_BW_MASK); | |
235 | else | |
236 | vht_cap->vht_mcs.tx_highest &= | |
237 | ~cpu_to_le16(IEEE80211_VHT_EXT_NSS_BW_CAPABLE); | |
238 | ||
55d942f4 JB |
239 | /* but also restrict MCSes */ |
240 | for (i = 0; i < 8; i++) { | |
241 | u16 own_rx, own_tx, peer_rx, peer_tx; | |
242 | ||
243 | own_rx = le16_to_cpu(own_cap.vht_mcs.rx_mcs_map); | |
244 | own_rx = (own_rx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
245 | ||
246 | own_tx = le16_to_cpu(own_cap.vht_mcs.tx_mcs_map); | |
247 | own_tx = (own_tx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
248 | ||
249 | peer_rx = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map); | |
250 | peer_rx = (peer_rx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
251 | ||
252 | peer_tx = le16_to_cpu(vht_cap->vht_mcs.tx_mcs_map); | |
253 | peer_tx = (peer_tx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
254 | ||
255 | if (peer_tx != IEEE80211_VHT_MCS_NOT_SUPPORTED) { | |
256 | if (own_rx == IEEE80211_VHT_MCS_NOT_SUPPORTED) | |
257 | peer_tx = IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
258 | else if (own_rx < peer_tx) | |
259 | peer_tx = own_rx; | |
260 | } | |
261 | ||
262 | if (peer_rx != IEEE80211_VHT_MCS_NOT_SUPPORTED) { | |
263 | if (own_tx == IEEE80211_VHT_MCS_NOT_SUPPORTED) | |
264 | peer_rx = IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
265 | else if (own_tx < peer_rx) | |
266 | peer_rx = own_tx; | |
267 | } | |
268 | ||
269 | vht_cap->vht_mcs.rx_mcs_map &= | |
270 | ~cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << i * 2); | |
271 | vht_cap->vht_mcs.rx_mcs_map |= cpu_to_le16(peer_rx << i * 2); | |
272 | ||
273 | vht_cap->vht_mcs.tx_mcs_map &= | |
274 | ~cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << i * 2); | |
275 | vht_cap->vht_mcs.tx_mcs_map |= cpu_to_le16(peer_tx << i * 2); | |
276 | } | |
277 | ||
c8eaf347 FM |
278 | /* |
279 | * This is a workaround for VHT-enabled STAs which break the spec | |
280 | * and have the VHT-MCS Rx map filled in with value 3 for all eight | |
281 | * spacial streams, an example is AR9462. | |
282 | * | |
283 | * As per spec, in section 22.1.1 Introduction to the VHT PHY | |
284 | * A VHT STA shall support at least single spactial stream VHT-MCSs | |
285 | * 0 to 7 (transmit and receive) in all supported channel widths. | |
286 | */ | |
287 | if (vht_cap->vht_mcs.rx_mcs_map == cpu_to_le16(0xFFFF)) { | |
288 | vht_cap->vht_supported = false; | |
c71420db JB |
289 | sdata_info(sdata, |
290 | "Ignoring VHT IE from %pM (link:%pM) due to invalid rx_mcs_map\n", | |
291 | link_sta->sta->addr, link_sta->addr); | |
c8eaf347 FM |
292 | return; |
293 | } | |
294 | ||
55d942f4 | 295 | /* finally set up the bandwidth */ |
0af83d3d JB |
296 | switch (vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) { |
297 | case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ: | |
298 | case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ: | |
c71420db | 299 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160; |
0af83d3d JB |
300 | break; |
301 | default: | |
c71420db | 302 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80; |
e80d6425 JB |
303 | |
304 | if (!(vht_cap->vht_mcs.tx_highest & | |
305 | cpu_to_le16(IEEE80211_VHT_EXT_NSS_BW_CAPABLE))) | |
306 | break; | |
307 | ||
308 | /* | |
309 | * If this is non-zero, then it does support 160 MHz after all, | |
310 | * in one form or the other. We don't distinguish here (or even | |
311 | * above) between 160 and 80+80 yet. | |
312 | */ | |
313 | if (cap_info & IEEE80211_VHT_CAP_EXT_NSS_BW_MASK) | |
c71420db | 314 | link_sta->cur_max_bandwidth = |
afe0d181 | 315 | IEEE80211_STA_RX_BW_160; |
0af83d3d JB |
316 | } |
317 | ||
c71420db | 318 | link_sta->pub->bandwidth = ieee80211_sta_cur_vht_bw(link_sta); |
506bcfa8 | 319 | |
c71420db JB |
320 | /* |
321 | * FIXME - should the amsdu len be per link? store per link | |
322 | * and maintain a minimum? | |
323 | */ | |
506bcfa8 EG |
324 | switch (vht_cap->cap & IEEE80211_VHT_CAP_MAX_MPDU_MASK) { |
325 | case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454: | |
4c51541d | 326 | link_sta->pub->agg.max_amsdu_len = IEEE80211_MAX_MPDU_LEN_VHT_11454; |
506bcfa8 EG |
327 | break; |
328 | case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991: | |
4c51541d | 329 | link_sta->pub->agg.max_amsdu_len = IEEE80211_MAX_MPDU_LEN_VHT_7991; |
506bcfa8 EG |
330 | break; |
331 | case IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895: | |
332 | default: | |
4c51541d | 333 | link_sta->pub->agg.max_amsdu_len = IEEE80211_MAX_MPDU_LEN_VHT_3895; |
506bcfa8 EG |
334 | break; |
335 | } | |
4c51541d BB |
336 | |
337 | ieee80211_sta_recalc_aggregates(&link_sta->sta->sta); | |
e1a0c6b3 JB |
338 | } |
339 | ||
a1de6407 | 340 | /* FIXME: move this to some better location - parses HE/EHT now */ |
c71420db JB |
341 | enum ieee80211_sta_rx_bandwidth |
342 | ieee80211_sta_cap_rx_bw(struct link_sta_info *link_sta) | |
e1a0c6b3 | 343 | { |
c71420db JB |
344 | unsigned int link_id = link_sta->link_id; |
345 | struct ieee80211_sub_if_data *sdata = link_sta->sta->sdata; | |
c71420db JB |
346 | struct ieee80211_sta_vht_cap *vht_cap = &link_sta->pub->vht_cap; |
347 | struct ieee80211_sta_he_cap *he_cap = &link_sta->pub->he_cap; | |
348 | struct ieee80211_sta_eht_cap *eht_cap = &link_sta->pub->eht_cap; | |
1c45c5ce | 349 | u32 cap_width; |
e1a0c6b3 | 350 | |
cf2c9cc3 | 351 | if (he_cap->has_he) { |
d8675a63 JB |
352 | struct ieee80211_bss_conf *link_conf; |
353 | enum ieee80211_sta_rx_bandwidth ret; | |
a1de6407 IP |
354 | u8 info; |
355 | ||
d8675a63 JB |
356 | rcu_read_lock(); |
357 | link_conf = rcu_dereference(sdata->vif.link_conf[link_id]); | |
358 | ||
a1de6407 | 359 | if (eht_cap->has_eht && |
b4f85443 | 360 | link_conf->chandef.chan->band == NL80211_BAND_6GHZ) { |
a1de6407 IP |
361 | info = eht_cap->eht_cap_elem.phy_cap_info[0]; |
362 | ||
d8675a63 JB |
363 | if (info & IEEE80211_EHT_PHY_CAP0_320MHZ_IN_6GHZ) { |
364 | ret = IEEE80211_STA_RX_BW_320; | |
365 | goto out; | |
366 | } | |
a1de6407 IP |
367 | } |
368 | ||
369 | info = he_cap->he_cap_elem.phy_cap_info[0]; | |
cf2c9cc3 | 370 | |
b4f85443 | 371 | if (link_conf->chandef.chan->band == NL80211_BAND_2GHZ) { |
cf2c9cc3 | 372 | if (info & IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_IN_2G) |
d8675a63 | 373 | ret = IEEE80211_STA_RX_BW_40; |
cf2c9cc3 | 374 | else |
d8675a63 JB |
375 | ret = IEEE80211_STA_RX_BW_20; |
376 | goto out; | |
cf2c9cc3 JB |
377 | } |
378 | ||
379 | if (info & IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_160MHZ_IN_5G || | |
380 | info & IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_80PLUS80_MHZ_IN_5G) | |
d8675a63 | 381 | ret = IEEE80211_STA_RX_BW_160; |
cf2c9cc3 | 382 | else if (info & IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_40MHZ_80MHZ_IN_5G) |
d8675a63 JB |
383 | ret = IEEE80211_STA_RX_BW_80; |
384 | else | |
385 | ret = IEEE80211_STA_RX_BW_20; | |
386 | out: | |
387 | rcu_read_unlock(); | |
cf2c9cc3 | 388 | |
d8675a63 | 389 | return ret; |
cf2c9cc3 JB |
390 | } |
391 | ||
1c45c5ce | 392 | if (!vht_cap->vht_supported) |
c71420db | 393 | return link_sta->pub->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ? |
1c45c5ce EP |
394 | IEEE80211_STA_RX_BW_40 : |
395 | IEEE80211_STA_RX_BW_20; | |
e1a0c6b3 | 396 | |
1c45c5ce EP |
397 | cap_width = vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; |
398 | ||
399 | if (cap_width == IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ || | |
400 | cap_width == IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) | |
401 | return IEEE80211_STA_RX_BW_160; | |
402 | ||
e5c0b0ff MG |
403 | /* |
404 | * If this is non-zero, then it does support 160 MHz after all, | |
405 | * in one form or the other. We don't distinguish here (or even | |
406 | * above) between 160 and 80+80 yet. | |
407 | */ | |
408 | if (vht_cap->cap & IEEE80211_VHT_CAP_EXT_NSS_BW_MASK) | |
409 | return IEEE80211_STA_RX_BW_160; | |
410 | ||
1c45c5ce EP |
411 | return IEEE80211_STA_RX_BW_80; |
412 | } | |
413 | ||
c71420db JB |
414 | enum nl80211_chan_width |
415 | ieee80211_sta_cap_chan_bw(struct link_sta_info *link_sta) | |
59021c67 | 416 | { |
c71420db | 417 | struct ieee80211_sta_vht_cap *vht_cap = &link_sta->pub->vht_cap; |
59021c67 AN |
418 | u32 cap_width; |
419 | ||
420 | if (!vht_cap->vht_supported) { | |
c71420db | 421 | if (!link_sta->pub->ht_cap.ht_supported) |
59021c67 AN |
422 | return NL80211_CHAN_WIDTH_20_NOHT; |
423 | ||
c71420db | 424 | return link_sta->pub->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ? |
59021c67 AN |
425 | NL80211_CHAN_WIDTH_40 : NL80211_CHAN_WIDTH_20; |
426 | } | |
427 | ||
428 | cap_width = vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; | |
429 | ||
430 | if (cap_width == IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ) | |
431 | return NL80211_CHAN_WIDTH_160; | |
432 | else if (cap_width == IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) | |
433 | return NL80211_CHAN_WIDTH_80P80; | |
434 | ||
435 | return NL80211_CHAN_WIDTH_80; | |
436 | } | |
437 | ||
97f5f425 | 438 | enum nl80211_chan_width |
c71420db | 439 | ieee80211_sta_rx_bw_to_chan_width(struct link_sta_info *link_sta) |
97f5f425 | 440 | { |
afe0d181 | 441 | enum ieee80211_sta_rx_bandwidth cur_bw = |
c71420db | 442 | link_sta->pub->bandwidth; |
afe0d181 | 443 | struct ieee80211_sta_vht_cap *vht_cap = |
c71420db | 444 | &link_sta->pub->vht_cap; |
97f5f425 | 445 | u32 cap_width; |
446 | ||
447 | switch (cur_bw) { | |
448 | case IEEE80211_STA_RX_BW_20: | |
c71420db | 449 | if (!link_sta->pub->ht_cap.ht_supported) |
97f5f425 | 450 | return NL80211_CHAN_WIDTH_20_NOHT; |
451 | else | |
452 | return NL80211_CHAN_WIDTH_20; | |
453 | case IEEE80211_STA_RX_BW_40: | |
454 | return NL80211_CHAN_WIDTH_40; | |
455 | case IEEE80211_STA_RX_BW_80: | |
456 | return NL80211_CHAN_WIDTH_80; | |
457 | case IEEE80211_STA_RX_BW_160: | |
458 | cap_width = | |
459 | vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK; | |
460 | ||
461 | if (cap_width == IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ) | |
462 | return NL80211_CHAN_WIDTH_160; | |
463 | ||
464 | return NL80211_CHAN_WIDTH_80P80; | |
465 | default: | |
466 | return NL80211_CHAN_WIDTH_20; | |
467 | } | |
468 | } | |
469 | ||
59021c67 | 470 | enum ieee80211_sta_rx_bandwidth |
1c45c5ce EP |
471 | ieee80211_chan_width_to_rx_bw(enum nl80211_chan_width width) |
472 | { | |
473 | switch (width) { | |
e1a0c6b3 JB |
474 | case NL80211_CHAN_WIDTH_20_NOHT: |
475 | case NL80211_CHAN_WIDTH_20: | |
1c45c5ce | 476 | return IEEE80211_STA_RX_BW_20; |
e1a0c6b3 | 477 | case NL80211_CHAN_WIDTH_40: |
1c45c5ce EP |
478 | return IEEE80211_STA_RX_BW_40; |
479 | case NL80211_CHAN_WIDTH_80: | |
480 | return IEEE80211_STA_RX_BW_80; | |
e1a0c6b3 | 481 | case NL80211_CHAN_WIDTH_160: |
e1a0c6b3 | 482 | case NL80211_CHAN_WIDTH_80P80: |
1c45c5ce | 483 | return IEEE80211_STA_RX_BW_160; |
5dca295d IP |
484 | case NL80211_CHAN_WIDTH_320: |
485 | return IEEE80211_STA_RX_BW_320; | |
1c45c5ce EP |
486 | default: |
487 | WARN_ON_ONCE(1); | |
488 | return IEEE80211_STA_RX_BW_20; | |
e1a0c6b3 | 489 | } |
1c45c5ce EP |
490 | } |
491 | ||
cf2c9cc3 | 492 | /* FIXME: rename/move - this deals with everything not just VHT */ |
c71420db JB |
493 | enum ieee80211_sta_rx_bandwidth |
494 | ieee80211_sta_cur_vht_bw(struct link_sta_info *link_sta) | |
1c45c5ce | 495 | { |
c71420db | 496 | struct sta_info *sta = link_sta->sta; |
d8675a63 JB |
497 | struct ieee80211_bss_conf *link_conf; |
498 | enum nl80211_chan_width bss_width; | |
1c45c5ce EP |
499 | enum ieee80211_sta_rx_bandwidth bw; |
500 | ||
d8675a63 JB |
501 | rcu_read_lock(); |
502 | link_conf = rcu_dereference(sta->sdata->vif.link_conf[link_sta->link_id]); | |
503 | if (WARN_ON(!link_conf)) | |
504 | bss_width = NL80211_CHAN_WIDTH_20_NOHT; | |
505 | else | |
506 | bss_width = link_conf->chandef.width; | |
507 | rcu_read_unlock(); | |
508 | ||
c71420db JB |
509 | bw = ieee80211_sta_cap_rx_bw(link_sta); |
510 | bw = min(bw, link_sta->cur_max_bandwidth); | |
504871e6 MP |
511 | |
512 | /* Don't consider AP's bandwidth for TDLS peers, section 11.23.1 of | |
513 | * IEEE80211-2016 specification makes higher bandwidth operation | |
514 | * possible on the TDLS link if the peers have wider bandwidth | |
515 | * capability. | |
f65607cd JB |
516 | * |
517 | * However, in this case, and only if the TDLS peer is authorized, | |
518 | * limit to the tdls_chandef so that the configuration here isn't | |
519 | * wider than what's actually requested on the channel context. | |
504871e6 MP |
520 | */ |
521 | if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) && | |
f65607cd JB |
522 | test_sta_flag(sta, WLAN_STA_TDLS_WIDER_BW) && |
523 | test_sta_flag(sta, WLAN_STA_AUTHORIZED) && | |
524 | sta->tdls_chandef.chan) | |
525 | bw = min(bw, ieee80211_chan_width_to_rx_bw(sta->tdls_chandef.width)); | |
526 | else | |
527 | bw = min(bw, ieee80211_chan_width_to_rx_bw(bss_width)); | |
b98fb44f | 528 | |
0af83d3d | 529 | return bw; |
818255ea | 530 | } |
8921d04e | 531 | |
c71420db | 532 | void ieee80211_sta_set_rx_nss(struct link_sta_info *link_sta) |
8921d04e | 533 | { |
443df9a7 | 534 | u8 ht_rx_nss = 0, vht_rx_nss = 0, he_rx_nss = 0, eht_rx_nss = 0, rx_nss; |
2d5e09d0 | 535 | bool support_160; |
8921d04e JB |
536 | |
537 | /* if we received a notification already don't overwrite it */ | |
c71420db | 538 | if (link_sta->pub->rx_nss) |
8921d04e JB |
539 | return; |
540 | ||
c71420db | 541 | if (link_sta->pub->eht_cap.has_eht) { |
443df9a7 | 542 | int i; |
c71420db | 543 | const u8 *rx_nss_mcs = (void *)&link_sta->pub->eht_cap.eht_mcs_nss_supp; |
443df9a7 MG |
544 | |
545 | /* get the max nss for EHT over all possible bandwidths and mcs */ | |
546 | for (i = 0; i < sizeof(struct ieee80211_eht_mcs_nss_supp); i++) | |
547 | eht_rx_nss = max_t(u8, eht_rx_nss, | |
548 | u8_get_bits(rx_nss_mcs[i], | |
549 | IEEE80211_EHT_MCS_NSS_RX)); | |
550 | } | |
551 | ||
c71420db | 552 | if (link_sta->pub->he_cap.has_he) { |
f46209b9 TM |
553 | int i; |
554 | u8 rx_mcs_80 = 0, rx_mcs_160 = 0; | |
c71420db | 555 | const struct ieee80211_sta_he_cap *he_cap = &link_sta->pub->he_cap; |
f46209b9 TM |
556 | u16 mcs_160_map = |
557 | le16_to_cpu(he_cap->he_mcs_nss_supp.rx_mcs_160); | |
558 | u16 mcs_80_map = le16_to_cpu(he_cap->he_mcs_nss_supp.rx_mcs_80); | |
559 | ||
560 | for (i = 7; i >= 0; i--) { | |
561 | u8 mcs_160 = (mcs_160_map >> (2 * i)) & 3; | |
562 | ||
abd5a8e5 | 563 | if (mcs_160 != IEEE80211_HE_MCS_NOT_SUPPORTED) { |
f46209b9 TM |
564 | rx_mcs_160 = i + 1; |
565 | break; | |
566 | } | |
567 | } | |
568 | for (i = 7; i >= 0; i--) { | |
569 | u8 mcs_80 = (mcs_80_map >> (2 * i)) & 3; | |
570 | ||
abd5a8e5 | 571 | if (mcs_80 != IEEE80211_HE_MCS_NOT_SUPPORTED) { |
f46209b9 TM |
572 | rx_mcs_80 = i + 1; |
573 | break; | |
574 | } | |
575 | } | |
576 | ||
2d5e09d0 WG |
577 | support_160 = he_cap->he_cap_elem.phy_cap_info[0] & |
578 | IEEE80211_HE_PHY_CAP0_CHANNEL_WIDTH_SET_160MHZ_IN_5G; | |
579 | ||
580 | if (support_160) | |
581 | he_rx_nss = min(rx_mcs_80, rx_mcs_160); | |
582 | else | |
583 | he_rx_nss = rx_mcs_80; | |
f46209b9 TM |
584 | } |
585 | ||
c71420db JB |
586 | if (link_sta->pub->ht_cap.ht_supported) { |
587 | if (link_sta->pub->ht_cap.mcs.rx_mask[0]) | |
8921d04e | 588 | ht_rx_nss++; |
c71420db | 589 | if (link_sta->pub->ht_cap.mcs.rx_mask[1]) |
8921d04e | 590 | ht_rx_nss++; |
c71420db | 591 | if (link_sta->pub->ht_cap.mcs.rx_mask[2]) |
8921d04e | 592 | ht_rx_nss++; |
c71420db | 593 | if (link_sta->pub->ht_cap.mcs.rx_mask[3]) |
8921d04e JB |
594 | ht_rx_nss++; |
595 | /* FIXME: consider rx_highest? */ | |
596 | } | |
597 | ||
c71420db | 598 | if (link_sta->pub->vht_cap.vht_supported) { |
8921d04e JB |
599 | int i; |
600 | u16 rx_mcs_map; | |
601 | ||
c71420db | 602 | rx_mcs_map = le16_to_cpu(link_sta->pub->vht_cap.vht_mcs.rx_mcs_map); |
8921d04e JB |
603 | |
604 | for (i = 7; i >= 0; i--) { | |
605 | u8 mcs = (rx_mcs_map >> (2 * i)) & 3; | |
606 | ||
607 | if (mcs != IEEE80211_VHT_MCS_NOT_SUPPORTED) { | |
608 | vht_rx_nss = i + 1; | |
609 | break; | |
610 | } | |
611 | } | |
612 | /* FIXME: consider rx_highest? */ | |
613 | } | |
614 | ||
f46209b9 TM |
615 | rx_nss = max(vht_rx_nss, ht_rx_nss); |
616 | rx_nss = max(he_rx_nss, rx_nss); | |
443df9a7 | 617 | rx_nss = max(eht_rx_nss, rx_nss); |
c71420db | 618 | link_sta->pub->rx_nss = max_t(u8, 1, rx_nss); |
8921d04e | 619 | } |
0af83d3d | 620 | |
b1bce14a | 621 | u32 __ieee80211_vht_handle_opmode(struct ieee80211_sub_if_data *sdata, |
c71420db | 622 | struct link_sta_info *link_sta, |
afe0d181 | 623 | u8 opmode, enum nl80211_band band) |
0af83d3d | 624 | { |
0af83d3d | 625 | enum ieee80211_sta_rx_bandwidth new_bw; |
ff84e7bf | 626 | struct sta_opmode_info sta_opmode = {}; |
0af83d3d | 627 | u32 changed = 0; |
57b341e9 | 628 | u8 nss, cur_nss; |
0af83d3d | 629 | |
0af83d3d JB |
630 | /* ignore - no support for BF yet */ |
631 | if (opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF) | |
b1bce14a | 632 | return 0; |
0af83d3d JB |
633 | |
634 | nss = opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK; | |
635 | nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT; | |
636 | nss += 1; | |
637 | ||
c71420db | 638 | if (link_sta->pub->rx_nss != nss) { |
57b341e9 RS |
639 | cur_nss = link_sta->pub->rx_nss; |
640 | /* Reset rx_nss and call ieee80211_sta_set_rx_nss() which | |
641 | * will set the same to max nss value calculated based on capability. | |
642 | */ | |
643 | link_sta->pub->rx_nss = 0; | |
644 | ieee80211_sta_set_rx_nss(link_sta); | |
645 | /* Do not allow an nss change to rx_nss greater than max_nss | |
646 | * negotiated and capped to APs capability during association. | |
647 | */ | |
648 | if (nss <= link_sta->pub->rx_nss) { | |
649 | link_sta->pub->rx_nss = nss; | |
650 | sta_opmode.rx_nss = nss; | |
651 | changed |= IEEE80211_RC_NSS_CHANGED; | |
652 | sta_opmode.changed |= STA_OPMODE_N_SS_CHANGED; | |
653 | } else { | |
654 | link_sta->pub->rx_nss = cur_nss; | |
655 | pr_warn_ratelimited("Ignoring NSS change in VHT Operating Mode Notification from %pM with invalid nss %d", | |
656 | link_sta->pub->addr, nss); | |
657 | } | |
0af83d3d JB |
658 | } |
659 | ||
660 | switch (opmode & IEEE80211_OPMODE_NOTIF_CHANWIDTH_MASK) { | |
661 | case IEEE80211_OPMODE_NOTIF_CHANWIDTH_20MHZ: | |
9166cc49 | 662 | /* ignore IEEE80211_OPMODE_NOTIF_BW_160_80P80 must not be set */ |
c71420db | 663 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_20; |
0af83d3d JB |
664 | break; |
665 | case IEEE80211_OPMODE_NOTIF_CHANWIDTH_40MHZ: | |
9166cc49 | 666 | /* ignore IEEE80211_OPMODE_NOTIF_BW_160_80P80 must not be set */ |
c71420db | 667 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_40; |
0af83d3d JB |
668 | break; |
669 | case IEEE80211_OPMODE_NOTIF_CHANWIDTH_80MHZ: | |
9166cc49 | 670 | if (opmode & IEEE80211_OPMODE_NOTIF_BW_160_80P80) |
c71420db | 671 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160; |
9166cc49 | 672 | else |
c71420db | 673 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80; |
0af83d3d JB |
674 | break; |
675 | case IEEE80211_OPMODE_NOTIF_CHANWIDTH_160MHZ: | |
9166cc49 | 676 | /* legacy only, no longer used by newer spec */ |
c71420db | 677 | link_sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160; |
0af83d3d JB |
678 | break; |
679 | } | |
680 | ||
c71420db JB |
681 | new_bw = ieee80211_sta_cur_vht_bw(link_sta); |
682 | if (new_bw != link_sta->pub->bandwidth) { | |
683 | link_sta->pub->bandwidth = new_bw; | |
684 | sta_opmode.bw = ieee80211_sta_rx_bw_to_chan_width(link_sta); | |
38745c74 | 685 | changed |= IEEE80211_RC_BW_CHANGED; |
ff84e7bf | 686 | sta_opmode.changed |= STA_OPMODE_MAX_BW_CHANGED; |
0af83d3d JB |
687 | } |
688 | ||
ff84e7bf | 689 | if (sta_opmode.changed) |
c71420db | 690 | cfg80211_sta_opmode_change_notify(sdata->dev, link_sta->addr, |
ff84e7bf | 691 | &sta_opmode, GFP_KERNEL); |
692 | ||
b1bce14a MK |
693 | return changed; |
694 | } | |
695 | ||
23a1f8d4 | 696 | void ieee80211_process_mu_groups(struct ieee80211_sub_if_data *sdata, |
d8675a63 | 697 | struct ieee80211_link_data *link, |
23a1f8d4 SS |
698 | struct ieee80211_mgmt *mgmt) |
699 | { | |
d8675a63 | 700 | struct ieee80211_bss_conf *link_conf = link->conf; |
23a1f8d4 | 701 | |
afe0d181 | 702 | if (!link_conf->mu_mimo_owner) |
23a1f8d4 SS |
703 | return; |
704 | ||
705 | if (!memcmp(mgmt->u.action.u.vht_group_notif.position, | |
afe0d181 | 706 | link_conf->mu_group.position, WLAN_USER_POSITION_LEN) && |
23a1f8d4 | 707 | !memcmp(mgmt->u.action.u.vht_group_notif.membership, |
afe0d181 | 708 | link_conf->mu_group.membership, WLAN_MEMBERSHIP_LEN)) |
23a1f8d4 SS |
709 | return; |
710 | ||
afe0d181 | 711 | memcpy(link_conf->mu_group.membership, |
0241fa19 SS |
712 | mgmt->u.action.u.vht_group_notif.membership, |
713 | WLAN_MEMBERSHIP_LEN); | |
afe0d181 | 714 | memcpy(link_conf->mu_group.position, |
0241fa19 SS |
715 | mgmt->u.action.u.vht_group_notif.position, |
716 | WLAN_USER_POSITION_LEN); | |
23a1f8d4 | 717 | |
d8675a63 JB |
718 | ieee80211_link_info_change_notify(sdata, link, |
719 | BSS_CHANGED_MU_GROUPS); | |
23a1f8d4 SS |
720 | } |
721 | ||
afe0d181 | 722 | void ieee80211_update_mu_groups(struct ieee80211_vif *vif, unsigned int link_id, |
65554d07 SS |
723 | const u8 *membership, const u8 *position) |
724 | { | |
d8675a63 | 725 | struct ieee80211_bss_conf *link_conf; |
65554d07 | 726 | |
d8675a63 JB |
727 | rcu_read_lock(); |
728 | link_conf = rcu_dereference(vif->link_conf[link_id]); | |
65554d07 | 729 | |
d8675a63 JB |
730 | if (!WARN_ON_ONCE(!link_conf || !link_conf->mu_mimo_owner)) { |
731 | memcpy(link_conf->mu_group.membership, membership, | |
732 | WLAN_MEMBERSHIP_LEN); | |
733 | memcpy(link_conf->mu_group.position, position, | |
734 | WLAN_USER_POSITION_LEN); | |
735 | } | |
736 | rcu_read_unlock(); | |
65554d07 SS |
737 | } |
738 | EXPORT_SYMBOL_GPL(ieee80211_update_mu_groups); | |
739 | ||
b1bce14a | 740 | void ieee80211_vht_handle_opmode(struct ieee80211_sub_if_data *sdata, |
c71420db | 741 | struct link_sta_info *link_sta, |
afe0d181 | 742 | u8 opmode, enum nl80211_band band) |
b1bce14a MK |
743 | { |
744 | struct ieee80211_local *local = sdata->local; | |
745 | struct ieee80211_supported_band *sband = local->hw.wiphy->bands[band]; | |
746 | ||
c71420db | 747 | u32 changed = __ieee80211_vht_handle_opmode(sdata, link_sta, |
afe0d181 | 748 | opmode, band); |
b1bce14a | 749 | |
d2941df8 | 750 | if (changed > 0) { |
0cbf348a | 751 | ieee80211_recalc_min_chandef(sdata, link_sta->link_id); |
c71420db JB |
752 | rate_control_rate_update(local, sband, link_sta->sta, |
753 | link_sta->link_id, changed); | |
d2941df8 | 754 | } |
0af83d3d | 755 | } |
b119ad6e LB |
756 | |
757 | void ieee80211_get_vht_mask_from_cap(__le16 vht_cap, | |
758 | u16 vht_mask[NL80211_VHT_NSS_MAX]) | |
759 | { | |
760 | int i; | |
761 | u16 mask, cap = le16_to_cpu(vht_cap); | |
762 | ||
763 | for (i = 0; i < NL80211_VHT_NSS_MAX; i++) { | |
764 | mask = (cap >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED; | |
765 | switch (mask) { | |
766 | case IEEE80211_VHT_MCS_SUPPORT_0_7: | |
767 | vht_mask[i] = 0x00FF; | |
768 | break; | |
769 | case IEEE80211_VHT_MCS_SUPPORT_0_8: | |
770 | vht_mask[i] = 0x01FF; | |
771 | break; | |
772 | case IEEE80211_VHT_MCS_SUPPORT_0_9: | |
773 | vht_mask[i] = 0x03FF; | |
774 | break; | |
775 | case IEEE80211_VHT_MCS_NOT_SUPPORTED: | |
776 | default: | |
777 | vht_mask[i] = 0; | |
778 | break; | |
779 | } | |
780 | } | |
781 | } |