]>
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. | |
5 | * Copyright (c) 2008, Jouni Malinen <j@w1.fi> | |
71b6ae14 | 6 | * Copyright (c) 2007-2008, Intel Corporation |
6fc6879b JM |
7 | * |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | * | |
12 | * Alternatively, this software may be distributed under the terms of BSD | |
13 | * license. | |
14 | * | |
15 | * See README and COPYING for more details. | |
16 | */ | |
17 | ||
18 | #include "includes.h" | |
19 | ||
20 | #ifndef CONFIG_NATIVE_WINDOWS | |
21 | ||
22 | #include "hostapd.h" | |
23 | #include "ieee802_11.h" | |
24 | #include "wpa.h" | |
25 | #include "wme.h" | |
26 | #include "beacon.h" | |
27 | #include "hw_features.h" | |
bfddd95c | 28 | #include "driver_i.h" |
6fc6879b | 29 | #include "sta_info.h" |
ad08c363 | 30 | #include "wps_hostapd.h" |
6fc6879b JM |
31 | |
32 | ||
33 | static u8 ieee802_11_erp_info(struct hostapd_data *hapd) | |
34 | { | |
35 | u8 erp = 0; | |
36 | ||
37 | if (hapd->iface->current_mode == NULL || | |
38 | hapd->iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G) | |
39 | return 0; | |
40 | ||
41 | switch (hapd->iconf->cts_protection_type) { | |
42 | case CTS_PROTECTION_FORCE_ENABLED: | |
43 | erp |= ERP_INFO_NON_ERP_PRESENT | ERP_INFO_USE_PROTECTION; | |
44 | break; | |
45 | case CTS_PROTECTION_FORCE_DISABLED: | |
46 | erp = 0; | |
47 | break; | |
48 | case CTS_PROTECTION_AUTOMATIC: | |
49 | if (hapd->iface->olbc) | |
50 | erp |= ERP_INFO_USE_PROTECTION; | |
51 | /* continue */ | |
52 | case CTS_PROTECTION_AUTOMATIC_NO_OLBC: | |
53 | if (hapd->iface->num_sta_non_erp > 0) { | |
54 | erp |= ERP_INFO_NON_ERP_PRESENT | | |
55 | ERP_INFO_USE_PROTECTION; | |
56 | } | |
57 | break; | |
58 | } | |
59 | if (hapd->iface->num_sta_no_short_preamble > 0) | |
60 | erp |= ERP_INFO_BARKER_PREAMBLE_MODE; | |
61 | ||
62 | return erp; | |
63 | } | |
64 | ||
65 | ||
66 | static u8 * hostapd_eid_ds_params(struct hostapd_data *hapd, u8 *eid) | |
67 | { | |
68 | *eid++ = WLAN_EID_DS_PARAMS; | |
69 | *eid++ = 1; | |
70 | *eid++ = hapd->iconf->channel; | |
71 | return eid; | |
72 | } | |
73 | ||
74 | ||
75 | static u8 * hostapd_eid_erp_info(struct hostapd_data *hapd, u8 *eid) | |
76 | { | |
77 | if (hapd->iface->current_mode == NULL || | |
78 | hapd->iface->current_mode->mode != HOSTAPD_MODE_IEEE80211G) | |
79 | return eid; | |
80 | ||
81 | /* Set NonERP_present and use_protection bits if there | |
82 | * are any associated NonERP stations. */ | |
83 | /* TODO: use_protection bit can be set to zero even if | |
84 | * there are NonERP stations present. This optimization | |
85 | * might be useful if NonERP stations are "quiet". | |
86 | * See 802.11g/D6 E-1 for recommended practice. | |
87 | * In addition, Non ERP present might be set, if AP detects Non ERP | |
88 | * operation on other APs. */ | |
89 | ||
90 | /* Add ERP Information element */ | |
91 | *eid++ = WLAN_EID_ERP_INFO; | |
92 | *eid++ = 1; | |
93 | *eid++ = ieee802_11_erp_info(hapd); | |
94 | ||
95 | return eid; | |
96 | } | |
97 | ||
98 | ||
df73d284 JM |
99 | static u8 * hostapd_eid_country_add(u8 *pos, u8 *end, int chan_spacing, |
100 | struct hostapd_channel_data *start, | |
101 | struct hostapd_channel_data *prev) | |
102 | { | |
103 | if (end - pos < 3) | |
104 | return pos; | |
105 | ||
106 | /* first channel number */ | |
107 | *pos++ = start->chan; | |
108 | /* number of channels */ | |
109 | *pos++ = (prev->chan - start->chan) / chan_spacing + 1; | |
110 | /* maximum transmit power level */ | |
111 | *pos++ = start->max_tx_power; | |
112 | ||
113 | return pos; | |
114 | } | |
115 | ||
116 | ||
6fc6879b JM |
117 | static u8 * hostapd_eid_country(struct hostapd_data *hapd, u8 *eid, |
118 | int max_len) | |
119 | { | |
120 | u8 *pos = eid; | |
df73d284 JM |
121 | u8 *end = eid + max_len; |
122 | int i; | |
123 | struct hostapd_hw_modes *mode; | |
124 | struct hostapd_channel_data *start, *prev; | |
125 | int chan_spacing = 1; | |
126 | ||
127 | if (!hapd->iconf->ieee80211d || max_len < 6 || | |
128 | hapd->iface->current_mode == NULL) | |
6fc6879b JM |
129 | return eid; |
130 | ||
131 | *pos++ = WLAN_EID_COUNTRY; | |
132 | pos++; /* length will be set later */ | |
133 | os_memcpy(pos, hapd->iconf->country, 3); /* e.g., 'US ' */ | |
134 | pos += 3; | |
135 | ||
df73d284 JM |
136 | mode = hapd->iface->current_mode; |
137 | if (mode->mode == HOSTAPD_MODE_IEEE80211A) | |
138 | chan_spacing = 4; | |
139 | ||
140 | start = prev = NULL; | |
141 | for (i = 0; i < mode->num_channels; i++) { | |
142 | struct hostapd_channel_data *chan = &mode->channels[i]; | |
143 | if (chan->flag & HOSTAPD_CHAN_DISABLED) | |
144 | continue; | |
145 | if (start && prev && | |
146 | prev->chan + chan_spacing == chan->chan && | |
147 | start->max_tx_power == chan->max_tx_power) { | |
148 | prev = chan; | |
149 | continue; /* can use same entry */ | |
150 | } | |
151 | ||
152 | if (start) { | |
153 | pos = hostapd_eid_country_add(pos, end, chan_spacing, | |
154 | start, prev); | |
155 | start = NULL; | |
156 | } | |
157 | ||
158 | /* Start new group */ | |
159 | start = prev = chan; | |
160 | } | |
161 | ||
162 | if (start) { | |
163 | pos = hostapd_eid_country_add(pos, end, chan_spacing, | |
164 | start, prev); | |
165 | } | |
166 | ||
167 | if ((pos - eid) & 1) { | |
168 | if (end - pos < 1) | |
169 | return eid; | |
6fc6879b | 170 | *pos++ = 0; /* pad for 16-bit alignment */ |
df73d284 | 171 | } |
6fc6879b JM |
172 | |
173 | eid[1] = (pos - eid) - 2; | |
174 | ||
175 | return pos; | |
176 | } | |
177 | ||
178 | ||
6fc6879b JM |
179 | static u8 * hostapd_eid_wpa(struct hostapd_data *hapd, u8 *eid, size_t len, |
180 | struct sta_info *sta) | |
181 | { | |
182 | const u8 *ie; | |
183 | size_t ielen; | |
184 | ||
185 | ie = wpa_auth_get_wpa_ie(hapd->wpa_auth, &ielen); | |
186 | if (ie == NULL || ielen > len) | |
187 | return eid; | |
188 | ||
189 | os_memcpy(eid, ie, ielen); | |
190 | return eid + ielen; | |
191 | } | |
192 | ||
193 | ||
194 | void handle_probe_req(struct hostapd_data *hapd, struct ieee80211_mgmt *mgmt, | |
195 | size_t len) | |
196 | { | |
197 | struct ieee80211_mgmt *resp; | |
198 | struct ieee802_11_elems elems; | |
199 | char *ssid; | |
200 | u8 *pos, *epos, *ie; | |
201 | size_t ssid_len, ie_len; | |
202 | struct sta_info *sta = NULL; | |
203 | ||
204 | ie = mgmt->u.probe_req.variable; | |
205 | ie_len = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); | |
206 | ||
ad08c363 JM |
207 | hostapd_wps_probe_req_rx(hapd, mgmt->sa, ie, ie_len); |
208 | ||
6fc6879b JM |
209 | if (!hapd->iconf->send_probe_response) |
210 | return; | |
211 | ||
3d536eb4 | 212 | if (ieee802_11_parse_elems(ie, ie_len, &elems, 0) == ParseFailed) { |
6fc6879b JM |
213 | wpa_printf(MSG_DEBUG, "Could not parse ProbeReq from " MACSTR, |
214 | MAC2STR(mgmt->sa)); | |
215 | return; | |
216 | } | |
217 | ||
218 | ssid = NULL; | |
219 | ssid_len = 0; | |
220 | ||
221 | if ((!elems.ssid || !elems.supp_rates)) { | |
222 | wpa_printf(MSG_DEBUG, "STA " MACSTR " sent probe request " | |
223 | "without SSID or supported rates element", | |
224 | MAC2STR(mgmt->sa)); | |
225 | return; | |
226 | } | |
227 | ||
228 | if (hapd->conf->ignore_broadcast_ssid && elems.ssid_len == 0) { | |
229 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR " for " | |
230 | "broadcast SSID ignored", MAC2STR(mgmt->sa)); | |
231 | return; | |
232 | } | |
233 | ||
234 | sta = ap_get_sta(hapd, mgmt->sa); | |
235 | ||
236 | if (elems.ssid_len == 0 || | |
237 | (elems.ssid_len == hapd->conf->ssid.ssid_len && | |
238 | os_memcmp(elems.ssid, hapd->conf->ssid.ssid, elems.ssid_len) == | |
239 | 0)) { | |
240 | ssid = hapd->conf->ssid.ssid; | |
241 | ssid_len = hapd->conf->ssid.ssid_len; | |
242 | if (sta) | |
243 | sta->ssid_probe = &hapd->conf->ssid; | |
244 | } | |
245 | ||
246 | if (!ssid) { | |
247 | if (!(mgmt->da[0] & 0x01)) { | |
248 | char ssid_txt[33]; | |
249 | ieee802_11_print_ssid(ssid_txt, elems.ssid, | |
250 | elems.ssid_len); | |
251 | wpa_printf(MSG_MSGDUMP, "Probe Request from " MACSTR | |
252 | " for foreign SSID '%s'", | |
253 | MAC2STR(mgmt->sa), ssid_txt); | |
254 | } | |
255 | return; | |
256 | } | |
257 | ||
258 | /* TODO: verify that supp_rates contains at least one matching rate | |
259 | * with AP configuration */ | |
260 | #define MAX_PROBERESP_LEN 768 | |
261 | resp = os_zalloc(MAX_PROBERESP_LEN); | |
262 | if (resp == NULL) | |
263 | return; | |
264 | epos = ((u8 *) resp) + MAX_PROBERESP_LEN; | |
265 | ||
266 | resp->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, | |
267 | WLAN_FC_STYPE_PROBE_RESP); | |
268 | os_memcpy(resp->da, mgmt->sa, ETH_ALEN); | |
269 | os_memcpy(resp->sa, hapd->own_addr, ETH_ALEN); | |
270 | ||
271 | os_memcpy(resp->bssid, hapd->own_addr, ETH_ALEN); | |
272 | resp->u.probe_resp.beacon_int = | |
273 | host_to_le16(hapd->iconf->beacon_int); | |
274 | ||
275 | /* hardware or low-level driver will setup seq_ctrl and timestamp */ | |
276 | resp->u.probe_resp.capab_info = | |
277 | host_to_le16(hostapd_own_capab_info(hapd, sta, 1)); | |
278 | ||
279 | pos = resp->u.probe_resp.variable; | |
280 | *pos++ = WLAN_EID_SSID; | |
281 | *pos++ = ssid_len; | |
282 | os_memcpy(pos, ssid, ssid_len); | |
283 | pos += ssid_len; | |
284 | ||
285 | /* Supported rates */ | |
286 | pos = hostapd_eid_supp_rates(hapd, pos); | |
287 | ||
288 | /* DS Params */ | |
289 | pos = hostapd_eid_ds_params(hapd, pos); | |
290 | ||
291 | pos = hostapd_eid_country(hapd, pos, epos - pos); | |
292 | ||
6fc6879b JM |
293 | /* ERP Information element */ |
294 | pos = hostapd_eid_erp_info(hapd, pos); | |
295 | ||
296 | /* Extended supported rates */ | |
297 | pos = hostapd_eid_ext_supp_rates(hapd, pos); | |
298 | ||
299 | pos = hostapd_eid_wpa(hapd, pos, epos - pos, sta); | |
300 | ||
3ae0800c JM |
301 | /* Wi-Fi Alliance WMM */ |
302 | pos = hostapd_eid_wmm(hapd, pos); | |
6fc6879b | 303 | |
9d2a76a2 JM |
304 | pos = hostapd_eid_ht_capabilities_info(hapd, pos); |
305 | pos = hostapd_eid_ht_operation(hapd, pos); | |
de9289c8 | 306 | |
ad08c363 JM |
307 | #ifdef CONFIG_WPS |
308 | if (hapd->conf->wps_state && hapd->wps_probe_resp_ie) { | |
309 | os_memcpy(pos, hapd->wps_probe_resp_ie, | |
310 | hapd->wps_probe_resp_ie_len); | |
311 | pos += hapd->wps_probe_resp_ie_len; | |
312 | } | |
313 | #endif /* CONFIG_WPS */ | |
314 | ||
6fc6879b JM |
315 | if (hostapd_send_mgmt_frame(hapd, resp, pos - (u8 *) resp, 0) < 0) |
316 | perror("handle_probe_req: send"); | |
317 | ||
318 | os_free(resp); | |
319 | ||
320 | wpa_printf(MSG_MSGDUMP, "STA " MACSTR " sent probe request for %s " | |
321 | "SSID", MAC2STR(mgmt->sa), | |
322 | elems.ssid_len == 0 ? "broadcast" : "our"); | |
323 | } | |
324 | ||
325 | ||
326 | void ieee802_11_set_beacon(struct hostapd_data *hapd) | |
327 | { | |
328 | struct ieee80211_mgmt *head; | |
329 | u8 *pos, *tail, *tailpos; | |
330 | int preamble; | |
331 | u16 capab_info; | |
332 | size_t head_len, tail_len; | |
333 | int cts_protection = ((ieee802_11_erp_info(hapd) & | |
334 | ERP_INFO_USE_PROTECTION) ? 1 : 0); | |
335 | ||
336 | #define BEACON_HEAD_BUF_SIZE 256 | |
337 | #define BEACON_TAIL_BUF_SIZE 512 | |
338 | head = os_zalloc(BEACON_HEAD_BUF_SIZE); | |
339 | tailpos = tail = os_malloc(BEACON_TAIL_BUF_SIZE); | |
340 | if (head == NULL || tail == NULL) { | |
341 | wpa_printf(MSG_ERROR, "Failed to set beacon data"); | |
342 | os_free(head); | |
343 | os_free(tail); | |
344 | return; | |
345 | } | |
346 | ||
347 | head->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, | |
348 | WLAN_FC_STYPE_BEACON); | |
349 | head->duration = host_to_le16(0); | |
350 | os_memset(head->da, 0xff, ETH_ALEN); | |
351 | ||
352 | os_memcpy(head->sa, hapd->own_addr, ETH_ALEN); | |
353 | os_memcpy(head->bssid, hapd->own_addr, ETH_ALEN); | |
354 | head->u.beacon.beacon_int = | |
355 | host_to_le16(hapd->iconf->beacon_int); | |
356 | ||
357 | /* hardware or low-level driver will setup seq_ctrl and timestamp */ | |
358 | capab_info = hostapd_own_capab_info(hapd, NULL, 0); | |
359 | head->u.beacon.capab_info = host_to_le16(capab_info); | |
360 | pos = &head->u.beacon.variable[0]; | |
361 | ||
362 | /* SSID */ | |
363 | *pos++ = WLAN_EID_SSID; | |
364 | if (hapd->conf->ignore_broadcast_ssid == 2) { | |
365 | /* clear the data, but keep the correct length of the SSID */ | |
366 | *pos++ = hapd->conf->ssid.ssid_len; | |
367 | os_memset(pos, 0, hapd->conf->ssid.ssid_len); | |
368 | pos += hapd->conf->ssid.ssid_len; | |
369 | } else if (hapd->conf->ignore_broadcast_ssid) { | |
370 | *pos++ = 0; /* empty SSID */ | |
371 | } else { | |
372 | *pos++ = hapd->conf->ssid.ssid_len; | |
373 | os_memcpy(pos, hapd->conf->ssid.ssid, | |
374 | hapd->conf->ssid.ssid_len); | |
375 | pos += hapd->conf->ssid.ssid_len; | |
376 | } | |
377 | ||
378 | /* Supported rates */ | |
379 | pos = hostapd_eid_supp_rates(hapd, pos); | |
380 | ||
381 | /* DS Params */ | |
382 | pos = hostapd_eid_ds_params(hapd, pos); | |
383 | ||
384 | head_len = pos - (u8 *) head; | |
385 | ||
386 | tailpos = hostapd_eid_country(hapd, tailpos, | |
387 | tail + BEACON_TAIL_BUF_SIZE - tailpos); | |
388 | ||
6fc6879b JM |
389 | /* ERP Information element */ |
390 | tailpos = hostapd_eid_erp_info(hapd, tailpos); | |
391 | ||
392 | /* Extended supported rates */ | |
393 | tailpos = hostapd_eid_ext_supp_rates(hapd, tailpos); | |
394 | ||
395 | tailpos = hostapd_eid_wpa(hapd, tailpos, tail + BEACON_TAIL_BUF_SIZE - | |
396 | tailpos, NULL); | |
397 | ||
3ae0800c JM |
398 | /* Wi-Fi Alliance WMM */ |
399 | tailpos = hostapd_eid_wmm(hapd, tailpos); | |
6fc6879b | 400 | |
de9289c8 | 401 | #ifdef CONFIG_IEEE80211N |
9d2a76a2 | 402 | if (hapd->iconf->ieee80211n) { |
ffbcf648 JM |
403 | u8 *ht_capab, *ht_oper; |
404 | ht_capab = tailpos; | |
de9289c8 | 405 | tailpos = hostapd_eid_ht_capabilities_info(hapd, tailpos); |
ffbcf648 JM |
406 | |
407 | ht_oper = tailpos; | |
408 | tailpos = hostapd_eid_ht_operation(hapd, tailpos); | |
409 | ||
410 | if (tailpos > ht_oper && ht_oper > ht_capab && | |
411 | hostapd_set_ht_params(hapd->conf->iface, hapd, | |
412 | ht_capab + 2, ht_capab[1], | |
413 | ht_oper + 2, ht_oper[1])) { | |
de9289c8 JM |
414 | wpa_printf(MSG_ERROR, "Could not set HT capabilities " |
415 | "for kernel driver"); | |
416 | } | |
de9289c8 JM |
417 | } |
418 | #endif /* CONFIG_IEEE80211N */ | |
419 | ||
ad08c363 JM |
420 | #ifdef CONFIG_WPS |
421 | if (hapd->conf->wps_state && hapd->wps_beacon_ie) { | |
422 | os_memcpy(tailpos, hapd->wps_beacon_ie, | |
423 | hapd->wps_beacon_ie_len); | |
424 | tailpos += hapd->wps_beacon_ie_len; | |
425 | } | |
426 | #endif /* CONFIG_WPS */ | |
427 | ||
6fc6879b JM |
428 | tail_len = tailpos > tail ? tailpos - tail : 0; |
429 | ||
430 | if (hostapd_set_beacon(hapd->conf->iface, hapd, (u8 *) head, head_len, | |
431 | tail, tail_len)) | |
432 | wpa_printf(MSG_ERROR, "Failed to set beacon head/tail"); | |
433 | ||
434 | os_free(tail); | |
435 | os_free(head); | |
436 | ||
eb1f7446 JM |
437 | if (hostapd_set_dtim_period(hapd, hapd->conf->dtim_period)) |
438 | wpa_printf(MSG_ERROR, "Could not set DTIM period for kernel " | |
439 | "driver"); | |
440 | ||
6fc6879b JM |
441 | if (hostapd_set_cts_protect(hapd, cts_protection)) |
442 | wpa_printf(MSG_ERROR, "Failed to set CTS protect in kernel " | |
443 | "driver"); | |
444 | ||
445 | if (hapd->iface->current_mode && | |
446 | hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G && | |
447 | hostapd_set_short_slot_time(hapd, | |
448 | hapd->iface->num_sta_no_short_slot_time | |
449 | > 0 ? 0 : 1)) | |
450 | wpa_printf(MSG_ERROR, "Failed to set Short Slot Time option " | |
451 | "in kernel driver"); | |
452 | ||
453 | if (hapd->iface->num_sta_no_short_preamble == 0 && | |
454 | hapd->iconf->preamble == SHORT_PREAMBLE) | |
455 | preamble = SHORT_PREAMBLE; | |
456 | else | |
457 | preamble = LONG_PREAMBLE; | |
458 | if (hostapd_set_preamble(hapd, preamble)) | |
459 | wpa_printf(MSG_ERROR, "Could not set preamble for kernel " | |
460 | "driver"); | |
461 | } | |
462 | ||
463 | ||
464 | void ieee802_11_set_beacons(struct hostapd_iface *iface) | |
465 | { | |
466 | size_t i; | |
467 | for (i = 0; i < iface->num_bss; i++) | |
468 | ieee802_11_set_beacon(iface->bss[i]); | |
469 | } | |
470 | ||
471 | #endif /* CONFIG_NATIVE_WINDOWS */ |