]>
Commit | Line | Data |
---|---|---|
6fc6879b JM |
1 | /* |
2 | * hostapd / IEEE 802.11 Management: Beacon and Probe Request/Response | |
3 | * Copyright (c) 2002-2004, Instant802 Networks, Inc. | |
4 | * Copyright (c) 2005-2006, Devicescape Software, Inc. | |
0a66ce3c | 5 | * Copyright (c) 2008-2012, Jouni Malinen <j@w1.fi> |
6fc6879b JM |
6 | * |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * Alternatively, this software may be distributed under the terms of BSD | |
12 | * license. | |
13 | * | |
14 | * See README and COPYING for more details. | |
15 | */ | |
16 | ||
6226e38d | 17 | #include "utils/includes.h" |
6fc6879b JM |
18 | |
19 | #ifndef CONFIG_NATIVE_WINDOWS | |
20 | ||
6226e38d | 21 | #include "utils/common.h" |
81f4f619 JM |
22 | #include "common/ieee802_11_defs.h" |
23 | #include "common/ieee802_11_common.h" | |
6226e38d | 24 | #include "drivers/driver.h" |
e44f8bf2 JM |
25 | #include "wps/wps_defs.h" |
26 | #include "p2p/p2p.h" | |
6fc6879b JM |
27 | #include "hostapd.h" |
28 | #include "ieee802_11.h" | |
6226e38d | 29 | #include "wpa_auth.h" |
1057d78e | 30 | #include "wmm.h" |
6226e38d | 31 | #include "ap_config.h" |
6fc6879b | 32 | #include "sta_info.h" |
dce044cc | 33 | #include "p2p_hostapd.h" |
cee7d66b | 34 | #include "ap_drv_ops.h" |
6226e38d | 35 | #include "beacon.h" |
19a8ad99 | 36 | #include "hs20.h" |
6fc6879b JM |
37 | |
38 | ||
062390ef JM |
39 | #ifdef NEED_AP_MLME |
40 | ||
6fc6879b JM |
41 | static u8 ieee802_11_erp_info(struct hostapd_data *hapd) |
42 | { | |
43 | u8 erp = 0; | |
44 | ||
45 | if (hapd->iface->current_mode == NULL || | |
46 | hapd->iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G) | |
47 | return 0; | |
48 | ||
735f6522 JM |
49 | if (hapd->iface->olbc) |
50 | erp |= ERP_INFO_USE_PROTECTION; | |
51 | if (hapd->iface->num_sta_non_erp > 0) { | |
52 | erp |= ERP_INFO_NON_ERP_PRESENT | | |
53 | ERP_INFO_USE_PROTECTION; | |
6fc6879b | 54 | } |
a0fad210 JM |
55 | if (hapd->iface->num_sta_no_short_preamble > 0 || |
56 | hapd->iconf->preamble == LONG_PREAMBLE) | |
6fc6879b JM |
57 | erp |= ERP_INFO_BARKER_PREAMBLE_MODE; |
58 | ||
59 | return erp; | |
60 | } | |
61 | ||
62 | ||
63 | static u8 * hostapd_eid_ds_params(struct hostapd_data *hapd, u8 *eid) | |
64 | { | |
65 | *eid++ = WLAN_EID_DS_PARAMS; | |
66 | *eid++ = 1; | |
67 | *eid++ = hapd->iconf->channel; | |
68 | return eid; | |
69 | } | |
70 | ||
71 | ||
72 | static u8 * hostapd_eid_erp_info(struct hostapd_data *hapd, u8 *eid) | |
73 | { | |
74 | if (hapd->iface->current_mode == NULL || | |
75 | hapd->iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G) | |
76 | return eid; | |
77 | ||
78 | /* Set NonERP_present and use_protection bits if there | |
79 | * are any associated NonERP stations. */ | |
80 | /* TODO: use_protection bit can be set to zero even if | |
81 | * there are NonERP stations present. This optimization | |
82 | * might be useful if NonERP stations are "quiet". | |
83 | * See 802.11g/D6 E-1 for recommended practice. | |
84 | * In addition, Non ERP present might be set, if AP detects Non ERP | |
85 | * operation on other APs. */ | |
86 | ||
87 | /* Add ERP Information element */ | |
88 | *eid++ = WLAN_EID_ERP_INFO; | |
89 | *eid++ = 1; | |
90 | *eid++ = ieee802_11_erp_info(hapd); | |
91 | ||
92 | return eid; | |
93 | } | |
94 | ||
95 | ||
df73d284 JM |
96 | static u8 * hostapd_eid_country_add(u8 *pos, u8 *end, int chan_spacing, |
97 | struct hostapd_channel_data *start, | |
98 | struct hostapd_channel_data *prev) | |
99 | { | |
100 | if (end - pos < 3) | |
101 | return pos; | |
102 | ||
103 | /* first channel number */ | |
104 | *pos++ = start->chan; | |
105 | /* number of channels */ | |
106 | *pos++ = (prev->chan - start->chan) / chan_spacing + 1; | |
107 | /* maximum transmit power level */ | |
108 | *pos++ = start->max_tx_power; | |
109 | ||
110 | return pos; | |
111 | } | |
112 | ||
113 | ||
6fc6879b JM |
114 | static u8 * hostapd_eid_country(struct hostapd_data *hapd, u8 *eid, |
115 | int max_len) | |
116 | { | |
117 | u8 *pos = eid; | |
df73d284 JM |
118 | u8 *end = eid + max_len; |
119 | int i; | |
120 | struct hostapd_hw_modes *mode; | |
121 | struct hostapd_channel_data *start, *prev; | |
122 | int chan_spacing = 1; | |
123 | ||
124 | if (!hapd->iconf->ieee80211d || max_len < 6 || | |
125 | hapd->iface->current_mode == NULL) | |
6fc6879b JM |
126 | return eid; |
127 | ||
128 | *pos++ = WLAN_EID_COUNTRY; | |
129 | pos++; /* length will be set later */ | |
130 | os_memcpy(pos, hapd->iconf->country, 3); /* e.g., 'US ' */ | |
131 | pos += 3; | |
132 | ||
df73d284 JM |
133 | mode = hapd->iface->current_mode; |
134 | if (mode->mode == HOSTAPD_MODE_IEEE80211A) | |
135 | chan_spacing = 4; | |
136 | ||
137 | start = prev = NULL; | |
138 | for (i = 0; i < mode->num_channels; i++) { | |
139 | struct hostapd_channel_data *chan = &mode->channels[i]; | |
140 | if (chan->flag & HOSTAPD_CHAN_DISABLED) | |
141 | continue; | |
142 | if (start && prev && | |
143 | prev->chan + chan_spacing == chan->chan && | |
144 | start->max_tx_power == chan->max_tx_power) { | |
145 | prev = chan; | |
146 | continue; /* can use same entry */ | |
147 | } | |
148 | ||
149 | if (start) { | |
150 | pos = hostapd_eid_country_add(pos, end, chan_spacing, | |
151 | start, prev); | |
152 | start = NULL; | |
153 | } | |
154 | ||
155 | /* Start new group */ | |
156 | start = prev = chan; | |
157 | } | |
158 | ||
159 | if (start) { | |
160 | pos = hostapd_eid_country_add(pos, end, chan_spacing, | |
161 | start, prev); | |
162 | } | |
163 | ||
164 | if ((pos - eid) & 1) { | |
165 | if (end - pos < 1) | |
166 | return eid; | |
6fc6879b | 167 | *pos++ = 0; /* pad for 16-bit alignment */ |
df73d284 | 168 | } |
6fc6879b JM |
169 | |
170 | eid[1] = (pos - eid) - 2; | |
171 | ||
172 | return pos; | |
173 | } | |
174 | ||
175 | ||
6c0575c3 | 176 | static u8 * hostapd_eid_wpa(struct hostapd_data *hapd, u8 *eid, size_t len) |
6fc6879b JM |
177 | { |
178 | const u8 *ie; | |
179 | size_t ielen; | |
180 | ||
181 | ie = wpa_auth_get_wpa_ie(hapd->wpa_auth, &ielen); | |
182 | if (ie == NULL || ielen > len) | |
183 | return eid; | |
184 | ||
185 | os_memcpy(eid, ie, ielen); | |
186 | return eid + ielen; | |
187 | } | |
188 | ||
189 | ||
eacc6b24 AN |
190 | static u8 * hostapd_gen_probe_resp(struct hostapd_data *hapd, |
191 | struct sta_info *sta, | |
192 | const struct ieee80211_mgmt *req, | |
193 | int is_p2p, size_t *resp_len) | |
194 | { | |
195 | struct ieee80211_mgmt *resp; | |
196 | u8 *pos, *epos; | |
197 | size_t buflen; | |
198 | ||
199 | #define MAX_PROBERESP_LEN 768 | |
200 | buflen = MAX_PROBERESP_LEN; | |
201 | #ifdef CONFIG_WPS | |
202 | if (hapd->wps_probe_resp_ie) | |
203 | buflen += wpabuf_len(hapd->wps_probe_resp_ie); | |
204 | #endif /* CONFIG_WPS */ | |
205 | #ifdef CONFIG_P2P | |
206 | if (hapd->p2p_probe_resp_ie) | |
207 | buflen += wpabuf_len(hapd->p2p_probe_resp_ie); | |
208 | #endif /* CONFIG_P2P */ | |
b52f084c JM |
209 | if (hapd->conf->vendor_elements) |
210 | buflen += wpabuf_len(hapd->conf->vendor_elements); | |
eacc6b24 AN |
211 | resp = os_zalloc(buflen); |
212 | if (resp == NULL) | |
213 | return NULL; | |
214 | ||
215 | epos = ((u8 *) resp) + MAX_PROBERESP_LEN; | |
216 | ||
217 | resp->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, | |
218 | WLAN_FC_STYPE_PROBE_RESP); | |
219 | if (req) | |
220 | os_memcpy(resp->da, req->sa, ETH_ALEN); | |
221 | os_memcpy(resp->sa, hapd->own_addr, ETH_ALEN); | |
222 | ||
223 | os_memcpy(resp->bssid, hapd->own_addr, ETH_ALEN); | |
224 | resp->u.probe_resp.beacon_int = | |
225 | host_to_le16(hapd->iconf->beacon_int); | |
226 | ||
227 | /* hardware or low-level driver will setup seq_ctrl and timestamp */ | |
228 | resp->u.probe_resp.capab_info = | |
229 | host_to_le16(hostapd_own_capab_info(hapd, sta, 1)); | |
230 | ||
231 | pos = resp->u.probe_resp.variable; | |
232 | *pos++ = WLAN_EID_SSID; | |
233 | *pos++ = hapd->conf->ssid.ssid_len; | |
234 | os_memcpy(pos, hapd->conf->ssid.ssid, hapd->conf->ssid.ssid_len); | |
235 | pos += hapd->conf->ssid.ssid_len; | |
236 | ||
237 | /* Supported rates */ | |
238 | pos = hostapd_eid_supp_rates(hapd, pos); | |
239 | ||
240 | /* DS Params */ | |
241 | pos = hostapd_eid_ds_params(hapd, pos); | |
242 | ||
243 | pos = hostapd_eid_country(hapd, pos, epos - pos); | |
244 | ||
245 | /* ERP Information element */ | |
246 | pos = hostapd_eid_erp_info(hapd, pos); | |
247 | ||
248 | /* Extended supported rates */ | |
249 | pos = hostapd_eid_ext_supp_rates(hapd, pos); | |
250 | ||
251 | /* RSN, MDIE, WPA */ | |
252 | pos = hostapd_eid_wpa(hapd, pos, epos - pos); | |
253 | ||
254 | #ifdef CONFIG_IEEE80211N | |
255 | pos = hostapd_eid_ht_capabilities(hapd, pos); | |
256 | pos = hostapd_eid_ht_operation(hapd, pos); | |
257 | #endif /* CONFIG_IEEE80211N */ | |
258 | ||
259 | pos = hostapd_eid_ext_capab(hapd, pos); | |
260 | ||
261 | pos = hostapd_eid_time_adv(hapd, pos); | |
262 | pos = hostapd_eid_time_zone(hapd, pos); | |
263 | ||
264 | pos = hostapd_eid_interworking(hapd, pos); | |
265 | pos = hostapd_eid_adv_proto(hapd, pos); | |
266 | pos = hostapd_eid_roaming_consortium(hapd, pos); | |
267 | ||
532b16c7 MP |
268 | #ifdef CONFIG_IEEE80211AC |
269 | pos = hostapd_eid_vht_capabilities(hapd, pos); | |
270 | pos = hostapd_eid_vht_operation(hapd, pos); | |
271 | #endif /* CONFIG_IEEE80211AC */ | |
272 | ||
eacc6b24 AN |
273 | /* Wi-Fi Alliance WMM */ |
274 | pos = hostapd_eid_wmm(hapd, pos); | |
275 | ||
276 | #ifdef CONFIG_WPS | |
277 | if (hapd->conf->wps_state && hapd->wps_probe_resp_ie) { | |
278 | os_memcpy(pos, wpabuf_head(hapd->wps_probe_resp_ie), | |
279 | wpabuf_len(hapd->wps_probe_resp_ie)); | |
280 | pos += wpabuf_len(hapd->wps_probe_resp_ie); | |
281 | } | |
282 | #endif /* CONFIG_WPS */ | |
283 | ||
284 | #ifdef CONFIG_P2P | |
285 | if ((hapd->conf->p2p & P2P_ENABLED) && is_p2p && | |
286 | hapd->p2p_probe_resp_ie) { | |
287 | os_memcpy(pos, wpabuf_head(hapd->p2p_probe_resp_ie), | |
288 | wpabuf_len(hapd->p2p_probe_resp_ie)); | |
289 | pos += wpabuf_len(hapd->p2p_probe_resp_ie); | |
290 | } | |
291 | #endif /* CONFIG_P2P */ | |
292 | #ifdef CONFIG_P2P_MANAGER | |
293 | if ((hapd->conf->p2p & (P2P_MANAGE | P2P_ENABLED | P2P_GROUP_OWNER)) == | |
294 | P2P_MANAGE) | |
295 | pos = hostapd_eid_p2p_manage(hapd, pos); | |
296 | #endif /* CONFIG_P2P_MANAGER */ | |
297 | ||
19a8ad99 JK |
298 | #ifdef CONFIG_HS20 |
299 | pos = hostapd_eid_hs20_indication(hapd, pos); | |
300 | #endif /* CONFIG_HS20 */ | |
301 | ||
b52f084c JM |
302 | if (hapd->conf->vendor_elements) { |
303 | os_memcpy(pos, wpabuf_head(hapd->conf->vendor_elements), | |
304 | wpabuf_len(hapd->conf->vendor_elements)); | |
305 | pos += wpabuf_len(hapd->conf->vendor_elements); | |
306 | } | |
307 | ||
eacc6b24 AN |
308 | *resp_len = pos - (u8 *) resp; |
309 | return (u8 *) resp; | |
310 | } | |
311 | ||
312 | ||
0a66ce3c JM |
313 | enum ssid_match_result { |
314 | NO_SSID_MATCH, | |
315 | EXACT_SSID_MATCH, | |
316 | WILDCARD_SSID_MATCH | |
317 | }; | |
318 | ||
319 | static enum ssid_match_result ssid_match(struct hostapd_data *hapd, | |
320 | const u8 *ssid, size_t ssid_len, | |
321 | const u8 *ssid_list, | |
322 | size_t ssid_list_len) | |
323 | { | |
324 | const u8 *pos, *end; | |
325 | int wildcard = 0; | |
326 | ||
327 | if (ssid_len == 0) | |
328 | wildcard = 1; | |
329 | if (ssid_len == hapd->conf->ssid.ssid_len && | |
330 | os_memcmp(ssid, hapd->conf->ssid.ssid, ssid_len) == 0) | |
331 | return EXACT_SSID_MATCH; | |
332 | ||
333 | if (ssid_list == NULL) | |
334 | return wildcard ? WILDCARD_SSID_MATCH : NO_SSID_MATCH; | |
335 | ||
336 | pos = ssid_list; | |
337 | end = ssid_list + ssid_list_len; | |
338 | while (pos + 1 <= end) { | |
339 | if (pos + 2 + pos[1] > end) | |
340 | break; | |
341 | if (pos[1] == 0) | |
342 | wildcard = 1; | |
343 | if (pos[1] == hapd->conf->ssid.ssid_len && | |
344 | os_memcmp(pos + 2, hapd->conf->ssid.ssid, pos[1]) == 0) | |
345 | return EXACT_SSID_MATCH; | |
346 | pos += 2 + pos[1]; | |
347 | } | |
348 | ||
349 | return wildcard ? WILDCARD_SSID_MATCH : NO_SSID_MATCH; | |
350 | } | |
351 | ||
352 | ||
b57e086c | 353 | void handle_probe_req(struct hostapd_data *hapd, |
baf513d6 JB |
354 | const struct ieee80211_mgmt *mgmt, size_t len, |
355 | int ssi_signal) | |
6fc6879b | 356 | { |
eacc6b24 | 357 | u8 *resp; |
6fc6879b | 358 | struct ieee802_11_elems elems; |
b57e086c | 359 | const u8 *ie; |
eacc6b24 | 360 | size_t ie_len; |
6fc6879b | 361 | struct sta_info *sta = NULL; |
eacc6b24 | 362 | size_t i, resp_len; |
9a898ee8 | 363 | int noack; |
0a66ce3c | 364 | enum ssid_match_result res; |
6fc6879b JM |
365 | |
366 | ie = mgmt->u.probe_req.variable; | |
cbcf92b4 JM |
367 | if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)) |
368 | return; | |
6fc6879b JM |
369 | ie_len = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); |
370 | ||
94709ea3 | 371 | for (i = 0; hapd->probereq_cb && i < hapd->num_probereq_cb; i++) |
cd7d80f3 | 372 | if (hapd->probereq_cb[i].cb(hapd->probereq_cb[i].ctx, |
04a85e44 | 373 | mgmt->sa, mgmt->da, mgmt->bssid, |
baf513d6 | 374 | ie, ie_len, ssi_signal) > 0) |
cd7d80f3 | 375 | return; |
ad08c363 | 376 | |
6fc6879b JM |
377 | if (!hapd->iconf->send_probe_response) |
378 | return; | |
379 | ||
3d536eb4 | 380 | if (ieee802_11_parse_elems(ie, ie_len, &elems, 0) == ParseFailed) { |
6fc6879b JM |
381 | wpa_printf(MSG_DEBUG, "Could not parse ProbeReq from " MACSTR, |
382 | MAC2STR(mgmt->sa)); | |
383 | return; | |
384 | } | |
385 | ||
6fc6879b JM |
386 | if ((!elems.ssid || !elems.supp_rates)) { |
387 | wpa_printf(MSG_DEBUG, "STA " MACSTR " sent probe request " | |
388 | "without SSID or supported rates element", | |
389 | MAC2STR(mgmt->sa)); | |
390 | return; | |
391 | } | |
392 | ||
e44f8bf2 JM |
393 | #ifdef CONFIG_P2P |
394 | if (hapd->p2p && elems.wps_ie) { | |
395 | struct wpabuf *wps; | |
396 | wps = ieee802_11_vendor_ie_concat(ie, ie_len, WPS_DEV_OUI_WFA); | |
397 | if (wps && !p2p_group_match_dev_type(hapd->p2p_group, wps)) { | |
398 | wpa_printf(MSG_MSGDUMP, "P2P: Ignore Probe Request " | |
399 | "due to mismatch with Requested Device " | |
400 | "Type"); | |
401 | wpabuf_free(wps); | |
402 | return; | |
403 | } | |
404 | wpabuf_free(wps); | |
405 | } | |
8017b538 JM |
406 | |
407 | if (hapd->p2p && elems.p2p) { | |
408 | struct wpabuf *p2p; | |
409 | p2p = ieee802_11_vendor_ie_concat(ie, ie_len, P2P_IE_VENDOR_TYPE); | |
410 | if (p2p && !p2p_group_match_dev_id(hapd->p2p_group, p2p)) { | |
411 | wpa_printf(MSG_MSGDUMP, "P2P: Ignore Probe Request " | |
412 | "due to mismatch with Device ID"); | |
413 | wpabuf_free(p2p); | |
414 | return; | |
415 | } | |
416 | wpabuf_free(p2p); | |
417 | } | |
e44f8bf2 JM |
418 | #endif /* CONFIG_P2P */ |
419 | ||
0a66ce3c JM |
420 | if (hapd->conf->ignore_broadcast_ssid && elems.ssid_len == 0 && |
421 | elems.ssid_list_len == 0) { | |
6fc6879b JM |
422 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR " for " |
423 | "broadcast SSID ignored", MAC2STR(mgmt->sa)); | |
424 | return; | |
425 | } | |
426 | ||
427 | sta = ap_get_sta(hapd, mgmt->sa); | |
428 | ||
e44f8bf2 JM |
429 | #ifdef CONFIG_P2P |
430 | if ((hapd->conf->p2p & P2P_GROUP_OWNER) && | |
431 | elems.ssid_len == P2P_WILDCARD_SSID_LEN && | |
432 | os_memcmp(elems.ssid, P2P_WILDCARD_SSID, | |
433 | P2P_WILDCARD_SSID_LEN) == 0) { | |
434 | /* Process P2P Wildcard SSID like Wildcard SSID */ | |
435 | elems.ssid_len = 0; | |
436 | } | |
437 | #endif /* CONFIG_P2P */ | |
438 | ||
0a66ce3c JM |
439 | res = ssid_match(hapd, elems.ssid, elems.ssid_len, |
440 | elems.ssid_list, elems.ssid_list_len); | |
441 | if (res != NO_SSID_MATCH) { | |
6fc6879b JM |
442 | if (sta) |
443 | sta->ssid_probe = &hapd->conf->ssid; | |
eacc6b24 | 444 | } else { |
6fc6879b JM |
445 | if (!(mgmt->da[0] & 0x01)) { |
446 | char ssid_txt[33]; | |
447 | ieee802_11_print_ssid(ssid_txt, elems.ssid, | |
448 | elems.ssid_len); | |
449 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR | |
0a66ce3c | 450 | " for foreign SSID '%s' (DA " MACSTR ")%s", |
2d8bf732 | 451 | MAC2STR(mgmt->sa), ssid_txt, |
0a66ce3c JM |
452 | MAC2STR(mgmt->da), |
453 | elems.ssid_list ? " (SSID list)" : ""); | |
6fc6879b JM |
454 | } |
455 | return; | |
456 | } | |
457 | ||
122ba579 JM |
458 | #ifdef CONFIG_INTERWORKING |
459 | if (elems.interworking && elems.interworking_len >= 1) { | |
460 | u8 ant = elems.interworking[0] & 0x0f; | |
461 | if (ant != INTERWORKING_ANT_WILDCARD && | |
462 | ant != hapd->conf->access_network_type) { | |
463 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR | |
464 | " for mismatching ANT %u ignored", | |
465 | MAC2STR(mgmt->sa), ant); | |
466 | return; | |
467 | } | |
468 | } | |
469 | ||
470 | if (elems.interworking && | |
471 | (elems.interworking_len == 7 || elems.interworking_len == 9)) { | |
472 | const u8 *hessid; | |
473 | if (elems.interworking_len == 7) | |
474 | hessid = elems.interworking + 1; | |
475 | else | |
476 | hessid = elems.interworking + 1 + 2; | |
477 | if (!is_broadcast_ether_addr(hessid) && | |
478 | os_memcmp(hessid, hapd->conf->hessid, ETH_ALEN) != 0) { | |
479 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR | |
480 | " for mismatching HESSID " MACSTR | |
481 | " ignored", | |
482 | MAC2STR(mgmt->sa), MAC2STR(hessid)); | |
483 | return; | |
484 | } | |
485 | } | |
486 | #endif /* CONFIG_INTERWORKING */ | |
487 | ||
6fc6879b JM |
488 | /* TODO: verify that supp_rates contains at least one matching rate |
489 | * with AP configuration */ | |
eacc6b24 AN |
490 | |
491 | resp = hostapd_gen_probe_resp(hapd, sta, mgmt, elems.p2p != NULL, | |
492 | &resp_len); | |
6fc6879b JM |
493 | if (resp == NULL) |
494 | return; | |
e44f8bf2 | 495 | |
9a898ee8 HS |
496 | /* |
497 | * If this is a broadcast probe request, apply no ack policy to avoid | |
498 | * excessive retries. | |
499 | */ | |
0a66ce3c JM |
500 | noack = !!(res == WILDCARD_SSID_MATCH && |
501 | is_broadcast_ether_addr(mgmt->da)); | |
9a898ee8 | 502 | |
eacc6b24 | 503 | if (hostapd_drv_send_mlme(hapd, resp, resp_len, noack) < 0) |
6fc6879b JM |
504 | perror("handle_probe_req: send"); |
505 | ||
506 | os_free(resp); | |
507 | ||
2d8bf732 | 508 | wpa_printf(MSG_EXCESSIVE, "STA " MACSTR " sent probe request for %s " |
6fc6879b JM |
509 | "SSID", MAC2STR(mgmt->sa), |
510 | elems.ssid_len == 0 ? "broadcast" : "our"); | |
511 | } | |
512 | ||
5b99e21a AN |
513 | |
514 | static u8 * hostapd_probe_resp_offloads(struct hostapd_data *hapd, | |
515 | size_t *resp_len) | |
516 | { | |
517 | /* check probe response offloading caps and print warnings */ | |
518 | if (!(hapd->iface->drv_flags & WPA_DRIVER_FLAGS_PROBE_RESP_OFFLOAD)) | |
519 | return NULL; | |
520 | ||
521 | #ifdef CONFIG_WPS | |
522 | if (hapd->conf->wps_state && hapd->wps_probe_resp_ie && | |
523 | (!(hapd->iface->probe_resp_offloads & | |
524 | (WPA_DRIVER_PROBE_RESP_OFFLOAD_WPS | | |
525 | WPA_DRIVER_PROBE_RESP_OFFLOAD_WPS2)))) | |
526 | wpa_printf(MSG_WARNING, "Device is trying to offload WPS " | |
527 | "Probe Response while not supporting this"); | |
528 | #endif /* CONFIG_WPS */ | |
529 | ||
530 | #ifdef CONFIG_P2P | |
531 | if ((hapd->conf->p2p & P2P_ENABLED) && hapd->p2p_probe_resp_ie && | |
532 | !(hapd->iface->probe_resp_offloads & | |
533 | WPA_DRIVER_PROBE_RESP_OFFLOAD_P2P)) | |
534 | wpa_printf(MSG_WARNING, "Device is trying to offload P2P " | |
535 | "Probe Response while not supporting this"); | |
536 | #endif /* CONFIG_P2P */ | |
537 | ||
538 | if (hapd->conf->interworking && | |
539 | !(hapd->iface->probe_resp_offloads & | |
540 | WPA_DRIVER_PROBE_RESP_OFFLOAD_INTERWORKING)) | |
541 | wpa_printf(MSG_WARNING, "Device is trying to offload " | |
542 | "Interworking Probe Response while not supporting " | |
543 | "this"); | |
544 | ||
545 | /* Generate a Probe Response template for the non-P2P case */ | |
546 | return hostapd_gen_probe_resp(hapd, NULL, NULL, 0, resp_len); | |
547 | } | |
548 | ||
062390ef JM |
549 | #endif /* NEED_AP_MLME */ |
550 | ||
551 | ||
6fc6879b JM |
552 | void ieee802_11_set_beacon(struct hostapd_data *hapd) |
553 | { | |
062390ef JM |
554 | struct ieee80211_mgmt *head = NULL; |
555 | u8 *tail = NULL; | |
556 | size_t head_len = 0, tail_len = 0; | |
5b99e21a AN |
557 | u8 *resp = NULL; |
558 | size_t resp_len = 0; | |
19c3b566 | 559 | struct wpa_driver_ap_params params; |
fb91db56 | 560 | struct wpabuf *beacon, *proberesp, *assocresp; |
062390ef JM |
561 | #ifdef NEED_AP_MLME |
562 | u16 capab_info; | |
563 | u8 *pos, *tailpos; | |
564 | #endif /* NEED_AP_MLME */ | |
6fc6879b | 565 | |
bc45d427 | 566 | hapd->beacon_set_done = 1; |
e44f8bf2 | 567 | |
062390ef JM |
568 | #ifdef NEED_AP_MLME |
569 | ||
6fc6879b JM |
570 | #define BEACON_HEAD_BUF_SIZE 256 |
571 | #define BEACON_TAIL_BUF_SIZE 512 | |
572 | head = os_zalloc(BEACON_HEAD_BUF_SIZE); | |
1c08f8c0 JM |
573 | tail_len = BEACON_TAIL_BUF_SIZE; |
574 | #ifdef CONFIG_WPS | |
575 | if (hapd->conf->wps_state && hapd->wps_beacon_ie) | |
576 | tail_len += wpabuf_len(hapd->wps_beacon_ie); | |
577 | #endif /* CONFIG_WPS */ | |
e44f8bf2 JM |
578 | #ifdef CONFIG_P2P |
579 | if (hapd->p2p_beacon_ie) | |
580 | tail_len += wpabuf_len(hapd->p2p_beacon_ie); | |
581 | #endif /* CONFIG_P2P */ | |
b52f084c JM |
582 | if (hapd->conf->vendor_elements) |
583 | tail_len += wpabuf_len(hapd->conf->vendor_elements); | |
1c08f8c0 | 584 | tailpos = tail = os_malloc(tail_len); |
6fc6879b JM |
585 | if (head == NULL || tail == NULL) { |
586 | wpa_printf(MSG_ERROR, "Failed to set beacon data"); | |
587 | os_free(head); | |
588 | os_free(tail); | |
589 | return; | |
590 | } | |
591 | ||
592 | head->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, | |
593 | WLAN_FC_STYPE_BEACON); | |
594 | head->duration = host_to_le16(0); | |
595 | os_memset(head->da, 0xff, ETH_ALEN); | |
596 | ||
597 | os_memcpy(head->sa, hapd->own_addr, ETH_ALEN); | |
598 | os_memcpy(head->bssid, hapd->own_addr, ETH_ALEN); | |
599 | head->u.beacon.beacon_int = | |
600 | host_to_le16(hapd->iconf->beacon_int); | |
601 | ||
602 | /* hardware or low-level driver will setup seq_ctrl and timestamp */ | |
603 | capab_info = hostapd_own_capab_info(hapd, NULL, 0); | |
604 | head->u.beacon.capab_info = host_to_le16(capab_info); | |
605 | pos = &head->u.beacon.variable[0]; | |
606 | ||
607 | /* SSID */ | |
608 | *pos++ = WLAN_EID_SSID; | |
609 | if (hapd->conf->ignore_broadcast_ssid == 2) { | |
610 | /* clear the data, but keep the correct length of the SSID */ | |
611 | *pos++ = hapd->conf->ssid.ssid_len; | |
612 | os_memset(pos, 0, hapd->conf->ssid.ssid_len); | |
613 | pos += hapd->conf->ssid.ssid_len; | |
614 | } else if (hapd->conf->ignore_broadcast_ssid) { | |
615 | *pos++ = 0; /* empty SSID */ | |
616 | } else { | |
617 | *pos++ = hapd->conf->ssid.ssid_len; | |
618 | os_memcpy(pos, hapd->conf->ssid.ssid, | |
619 | hapd->conf->ssid.ssid_len); | |
620 | pos += hapd->conf->ssid.ssid_len; | |
621 | } | |
622 | ||
623 | /* Supported rates */ | |
624 | pos = hostapd_eid_supp_rates(hapd, pos); | |
625 | ||
626 | /* DS Params */ | |
627 | pos = hostapd_eid_ds_params(hapd, pos); | |
628 | ||
629 | head_len = pos - (u8 *) head; | |
630 | ||
631 | tailpos = hostapd_eid_country(hapd, tailpos, | |
632 | tail + BEACON_TAIL_BUF_SIZE - tailpos); | |
633 | ||
6fc6879b JM |
634 | /* ERP Information element */ |
635 | tailpos = hostapd_eid_erp_info(hapd, tailpos); | |
636 | ||
637 | /* Extended supported rates */ | |
638 | tailpos = hostapd_eid_ext_supp_rates(hapd, tailpos); | |
639 | ||
1bc774a1 | 640 | /* RSN, MDIE, WPA */ |
6fc6879b | 641 | tailpos = hostapd_eid_wpa(hapd, tailpos, tail + BEACON_TAIL_BUF_SIZE - |
6c0575c3 | 642 | tailpos); |
6fc6879b | 643 | |
de9289c8 | 644 | #ifdef CONFIG_IEEE80211N |
677449b9 JM |
645 | tailpos = hostapd_eid_ht_capabilities(hapd, tailpos); |
646 | tailpos = hostapd_eid_ht_operation(hapd, tailpos); | |
de9289c8 JM |
647 | #endif /* CONFIG_IEEE80211N */ |
648 | ||
1161ff1e JM |
649 | tailpos = hostapd_eid_ext_capab(hapd, tailpos); |
650 | ||
39b97072 JM |
651 | /* |
652 | * TODO: Time Advertisement element should only be included in some | |
653 | * DTIM Beacon frames. | |
654 | */ | |
655 | tailpos = hostapd_eid_time_adv(hapd, tailpos); | |
656 | ||
b83e3e93 | 657 | tailpos = hostapd_eid_interworking(hapd, tailpos); |
c7c178e1 | 658 | tailpos = hostapd_eid_adv_proto(hapd, tailpos); |
4b2a77ab | 659 | tailpos = hostapd_eid_roaming_consortium(hapd, tailpos); |
b83e3e93 | 660 | |
532b16c7 MP |
661 | #ifdef CONFIG_IEEE80211AC |
662 | tailpos = hostapd_eid_vht_capabilities(hapd, tailpos); | |
663 | tailpos = hostapd_eid_vht_operation(hapd, tailpos); | |
664 | #endif /* CONFIG_IEEE80211AC */ | |
665 | ||
1bc774a1 JM |
666 | /* Wi-Fi Alliance WMM */ |
667 | tailpos = hostapd_eid_wmm(hapd, tailpos); | |
668 | ||
ad08c363 JM |
669 | #ifdef CONFIG_WPS |
670 | if (hapd->conf->wps_state && hapd->wps_beacon_ie) { | |
14f79386 JM |
671 | os_memcpy(tailpos, wpabuf_head(hapd->wps_beacon_ie), |
672 | wpabuf_len(hapd->wps_beacon_ie)); | |
673 | tailpos += wpabuf_len(hapd->wps_beacon_ie); | |
ad08c363 JM |
674 | } |
675 | #endif /* CONFIG_WPS */ | |
676 | ||
e44f8bf2 JM |
677 | #ifdef CONFIG_P2P |
678 | if ((hapd->conf->p2p & P2P_ENABLED) && hapd->p2p_beacon_ie) { | |
679 | os_memcpy(tailpos, wpabuf_head(hapd->p2p_beacon_ie), | |
680 | wpabuf_len(hapd->p2p_beacon_ie)); | |
681 | tailpos += wpabuf_len(hapd->p2p_beacon_ie); | |
682 | } | |
683 | #endif /* CONFIG_P2P */ | |
962473c1 JM |
684 | #ifdef CONFIG_P2P_MANAGER |
685 | if ((hapd->conf->p2p & (P2P_MANAGE | P2P_ENABLED | P2P_GROUP_OWNER)) == | |
686 | P2P_MANAGE) | |
687 | tailpos = hostapd_eid_p2p_manage(hapd, tailpos); | |
688 | #endif /* CONFIG_P2P_MANAGER */ | |
e44f8bf2 | 689 | |
19a8ad99 JK |
690 | #ifdef CONFIG_HS20 |
691 | tailpos = hostapd_eid_hs20_indication(hapd, tailpos); | |
692 | #endif /* CONFIG_HS20 */ | |
693 | ||
b52f084c JM |
694 | if (hapd->conf->vendor_elements) { |
695 | os_memcpy(tailpos, wpabuf_head(hapd->conf->vendor_elements), | |
696 | wpabuf_len(hapd->conf->vendor_elements)); | |
697 | tailpos += wpabuf_len(hapd->conf->vendor_elements); | |
698 | } | |
699 | ||
6fc6879b JM |
700 | tail_len = tailpos > tail ? tailpos - tail : 0; |
701 | ||
5b99e21a | 702 | resp = hostapd_probe_resp_offloads(hapd, &resp_len); |
062390ef JM |
703 | #endif /* NEED_AP_MLME */ |
704 | ||
19c3b566 JM |
705 | os_memset(¶ms, 0, sizeof(params)); |
706 | params.head = (u8 *) head; | |
707 | params.head_len = head_len; | |
708 | params.tail = tail; | |
709 | params.tail_len = tail_len; | |
5b99e21a AN |
710 | params.proberesp = resp; |
711 | params.proberesp_len = resp_len; | |
19c3b566 JM |
712 | params.dtim_period = hapd->conf->dtim_period; |
713 | params.beacon_int = hapd->iconf->beacon_int; | |
44256451 | 714 | params.basic_rates = hapd->iface->basic_rates; |
986de33d | 715 | params.ssid = hapd->conf->ssid.ssid; |
ccb941e6 | 716 | params.ssid_len = hapd->conf->ssid.ssid_len; |
b11d1d64 JM |
717 | params.pairwise_ciphers = hapd->conf->rsn_pairwise ? |
718 | hapd->conf->rsn_pairwise : hapd->conf->wpa_pairwise; | |
719 | params.group_cipher = hapd->conf->wpa_group; | |
720 | params.key_mgmt_suites = hapd->conf->wpa_key_mgmt; | |
721 | params.auth_algs = hapd->conf->auth_algs; | |
722 | params.wpa_version = hapd->conf->wpa; | |
723 | params.privacy = hapd->conf->ssid.wep.keys_set || hapd->conf->wpa || | |
724 | (hapd->conf->ieee802_1x && | |
725 | (hapd->conf->default_wep_key_len || | |
726 | hapd->conf->individual_wep_key_len)); | |
97a7a0b5 JM |
727 | switch (hapd->conf->ignore_broadcast_ssid) { |
728 | case 0: | |
729 | params.hide_ssid = NO_SSID_HIDING; | |
730 | break; | |
731 | case 1: | |
732 | params.hide_ssid = HIDDEN_SSID_ZERO_LEN; | |
733 | break; | |
734 | case 2: | |
735 | params.hide_ssid = HIDDEN_SSID_ZERO_CONTENTS; | |
736 | break; | |
737 | } | |
fb91db56 JM |
738 | hostapd_build_ap_extra_ies(hapd, &beacon, &proberesp, &assocresp); |
739 | params.beacon_ies = beacon; | |
740 | params.proberesp_ies = proberesp; | |
741 | params.assocresp_ies = assocresp; | |
fd13a541 | 742 | params.isolate = hapd->conf->isolate; |
31357268 JM |
743 | #ifdef NEED_AP_MLME |
744 | params.cts_protect = !!(ieee802_11_erp_info(hapd) & | |
745 | ERP_INFO_USE_PROTECTION); | |
746 | params.preamble = hapd->iface->num_sta_no_short_preamble == 0 && | |
747 | hapd->iconf->preamble == SHORT_PREAMBLE; | |
748 | if (hapd->iface->current_mode && | |
749 | hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) | |
750 | params.short_slot_time = | |
751 | hapd->iface->num_sta_no_short_slot_time > 0 ? 0 : 1; | |
752 | else | |
753 | params.short_slot_time = -1; | |
754 | if (!hapd->iconf->ieee80211n || hapd->conf->disable_11n) | |
755 | params.ht_opmode = -1; | |
756 | else | |
757 | params.ht_opmode = hapd->iface->ht_op_mode; | |
758 | #endif /* NEED_AP_MLME */ | |
8a33a63f JM |
759 | params.interworking = hapd->conf->interworking; |
760 | if (hapd->conf->interworking && | |
761 | !is_zero_ether_addr(hapd->conf->hessid)) | |
762 | params.hessid = hapd->conf->hessid; | |
16991cff | 763 | params.access_network_type = hapd->conf->access_network_type; |
a0133ee1 | 764 | params.ap_max_inactivity = hapd->conf->ap_max_inactivity; |
83421850 JM |
765 | #ifdef CONFIG_HS20 |
766 | params.disable_dgaf = hapd->conf->disable_dgaf; | |
767 | #endif /* CONFIG_HS20 */ | |
19c3b566 JM |
768 | if (hostapd_drv_set_ap(hapd, ¶ms)) |
769 | wpa_printf(MSG_ERROR, "Failed to set beacon parameters"); | |
fb91db56 | 770 | hostapd_free_ap_extra_ies(hapd, beacon, proberesp, assocresp); |
6fc6879b JM |
771 | |
772 | os_free(tail); | |
773 | os_free(head); | |
5b99e21a | 774 | os_free(resp); |
6fc6879b JM |
775 | } |
776 | ||
777 | ||
778 | void ieee802_11_set_beacons(struct hostapd_iface *iface) | |
779 | { | |
780 | size_t i; | |
781 | for (i = 0; i < iface->num_bss; i++) | |
782 | ieee802_11_set_beacon(iface->bss[i]); | |
783 | } | |
784 | ||
370b0761 LC |
785 | |
786 | /* only update beacons if started */ | |
787 | void ieee802_11_update_beacons(struct hostapd_iface *iface) | |
788 | { | |
789 | size_t i; | |
790 | for (i = 0; i < iface->num_bss; i++) | |
791 | if (iface->bss[i]->beacon_set_done) | |
792 | ieee802_11_set_beacon(iface->bss[i]); | |
793 | } | |
794 | ||
6fc6879b | 795 | #endif /* CONFIG_NATIVE_WINDOWS */ |