2 * hostapd - Driver operations
3 * Copyright (c) 2009-2010, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
9 #include "utils/includes.h"
11 #include "utils/common.h"
12 #include "common/ieee802_11_defs.h"
16 #include "ieee802_11.h"
18 #include "ap_config.h"
19 #include "p2p_hostapd.h"
21 #include "ap_drv_ops.h"
24 u32 hostapd_sta_flags_to_drv(u32 flags)
27 if (flags & WLAN_STA_AUTHORIZED)
28 res |= WPA_STA_AUTHORIZED;
29 if (flags & WLAN_STA_WMM)
31 if (flags & WLAN_STA_SHORT_PREAMBLE)
32 res |= WPA_STA_SHORT_PREAMBLE;
33 if (flags & WLAN_STA_MFP)
39 int hostapd_build_ap_extra_ies(struct hostapd_data *hapd,
40 struct wpabuf **beacon_ret,
41 struct wpabuf **proberesp_ret,
42 struct wpabuf **assocresp_ret)
44 struct wpabuf *beacon = NULL, *proberesp = NULL, *assocresp = NULL;
47 *beacon_ret = *proberesp_ret = *assocresp_ret = NULL;
50 pos = hostapd_eid_time_adv(hapd, pos);
52 if (wpabuf_resize(&beacon, pos - buf) != 0)
54 wpabuf_put_data(beacon, buf, pos - buf);
56 pos = hostapd_eid_time_zone(hapd, pos);
58 if (wpabuf_resize(&proberesp, pos - buf) != 0)
60 wpabuf_put_data(proberesp, buf, pos - buf);
64 pos = hostapd_eid_ext_capab(hapd, pos);
66 if (wpabuf_resize(&assocresp, pos - buf) != 0)
68 wpabuf_put_data(assocresp, buf, pos - buf);
70 pos = hostapd_eid_interworking(hapd, pos);
71 pos = hostapd_eid_adv_proto(hapd, pos);
72 pos = hostapd_eid_roaming_consortium(hapd, pos);
74 if (wpabuf_resize(&beacon, pos - buf) != 0)
76 wpabuf_put_data(beacon, buf, pos - buf);
78 if (wpabuf_resize(&proberesp, pos - buf) != 0)
80 wpabuf_put_data(proberesp, buf, pos - buf);
83 if (hapd->wps_beacon_ie) {
84 if (wpabuf_resize(&beacon, wpabuf_len(hapd->wps_beacon_ie)) <
87 wpabuf_put_buf(beacon, hapd->wps_beacon_ie);
90 if (hapd->wps_probe_resp_ie) {
91 if (wpabuf_resize(&proberesp,
92 wpabuf_len(hapd->wps_probe_resp_ie)) < 0)
94 wpabuf_put_buf(proberesp, hapd->wps_probe_resp_ie);
98 if (hapd->p2p_beacon_ie) {
99 if (wpabuf_resize(&beacon, wpabuf_len(hapd->p2p_beacon_ie)) <
102 wpabuf_put_buf(beacon, hapd->p2p_beacon_ie);
105 if (hapd->p2p_probe_resp_ie) {
106 if (wpabuf_resize(&proberesp,
107 wpabuf_len(hapd->p2p_probe_resp_ie)) < 0)
109 wpabuf_put_buf(proberesp, hapd->p2p_probe_resp_ie);
111 #endif /* CONFIG_P2P */
113 #ifdef CONFIG_P2P_MANAGER
114 if (hapd->conf->p2p & P2P_MANAGE) {
115 if (wpabuf_resize(&beacon, 100) == 0) {
117 start = wpabuf_put(beacon, 0);
118 p = hostapd_eid_p2p_manage(hapd, start);
119 wpabuf_put(beacon, p - start);
122 if (wpabuf_resize(&proberesp, 100) == 0) {
124 start = wpabuf_put(proberesp, 0);
125 p = hostapd_eid_p2p_manage(hapd, start);
126 wpabuf_put(proberesp, p - start);
129 #endif /* CONFIG_P2P_MANAGER */
132 if (hapd->conf->wps_state) {
133 struct wpabuf *a = wps_build_assoc_resp_ie();
134 if (a && wpabuf_resize(&assocresp, wpabuf_len(a)) == 0)
135 wpabuf_put_buf(assocresp, a);
138 #endif /* CONFIG_WPS2 */
140 #ifdef CONFIG_P2P_MANAGER
141 if (hapd->conf->p2p & P2P_MANAGE) {
142 if (wpabuf_resize(&assocresp, 100) == 0) {
144 start = wpabuf_put(assocresp, 0);
145 p = hostapd_eid_p2p_manage(hapd, start);
146 wpabuf_put(assocresp, p - start);
149 #endif /* CONFIG_P2P_MANAGER */
151 #ifdef CONFIG_WIFI_DISPLAY
152 if (hapd->p2p_group) {
154 a = p2p_group_assoc_resp_ie(hapd->p2p_group, P2P_SC_SUCCESS);
155 if (a && wpabuf_resize(&assocresp, wpabuf_len(a)) == 0)
156 wpabuf_put_buf(assocresp, a);
159 #endif /* CONFIG_WIFI_DISPLAY */
163 pos = hostapd_eid_hs20_indication(hapd, pos);
165 if (wpabuf_resize(&beacon, pos - buf) != 0)
167 wpabuf_put_data(beacon, buf, pos - buf);
169 if (wpabuf_resize(&proberesp, pos - buf) != 0)
171 wpabuf_put_data(proberesp, buf, pos - buf);
173 #endif /* CONFIG_HS20 */
175 if (hapd->conf->vendor_elements) {
176 size_t add = wpabuf_len(hapd->conf->vendor_elements);
177 if (wpabuf_resize(&beacon, add) == 0)
178 wpabuf_put_buf(beacon, hapd->conf->vendor_elements);
179 if (wpabuf_resize(&proberesp, add) == 0)
180 wpabuf_put_buf(proberesp, hapd->conf->vendor_elements);
183 *beacon_ret = beacon;
184 *proberesp_ret = proberesp;
185 *assocresp_ret = assocresp;
191 wpabuf_free(proberesp);
192 wpabuf_free(assocresp);
197 void hostapd_free_ap_extra_ies(struct hostapd_data *hapd,
198 struct wpabuf *beacon,
199 struct wpabuf *proberesp,
200 struct wpabuf *assocresp)
203 wpabuf_free(proberesp);
204 wpabuf_free(assocresp);
208 int hostapd_set_ap_wps_ie(struct hostapd_data *hapd)
210 struct wpabuf *beacon, *proberesp, *assocresp;
213 if (hapd->driver == NULL || hapd->driver->set_ap_wps_ie == NULL)
216 if (hostapd_build_ap_extra_ies(hapd, &beacon, &proberesp, &assocresp) <
220 ret = hapd->driver->set_ap_wps_ie(hapd->drv_priv, beacon, proberesp,
223 hostapd_free_ap_extra_ies(hapd, beacon, proberesp, assocresp);
229 int hostapd_set_authorized(struct hostapd_data *hapd,
230 struct sta_info *sta, int authorized)
233 return hostapd_sta_set_flags(hapd, sta->addr,
234 hostapd_sta_flags_to_drv(
236 WPA_STA_AUTHORIZED, ~0);
239 return hostapd_sta_set_flags(hapd, sta->addr,
240 hostapd_sta_flags_to_drv(sta->flags),
241 0, ~WPA_STA_AUTHORIZED);
245 int hostapd_set_sta_flags(struct hostapd_data *hapd, struct sta_info *sta)
247 int set_flags, total_flags, flags_and, flags_or;
248 total_flags = hostapd_sta_flags_to_drv(sta->flags);
249 set_flags = WPA_STA_SHORT_PREAMBLE | WPA_STA_WMM | WPA_STA_MFP;
250 if (((!hapd->conf->ieee802_1x && !hapd->conf->wpa) ||
251 sta->auth_alg == WLAN_AUTH_FT) &&
252 sta->flags & WLAN_STA_AUTHORIZED)
253 set_flags |= WPA_STA_AUTHORIZED;
254 flags_or = total_flags & set_flags;
255 flags_and = total_flags | ~set_flags;
256 return hostapd_sta_set_flags(hapd, sta->addr, total_flags,
257 flags_or, flags_and);
261 int hostapd_set_drv_ieee8021x(struct hostapd_data *hapd, const char *ifname,
264 struct wpa_bss_params params;
265 os_memset(¶ms, 0, sizeof(params));
266 params.ifname = ifname;
267 params.enabled = enabled;
269 params.wpa = hapd->conf->wpa;
270 params.ieee802_1x = hapd->conf->ieee802_1x;
271 params.wpa_group = hapd->conf->wpa_group;
272 params.wpa_pairwise = hapd->conf->wpa_pairwise;
273 params.wpa_key_mgmt = hapd->conf->wpa_key_mgmt;
274 params.rsn_preauth = hapd->conf->rsn_preauth;
275 #ifdef CONFIG_IEEE80211W
276 params.ieee80211w = hapd->conf->ieee80211w;
277 #endif /* CONFIG_IEEE80211W */
279 return hostapd_set_ieee8021x(hapd, ¶ms);
283 int hostapd_vlan_if_add(struct hostapd_data *hapd, const char *ifname)
285 char force_ifname[IFNAMSIZ];
286 u8 if_addr[ETH_ALEN];
287 return hostapd_if_add(hapd, WPA_IF_AP_VLAN, ifname, hapd->own_addr,
288 NULL, NULL, force_ifname, if_addr, NULL, 0);
292 int hostapd_vlan_if_remove(struct hostapd_data *hapd, const char *ifname)
294 return hostapd_if_remove(hapd, WPA_IF_AP_VLAN, ifname);
298 int hostapd_set_wds_sta(struct hostapd_data *hapd, char *ifname_wds,
299 const u8 *addr, int aid, int val)
301 const char *bridge = NULL;
303 if (hapd->driver == NULL || hapd->driver->set_wds_sta == NULL)
305 if (hapd->conf->wds_bridge[0])
306 bridge = hapd->conf->wds_bridge;
307 else if (hapd->conf->bridge[0])
308 bridge = hapd->conf->bridge;
309 return hapd->driver->set_wds_sta(hapd->drv_priv, addr, aid, val,
314 int hostapd_add_sta_node(struct hostapd_data *hapd, const u8 *addr,
317 if (hapd->driver == NULL || hapd->driver->add_sta_node == NULL)
319 return hapd->driver->add_sta_node(hapd->drv_priv, addr, auth_alg);
323 int hostapd_sta_auth(struct hostapd_data *hapd, const u8 *addr,
324 u16 seq, u16 status, const u8 *ie, size_t len)
326 if (hapd->driver == NULL || hapd->driver->sta_auth == NULL)
328 return hapd->driver->sta_auth(hapd->drv_priv, hapd->own_addr, addr,
329 seq, status, ie, len);
333 int hostapd_sta_assoc(struct hostapd_data *hapd, const u8 *addr,
334 int reassoc, u16 status, const u8 *ie, size_t len)
336 if (hapd->driver == NULL || hapd->driver->sta_assoc == NULL)
338 return hapd->driver->sta_assoc(hapd->drv_priv, hapd->own_addr, addr,
339 reassoc, status, ie, len);
343 int hostapd_sta_add(struct hostapd_data *hapd,
344 const u8 *addr, u16 aid, u16 capability,
345 const u8 *supp_rates, size_t supp_rates_len,
347 const struct ieee80211_ht_capabilities *ht_capab,
348 const struct ieee80211_vht_capabilities *vht_capab,
349 u32 flags, u8 qosinfo)
351 struct hostapd_sta_add_params params;
353 if (hapd->driver == NULL)
355 if (hapd->driver->sta_add == NULL)
358 os_memset(¶ms, 0, sizeof(params));
361 params.capability = capability;
362 params.supp_rates = supp_rates;
363 params.supp_rates_len = supp_rates_len;
364 params.listen_interval = listen_interval;
365 params.ht_capabilities = ht_capab;
366 params.vht_capabilities = vht_capab;
367 params.flags = hostapd_sta_flags_to_drv(flags);
368 params.qosinfo = qosinfo;
369 return hapd->driver->sta_add(hapd->drv_priv, ¶ms);
373 int hostapd_add_tspec(struct hostapd_data *hapd, const u8 *addr,
374 u8 *tspec_ie, size_t tspec_ielen)
376 if (hapd->driver == NULL || hapd->driver->add_tspec == NULL)
378 return hapd->driver->add_tspec(hapd->drv_priv, addr, tspec_ie,
383 int hostapd_set_privacy(struct hostapd_data *hapd, int enabled)
385 if (hapd->driver == NULL || hapd->driver->set_privacy == NULL)
387 return hapd->driver->set_privacy(hapd->drv_priv, enabled);
391 int hostapd_set_generic_elem(struct hostapd_data *hapd, const u8 *elem,
394 if (hapd->driver == NULL || hapd->driver->set_generic_elem == NULL)
396 return hapd->driver->set_generic_elem(hapd->drv_priv, elem, elem_len);
400 int hostapd_get_ssid(struct hostapd_data *hapd, u8 *buf, size_t len)
402 if (hapd->driver == NULL || hapd->driver->hapd_get_ssid == NULL)
404 return hapd->driver->hapd_get_ssid(hapd->drv_priv, buf, len);
408 int hostapd_set_ssid(struct hostapd_data *hapd, const u8 *buf, size_t len)
410 if (hapd->driver == NULL || hapd->driver->hapd_set_ssid == NULL)
412 return hapd->driver->hapd_set_ssid(hapd->drv_priv, buf, len);
416 int hostapd_if_add(struct hostapd_data *hapd, enum wpa_driver_if_type type,
417 const char *ifname, const u8 *addr, void *bss_ctx,
418 void **drv_priv, char *force_ifname, u8 *if_addr,
419 const char *bridge, int use_existing)
421 if (hapd->driver == NULL || hapd->driver->if_add == NULL)
423 return hapd->driver->if_add(hapd->drv_priv, type, ifname, addr,
424 bss_ctx, drv_priv, force_ifname, if_addr,
425 bridge, use_existing);
429 int hostapd_if_remove(struct hostapd_data *hapd, enum wpa_driver_if_type type,
432 if (hapd->driver == NULL || hapd->drv_priv == NULL ||
433 hapd->driver->if_remove == NULL)
435 return hapd->driver->if_remove(hapd->drv_priv, type, ifname);
439 int hostapd_set_ieee8021x(struct hostapd_data *hapd,
440 struct wpa_bss_params *params)
442 if (hapd->driver == NULL || hapd->driver->set_ieee8021x == NULL)
444 return hapd->driver->set_ieee8021x(hapd->drv_priv, params);
448 int hostapd_get_seqnum(const char *ifname, struct hostapd_data *hapd,
449 const u8 *addr, int idx, u8 *seq)
451 if (hapd->driver == NULL || hapd->driver->get_seqnum == NULL)
453 return hapd->driver->get_seqnum(ifname, hapd->drv_priv, addr, idx,
458 int hostapd_flush(struct hostapd_data *hapd)
460 if (hapd->driver == NULL || hapd->driver->flush == NULL)
462 return hapd->driver->flush(hapd->drv_priv);
466 int hostapd_set_freq_params(struct hostapd_freq_params *data, int mode,
467 int freq, int channel, int ht_enabled,
468 int vht_enabled, int sec_channel_offset,
469 int vht_oper_chwidth, int center_segment0,
470 int center_segment1, u32 vht_caps)
474 os_memset(data, 0, sizeof(*data));
477 data->channel = channel;
478 data->ht_enabled = ht_enabled;
479 data->vht_enabled = vht_enabled;
480 data->sec_channel_offset = sec_channel_offset;
481 data->center_freq1 = freq + sec_channel_offset * 10;
482 data->center_freq2 = 0;
483 data->bandwidth = sec_channel_offset ? 40 : 20;
486 * This validation code is probably misplaced, maybe it should be
487 * in src/ap/hw_features.c and check the hardware support as well.
489 if (data->vht_enabled) switch (vht_oper_chwidth) {
490 case VHT_CHANWIDTH_USE_HT:
493 if (5000 + center_segment0 * 5 != data->center_freq1 &&
494 2407 + center_segment0 * 5 != data->center_freq1)
497 case VHT_CHANWIDTH_80P80MHZ:
498 if (!(vht_caps & VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ)) {
499 wpa_printf(MSG_ERROR,
500 "80+80 channel width is not supported!");
503 if (center_segment1 == center_segment0 + 4 ||
504 center_segment1 == center_segment0 - 4)
506 data->center_freq2 = 5000 + center_segment1 * 5;
508 case VHT_CHANWIDTH_80MHZ:
509 data->bandwidth = 80;
510 if (vht_oper_chwidth == 1 && center_segment1)
512 if (vht_oper_chwidth == 3 && !center_segment1)
514 if (!sec_channel_offset)
516 /* primary 40 part must match the HT configuration */
517 tmp = (30 + freq - 5000 - center_segment0 * 5)/20;
519 if (data->center_freq1 != 5000 +
520 center_segment0 * 5 - 20 + 40 * tmp)
522 data->center_freq1 = 5000 + center_segment0 * 5;
524 case VHT_CHANWIDTH_160MHZ:
525 data->bandwidth = 160;
526 if (!(vht_caps & (VHT_CAP_SUPP_CHAN_WIDTH_160MHZ |
527 VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ))) {
528 wpa_printf(MSG_ERROR,
529 "160MHZ channel width is not supported!");
534 if (!sec_channel_offset)
536 /* primary 40 part must match the HT configuration */
537 tmp = (70 + freq - 5000 - center_segment0 * 5)/20;
539 if (data->center_freq1 != 5000 +
540 center_segment0 * 5 - 60 + 40 * tmp)
542 data->center_freq1 = 5000 + center_segment0 * 5;
550 int hostapd_set_freq(struct hostapd_data *hapd, int mode, int freq,
551 int channel, int ht_enabled, int vht_enabled,
552 int sec_channel_offset, int vht_oper_chwidth,
553 int center_segment0, int center_segment1)
555 struct hostapd_freq_params data;
557 if (hostapd_set_freq_params(&data, mode, freq, channel, ht_enabled,
558 vht_enabled, sec_channel_offset,
560 center_segment0, center_segment1,
561 hapd->iface->current_mode->vht_capab))
564 if (hapd->driver == NULL)
566 if (hapd->driver->set_freq == NULL)
568 return hapd->driver->set_freq(hapd->drv_priv, &data);
571 int hostapd_set_rts(struct hostapd_data *hapd, int rts)
573 if (hapd->driver == NULL || hapd->driver->set_rts == NULL)
575 return hapd->driver->set_rts(hapd->drv_priv, rts);
579 int hostapd_set_frag(struct hostapd_data *hapd, int frag)
581 if (hapd->driver == NULL || hapd->driver->set_frag == NULL)
583 return hapd->driver->set_frag(hapd->drv_priv, frag);
587 int hostapd_sta_set_flags(struct hostapd_data *hapd, u8 *addr,
588 int total_flags, int flags_or, int flags_and)
590 if (hapd->driver == NULL || hapd->driver->sta_set_flags == NULL)
592 return hapd->driver->sta_set_flags(hapd->drv_priv, addr, total_flags,
593 flags_or, flags_and);
597 int hostapd_set_country(struct hostapd_data *hapd, const char *country)
599 if (hapd->driver == NULL ||
600 hapd->driver->set_country == NULL)
602 return hapd->driver->set_country(hapd->drv_priv, country);
606 int hostapd_set_tx_queue_params(struct hostapd_data *hapd, int queue, int aifs,
607 int cw_min, int cw_max, int burst_time)
609 if (hapd->driver == NULL || hapd->driver->set_tx_queue_params == NULL)
611 return hapd->driver->set_tx_queue_params(hapd->drv_priv, queue, aifs,
612 cw_min, cw_max, burst_time);
616 struct hostapd_hw_modes *
617 hostapd_get_hw_feature_data(struct hostapd_data *hapd, u16 *num_modes,
620 if (hapd->driver == NULL ||
621 hapd->driver->get_hw_feature_data == NULL)
623 return hapd->driver->get_hw_feature_data(hapd->drv_priv, num_modes,
628 int hostapd_driver_commit(struct hostapd_data *hapd)
630 if (hapd->driver == NULL || hapd->driver->commit == NULL)
632 return hapd->driver->commit(hapd->drv_priv);
636 int hostapd_drv_none(struct hostapd_data *hapd)
638 return hapd->driver && os_strcmp(hapd->driver->name, "none") == 0;
642 int hostapd_driver_scan(struct hostapd_data *hapd,
643 struct wpa_driver_scan_params *params)
645 if (hapd->driver && hapd->driver->scan2)
646 return hapd->driver->scan2(hapd->drv_priv, params);
651 struct wpa_scan_results * hostapd_driver_get_scan_results(
652 struct hostapd_data *hapd)
654 if (hapd->driver && hapd->driver->get_scan_results2)
655 return hapd->driver->get_scan_results2(hapd->drv_priv);
660 int hostapd_driver_set_noa(struct hostapd_data *hapd, u8 count, int start,
663 if (hapd->driver && hapd->driver->set_noa)
664 return hapd->driver->set_noa(hapd->drv_priv, count, start,
670 int hostapd_drv_set_key(const char *ifname, struct hostapd_data *hapd,
671 enum wpa_alg alg, const u8 *addr,
672 int key_idx, int set_tx,
673 const u8 *seq, size_t seq_len,
674 const u8 *key, size_t key_len)
676 if (hapd->driver == NULL || hapd->driver->set_key == NULL)
678 return hapd->driver->set_key(ifname, hapd->drv_priv, alg, addr,
679 key_idx, set_tx, seq, seq_len, key,
684 int hostapd_drv_send_mlme(struct hostapd_data *hapd,
685 const void *msg, size_t len, int noack)
687 if (hapd->driver == NULL || hapd->driver->send_mlme == NULL)
689 return hapd->driver->send_mlme(hapd->drv_priv, msg, len, noack);
693 int hostapd_drv_sta_deauth(struct hostapd_data *hapd,
694 const u8 *addr, int reason)
696 if (hapd->driver == NULL || hapd->driver->sta_deauth == NULL)
698 return hapd->driver->sta_deauth(hapd->drv_priv, hapd->own_addr, addr,
703 int hostapd_drv_sta_disassoc(struct hostapd_data *hapd,
704 const u8 *addr, int reason)
706 if (hapd->driver == NULL || hapd->driver->sta_disassoc == NULL)
708 return hapd->driver->sta_disassoc(hapd->drv_priv, hapd->own_addr, addr,
713 int hostapd_drv_wnm_oper(struct hostapd_data *hapd, enum wnm_oper oper,
714 const u8 *peer, u8 *buf, u16 *buf_len)
716 if (hapd->driver == NULL || hapd->driver->wnm_oper == NULL)
718 return hapd->driver->wnm_oper(hapd->drv_priv, oper, peer, buf,
723 int hostapd_drv_send_action(struct hostapd_data *hapd, unsigned int freq,
724 unsigned int wait, const u8 *dst, const u8 *data,
727 if (hapd->driver == NULL || hapd->driver->send_action == NULL)
729 return hapd->driver->send_action(hapd->drv_priv, freq, wait, dst,
730 hapd->own_addr, hapd->own_addr, data,
735 int hostapd_start_dfs_cac(struct hostapd_iface *iface, int mode, int freq,
736 int channel, int ht_enabled, int vht_enabled,
737 int sec_channel_offset, int vht_oper_chwidth,
738 int center_segment0, int center_segment1)
740 struct hostapd_data *hapd = iface->bss[0];
741 struct hostapd_freq_params data;
744 if (!hapd->driver || !hapd->driver->start_dfs_cac)
747 if (!iface->conf->ieee80211h) {
748 wpa_printf(MSG_ERROR, "Can't start DFS CAC, DFS functionality "
753 if (hostapd_set_freq_params(&data, mode, freq, channel, ht_enabled,
754 vht_enabled, sec_channel_offset,
755 vht_oper_chwidth, center_segment0,
757 iface->current_mode->vht_capab))
760 res = hapd->driver->start_dfs_cac(hapd->drv_priv, &data);
762 iface->cac_started = 1;
768 int hostapd_drv_set_qos_map(struct hostapd_data *hapd,
769 const u8 *qos_map_set, u8 qos_map_set_len)
771 if (hapd->driver == NULL || hapd->driver->set_qos_map == NULL)
773 return hapd->driver->set_qos_map(hapd->drv_priv, qos_map_set,