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-2009, Jouni Malinen <j@w1.fi>
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.
11 * Alternatively, this software may be distributed under the terms of BSD
14 * See README and COPYING for more details.
17 #include "utils/includes.h"
19 #ifndef CONFIG_NATIVE_WINDOWS
21 #include "utils/common.h"
22 #include "common/ieee802_11_defs.h"
23 #include "common/ieee802_11_common.h"
24 #include "drivers/driver.h"
25 #include "wps/wps_defs.h"
28 #include "ieee802_11.h"
31 #include "ap_config.h"
33 #include "p2p_hostapd.h"
34 #include "ap_drv_ops.h"
40 static u8
ieee802_11_erp_info(struct hostapd_data
*hapd
)
44 if (hapd
->iface
->current_mode
== NULL
||
45 hapd
->iface
->current_mode
->mode
!= HOSTAPD_MODE_IEEE80211G
)
48 switch (hapd
->iconf
->cts_protection_type
) {
49 case CTS_PROTECTION_FORCE_ENABLED
:
50 erp
|= ERP_INFO_NON_ERP_PRESENT
| ERP_INFO_USE_PROTECTION
;
52 case CTS_PROTECTION_FORCE_DISABLED
:
55 case CTS_PROTECTION_AUTOMATIC
:
56 if (hapd
->iface
->olbc
)
57 erp
|= ERP_INFO_USE_PROTECTION
;
59 case CTS_PROTECTION_AUTOMATIC_NO_OLBC
:
60 if (hapd
->iface
->num_sta_non_erp
> 0) {
61 erp
|= ERP_INFO_NON_ERP_PRESENT
|
62 ERP_INFO_USE_PROTECTION
;
66 if (hapd
->iface
->num_sta_no_short_preamble
> 0 ||
67 hapd
->iconf
->preamble
== LONG_PREAMBLE
)
68 erp
|= ERP_INFO_BARKER_PREAMBLE_MODE
;
74 static u8
* hostapd_eid_ds_params(struct hostapd_data
*hapd
, u8
*eid
)
76 *eid
++ = WLAN_EID_DS_PARAMS
;
78 *eid
++ = hapd
->iconf
->channel
;
83 static u8
* hostapd_eid_erp_info(struct hostapd_data
*hapd
, u8
*eid
)
85 if (hapd
->iface
->current_mode
== NULL
||
86 hapd
->iface
->current_mode
->mode
!= HOSTAPD_MODE_IEEE80211G
)
89 /* Set NonERP_present and use_protection bits if there
90 * are any associated NonERP stations. */
91 /* TODO: use_protection bit can be set to zero even if
92 * there are NonERP stations present. This optimization
93 * might be useful if NonERP stations are "quiet".
94 * See 802.11g/D6 E-1 for recommended practice.
95 * In addition, Non ERP present might be set, if AP detects Non ERP
96 * operation on other APs. */
98 /* Add ERP Information element */
99 *eid
++ = WLAN_EID_ERP_INFO
;
101 *eid
++ = ieee802_11_erp_info(hapd
);
107 static u8
* hostapd_eid_country_add(u8
*pos
, u8
*end
, int chan_spacing
,
108 struct hostapd_channel_data
*start
,
109 struct hostapd_channel_data
*prev
)
114 /* first channel number */
115 *pos
++ = start
->chan
;
116 /* number of channels */
117 *pos
++ = (prev
->chan
- start
->chan
) / chan_spacing
+ 1;
118 /* maximum transmit power level */
119 *pos
++ = start
->max_tx_power
;
125 static u8
* hostapd_eid_country(struct hostapd_data
*hapd
, u8
*eid
,
129 u8
*end
= eid
+ max_len
;
131 struct hostapd_hw_modes
*mode
;
132 struct hostapd_channel_data
*start
, *prev
;
133 int chan_spacing
= 1;
135 if (!hapd
->iconf
->ieee80211d
|| max_len
< 6 ||
136 hapd
->iface
->current_mode
== NULL
)
139 *pos
++ = WLAN_EID_COUNTRY
;
140 pos
++; /* length will be set later */
141 os_memcpy(pos
, hapd
->iconf
->country
, 3); /* e.g., 'US ' */
144 mode
= hapd
->iface
->current_mode
;
145 if (mode
->mode
== HOSTAPD_MODE_IEEE80211A
)
149 for (i
= 0; i
< mode
->num_channels
; i
++) {
150 struct hostapd_channel_data
*chan
= &mode
->channels
[i
];
151 if (chan
->flag
& HOSTAPD_CHAN_DISABLED
)
154 prev
->chan
+ chan_spacing
== chan
->chan
&&
155 start
->max_tx_power
== chan
->max_tx_power
) {
157 continue; /* can use same entry */
161 pos
= hostapd_eid_country_add(pos
, end
, chan_spacing
,
166 /* Start new group */
171 pos
= hostapd_eid_country_add(pos
, end
, chan_spacing
,
175 if ((pos
- eid
) & 1) {
178 *pos
++ = 0; /* pad for 16-bit alignment */
181 eid
[1] = (pos
- eid
) - 2;
187 static u8
* hostapd_eid_wpa(struct hostapd_data
*hapd
, u8
*eid
, size_t len
)
192 ie
= wpa_auth_get_wpa_ie(hapd
->wpa_auth
, &ielen
);
193 if (ie
== NULL
|| ielen
> len
)
196 os_memcpy(eid
, ie
, ielen
);
201 void handle_probe_req(struct hostapd_data
*hapd
,
202 const struct ieee80211_mgmt
*mgmt
, size_t len
)
204 struct ieee80211_mgmt
*resp
;
205 struct ieee802_11_elems elems
;
209 size_t ssid_len
, ie_len
;
210 struct sta_info
*sta
= NULL
;
214 ie
= mgmt
->u
.probe_req
.variable
;
215 if (len
< IEEE80211_HDRLEN
+ sizeof(mgmt
->u
.probe_req
))
217 ie_len
= len
- (IEEE80211_HDRLEN
+ sizeof(mgmt
->u
.probe_req
));
219 for (i
= 0; hapd
->probereq_cb
&& i
< hapd
->num_probereq_cb
; i
++)
220 if (hapd
->probereq_cb
[i
].cb(hapd
->probereq_cb
[i
].ctx
,
221 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
,
225 if (!hapd
->iconf
->send_probe_response
)
228 if (ieee802_11_parse_elems(ie
, ie_len
, &elems
, 0) == ParseFailed
) {
229 wpa_printf(MSG_DEBUG
, "Could not parse ProbeReq from " MACSTR
,
237 if ((!elems
.ssid
|| !elems
.supp_rates
)) {
238 wpa_printf(MSG_DEBUG
, "STA " MACSTR
" sent probe request "
239 "without SSID or supported rates element",
245 if (hapd
->p2p
&& elems
.wps_ie
) {
247 wps
= ieee802_11_vendor_ie_concat(ie
, ie_len
, WPS_DEV_OUI_WFA
);
248 if (wps
&& !p2p_group_match_dev_type(hapd
->p2p_group
, wps
)) {
249 wpa_printf(MSG_MSGDUMP
, "P2P: Ignore Probe Request "
250 "due to mismatch with Requested Device "
257 #endif /* CONFIG_P2P */
259 if (hapd
->conf
->ignore_broadcast_ssid
&& elems
.ssid_len
== 0) {
260 wpa_printf(MSG_MSGDUMP
, "Probe Request from " MACSTR
" for "
261 "broadcast SSID ignored", MAC2STR(mgmt
->sa
));
265 sta
= ap_get_sta(hapd
, mgmt
->sa
);
268 if ((hapd
->conf
->p2p
& P2P_GROUP_OWNER
) &&
269 elems
.ssid_len
== P2P_WILDCARD_SSID_LEN
&&
270 os_memcmp(elems
.ssid
, P2P_WILDCARD_SSID
,
271 P2P_WILDCARD_SSID_LEN
) == 0) {
272 /* Process P2P Wildcard SSID like Wildcard SSID */
275 #endif /* CONFIG_P2P */
277 if (elems
.ssid_len
== 0 ||
278 (elems
.ssid_len
== hapd
->conf
->ssid
.ssid_len
&&
279 os_memcmp(elems
.ssid
, hapd
->conf
->ssid
.ssid
, elems
.ssid_len
) ==
281 ssid
= hapd
->conf
->ssid
.ssid
;
282 ssid_len
= hapd
->conf
->ssid
.ssid_len
;
284 sta
->ssid_probe
= &hapd
->conf
->ssid
;
288 if (!(mgmt
->da
[0] & 0x01)) {
290 ieee802_11_print_ssid(ssid_txt
, elems
.ssid
,
292 wpa_printf(MSG_MSGDUMP
, "Probe Request from " MACSTR
293 " for foreign SSID '%s' (DA " MACSTR
")",
294 MAC2STR(mgmt
->sa
), ssid_txt
,
300 /* TODO: verify that supp_rates contains at least one matching rate
301 * with AP configuration */
302 #define MAX_PROBERESP_LEN 768
303 buflen
= MAX_PROBERESP_LEN
;
305 if (hapd
->wps_probe_resp_ie
)
306 buflen
+= wpabuf_len(hapd
->wps_probe_resp_ie
);
307 #endif /* CONFIG_WPS */
309 if (hapd
->p2p_probe_resp_ie
)
310 buflen
+= wpabuf_len(hapd
->p2p_probe_resp_ie
);
311 #endif /* CONFIG_P2P */
312 resp
= os_zalloc(buflen
);
315 epos
= ((u8
*) resp
) + MAX_PROBERESP_LEN
;
317 resp
->frame_control
= IEEE80211_FC(WLAN_FC_TYPE_MGMT
,
318 WLAN_FC_STYPE_PROBE_RESP
);
319 os_memcpy(resp
->da
, mgmt
->sa
, ETH_ALEN
);
320 os_memcpy(resp
->sa
, hapd
->own_addr
, ETH_ALEN
);
322 os_memcpy(resp
->bssid
, hapd
->own_addr
, ETH_ALEN
);
323 resp
->u
.probe_resp
.beacon_int
=
324 host_to_le16(hapd
->iconf
->beacon_int
);
326 /* hardware or low-level driver will setup seq_ctrl and timestamp */
327 resp
->u
.probe_resp
.capab_info
=
328 host_to_le16(hostapd_own_capab_info(hapd
, sta
, 1));
330 pos
= resp
->u
.probe_resp
.variable
;
331 *pos
++ = WLAN_EID_SSID
;
333 os_memcpy(pos
, ssid
, ssid_len
);
336 /* Supported rates */
337 pos
= hostapd_eid_supp_rates(hapd
, pos
);
340 pos
= hostapd_eid_ds_params(hapd
, pos
);
342 pos
= hostapd_eid_country(hapd
, pos
, epos
- pos
);
344 /* ERP Information element */
345 pos
= hostapd_eid_erp_info(hapd
, pos
);
347 /* Extended supported rates */
348 pos
= hostapd_eid_ext_supp_rates(hapd
, pos
);
351 pos
= hostapd_eid_wpa(hapd
, pos
, epos
- pos
);
353 #ifdef CONFIG_IEEE80211N
354 pos
= hostapd_eid_ht_capabilities(hapd
, pos
);
355 pos
= hostapd_eid_ht_operation(hapd
, pos
);
356 #endif /* CONFIG_IEEE80211N */
358 pos
= hostapd_eid_ext_capab(hapd
, pos
);
360 pos
= hostapd_eid_interworking(hapd
, pos
);
362 /* Wi-Fi Alliance WMM */
363 pos
= hostapd_eid_wmm(hapd
, pos
);
366 if (hapd
->conf
->wps_state
&& hapd
->wps_probe_resp_ie
) {
367 os_memcpy(pos
, wpabuf_head(hapd
->wps_probe_resp_ie
),
368 wpabuf_len(hapd
->wps_probe_resp_ie
));
369 pos
+= wpabuf_len(hapd
->wps_probe_resp_ie
);
371 #endif /* CONFIG_WPS */
374 if ((hapd
->conf
->p2p
& P2P_ENABLED
) && elems
.p2p
&&
375 hapd
->p2p_probe_resp_ie
) {
376 os_memcpy(pos
, wpabuf_head(hapd
->p2p_probe_resp_ie
),
377 wpabuf_len(hapd
->p2p_probe_resp_ie
));
378 pos
+= wpabuf_len(hapd
->p2p_probe_resp_ie
);
380 #endif /* CONFIG_P2P */
381 #ifdef CONFIG_P2P_MANAGER
382 if ((hapd
->conf
->p2p
& (P2P_MANAGE
| P2P_ENABLED
| P2P_GROUP_OWNER
)) ==
384 pos
= hostapd_eid_p2p_manage(hapd
, pos
);
385 #endif /* CONFIG_P2P_MANAGER */
387 if (hostapd_drv_send_mlme(hapd
, resp
, pos
- (u8
*) resp
) < 0)
388 perror("handle_probe_req: send");
392 wpa_printf(MSG_EXCESSIVE
, "STA " MACSTR
" sent probe request for %s "
393 "SSID", MAC2STR(mgmt
->sa
),
394 elems
.ssid_len
== 0 ? "broadcast" : "our");
397 #endif /* NEED_AP_MLME */
400 void ieee802_11_set_beacon(struct hostapd_data
*hapd
)
402 struct ieee80211_mgmt
*head
= NULL
;
404 size_t head_len
= 0, tail_len
= 0;
405 struct wpa_driver_ap_params params
;
406 struct wpabuf
*beacon
, *proberesp
, *assocresp
;
410 #endif /* NEED_AP_MLME */
412 hapd
->beacon_set_done
= 1;
416 #define BEACON_HEAD_BUF_SIZE 256
417 #define BEACON_TAIL_BUF_SIZE 512
418 head
= os_zalloc(BEACON_HEAD_BUF_SIZE
);
419 tail_len
= BEACON_TAIL_BUF_SIZE
;
421 if (hapd
->conf
->wps_state
&& hapd
->wps_beacon_ie
)
422 tail_len
+= wpabuf_len(hapd
->wps_beacon_ie
);
423 #endif /* CONFIG_WPS */
425 if (hapd
->p2p_beacon_ie
)
426 tail_len
+= wpabuf_len(hapd
->p2p_beacon_ie
);
427 #endif /* CONFIG_P2P */
428 tailpos
= tail
= os_malloc(tail_len
);
429 if (head
== NULL
|| tail
== NULL
) {
430 wpa_printf(MSG_ERROR
, "Failed to set beacon data");
436 head
->frame_control
= IEEE80211_FC(WLAN_FC_TYPE_MGMT
,
437 WLAN_FC_STYPE_BEACON
);
438 head
->duration
= host_to_le16(0);
439 os_memset(head
->da
, 0xff, ETH_ALEN
);
441 os_memcpy(head
->sa
, hapd
->own_addr
, ETH_ALEN
);
442 os_memcpy(head
->bssid
, hapd
->own_addr
, ETH_ALEN
);
443 head
->u
.beacon
.beacon_int
=
444 host_to_le16(hapd
->iconf
->beacon_int
);
446 /* hardware or low-level driver will setup seq_ctrl and timestamp */
447 capab_info
= hostapd_own_capab_info(hapd
, NULL
, 0);
448 head
->u
.beacon
.capab_info
= host_to_le16(capab_info
);
449 pos
= &head
->u
.beacon
.variable
[0];
452 *pos
++ = WLAN_EID_SSID
;
453 if (hapd
->conf
->ignore_broadcast_ssid
== 2) {
454 /* clear the data, but keep the correct length of the SSID */
455 *pos
++ = hapd
->conf
->ssid
.ssid_len
;
456 os_memset(pos
, 0, hapd
->conf
->ssid
.ssid_len
);
457 pos
+= hapd
->conf
->ssid
.ssid_len
;
458 } else if (hapd
->conf
->ignore_broadcast_ssid
) {
459 *pos
++ = 0; /* empty SSID */
461 *pos
++ = hapd
->conf
->ssid
.ssid_len
;
462 os_memcpy(pos
, hapd
->conf
->ssid
.ssid
,
463 hapd
->conf
->ssid
.ssid_len
);
464 pos
+= hapd
->conf
->ssid
.ssid_len
;
467 /* Supported rates */
468 pos
= hostapd_eid_supp_rates(hapd
, pos
);
471 pos
= hostapd_eid_ds_params(hapd
, pos
);
473 head_len
= pos
- (u8
*) head
;
475 tailpos
= hostapd_eid_country(hapd
, tailpos
,
476 tail
+ BEACON_TAIL_BUF_SIZE
- tailpos
);
478 /* ERP Information element */
479 tailpos
= hostapd_eid_erp_info(hapd
, tailpos
);
481 /* Extended supported rates */
482 tailpos
= hostapd_eid_ext_supp_rates(hapd
, tailpos
);
485 tailpos
= hostapd_eid_wpa(hapd
, tailpos
, tail
+ BEACON_TAIL_BUF_SIZE
-
488 #ifdef CONFIG_IEEE80211N
489 tailpos
= hostapd_eid_ht_capabilities(hapd
, tailpos
);
490 tailpos
= hostapd_eid_ht_operation(hapd
, tailpos
);
491 #endif /* CONFIG_IEEE80211N */
493 tailpos
= hostapd_eid_ext_capab(hapd
, tailpos
);
495 tailpos
= hostapd_eid_interworking(hapd
, tailpos
);
497 /* Wi-Fi Alliance WMM */
498 tailpos
= hostapd_eid_wmm(hapd
, tailpos
);
501 if (hapd
->conf
->wps_state
&& hapd
->wps_beacon_ie
) {
502 os_memcpy(tailpos
, wpabuf_head(hapd
->wps_beacon_ie
),
503 wpabuf_len(hapd
->wps_beacon_ie
));
504 tailpos
+= wpabuf_len(hapd
->wps_beacon_ie
);
506 #endif /* CONFIG_WPS */
509 if ((hapd
->conf
->p2p
& P2P_ENABLED
) && hapd
->p2p_beacon_ie
) {
510 os_memcpy(tailpos
, wpabuf_head(hapd
->p2p_beacon_ie
),
511 wpabuf_len(hapd
->p2p_beacon_ie
));
512 tailpos
+= wpabuf_len(hapd
->p2p_beacon_ie
);
514 #endif /* CONFIG_P2P */
515 #ifdef CONFIG_P2P_MANAGER
516 if ((hapd
->conf
->p2p
& (P2P_MANAGE
| P2P_ENABLED
| P2P_GROUP_OWNER
)) ==
518 tailpos
= hostapd_eid_p2p_manage(hapd
, tailpos
);
519 #endif /* CONFIG_P2P_MANAGER */
521 tail_len
= tailpos
> tail
? tailpos
- tail
: 0;
523 #endif /* NEED_AP_MLME */
525 os_memset(¶ms
, 0, sizeof(params
));
526 params
.head
= (u8
*) head
;
527 params
.head_len
= head_len
;
529 params
.tail_len
= tail_len
;
530 params
.dtim_period
= hapd
->conf
->dtim_period
;
531 params
.beacon_int
= hapd
->iconf
->beacon_int
;
532 params
.ssid
= (u8
*) hapd
->conf
->ssid
.ssid
;
533 params
.ssid_len
= hapd
->conf
->ssid
.ssid_len
;
534 params
.pairwise_ciphers
= hapd
->conf
->rsn_pairwise
?
535 hapd
->conf
->rsn_pairwise
: hapd
->conf
->wpa_pairwise
;
536 params
.group_cipher
= hapd
->conf
->wpa_group
;
537 params
.key_mgmt_suites
= hapd
->conf
->wpa_key_mgmt
;
538 params
.auth_algs
= hapd
->conf
->auth_algs
;
539 params
.wpa_version
= hapd
->conf
->wpa
;
540 params
.privacy
= hapd
->conf
->ssid
.wep
.keys_set
|| hapd
->conf
->wpa
||
541 (hapd
->conf
->ieee802_1x
&&
542 (hapd
->conf
->default_wep_key_len
||
543 hapd
->conf
->individual_wep_key_len
));
544 switch (hapd
->conf
->ignore_broadcast_ssid
) {
546 params
.hide_ssid
= NO_SSID_HIDING
;
549 params
.hide_ssid
= HIDDEN_SSID_ZERO_LEN
;
552 params
.hide_ssid
= HIDDEN_SSID_ZERO_CONTENTS
;
555 hostapd_build_ap_extra_ies(hapd
, &beacon
, &proberesp
, &assocresp
);
556 params
.beacon_ies
= beacon
;
557 params
.proberesp_ies
= proberesp
;
558 params
.assocresp_ies
= assocresp
;
559 params
.isolate
= hapd
->conf
->isolate
;
561 params
.cts_protect
= !!(ieee802_11_erp_info(hapd
) &
562 ERP_INFO_USE_PROTECTION
);
563 params
.preamble
= hapd
->iface
->num_sta_no_short_preamble
== 0 &&
564 hapd
->iconf
->preamble
== SHORT_PREAMBLE
;
565 if (hapd
->iface
->current_mode
&&
566 hapd
->iface
->current_mode
->mode
== HOSTAPD_MODE_IEEE80211G
)
567 params
.short_slot_time
=
568 hapd
->iface
->num_sta_no_short_slot_time
> 0 ? 0 : 1;
570 params
.short_slot_time
= -1;
571 if (!hapd
->iconf
->ieee80211n
|| hapd
->conf
->disable_11n
)
572 params
.ht_opmode
= -1;
574 params
.ht_opmode
= hapd
->iface
->ht_op_mode
;
575 #endif /* NEED_AP_MLME */
576 if (hostapd_drv_set_ap(hapd
, ¶ms
))
577 wpa_printf(MSG_ERROR
, "Failed to set beacon parameters");
578 hostapd_free_ap_extra_ies(hapd
, beacon
, proberesp
, assocresp
);
585 void ieee802_11_set_beacons(struct hostapd_iface
*iface
)
588 for (i
= 0; i
< iface
->num_bss
; i
++)
589 ieee802_11_set_beacon(iface
->bss
[i
]);
592 #endif /* CONFIG_NATIVE_WINDOWS */