1 /*
2 * hostapd / IEEE 802.11ac VHT
3 * Copyright (c) 2002-2009, Jouni Malinen <j@w1.fi>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of BSD license
7 *
8 * See README and COPYING for more details.
9 */
10
11 #include "utils/includes.h"
12
13 #include "utils/common.h"
14 #include "common/ieee802_11_defs.h"
15 #include "hostapd.h"
16 #include "ap_config.h"
17 #include "sta_info.h"
18 #include "beacon.h"
19 #include "ieee802_11.h"
20
21
hostapd_eid_vht_capabilities(struct hostapd_data * hapd,u8 * eid)22 u8 * hostapd_eid_vht_capabilities(struct hostapd_data *hapd, u8 *eid)
23 {
24 struct ieee80211_vht_capabilities *cap;
25 struct hostapd_hw_modes *mode = hapd->iface->current_mode;
26 u8 *pos = eid;
27
28 if (!mode)
29 return eid;
30
31 if (mode->mode == HOSTAPD_MODE_IEEE80211G && hapd->conf->vendor_vht &&
32 mode->vht_capab == 0 && hapd->iface->hw_features) {
33 int i;
34
35 for (i = 0; i < hapd->iface->num_hw_features; i++) {
36 if (hapd->iface->hw_features[i].mode ==
37 HOSTAPD_MODE_IEEE80211A) {
38 mode = &hapd->iface->hw_features[i];
39 break;
40 }
41 }
42 }
43
44 *pos++ = WLAN_EID_VHT_CAP;
45 *pos++ = sizeof(*cap);
46
47 cap = (struct ieee80211_vht_capabilities *) pos;
48 os_memset(cap, 0, sizeof(*cap));
49 cap->vht_capabilities_info = host_to_le32(
50 hapd->iface->conf->vht_capab);
51
52 /* Supported MCS set comes from hw */
53 os_memcpy(&cap->vht_supported_mcs_set, mode->vht_mcs_set, 8);
54
55 pos += sizeof(*cap);
56
57 return pos;
58 }
59
60
hostapd_eid_vht_operation(struct hostapd_data * hapd,u8 * eid)61 u8 * hostapd_eid_vht_operation(struct hostapd_data *hapd, u8 *eid)
62 {
63 struct ieee80211_vht_operation *oper;
64 u8 *pos = eid;
65
66 *pos++ = WLAN_EID_VHT_OPERATION;
67 *pos++ = sizeof(*oper);
68
69 oper = (struct ieee80211_vht_operation *) pos;
70 os_memset(oper, 0, sizeof(*oper));
71
72 /*
73 * center freq = 5 GHz + (5 * index)
74 * So index 42 gives center freq 5.210 GHz
75 * which is channel 42 in 5G band
76 */
77 oper->vht_op_info_chan_center_freq_seg0_idx =
78 hapd->iconf->vht_oper_centr_freq_seg0_idx;
79 oper->vht_op_info_chan_center_freq_seg1_idx =
80 hapd->iconf->vht_oper_centr_freq_seg1_idx;
81
82 oper->vht_op_info_chwidth = hapd->iconf->vht_oper_chwidth;
83
84 /* VHT Basic MCS set comes from hw */
85 /* Hard code 1 stream, MCS0-7 is a min Basic VHT MCS rates */
86 oper->vht_basic_mcs_set = host_to_le16(0xfffc);
87 pos += sizeof(*oper);
88
89 return pos;
90 }
91
92
check_valid_vht_mcs(struct hostapd_hw_modes * mode,const u8 * sta_vht_capab)93 static int check_valid_vht_mcs(struct hostapd_hw_modes *mode,
94 const u8 *sta_vht_capab)
95 {
96 const struct ieee80211_vht_capabilities *vht_cap;
97 struct ieee80211_vht_capabilities ap_vht_cap;
98 u16 sta_rx_mcs_set, ap_tx_mcs_set;
99 int i;
100
101 if (!mode)
102 return 1;
103
104 /*
105 * Disable VHT caps for STAs for which there is not even a single
106 * allowed MCS in any supported number of streams, i.e., STA is
107 * advertising 3 (not supported) as VHT MCS rates for all supported
108 * stream cases.
109 */
110 os_memcpy(&ap_vht_cap.vht_supported_mcs_set, mode->vht_mcs_set,
111 sizeof(ap_vht_cap.vht_supported_mcs_set));
112 vht_cap = (const struct ieee80211_vht_capabilities *) sta_vht_capab;
113
114 /* AP Tx MCS map vs. STA Rx MCS map */
115 sta_rx_mcs_set = le_to_host16(vht_cap->vht_supported_mcs_set.rx_map);
116 ap_tx_mcs_set = le_to_host16(ap_vht_cap.vht_supported_mcs_set.tx_map);
117
118 for (i = 0; i < VHT_RX_NSS_MAX_STREAMS; i++) {
119 if ((ap_tx_mcs_set & (0x3 << (i * 2))) == 3)
120 continue;
121
122 if ((sta_rx_mcs_set & (0x3 << (i * 2))) == 3)
123 continue;
124
125 return 1;
126 }
127
128 wpa_printf(MSG_DEBUG,
129 "No matching VHT MCS found between AP TX and STA RX");
130 return 0;
131 }
132
133
copy_sta_vht_capab(struct hostapd_data * hapd,struct sta_info * sta,const u8 * vht_capab)134 u16 copy_sta_vht_capab(struct hostapd_data *hapd, struct sta_info *sta,
135 const u8 *vht_capab)
136 {
137 /* Disable VHT caps for STAs associated to no-VHT BSSes. */
138 if (!vht_capab ||
139 hapd->conf->disable_11ac ||
140 !check_valid_vht_mcs(hapd->iface->current_mode, vht_capab)) {
141 sta->flags &= ~WLAN_STA_VHT;
142 os_free(sta->vht_capabilities);
143 sta->vht_capabilities = NULL;
144 return WLAN_STATUS_SUCCESS;
145 }
146
147 if (sta->vht_capabilities == NULL) {
148 sta->vht_capabilities =
149 os_zalloc(sizeof(struct ieee80211_vht_capabilities));
150 if (sta->vht_capabilities == NULL)
151 return WLAN_STATUS_UNSPECIFIED_FAILURE;
152 }
153
154 sta->flags |= WLAN_STA_VHT;
155 os_memcpy(sta->vht_capabilities, vht_capab,
156 sizeof(struct ieee80211_vht_capabilities));
157
158 return WLAN_STATUS_SUCCESS;
159 }
160
161
copy_sta_vendor_vht(struct hostapd_data * hapd,struct sta_info * sta,const u8 * ie,size_t len)162 u16 copy_sta_vendor_vht(struct hostapd_data *hapd, struct sta_info *sta,
163 const u8 *ie, size_t len)
164 {
165 const u8 *vht_capab;
166 unsigned int vht_capab_len;
167
168 if (!ie || len < 5 + 2 + sizeof(struct ieee80211_vht_capabilities) ||
169 hapd->conf->disable_11ac)
170 goto no_capab;
171
172 /* The VHT Capabilities element embedded in vendor VHT */
173 vht_capab = ie + 5;
174 if (vht_capab[0] != WLAN_EID_VHT_CAP)
175 goto no_capab;
176 vht_capab_len = vht_capab[1];
177 if (vht_capab_len < sizeof(struct ieee80211_vht_capabilities) ||
178 (int) vht_capab_len > ie + len - vht_capab - 2)
179 goto no_capab;
180 vht_capab += 2;
181
182 if (sta->vht_capabilities == NULL) {
183 sta->vht_capabilities =
184 os_zalloc(sizeof(struct ieee80211_vht_capabilities));
185 if (sta->vht_capabilities == NULL)
186 return WLAN_STATUS_UNSPECIFIED_FAILURE;
187 }
188
189 sta->flags |= WLAN_STA_VHT | WLAN_STA_VENDOR_VHT;
190 os_memcpy(sta->vht_capabilities, vht_capab,
191 sizeof(struct ieee80211_vht_capabilities));
192 return WLAN_STATUS_SUCCESS;
193
194 no_capab:
195 sta->flags &= ~WLAN_STA_VENDOR_VHT;
196 return WLAN_STATUS_SUCCESS;
197 }
198
199
hostapd_eid_vendor_vht(struct hostapd_data * hapd,u8 * eid)200 u8 * hostapd_eid_vendor_vht(struct hostapd_data *hapd, u8 *eid)
201 {
202 u8 *pos = eid;
203
204 if (!hapd->iface->current_mode)
205 return eid;
206
207 *pos++ = WLAN_EID_VENDOR_SPECIFIC;
208 *pos++ = (5 + /* The Vendor OUI, type and subtype */
209 2 + sizeof(struct ieee80211_vht_capabilities) +
210 2 + sizeof(struct ieee80211_vht_operation));
211
212 WPA_PUT_BE32(pos, (OUI_BROADCOM << 8) | VENDOR_VHT_TYPE);
213 pos += 4;
214 *pos++ = VENDOR_VHT_SUBTYPE;
215 pos = hostapd_eid_vht_capabilities(hapd, pos);
216 pos = hostapd_eid_vht_operation(hapd, pos);
217
218 return pos;
219 }
220
221
set_sta_vht_opmode(struct hostapd_data * hapd,struct sta_info * sta,const u8 * vht_oper_notif)222 u16 set_sta_vht_opmode(struct hostapd_data *hapd, struct sta_info *sta,
223 const u8 *vht_oper_notif)
224 {
225 if (!vht_oper_notif) {
226 sta->flags &= ~WLAN_STA_VHT_OPMODE_ENABLED;
227 return WLAN_STATUS_SUCCESS;
228 }
229
230 sta->flags |= WLAN_STA_VHT_OPMODE_ENABLED;
231 sta->vht_opmode = *vht_oper_notif;
232 return WLAN_STATUS_SUCCESS;
233 }
234
235
hostapd_get_vht_capab(struct hostapd_data * hapd,struct ieee80211_vht_capabilities * vht_cap,struct ieee80211_vht_capabilities * neg_vht_cap)236 void hostapd_get_vht_capab(struct hostapd_data *hapd,
237 struct ieee80211_vht_capabilities *vht_cap,
238 struct ieee80211_vht_capabilities *neg_vht_cap)
239 {
240 u32 cap, own_cap, sym_caps;
241
242 if (vht_cap == NULL)
243 return;
244 os_memcpy(neg_vht_cap, vht_cap, sizeof(*neg_vht_cap));
245
246 cap = le_to_host32(neg_vht_cap->vht_capabilities_info);
247 own_cap = hapd->iconf->vht_capab;
248
249 /* mask out symmetric VHT capabilities we don't support */
250 sym_caps = VHT_CAP_SHORT_GI_80 | VHT_CAP_SHORT_GI_160;
251 cap &= ~sym_caps | (own_cap & sym_caps);
252
253 /* mask out beamformer/beamformee caps if not supported */
254 if (!(own_cap & VHT_CAP_SU_BEAMFORMER_CAPABLE))
255 cap &= ~(VHT_CAP_SU_BEAMFORMEE_CAPABLE |
256 VHT_CAP_BEAMFORMEE_STS_MAX);
257
258 if (!(own_cap & VHT_CAP_SU_BEAMFORMEE_CAPABLE))
259 cap &= ~(VHT_CAP_SU_BEAMFORMER_CAPABLE |
260 VHT_CAP_SOUNDING_DIMENSION_MAX);
261
262 if (!(own_cap & VHT_CAP_MU_BEAMFORMER_CAPABLE))
263 cap &= ~VHT_CAP_MU_BEAMFORMEE_CAPABLE;
264
265 if (!(own_cap & VHT_CAP_MU_BEAMFORMEE_CAPABLE))
266 cap &= ~VHT_CAP_MU_BEAMFORMER_CAPABLE;
267
268 /* mask channel widths we don't support */
269 switch (own_cap & VHT_CAP_SUPP_CHAN_WIDTH_MASK) {
270 case VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ:
271 break;
272 case VHT_CAP_SUPP_CHAN_WIDTH_160MHZ:
273 if (cap & VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ) {
274 cap &= ~VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ;
275 cap |= VHT_CAP_SUPP_CHAN_WIDTH_160MHZ;
276 }
277 break;
278 default:
279 cap &= ~VHT_CAP_SUPP_CHAN_WIDTH_MASK;
280 break;
281 }
282
283 if (!(cap & VHT_CAP_SUPP_CHAN_WIDTH_MASK))
284 cap &= ~VHT_CAP_SHORT_GI_160;
285
286 /*
287 * if we don't support RX STBC, mask out TX STBC in the STA's HT caps
288 * if we don't support TX STBC, mask out RX STBC in the STA's HT caps
289 */
290 if (!(own_cap & VHT_CAP_RXSTBC_MASK))
291 cap &= ~VHT_CAP_TXSTBC;
292 if (!(own_cap & VHT_CAP_TXSTBC))
293 cap &= ~VHT_CAP_RXSTBC_MASK;
294
295 neg_vht_cap->vht_capabilities_info = host_to_le32(cap);
296 }
297