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"
38 static u8
ieee802_11_erp_info(struct hostapd_data
*hapd
)
42 if (hapd
->iface
->current_mode
== NULL
||
43 hapd
->iface
->current_mode
->mode
!= HOSTAPD_MODE_IEEE80211G
)
46 switch (hapd
->iconf
->cts_protection_type
) {
47 case CTS_PROTECTION_FORCE_ENABLED
:
48 erp
|= ERP_INFO_NON_ERP_PRESENT
| ERP_INFO_USE_PROTECTION
;
50 case CTS_PROTECTION_FORCE_DISABLED
:
53 case CTS_PROTECTION_AUTOMATIC
:
54 if (hapd
->iface
->olbc
)
55 erp
|= ERP_INFO_USE_PROTECTION
;
57 case CTS_PROTECTION_AUTOMATIC_NO_OLBC
:
58 if (hapd
->iface
->num_sta_non_erp
> 0) {
59 erp
|= ERP_INFO_NON_ERP_PRESENT
|
60 ERP_INFO_USE_PROTECTION
;
64 if (hapd
->iface
->num_sta_no_short_preamble
> 0 ||
65 hapd
->iconf
->preamble
== LONG_PREAMBLE
)
66 erp
|= ERP_INFO_BARKER_PREAMBLE_MODE
;
72 static u8
* hostapd_eid_ds_params(struct hostapd_data
*hapd
, u8
*eid
)
74 *eid
++ = WLAN_EID_DS_PARAMS
;
76 *eid
++ = hapd
->iconf
->channel
;
81 static u8
* hostapd_eid_erp_info(struct hostapd_data
*hapd
, u8
*eid
)
83 if (hapd
->iface
->current_mode
== NULL
||
84 hapd
->iface
->current_mode
->mode
!= HOSTAPD_MODE_IEEE80211G
)
87 /* Set NonERP_present and use_protection bits if there
88 * are any associated NonERP stations. */
89 /* TODO: use_protection bit can be set to zero even if
90 * there are NonERP stations present. This optimization
91 * might be useful if NonERP stations are "quiet".
92 * See 802.11g/D6 E-1 for recommended practice.
93 * In addition, Non ERP present might be set, if AP detects Non ERP
94 * operation on other APs. */
96 /* Add ERP Information element */
97 *eid
++ = WLAN_EID_ERP_INFO
;
99 *eid
++ = ieee802_11_erp_info(hapd
);
105 static u8
* hostapd_eid_country_add(u8
*pos
, u8
*end
, int chan_spacing
,
106 struct hostapd_channel_data
*start
,
107 struct hostapd_channel_data
*prev
)
112 /* first channel number */
113 *pos
++ = start
->chan
;
114 /* number of channels */
115 *pos
++ = (prev
->chan
- start
->chan
) / chan_spacing
+ 1;
116 /* maximum transmit power level */
117 *pos
++ = start
->max_tx_power
;
123 static u8
* hostapd_eid_country(struct hostapd_data
*hapd
, u8
*eid
,
127 u8
*end
= eid
+ max_len
;
129 struct hostapd_hw_modes
*mode
;
130 struct hostapd_channel_data
*start
, *prev
;
131 int chan_spacing
= 1;
133 if (!hapd
->iconf
->ieee80211d
|| max_len
< 6 ||
134 hapd
->iface
->current_mode
== NULL
)
137 *pos
++ = WLAN_EID_COUNTRY
;
138 pos
++; /* length will be set later */
139 os_memcpy(pos
, hapd
->iconf
->country
, 3); /* e.g., 'US ' */
142 mode
= hapd
->iface
->current_mode
;
143 if (mode
->mode
== HOSTAPD_MODE_IEEE80211A
)
147 for (i
= 0; i
< mode
->num_channels
; i
++) {
148 struct hostapd_channel_data
*chan
= &mode
->channels
[i
];
149 if (chan
->flag
& HOSTAPD_CHAN_DISABLED
)
152 prev
->chan
+ chan_spacing
== chan
->chan
&&
153 start
->max_tx_power
== chan
->max_tx_power
) {
155 continue; /* can use same entry */
159 pos
= hostapd_eid_country_add(pos
, end
, chan_spacing
,
164 /* Start new group */
169 pos
= hostapd_eid_country_add(pos
, end
, chan_spacing
,
173 if ((pos
- eid
) & 1) {
176 *pos
++ = 0; /* pad for 16-bit alignment */
179 eid
[1] = (pos
- eid
) - 2;
185 static u8
* hostapd_eid_wpa(struct hostapd_data
*hapd
, u8
*eid
, size_t len
,
186 struct sta_info
*sta
)
191 ie
= wpa_auth_get_wpa_ie(hapd
->wpa_auth
, &ielen
);
192 if (ie
== NULL
|| ielen
> len
)
195 os_memcpy(eid
, ie
, ielen
);
200 void handle_probe_req(struct hostapd_data
*hapd
,
201 const struct ieee80211_mgmt
*mgmt
, size_t len
)
203 struct ieee80211_mgmt
*resp
;
204 struct ieee802_11_elems elems
;
208 size_t ssid_len
, ie_len
;
209 struct sta_info
*sta
= NULL
;
213 ie
= mgmt
->u
.probe_req
.variable
;
214 if (len
< IEEE80211_HDRLEN
+ sizeof(mgmt
->u
.probe_req
))
216 ie_len
= len
- (IEEE80211_HDRLEN
+ sizeof(mgmt
->u
.probe_req
));
218 for (i
= 0; hapd
->probereq_cb
&& i
< hapd
->num_probereq_cb
; i
++)
219 if (hapd
->probereq_cb
[i
].cb(hapd
->probereq_cb
[i
].ctx
,
220 mgmt
->sa
, mgmt
->da
, mgmt
->bssid
,
224 if (!hapd
->iconf
->send_probe_response
)
227 if (ieee802_11_parse_elems(ie
, ie_len
, &elems
, 0) == ParseFailed
) {
228 wpa_printf(MSG_DEBUG
, "Could not parse ProbeReq from " MACSTR
,
236 if ((!elems
.ssid
|| !elems
.supp_rates
)) {
237 wpa_printf(MSG_DEBUG
, "STA " MACSTR
" sent probe request "
238 "without SSID or supported rates element",
244 if (hapd
->p2p
&& elems
.wps_ie
) {
246 wps
= ieee802_11_vendor_ie_concat(ie
, ie_len
, WPS_DEV_OUI_WFA
);
247 if (wps
&& !p2p_group_match_dev_type(hapd
->p2p_group
, wps
)) {
248 wpa_printf(MSG_MSGDUMP
, "P2P: Ignore Probe Request "
249 "due to mismatch with Requested Device "
256 #endif /* CONFIG_P2P */
258 if (hapd
->conf
->ignore_broadcast_ssid
&& elems
.ssid_len
== 0) {
259 wpa_printf(MSG_MSGDUMP
, "Probe Request from " MACSTR
" for "
260 "broadcast SSID ignored", MAC2STR(mgmt
->sa
));
264 sta
= ap_get_sta(hapd
, mgmt
->sa
);
267 if ((hapd
->conf
->p2p
& P2P_GROUP_OWNER
) &&
268 elems
.ssid_len
== P2P_WILDCARD_SSID_LEN
&&
269 os_memcmp(elems
.ssid
, P2P_WILDCARD_SSID
,
270 P2P_WILDCARD_SSID_LEN
) == 0) {
271 /* Process P2P Wildcard SSID like Wildcard SSID */
274 #endif /* CONFIG_P2P */
276 if (elems
.ssid_len
== 0 ||
277 (elems
.ssid_len
== hapd
->conf
->ssid
.ssid_len
&&
278 os_memcmp(elems
.ssid
, hapd
->conf
->ssid
.ssid
, elems
.ssid_len
) ==
280 ssid
= hapd
->conf
->ssid
.ssid
;
281 ssid_len
= hapd
->conf
->ssid
.ssid_len
;
283 sta
->ssid_probe
= &hapd
->conf
->ssid
;
287 if (!(mgmt
->da
[0] & 0x01)) {
289 ieee802_11_print_ssid(ssid_txt
, elems
.ssid
,
291 wpa_printf(MSG_MSGDUMP
, "Probe Request from " MACSTR
292 " for foreign SSID '%s' (DA " MACSTR
")",
293 MAC2STR(mgmt
->sa
), ssid_txt
,
299 /* TODO: verify that supp_rates contains at least one matching rate
300 * with AP configuration */
301 #define MAX_PROBERESP_LEN 768
302 buflen
= MAX_PROBERESP_LEN
;
304 if (hapd
->wps_probe_resp_ie
)
305 buflen
+= wpabuf_len(hapd
->wps_probe_resp_ie
);
306 #endif /* CONFIG_WPS */
308 if (hapd
->p2p_probe_resp_ie
)
309 buflen
+= wpabuf_len(hapd
->p2p_probe_resp_ie
);
310 #endif /* CONFIG_P2P */
311 resp
= os_zalloc(buflen
);
314 epos
= ((u8
*) resp
) + MAX_PROBERESP_LEN
;
316 resp
->frame_control
= IEEE80211_FC(WLAN_FC_TYPE_MGMT
,
317 WLAN_FC_STYPE_PROBE_RESP
);
318 os_memcpy(resp
->da
, mgmt
->sa
, ETH_ALEN
);
319 os_memcpy(resp
->sa
, hapd
->own_addr
, ETH_ALEN
);
321 os_memcpy(resp
->bssid
, hapd
->own_addr
, ETH_ALEN
);
322 resp
->u
.probe_resp
.beacon_int
=
323 host_to_le16(hapd
->iconf
->beacon_int
);
325 /* hardware or low-level driver will setup seq_ctrl and timestamp */
326 resp
->u
.probe_resp
.capab_info
=
327 host_to_le16(hostapd_own_capab_info(hapd
, sta
, 1));
329 pos
= resp
->u
.probe_resp
.variable
;
330 *pos
++ = WLAN_EID_SSID
;
332 os_memcpy(pos
, ssid
, ssid_len
);
335 /* Supported rates */
336 pos
= hostapd_eid_supp_rates(hapd
, pos
);
339 pos
= hostapd_eid_ds_params(hapd
, pos
);
341 pos
= hostapd_eid_country(hapd
, pos
, epos
- pos
);
343 /* ERP Information element */
344 pos
= hostapd_eid_erp_info(hapd
, pos
);
346 /* Extended supported rates */
347 pos
= hostapd_eid_ext_supp_rates(hapd
, pos
);
350 pos
= hostapd_eid_wpa(hapd
, pos
, epos
- pos
, sta
);
352 #ifdef CONFIG_IEEE80211N
353 pos
= hostapd_eid_ht_capabilities(hapd
, pos
);
354 pos
= hostapd_eid_ht_operation(hapd
, pos
);
355 #endif /* CONFIG_IEEE80211N */
357 pos
= hostapd_eid_ext_capab(hapd
, pos
);
359 /* Wi-Fi Alliance WMM */
360 pos
= hostapd_eid_wmm(hapd
, pos
);
363 if (hapd
->conf
->wps_state
&& hapd
->wps_probe_resp_ie
) {
364 os_memcpy(pos
, wpabuf_head(hapd
->wps_probe_resp_ie
),
365 wpabuf_len(hapd
->wps_probe_resp_ie
));
366 pos
+= wpabuf_len(hapd
->wps_probe_resp_ie
);
368 #endif /* CONFIG_WPS */
371 if ((hapd
->conf
->p2p
& P2P_ENABLED
) && elems
.p2p
&&
372 hapd
->p2p_probe_resp_ie
) {
373 os_memcpy(pos
, wpabuf_head(hapd
->p2p_probe_resp_ie
),
374 wpabuf_len(hapd
->p2p_probe_resp_ie
));
375 pos
+= wpabuf_len(hapd
->p2p_probe_resp_ie
);
377 #endif /* CONFIG_P2P */
378 #ifdef CONFIG_P2P_MANAGER
379 if ((hapd
->conf
->p2p
& (P2P_MANAGE
| P2P_ENABLED
| P2P_GROUP_OWNER
)) ==
381 pos
= hostapd_eid_p2p_manage(hapd
, pos
);
382 #endif /* CONFIG_P2P_MANAGER */
384 if (hostapd_drv_send_mlme(hapd
, resp
, pos
- (u8
*) resp
) < 0)
385 perror("handle_probe_req: send");
389 wpa_printf(MSG_EXCESSIVE
, "STA " MACSTR
" sent probe request for %s "
390 "SSID", MAC2STR(mgmt
->sa
),
391 elems
.ssid_len
== 0 ? "broadcast" : "our");
395 void ieee802_11_set_beacon(struct hostapd_data
*hapd
)
397 struct ieee80211_mgmt
*head
;
398 u8
*pos
, *tail
, *tailpos
;
400 size_t head_len
, tail_len
;
403 if ((hapd
->conf
->p2p
& (P2P_ENABLED
| P2P_GROUP_OWNER
)) == P2P_ENABLED
)
405 #endif /* CONFIG_P2P */
406 hapd
->beacon_set_done
= 1;
408 #define BEACON_HEAD_BUF_SIZE 256
409 #define BEACON_TAIL_BUF_SIZE 512
410 head
= os_zalloc(BEACON_HEAD_BUF_SIZE
);
411 tail_len
= BEACON_TAIL_BUF_SIZE
;
413 if (hapd
->conf
->wps_state
&& hapd
->wps_beacon_ie
)
414 tail_len
+= wpabuf_len(hapd
->wps_beacon_ie
);
415 #endif /* CONFIG_WPS */
417 if (hapd
->p2p_beacon_ie
)
418 tail_len
+= wpabuf_len(hapd
->p2p_beacon_ie
);
419 #endif /* CONFIG_P2P */
420 tailpos
= tail
= os_malloc(tail_len
);
421 if (head
== NULL
|| tail
== NULL
) {
422 wpa_printf(MSG_ERROR
, "Failed to set beacon data");
428 head
->frame_control
= IEEE80211_FC(WLAN_FC_TYPE_MGMT
,
429 WLAN_FC_STYPE_BEACON
);
430 head
->duration
= host_to_le16(0);
431 os_memset(head
->da
, 0xff, ETH_ALEN
);
433 os_memcpy(head
->sa
, hapd
->own_addr
, ETH_ALEN
);
434 os_memcpy(head
->bssid
, hapd
->own_addr
, ETH_ALEN
);
435 head
->u
.beacon
.beacon_int
=
436 host_to_le16(hapd
->iconf
->beacon_int
);
438 /* hardware or low-level driver will setup seq_ctrl and timestamp */
439 capab_info
= hostapd_own_capab_info(hapd
, NULL
, 0);
440 head
->u
.beacon
.capab_info
= host_to_le16(capab_info
);
441 pos
= &head
->u
.beacon
.variable
[0];
444 *pos
++ = WLAN_EID_SSID
;
445 if (hapd
->conf
->ignore_broadcast_ssid
== 2) {
446 /* clear the data, but keep the correct length of the SSID */
447 *pos
++ = hapd
->conf
->ssid
.ssid_len
;
448 os_memset(pos
, 0, hapd
->conf
->ssid
.ssid_len
);
449 pos
+= hapd
->conf
->ssid
.ssid_len
;
450 } else if (hapd
->conf
->ignore_broadcast_ssid
) {
451 *pos
++ = 0; /* empty SSID */
453 *pos
++ = hapd
->conf
->ssid
.ssid_len
;
454 os_memcpy(pos
, hapd
->conf
->ssid
.ssid
,
455 hapd
->conf
->ssid
.ssid_len
);
456 pos
+= hapd
->conf
->ssid
.ssid_len
;
459 /* Supported rates */
460 pos
= hostapd_eid_supp_rates(hapd
, pos
);
463 pos
= hostapd_eid_ds_params(hapd
, pos
);
465 head_len
= pos
- (u8
*) head
;
467 tailpos
= hostapd_eid_country(hapd
, tailpos
,
468 tail
+ BEACON_TAIL_BUF_SIZE
- tailpos
);
470 /* ERP Information element */
471 tailpos
= hostapd_eid_erp_info(hapd
, tailpos
);
473 /* Extended supported rates */
474 tailpos
= hostapd_eid_ext_supp_rates(hapd
, tailpos
);
477 tailpos
= hostapd_eid_wpa(hapd
, tailpos
, tail
+ BEACON_TAIL_BUF_SIZE
-
480 #ifdef CONFIG_IEEE80211N
481 tailpos
= hostapd_eid_ht_capabilities(hapd
, tailpos
);
482 tailpos
= hostapd_eid_ht_operation(hapd
, tailpos
);
483 #endif /* CONFIG_IEEE80211N */
485 tailpos
= hostapd_eid_ext_capab(hapd
, tailpos
);
487 /* Wi-Fi Alliance WMM */
488 tailpos
= hostapd_eid_wmm(hapd
, tailpos
);
491 if (hapd
->conf
->wps_state
&& hapd
->wps_beacon_ie
) {
492 os_memcpy(tailpos
, wpabuf_head(hapd
->wps_beacon_ie
),
493 wpabuf_len(hapd
->wps_beacon_ie
));
494 tailpos
+= wpabuf_len(hapd
->wps_beacon_ie
);
496 #endif /* CONFIG_WPS */
499 if ((hapd
->conf
->p2p
& P2P_ENABLED
) && hapd
->p2p_beacon_ie
) {
500 os_memcpy(tailpos
, wpabuf_head(hapd
->p2p_beacon_ie
),
501 wpabuf_len(hapd
->p2p_beacon_ie
));
502 tailpos
+= wpabuf_len(hapd
->p2p_beacon_ie
);
504 #endif /* CONFIG_P2P */
505 #ifdef CONFIG_P2P_MANAGER
506 if ((hapd
->conf
->p2p
& (P2P_MANAGE
| P2P_ENABLED
| P2P_GROUP_OWNER
)) ==
508 tailpos
= hostapd_eid_p2p_manage(hapd
, tailpos
);
509 #endif /* CONFIG_P2P_MANAGER */
511 tail_len
= tailpos
> tail
? tailpos
- tail
: 0;
513 if (hostapd_drv_set_beacon(hapd
, (u8
*) head
, head_len
,
514 tail
, tail_len
, hapd
->conf
->dtim_period
,
515 hapd
->iconf
->beacon_int
))
516 wpa_printf(MSG_ERROR
, "Failed to set beacon head/tail or DTIM "
524 #endif /* CONFIG_P2P */
525 hostapd_set_bss_params(hapd
, !!(ieee802_11_erp_info(hapd
) &
526 ERP_INFO_USE_PROTECTION
));
530 void ieee802_11_set_beacons(struct hostapd_iface
*iface
)
533 for (i
= 0; i
< iface
->num_bss
; i
++)
534 ieee802_11_set_beacon(iface
->bss
[i
]);
537 #endif /* CONFIG_NATIVE_WINDOWS */