blob: d75f35c6e1a0884eb9452030cb27bcafb33deeab [file] [log] [blame]
Mahesh Palivela818255e2012-10-10 11:33:04 +00001/*
2 * VHT handling
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
7 */
8
9#include <linux/ieee80211.h>
10#include <linux/export.h>
11#include <net/mac80211.h>
12#include "ieee80211_i.h"
Johannes Berg0af83d32012-12-27 18:55:36 +010013#include "rate.h"
Mahesh Palivela818255e2012-10-10 11:33:04 +000014
15
Johannes Bergdd5ecfe2013-02-21 17:40:19 +010016static void __check_vhtcap_disable(struct ieee80211_sub_if_data *sdata,
17 struct ieee80211_sta_vht_cap *vht_cap,
18 u32 flag)
19{
20 __le32 le_flag = cpu_to_le32(flag);
21
22 if (sdata->u.mgd.vht_capa_mask.vht_cap_info & le_flag &&
23 !(sdata->u.mgd.vht_capa.vht_cap_info & le_flag))
24 vht_cap->cap &= ~flag;
25}
26
27void ieee80211_apply_vhtcap_overrides(struct ieee80211_sub_if_data *sdata,
28 struct ieee80211_sta_vht_cap *vht_cap)
29{
30 int i;
31 u16 rxmcs_mask, rxmcs_cap, rxmcs_n, txmcs_mask, txmcs_cap, txmcs_n;
32
33 if (!vht_cap->vht_supported)
34 return;
35
36 if (sdata->vif.type != NL80211_IFTYPE_STATION)
37 return;
38
39 __check_vhtcap_disable(sdata, vht_cap,
40 IEEE80211_VHT_CAP_RXLDPC);
41 __check_vhtcap_disable(sdata, vht_cap,
42 IEEE80211_VHT_CAP_SHORT_GI_80);
43 __check_vhtcap_disable(sdata, vht_cap,
44 IEEE80211_VHT_CAP_SHORT_GI_160);
45 __check_vhtcap_disable(sdata, vht_cap,
46 IEEE80211_VHT_CAP_TXSTBC);
47 __check_vhtcap_disable(sdata, vht_cap,
48 IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE);
49 __check_vhtcap_disable(sdata, vht_cap,
50 IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE);
51 __check_vhtcap_disable(sdata, vht_cap,
52 IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN);
53 __check_vhtcap_disable(sdata, vht_cap,
54 IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN);
55
56 /* Allow user to decrease AMPDU length exponent */
57 if (sdata->u.mgd.vht_capa_mask.vht_cap_info &
58 cpu_to_le32(IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK)) {
59 u32 cap, n;
60
61 n = le32_to_cpu(sdata->u.mgd.vht_capa.vht_cap_info) &
62 IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;
63 n >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
64 cap = vht_cap->cap & IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;
65 cap >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
66
67 if (n < cap) {
68 vht_cap->cap &=
69 ~IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;
70 vht_cap->cap |=
71 n << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;
72 }
73 }
74
75 /* Allow the user to decrease MCSes */
76 rxmcs_mask =
77 le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.rx_mcs_map);
78 rxmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.rx_mcs_map);
79 rxmcs_n &= rxmcs_mask;
80 rxmcs_cap = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map);
81
82 txmcs_mask =
83 le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.tx_mcs_map);
84 txmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.tx_mcs_map);
85 txmcs_n &= txmcs_mask;
86 txmcs_cap = le16_to_cpu(vht_cap->vht_mcs.tx_mcs_map);
87 for (i = 0; i < 8; i++) {
88 u8 m, n, c;
89
90 m = (rxmcs_mask >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
91 n = (rxmcs_n >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
92 c = (rxmcs_cap >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
93
94 if (m && ((c != IEEE80211_VHT_MCS_NOT_SUPPORTED && n < c) ||
95 n == IEEE80211_VHT_MCS_NOT_SUPPORTED)) {
96 rxmcs_cap &= ~(3 << 2*i);
97 rxmcs_cap |= (rxmcs_n & (3 << 2*i));
98 }
99
100 m = (txmcs_mask >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
101 n = (txmcs_n >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
102 c = (txmcs_cap >> 2*i) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
103
104 if (m && ((c != IEEE80211_VHT_MCS_NOT_SUPPORTED && n < c) ||
105 n == IEEE80211_VHT_MCS_NOT_SUPPORTED)) {
106 txmcs_cap &= ~(3 << 2*i);
107 txmcs_cap |= (txmcs_n & (3 << 2*i));
108 }
109 }
110 vht_cap->vht_mcs.rx_mcs_map = cpu_to_le16(rxmcs_cap);
111 vht_cap->vht_mcs.tx_mcs_map = cpu_to_le16(txmcs_cap);
112}
113
Johannes Berg4a3cb702013-02-12 16:43:19 +0100114void
115ieee80211_vht_cap_ie_to_sta_vht_cap(struct ieee80211_sub_if_data *sdata,
116 struct ieee80211_supported_band *sband,
117 const struct ieee80211_vht_cap *vht_cap_ie,
118 struct sta_info *sta)
Mahesh Palivela818255e2012-10-10 11:33:04 +0000119{
Johannes Berg4a342152013-02-07 11:58:58 +0100120 struct ieee80211_sta_vht_cap *vht_cap = &sta->sta.vht_cap;
Johannes Berg55d942f2013-03-01 13:07:48 +0100121 struct ieee80211_sta_vht_cap own_cap;
122 u32 cap_info, i;
Mahesh Palivela818255e2012-10-10 11:33:04 +0000123
124 memset(vht_cap, 0, sizeof(*vht_cap));
125
Johannes Berg4a342152013-02-07 11:58:58 +0100126 if (!sta->sta.ht_cap.ht_supported)
127 return;
128
Mahesh Palivela818255e2012-10-10 11:33:04 +0000129 if (!vht_cap_ie || !sband->vht_cap.vht_supported)
130 return;
131
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100132 /* A VHT STA must support 40 MHz */
133 if (!(sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40))
134 return;
135
Mahesh Palivela818255e2012-10-10 11:33:04 +0000136 vht_cap->vht_supported = true;
137
Johannes Berg55d942f2013-03-01 13:07:48 +0100138 own_cap = sband->vht_cap;
139 /*
140 * If user has specified capability overrides, take care
141 * of that if the station we're setting up is the AP that
142 * we advertised a restricted capability set to. Override
143 * our own capabilities and then use those below.
144 */
145 if (sdata->vif.type == NL80211_IFTYPE_STATION &&
146 !test_sta_flag(sta, WLAN_STA_TDLS_PEER))
147 ieee80211_apply_vhtcap_overrides(sdata, &own_cap);
148
149 /* take some capabilities as-is */
150 cap_info = le32_to_cpu(vht_cap_ie->vht_cap_info);
151 vht_cap->cap = cap_info;
152 vht_cap->cap &= IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_3895 |
153 IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_7991 |
154 IEEE80211_VHT_CAP_MAX_MPDU_LENGTH_11454 |
155 IEEE80211_VHT_CAP_RXLDPC |
156 IEEE80211_VHT_CAP_VHT_TXOP_PS |
157 IEEE80211_VHT_CAP_HTC_VHT |
158 IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK |
159 IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_UNSOL_MFB |
160 IEEE80211_VHT_CAP_VHT_LINK_ADAPTATION_VHT_MRQ_MFB |
161 IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN |
162 IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN;
163
164 /* and some based on our own capabilities */
165 switch (own_cap.cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
166 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
167 vht_cap->cap |= cap_info &
168 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ;
169 break;
170 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
171 vht_cap->cap |= cap_info &
172 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK;
173 break;
174 default:
175 /* nothing */
176 break;
177 }
178
179 /* symmetric capabilities */
180 vht_cap->cap |= cap_info & own_cap.cap &
181 (IEEE80211_VHT_CAP_SHORT_GI_80 |
182 IEEE80211_VHT_CAP_SHORT_GI_160);
183
184 /* remaining ones */
Eyal Shapirafbdd90e2013-11-11 20:14:00 +0200185 if (own_cap.cap & IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE)
Johannes Berg55d942f2013-03-01 13:07:48 +0100186 vht_cap->cap |= cap_info &
187 (IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE |
Eyal Shapirafbdd90e2013-11-11 20:14:00 +0200188 IEEE80211_VHT_CAP_SOUNDING_DIMENSIONS_MASK);
Johannes Berg55d942f2013-03-01 13:07:48 +0100189
190 if (own_cap.cap & IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE)
191 vht_cap->cap |= cap_info &
Eliad Peller5eb79062013-08-29 15:03:14 +0300192 (IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE |
Eyal Shapirafbdd90e2013-11-11 20:14:00 +0200193 IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK);
Johannes Berg55d942f2013-03-01 13:07:48 +0100194
195 if (own_cap.cap & IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE)
196 vht_cap->cap |= cap_info &
197 IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE;
198
199 if (own_cap.cap & IEEE80211_VHT_CAP_MU_BEAMFORMEE_CAPABLE)
200 vht_cap->cap |= cap_info &
201 IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE;
202
203 if (own_cap.cap & IEEE80211_VHT_CAP_TXSTBC)
204 vht_cap->cap |= cap_info & IEEE80211_VHT_CAP_RXSTBC_MASK;
205
206 if (own_cap.cap & IEEE80211_VHT_CAP_RXSTBC_MASK)
207 vht_cap->cap |= cap_info & IEEE80211_VHT_CAP_TXSTBC;
Mahesh Palivela818255e2012-10-10 11:33:04 +0000208
209 /* Copy peer MCS info, the driver might need them. */
210 memcpy(&vht_cap->vht_mcs, &vht_cap_ie->supp_mcs,
211 sizeof(struct ieee80211_vht_mcs_info));
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100212
Johannes Berg55d942f2013-03-01 13:07:48 +0100213 /* but also restrict MCSes */
214 for (i = 0; i < 8; i++) {
215 u16 own_rx, own_tx, peer_rx, peer_tx;
216
217 own_rx = le16_to_cpu(own_cap.vht_mcs.rx_mcs_map);
218 own_rx = (own_rx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
219
220 own_tx = le16_to_cpu(own_cap.vht_mcs.tx_mcs_map);
221 own_tx = (own_tx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
222
223 peer_rx = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map);
224 peer_rx = (peer_rx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
225
226 peer_tx = le16_to_cpu(vht_cap->vht_mcs.tx_mcs_map);
227 peer_tx = (peer_tx >> i * 2) & IEEE80211_VHT_MCS_NOT_SUPPORTED;
228
229 if (peer_tx != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
230 if (own_rx == IEEE80211_VHT_MCS_NOT_SUPPORTED)
231 peer_tx = IEEE80211_VHT_MCS_NOT_SUPPORTED;
232 else if (own_rx < peer_tx)
233 peer_tx = own_rx;
234 }
235
236 if (peer_rx != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
237 if (own_tx == IEEE80211_VHT_MCS_NOT_SUPPORTED)
238 peer_rx = IEEE80211_VHT_MCS_NOT_SUPPORTED;
239 else if (own_tx < peer_rx)
240 peer_rx = own_tx;
241 }
242
243 vht_cap->vht_mcs.rx_mcs_map &=
244 ~cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << i * 2);
245 vht_cap->vht_mcs.rx_mcs_map |= cpu_to_le16(peer_rx << i * 2);
246
247 vht_cap->vht_mcs.tx_mcs_map &=
248 ~cpu_to_le16(IEEE80211_VHT_MCS_NOT_SUPPORTED << i * 2);
249 vht_cap->vht_mcs.tx_mcs_map |= cpu_to_le16(peer_tx << i * 2);
250 }
251
252 /* finally set up the bandwidth */
Johannes Berg0af83d32012-12-27 18:55:36 +0100253 switch (vht_cap->cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
254 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
255 case IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
256 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
257 break;
258 default:
259 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
260 }
261
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100262 sta->sta.bandwidth = ieee80211_sta_cur_vht_bw(sta);
263}
264
265enum ieee80211_sta_rx_bandwidth ieee80211_sta_cur_vht_bw(struct sta_info *sta)
266{
267 struct ieee80211_sub_if_data *sdata = sta->sdata;
268 u32 cap = sta->sta.vht_cap.cap;
Johannes Berg0af83d32012-12-27 18:55:36 +0100269 enum ieee80211_sta_rx_bandwidth bw;
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100270
Johannes Berg0af83d32012-12-27 18:55:36 +0100271 if (!sta->sta.vht_cap.vht_supported) {
272 bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100273 IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
Johannes Berg0af83d32012-12-27 18:55:36 +0100274 goto check_max;
275 }
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100276
277 switch (sdata->vif.bss_conf.chandef.width) {
278 default:
279 WARN_ON_ONCE(1);
280 /* fall through */
281 case NL80211_CHAN_WIDTH_20_NOHT:
282 case NL80211_CHAN_WIDTH_20:
283 case NL80211_CHAN_WIDTH_40:
Johannes Berg0af83d32012-12-27 18:55:36 +0100284 bw = sta->sta.ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 ?
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100285 IEEE80211_STA_RX_BW_40 : IEEE80211_STA_RX_BW_20;
Johannes Berg0af83d32012-12-27 18:55:36 +0100286 break;
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100287 case NL80211_CHAN_WIDTH_160:
Johannes Berg0af83d32012-12-27 18:55:36 +0100288 if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
289 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ) {
290 bw = IEEE80211_STA_RX_BW_160;
291 break;
292 }
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100293 /* fall through */
294 case NL80211_CHAN_WIDTH_80P80:
Johannes Berg0af83d32012-12-27 18:55:36 +0100295 if ((cap & IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_MASK) ==
296 IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) {
297 bw = IEEE80211_STA_RX_BW_160;
298 break;
299 }
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100300 /* fall through */
301 case NL80211_CHAN_WIDTH_80:
Johannes Berg0af83d32012-12-27 18:55:36 +0100302 bw = IEEE80211_STA_RX_BW_80;
Johannes Berge1a0c6b2013-02-07 11:47:44 +0100303 }
Johannes Berg0af83d32012-12-27 18:55:36 +0100304
305 check_max:
306 if (bw > sta->cur_max_bandwidth)
307 bw = sta->cur_max_bandwidth;
308 return bw;
Mahesh Palivela818255e2012-10-10 11:33:04 +0000309}
Johannes Berg8921d042012-12-27 18:26:42 +0100310
311void ieee80211_sta_set_rx_nss(struct sta_info *sta)
312{
313 u8 ht_rx_nss = 0, vht_rx_nss = 0;
314
315 /* if we received a notification already don't overwrite it */
316 if (sta->sta.rx_nss)
317 return;
318
319 if (sta->sta.ht_cap.ht_supported) {
320 if (sta->sta.ht_cap.mcs.rx_mask[0])
321 ht_rx_nss++;
322 if (sta->sta.ht_cap.mcs.rx_mask[1])
323 ht_rx_nss++;
324 if (sta->sta.ht_cap.mcs.rx_mask[2])
325 ht_rx_nss++;
326 if (sta->sta.ht_cap.mcs.rx_mask[3])
327 ht_rx_nss++;
328 /* FIXME: consider rx_highest? */
329 }
330
331 if (sta->sta.vht_cap.vht_supported) {
332 int i;
333 u16 rx_mcs_map;
334
335 rx_mcs_map = le16_to_cpu(sta->sta.vht_cap.vht_mcs.rx_mcs_map);
336
337 for (i = 7; i >= 0; i--) {
338 u8 mcs = (rx_mcs_map >> (2 * i)) & 3;
339
340 if (mcs != IEEE80211_VHT_MCS_NOT_SUPPORTED) {
341 vht_rx_nss = i + 1;
342 break;
343 }
344 }
345 /* FIXME: consider rx_highest? */
346 }
347
348 ht_rx_nss = max(ht_rx_nss, vht_rx_nss);
349 sta->sta.rx_nss = max_t(u8, 1, ht_rx_nss);
350}
Johannes Berg0af83d32012-12-27 18:55:36 +0100351
352void ieee80211_vht_handle_opmode(struct ieee80211_sub_if_data *sdata,
353 struct sta_info *sta, u8 opmode,
Johannes Bergbee7f582013-02-07 22:24:55 +0100354 enum ieee80211_band band, bool nss_only)
Johannes Berg0af83d32012-12-27 18:55:36 +0100355{
356 struct ieee80211_local *local = sdata->local;
357 struct ieee80211_supported_band *sband;
358 enum ieee80211_sta_rx_bandwidth new_bw;
359 u32 changed = 0;
360 u8 nss;
361
362 sband = local->hw.wiphy->bands[band];
363
364 /* ignore - no support for BF yet */
365 if (opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF)
366 return;
367
368 nss = opmode & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK;
369 nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT;
370 nss += 1;
371
372 if (sta->sta.rx_nss != nss) {
373 sta->sta.rx_nss = nss;
374 changed |= IEEE80211_RC_NSS_CHANGED;
375 }
376
Johannes Bergbee7f582013-02-07 22:24:55 +0100377 if (nss_only)
378 goto change;
379
Johannes Berg0af83d32012-12-27 18:55:36 +0100380 switch (opmode & IEEE80211_OPMODE_NOTIF_CHANWIDTH_MASK) {
381 case IEEE80211_OPMODE_NOTIF_CHANWIDTH_20MHZ:
382 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_20;
383 break;
384 case IEEE80211_OPMODE_NOTIF_CHANWIDTH_40MHZ:
385 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_40;
386 break;
387 case IEEE80211_OPMODE_NOTIF_CHANWIDTH_80MHZ:
388 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_80;
389 break;
390 case IEEE80211_OPMODE_NOTIF_CHANWIDTH_160MHZ:
391 sta->cur_max_bandwidth = IEEE80211_STA_RX_BW_160;
392 break;
393 }
394
395 new_bw = ieee80211_sta_cur_vht_bw(sta);
396 if (new_bw != sta->sta.bandwidth) {
397 sta->sta.bandwidth = new_bw;
Ilan Peer38745c72013-06-10 10:34:14 +0300398 changed |= IEEE80211_RC_BW_CHANGED;
Johannes Berg0af83d32012-12-27 18:55:36 +0100399 }
400
Johannes Bergbee7f582013-02-07 22:24:55 +0100401 change:
Johannes Berg0af83d32012-12-27 18:55:36 +0100402 if (changed)
403 rate_control_rate_update(local, sband, sta, changed);
404}