mesh: Delay Authentication frame process with no_auto_peer
[mech_eap.git] / src / ap / hostapd.c
1 /*
2  * hostapd / Initialization and configuration
3  * Copyright (c) 2002-2014, Jouni Malinen <j@w1.fi>
4  *
5  * This software may be distributed under the terms of the BSD license.
6  * See README for more details.
7  */
8
9 #include "utils/includes.h"
10
11 #include "utils/common.h"
12 #include "utils/eloop.h"
13 #include "common/ieee802_11_defs.h"
14 #include "common/wpa_ctrl.h"
15 #include "radius/radius_client.h"
16 #include "radius/radius_das.h"
17 #include "eap_server/tncs.h"
18 #include "hostapd.h"
19 #include "authsrv.h"
20 #include "sta_info.h"
21 #include "accounting.h"
22 #include "ap_list.h"
23 #include "beacon.h"
24 #include "iapp.h"
25 #include "ieee802_1x.h"
26 #include "ieee802_11_auth.h"
27 #include "vlan_init.h"
28 #include "wpa_auth.h"
29 #include "wps_hostapd.h"
30 #include "hw_features.h"
31 #include "wpa_auth_glue.h"
32 #include "ap_drv_ops.h"
33 #include "ap_config.h"
34 #include "p2p_hostapd.h"
35 #include "gas_serv.h"
36 #include "dfs.h"
37 #include "ieee802_11.h"
38 #include "bss_load.h"
39 #include "x_snoop.h"
40 #include "dhcp_snoop.h"
41 #include "ndisc_snoop.h"
42
43
44 static int hostapd_flush_old_stations(struct hostapd_data *hapd, u16 reason);
45 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd);
46 static int hostapd_broadcast_wep_clear(struct hostapd_data *hapd);
47 static int setup_interface2(struct hostapd_iface *iface);
48 static void channel_list_update_timeout(void *eloop_ctx, void *timeout_ctx);
49
50
51 int hostapd_for_each_interface(struct hapd_interfaces *interfaces,
52                                int (*cb)(struct hostapd_iface *iface,
53                                          void *ctx), void *ctx)
54 {
55         size_t i;
56         int ret;
57
58         for (i = 0; i < interfaces->count; i++) {
59                 ret = cb(interfaces->iface[i], ctx);
60                 if (ret)
61                         return ret;
62         }
63
64         return 0;
65 }
66
67
68 static void hostapd_reload_bss(struct hostapd_data *hapd)
69 {
70         struct hostapd_ssid *ssid;
71
72 #ifndef CONFIG_NO_RADIUS
73         radius_client_reconfig(hapd->radius, hapd->conf->radius);
74 #endif /* CONFIG_NO_RADIUS */
75
76         ssid = &hapd->conf->ssid;
77         if (!ssid->wpa_psk_set && ssid->wpa_psk && !ssid->wpa_psk->next &&
78             ssid->wpa_passphrase_set && ssid->wpa_passphrase) {
79                 /*
80                  * Force PSK to be derived again since SSID or passphrase may
81                  * have changed.
82                  */
83                 os_free(ssid->wpa_psk);
84                 ssid->wpa_psk = NULL;
85         }
86         if (hostapd_setup_wpa_psk(hapd->conf)) {
87                 wpa_printf(MSG_ERROR, "Failed to re-configure WPA PSK "
88                            "after reloading configuration");
89         }
90
91         if (hapd->conf->ieee802_1x || hapd->conf->wpa)
92                 hostapd_set_drv_ieee8021x(hapd, hapd->conf->iface, 1);
93         else
94                 hostapd_set_drv_ieee8021x(hapd, hapd->conf->iface, 0);
95
96         if ((hapd->conf->wpa || hapd->conf->osen) && hapd->wpa_auth == NULL) {
97                 hostapd_setup_wpa(hapd);
98                 if (hapd->wpa_auth)
99                         wpa_init_keys(hapd->wpa_auth);
100         } else if (hapd->conf->wpa) {
101                 const u8 *wpa_ie;
102                 size_t wpa_ie_len;
103                 hostapd_reconfig_wpa(hapd);
104                 wpa_ie = wpa_auth_get_wpa_ie(hapd->wpa_auth, &wpa_ie_len);
105                 if (hostapd_set_generic_elem(hapd, wpa_ie, wpa_ie_len))
106                         wpa_printf(MSG_ERROR, "Failed to configure WPA IE for "
107                                    "the kernel driver.");
108         } else if (hapd->wpa_auth) {
109                 wpa_deinit(hapd->wpa_auth);
110                 hapd->wpa_auth = NULL;
111                 hostapd_set_privacy(hapd, 0);
112                 hostapd_setup_encryption(hapd->conf->iface, hapd);
113                 hostapd_set_generic_elem(hapd, (u8 *) "", 0);
114         }
115
116         ieee802_11_set_beacon(hapd);
117         hostapd_update_wps(hapd);
118
119         if (hapd->conf->ssid.ssid_set &&
120             hostapd_set_ssid(hapd, hapd->conf->ssid.ssid,
121                              hapd->conf->ssid.ssid_len)) {
122                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
123                 /* try to continue */
124         }
125         wpa_printf(MSG_DEBUG, "Reconfigured interface %s", hapd->conf->iface);
126 }
127
128
129 static void hostapd_clear_old(struct hostapd_iface *iface)
130 {
131         size_t j;
132
133         /*
134          * Deauthenticate all stations since the new configuration may not
135          * allow them to use the BSS anymore.
136          */
137         for (j = 0; j < iface->num_bss; j++) {
138                 hostapd_flush_old_stations(iface->bss[j],
139                                            WLAN_REASON_PREV_AUTH_NOT_VALID);
140                 hostapd_broadcast_wep_clear(iface->bss[j]);
141
142 #ifndef CONFIG_NO_RADIUS
143                 /* TODO: update dynamic data based on changed configuration
144                  * items (e.g., open/close sockets, etc.) */
145                 radius_client_flush(iface->bss[j]->radius, 0);
146 #endif /* CONFIG_NO_RADIUS */
147         }
148 }
149
150
151 int hostapd_reload_config(struct hostapd_iface *iface)
152 {
153         struct hostapd_data *hapd = iface->bss[0];
154         struct hostapd_config *newconf, *oldconf;
155         size_t j;
156
157         if (iface->config_fname == NULL) {
158                 /* Only in-memory config in use - assume it has been updated */
159                 hostapd_clear_old(iface);
160                 for (j = 0; j < iface->num_bss; j++)
161                         hostapd_reload_bss(iface->bss[j]);
162                 return 0;
163         }
164
165         if (iface->interfaces == NULL ||
166             iface->interfaces->config_read_cb == NULL)
167                 return -1;
168         newconf = iface->interfaces->config_read_cb(iface->config_fname);
169         if (newconf == NULL)
170                 return -1;
171
172         hostapd_clear_old(iface);
173
174         oldconf = hapd->iconf;
175         iface->conf = newconf;
176
177         for (j = 0; j < iface->num_bss; j++) {
178                 hapd = iface->bss[j];
179                 hapd->iconf = newconf;
180                 hapd->iconf->channel = oldconf->channel;
181                 hapd->iconf->secondary_channel = oldconf->secondary_channel;
182                 hapd->iconf->ieee80211n = oldconf->ieee80211n;
183                 hapd->iconf->ieee80211ac = oldconf->ieee80211ac;
184                 hapd->iconf->ht_capab = oldconf->ht_capab;
185                 hapd->iconf->vht_capab = oldconf->vht_capab;
186                 hapd->iconf->vht_oper_chwidth = oldconf->vht_oper_chwidth;
187                 hapd->iconf->vht_oper_centr_freq_seg0_idx =
188                         oldconf->vht_oper_centr_freq_seg0_idx;
189                 hapd->iconf->vht_oper_centr_freq_seg1_idx =
190                         oldconf->vht_oper_centr_freq_seg1_idx;
191                 hapd->conf = newconf->bss[j];
192                 hostapd_reload_bss(hapd);
193         }
194
195         hostapd_config_free(oldconf);
196
197
198         return 0;
199 }
200
201
202 static void hostapd_broadcast_key_clear_iface(struct hostapd_data *hapd,
203                                               char *ifname)
204 {
205         int i;
206
207         for (i = 0; i < NUM_WEP_KEYS; i++) {
208                 if (hostapd_drv_set_key(ifname, hapd, WPA_ALG_NONE, NULL, i,
209                                         0, NULL, 0, NULL, 0)) {
210                         wpa_printf(MSG_DEBUG, "Failed to clear default "
211                                    "encryption keys (ifname=%s keyidx=%d)",
212                                    ifname, i);
213                 }
214         }
215 #ifdef CONFIG_IEEE80211W
216         if (hapd->conf->ieee80211w) {
217                 for (i = NUM_WEP_KEYS; i < NUM_WEP_KEYS + 2; i++) {
218                         if (hostapd_drv_set_key(ifname, hapd, WPA_ALG_NONE,
219                                                 NULL, i, 0, NULL,
220                                                 0, NULL, 0)) {
221                                 wpa_printf(MSG_DEBUG, "Failed to clear "
222                                            "default mgmt encryption keys "
223                                            "(ifname=%s keyidx=%d)", ifname, i);
224                         }
225                 }
226         }
227 #endif /* CONFIG_IEEE80211W */
228 }
229
230
231 static int hostapd_broadcast_wep_clear(struct hostapd_data *hapd)
232 {
233         hostapd_broadcast_key_clear_iface(hapd, hapd->conf->iface);
234         return 0;
235 }
236
237
238 static int hostapd_broadcast_wep_set(struct hostapd_data *hapd)
239 {
240         int errors = 0, idx;
241         struct hostapd_ssid *ssid = &hapd->conf->ssid;
242
243         idx = ssid->wep.idx;
244         if (ssid->wep.default_len &&
245             hostapd_drv_set_key(hapd->conf->iface,
246                                 hapd, WPA_ALG_WEP, broadcast_ether_addr, idx,
247                                 1, NULL, 0, ssid->wep.key[idx],
248                                 ssid->wep.len[idx])) {
249                 wpa_printf(MSG_WARNING, "Could not set WEP encryption.");
250                 errors++;
251         }
252
253         return errors;
254 }
255
256
257 static void hostapd_free_hapd_data(struct hostapd_data *hapd)
258 {
259         if (!hapd->started) {
260                 wpa_printf(MSG_ERROR, "%s: Interface %s wasn't started",
261                            __func__, hapd->conf->iface);
262                 return;
263         }
264         hapd->started = 0;
265
266         wpa_printf(MSG_DEBUG, "%s(%s)", __func__, hapd->conf->iface);
267         iapp_deinit(hapd->iapp);
268         hapd->iapp = NULL;
269         accounting_deinit(hapd);
270         hostapd_deinit_wpa(hapd);
271         vlan_deinit(hapd);
272         hostapd_acl_deinit(hapd);
273 #ifndef CONFIG_NO_RADIUS
274         radius_client_deinit(hapd->radius);
275         hapd->radius = NULL;
276         radius_das_deinit(hapd->radius_das);
277         hapd->radius_das = NULL;
278 #endif /* CONFIG_NO_RADIUS */
279
280         hostapd_deinit_wps(hapd);
281
282         authsrv_deinit(hapd);
283
284         if (hapd->interface_added) {
285                 hapd->interface_added = 0;
286                 if (hostapd_if_remove(hapd, WPA_IF_AP_BSS, hapd->conf->iface)) {
287                         wpa_printf(MSG_WARNING,
288                                    "Failed to remove BSS interface %s",
289                                    hapd->conf->iface);
290                         hapd->interface_added = 1;
291                 } else {
292                         /*
293                          * Since this was a dynamically added interface, the
294                          * driver wrapper may have removed its internal instance
295                          * and hapd->drv_priv is not valid anymore.
296                          */
297                         hapd->drv_priv = NULL;
298                 }
299         }
300
301         os_free(hapd->probereq_cb);
302         hapd->probereq_cb = NULL;
303
304 #ifdef CONFIG_P2P
305         wpabuf_free(hapd->p2p_beacon_ie);
306         hapd->p2p_beacon_ie = NULL;
307         wpabuf_free(hapd->p2p_probe_resp_ie);
308         hapd->p2p_probe_resp_ie = NULL;
309 #endif /* CONFIG_P2P */
310
311         wpabuf_free(hapd->time_adv);
312
313 #ifdef CONFIG_INTERWORKING
314         gas_serv_deinit(hapd);
315 #endif /* CONFIG_INTERWORKING */
316
317         bss_load_update_deinit(hapd);
318         ndisc_snoop_deinit(hapd);
319         dhcp_snoop_deinit(hapd);
320         x_snoop_deinit(hapd);
321
322 #ifdef CONFIG_SQLITE
323         bin_clear_free(hapd->tmp_eap_user.identity,
324                        hapd->tmp_eap_user.identity_len);
325         bin_clear_free(hapd->tmp_eap_user.password,
326                        hapd->tmp_eap_user.password_len);
327 #endif /* CONFIG_SQLITE */
328
329 #ifdef CONFIG_MESH
330         wpabuf_free(hapd->mesh_pending_auth);
331         hapd->mesh_pending_auth = NULL;
332 #endif /* CONFIG_MESH */
333 }
334
335
336 /**
337  * hostapd_cleanup - Per-BSS cleanup (deinitialization)
338  * @hapd: Pointer to BSS data
339  *
340  * This function is used to free all per-BSS data structures and resources.
341  * Most of the modules that are initialized in hostapd_setup_bss() are
342  * deinitialized here.
343  */
344 static void hostapd_cleanup(struct hostapd_data *hapd)
345 {
346         wpa_printf(MSG_DEBUG, "%s(hapd=%p (%s))", __func__, hapd,
347                    hapd->conf->iface);
348         if (hapd->iface->interfaces &&
349             hapd->iface->interfaces->ctrl_iface_deinit)
350                 hapd->iface->interfaces->ctrl_iface_deinit(hapd);
351         hostapd_free_hapd_data(hapd);
352 }
353
354
355 static void hostapd_cleanup_iface_partial(struct hostapd_iface *iface)
356 {
357         wpa_printf(MSG_DEBUG, "%s(%p)", __func__, iface);
358         hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
359         iface->hw_features = NULL;
360         os_free(iface->current_rates);
361         iface->current_rates = NULL;
362         os_free(iface->basic_rates);
363         iface->basic_rates = NULL;
364         ap_list_deinit(iface);
365 }
366
367
368 /**
369  * hostapd_cleanup_iface - Complete per-interface cleanup
370  * @iface: Pointer to interface data
371  *
372  * This function is called after per-BSS data structures are deinitialized
373  * with hostapd_cleanup().
374  */
375 static void hostapd_cleanup_iface(struct hostapd_iface *iface)
376 {
377         wpa_printf(MSG_DEBUG, "%s(%p)", __func__, iface);
378         eloop_cancel_timeout(channel_list_update_timeout, iface, NULL);
379
380         hostapd_cleanup_iface_partial(iface);
381         hostapd_config_free(iface->conf);
382         iface->conf = NULL;
383
384         os_free(iface->config_fname);
385         os_free(iface->bss);
386         wpa_printf(MSG_DEBUG, "%s: free iface=%p", __func__, iface);
387         os_free(iface);
388 }
389
390
391 static void hostapd_clear_wep(struct hostapd_data *hapd)
392 {
393         if (hapd->drv_priv && !hapd->iface->driver_ap_teardown) {
394                 hostapd_set_privacy(hapd, 0);
395                 hostapd_broadcast_wep_clear(hapd);
396         }
397 }
398
399
400 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd)
401 {
402         int i;
403
404         hostapd_broadcast_wep_set(hapd);
405
406         if (hapd->conf->ssid.wep.default_len) {
407                 hostapd_set_privacy(hapd, 1);
408                 return 0;
409         }
410
411         /*
412          * When IEEE 802.1X is not enabled, the driver may need to know how to
413          * set authentication algorithms for static WEP.
414          */
415         hostapd_drv_set_authmode(hapd, hapd->conf->auth_algs);
416
417         for (i = 0; i < 4; i++) {
418                 if (hapd->conf->ssid.wep.key[i] &&
419                     hostapd_drv_set_key(iface, hapd, WPA_ALG_WEP, NULL, i,
420                                         i == hapd->conf->ssid.wep.idx, NULL, 0,
421                                         hapd->conf->ssid.wep.key[i],
422                                         hapd->conf->ssid.wep.len[i])) {
423                         wpa_printf(MSG_WARNING, "Could not set WEP "
424                                    "encryption.");
425                         return -1;
426                 }
427                 if (hapd->conf->ssid.wep.key[i] &&
428                     i == hapd->conf->ssid.wep.idx)
429                         hostapd_set_privacy(hapd, 1);
430         }
431
432         return 0;
433 }
434
435
436 static int hostapd_flush_old_stations(struct hostapd_data *hapd, u16 reason)
437 {
438         int ret = 0;
439         u8 addr[ETH_ALEN];
440
441         if (hostapd_drv_none(hapd) || hapd->drv_priv == NULL)
442                 return 0;
443
444         if (!hapd->iface->driver_ap_teardown) {
445                 wpa_dbg(hapd->msg_ctx, MSG_DEBUG,
446                         "Flushing old station entries");
447
448                 if (hostapd_flush(hapd)) {
449                         wpa_msg(hapd->msg_ctx, MSG_WARNING,
450                                 "Could not connect to kernel driver");
451                         ret = -1;
452                 }
453         }
454         wpa_dbg(hapd->msg_ctx, MSG_DEBUG, "Deauthenticate all stations");
455         os_memset(addr, 0xff, ETH_ALEN);
456         hostapd_drv_sta_deauth(hapd, addr, reason);
457         hostapd_free_stas(hapd);
458
459         return ret;
460 }
461
462
463 static void hostapd_bss_deinit_no_free(struct hostapd_data *hapd)
464 {
465         hostapd_free_stas(hapd);
466         hostapd_flush_old_stations(hapd, WLAN_REASON_DEAUTH_LEAVING);
467         hostapd_clear_wep(hapd);
468 }
469
470
471 /**
472  * hostapd_validate_bssid_configuration - Validate BSSID configuration
473  * @iface: Pointer to interface data
474  * Returns: 0 on success, -1 on failure
475  *
476  * This function is used to validate that the configured BSSIDs are valid.
477  */
478 static int hostapd_validate_bssid_configuration(struct hostapd_iface *iface)
479 {
480         u8 mask[ETH_ALEN] = { 0 };
481         struct hostapd_data *hapd = iface->bss[0];
482         unsigned int i = iface->conf->num_bss, bits = 0, j;
483         int auto_addr = 0;
484
485         if (hostapd_drv_none(hapd))
486                 return 0;
487
488         /* Generate BSSID mask that is large enough to cover the BSSIDs. */
489
490         /* Determine the bits necessary to cover the number of BSSIDs. */
491         for (i--; i; i >>= 1)
492                 bits++;
493
494         /* Determine the bits necessary to any configured BSSIDs,
495            if they are higher than the number of BSSIDs. */
496         for (j = 0; j < iface->conf->num_bss; j++) {
497                 if (hostapd_mac_comp_empty(iface->conf->bss[j]->bssid) == 0) {
498                         if (j)
499                                 auto_addr++;
500                         continue;
501                 }
502
503                 for (i = 0; i < ETH_ALEN; i++) {
504                         mask[i] |=
505                                 iface->conf->bss[j]->bssid[i] ^
506                                 hapd->own_addr[i];
507                 }
508         }
509
510         if (!auto_addr)
511                 goto skip_mask_ext;
512
513         for (i = 0; i < ETH_ALEN && mask[i] == 0; i++)
514                 ;
515         j = 0;
516         if (i < ETH_ALEN) {
517                 j = (5 - i) * 8;
518
519                 while (mask[i] != 0) {
520                         mask[i] >>= 1;
521                         j++;
522                 }
523         }
524
525         if (bits < j)
526                 bits = j;
527
528         if (bits > 40) {
529                 wpa_printf(MSG_ERROR, "Too many bits in the BSSID mask (%u)",
530                            bits);
531                 return -1;
532         }
533
534         os_memset(mask, 0xff, ETH_ALEN);
535         j = bits / 8;
536         for (i = 5; i > 5 - j; i--)
537                 mask[i] = 0;
538         j = bits % 8;
539         while (j--)
540                 mask[i] <<= 1;
541
542 skip_mask_ext:
543         wpa_printf(MSG_DEBUG, "BSS count %lu, BSSID mask " MACSTR " (%d bits)",
544                    (unsigned long) iface->conf->num_bss, MAC2STR(mask), bits);
545
546         if (!auto_addr)
547                 return 0;
548
549         for (i = 0; i < ETH_ALEN; i++) {
550                 if ((hapd->own_addr[i] & mask[i]) != hapd->own_addr[i]) {
551                         wpa_printf(MSG_ERROR, "Invalid BSSID mask " MACSTR
552                                    " for start address " MACSTR ".",
553                                    MAC2STR(mask), MAC2STR(hapd->own_addr));
554                         wpa_printf(MSG_ERROR, "Start address must be the "
555                                    "first address in the block (i.e., addr "
556                                    "AND mask == addr).");
557                         return -1;
558                 }
559         }
560
561         return 0;
562 }
563
564
565 static int mac_in_conf(struct hostapd_config *conf, const void *a)
566 {
567         size_t i;
568
569         for (i = 0; i < conf->num_bss; i++) {
570                 if (hostapd_mac_comp(conf->bss[i]->bssid, a) == 0) {
571                         return 1;
572                 }
573         }
574
575         return 0;
576 }
577
578
579 #ifndef CONFIG_NO_RADIUS
580
581 static int hostapd_das_nas_mismatch(struct hostapd_data *hapd,
582                                     struct radius_das_attrs *attr)
583 {
584         if (attr->nas_identifier &&
585             (!hapd->conf->nas_identifier ||
586              os_strlen(hapd->conf->nas_identifier) !=
587              attr->nas_identifier_len ||
588              os_memcmp(hapd->conf->nas_identifier, attr->nas_identifier,
589                        attr->nas_identifier_len) != 0)) {
590                 wpa_printf(MSG_DEBUG, "RADIUS DAS: NAS-Identifier mismatch");
591                 return 1;
592         }
593
594         if (attr->nas_ip_addr &&
595             (hapd->conf->own_ip_addr.af != AF_INET ||
596              os_memcmp(&hapd->conf->own_ip_addr.u.v4, attr->nas_ip_addr, 4) !=
597              0)) {
598                 wpa_printf(MSG_DEBUG, "RADIUS DAS: NAS-IP-Address mismatch");
599                 return 1;
600         }
601
602 #ifdef CONFIG_IPV6
603         if (attr->nas_ipv6_addr &&
604             (hapd->conf->own_ip_addr.af != AF_INET6 ||
605              os_memcmp(&hapd->conf->own_ip_addr.u.v6, attr->nas_ipv6_addr, 16)
606              != 0)) {
607                 wpa_printf(MSG_DEBUG, "RADIUS DAS: NAS-IPv6-Address mismatch");
608                 return 1;
609         }
610 #endif /* CONFIG_IPV6 */
611
612         return 0;
613 }
614
615
616 static struct sta_info * hostapd_das_find_sta(struct hostapd_data *hapd,
617                                               struct radius_das_attrs *attr)
618 {
619         struct sta_info *sta = NULL;
620         char buf[128];
621
622         if (attr->sta_addr)
623                 sta = ap_get_sta(hapd, attr->sta_addr);
624
625         if (sta == NULL && attr->acct_session_id &&
626             attr->acct_session_id_len == 17) {
627                 for (sta = hapd->sta_list; sta; sta = sta->next) {
628                         os_snprintf(buf, sizeof(buf), "%08X-%08X",
629                                     sta->acct_session_id_hi,
630                                     sta->acct_session_id_lo);
631                         if (os_memcmp(attr->acct_session_id, buf, 17) == 0)
632                                 break;
633                 }
634         }
635
636         if (sta == NULL && attr->cui) {
637                 for (sta = hapd->sta_list; sta; sta = sta->next) {
638                         struct wpabuf *cui;
639                         cui = ieee802_1x_get_radius_cui(sta->eapol_sm);
640                         if (cui && wpabuf_len(cui) == attr->cui_len &&
641                             os_memcmp(wpabuf_head(cui), attr->cui,
642                                       attr->cui_len) == 0)
643                                 break;
644                 }
645         }
646
647         if (sta == NULL && attr->user_name) {
648                 for (sta = hapd->sta_list; sta; sta = sta->next) {
649                         u8 *identity;
650                         size_t identity_len;
651                         identity = ieee802_1x_get_identity(sta->eapol_sm,
652                                                            &identity_len);
653                         if (identity &&
654                             identity_len == attr->user_name_len &&
655                             os_memcmp(identity, attr->user_name, identity_len)
656                             == 0)
657                                 break;
658                 }
659         }
660
661         return sta;
662 }
663
664
665 static enum radius_das_res
666 hostapd_das_disconnect(void *ctx, struct radius_das_attrs *attr)
667 {
668         struct hostapd_data *hapd = ctx;
669         struct sta_info *sta;
670
671         if (hostapd_das_nas_mismatch(hapd, attr))
672                 return RADIUS_DAS_NAS_MISMATCH;
673
674         sta = hostapd_das_find_sta(hapd, attr);
675         if (sta == NULL)
676                 return RADIUS_DAS_SESSION_NOT_FOUND;
677
678         wpa_auth_pmksa_remove(hapd->wpa_auth, sta->addr);
679
680         hostapd_drv_sta_deauth(hapd, sta->addr,
681                                WLAN_REASON_PREV_AUTH_NOT_VALID);
682         ap_sta_deauthenticate(hapd, sta, WLAN_REASON_PREV_AUTH_NOT_VALID);
683
684         return RADIUS_DAS_SUCCESS;
685 }
686
687 #endif /* CONFIG_NO_RADIUS */
688
689
690 /**
691  * hostapd_setup_bss - Per-BSS setup (initialization)
692  * @hapd: Pointer to BSS data
693  * @first: Whether this BSS is the first BSS of an interface; -1 = not first,
694  *      but interface may exist
695  *
696  * This function is used to initialize all per-BSS data structures and
697  * resources. This gets called in a loop for each BSS when an interface is
698  * initialized. Most of the modules that are initialized here will be
699  * deinitialized in hostapd_cleanup().
700  */
701 static int hostapd_setup_bss(struct hostapd_data *hapd, int first)
702 {
703         struct hostapd_bss_config *conf = hapd->conf;
704         u8 ssid[HOSTAPD_MAX_SSID_LEN + 1];
705         int ssid_len, set_ssid;
706         char force_ifname[IFNAMSIZ];
707         u8 if_addr[ETH_ALEN];
708         int flush_old_stations = 1;
709
710         wpa_printf(MSG_DEBUG, "%s(hapd=%p (%s), first=%d)",
711                    __func__, hapd, conf->iface, first);
712
713 #ifdef EAP_SERVER_TNC
714         if (conf->tnc && tncs_global_init() < 0) {
715                 wpa_printf(MSG_ERROR, "Failed to initialize TNCS");
716                 return -1;
717         }
718 #endif /* EAP_SERVER_TNC */
719
720         if (hapd->started) {
721                 wpa_printf(MSG_ERROR, "%s: Interface %s was already started",
722                            __func__, conf->iface);
723                 return -1;
724         }
725         hapd->started = 1;
726
727         if (!first || first == -1) {
728                 if (hostapd_mac_comp_empty(conf->bssid) == 0) {
729                         /* Allocate the next available BSSID. */
730                         do {
731                                 inc_byte_array(hapd->own_addr, ETH_ALEN);
732                         } while (mac_in_conf(hapd->iconf, hapd->own_addr));
733                 } else {
734                         /* Allocate the configured BSSID. */
735                         os_memcpy(hapd->own_addr, conf->bssid, ETH_ALEN);
736
737                         if (hostapd_mac_comp(hapd->own_addr,
738                                              hapd->iface->bss[0]->own_addr) ==
739                             0) {
740                                 wpa_printf(MSG_ERROR, "BSS '%s' may not have "
741                                            "BSSID set to the MAC address of "
742                                            "the radio", conf->iface);
743                                 return -1;
744                         }
745                 }
746
747                 hapd->interface_added = 1;
748                 if (hostapd_if_add(hapd->iface->bss[0], WPA_IF_AP_BSS,
749                                    conf->iface, hapd->own_addr, hapd,
750                                    &hapd->drv_priv, force_ifname, if_addr,
751                                    conf->bridge[0] ? conf->bridge : NULL,
752                                    first == -1)) {
753                         wpa_printf(MSG_ERROR, "Failed to add BSS (BSSID="
754                                    MACSTR ")", MAC2STR(hapd->own_addr));
755                         hapd->interface_added = 0;
756                         return -1;
757                 }
758         }
759
760         if (conf->wmm_enabled < 0)
761                 conf->wmm_enabled = hapd->iconf->ieee80211n;
762
763 #ifdef CONFIG_MESH
764         if (hapd->iface->mconf == NULL)
765                 flush_old_stations = 0;
766 #endif /* CONFIG_MESH */
767
768         if (flush_old_stations)
769                 hostapd_flush_old_stations(hapd,
770                                            WLAN_REASON_PREV_AUTH_NOT_VALID);
771         hostapd_set_privacy(hapd, 0);
772
773         hostapd_broadcast_wep_clear(hapd);
774         if (hostapd_setup_encryption(conf->iface, hapd))
775                 return -1;
776
777         /*
778          * Fetch the SSID from the system and use it or,
779          * if one was specified in the config file, verify they
780          * match.
781          */
782         ssid_len = hostapd_get_ssid(hapd, ssid, sizeof(ssid));
783         if (ssid_len < 0) {
784                 wpa_printf(MSG_ERROR, "Could not read SSID from system");
785                 return -1;
786         }
787         if (conf->ssid.ssid_set) {
788                 /*
789                  * If SSID is specified in the config file and it differs
790                  * from what is being used then force installation of the
791                  * new SSID.
792                  */
793                 set_ssid = (conf->ssid.ssid_len != (size_t) ssid_len ||
794                             os_memcmp(conf->ssid.ssid, ssid, ssid_len) != 0);
795         } else {
796                 /*
797                  * No SSID in the config file; just use the one we got
798                  * from the system.
799                  */
800                 set_ssid = 0;
801                 conf->ssid.ssid_len = ssid_len;
802                 os_memcpy(conf->ssid.ssid, ssid, conf->ssid.ssid_len);
803         }
804
805         if (!hostapd_drv_none(hapd)) {
806                 wpa_printf(MSG_ERROR, "Using interface %s with hwaddr " MACSTR
807                            " and ssid \"%s\"",
808                            conf->iface, MAC2STR(hapd->own_addr),
809                            wpa_ssid_txt(conf->ssid.ssid, conf->ssid.ssid_len));
810         }
811
812         if (hostapd_setup_wpa_psk(conf)) {
813                 wpa_printf(MSG_ERROR, "WPA-PSK setup failed.");
814                 return -1;
815         }
816
817         /* Set SSID for the kernel driver (to be used in beacon and probe
818          * response frames) */
819         if (set_ssid && hostapd_set_ssid(hapd, conf->ssid.ssid,
820                                          conf->ssid.ssid_len)) {
821                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
822                 return -1;
823         }
824
825         if (wpa_debug_level <= MSG_MSGDUMP)
826                 conf->radius->msg_dumps = 1;
827 #ifndef CONFIG_NO_RADIUS
828         hapd->radius = radius_client_init(hapd, conf->radius);
829         if (hapd->radius == NULL) {
830                 wpa_printf(MSG_ERROR, "RADIUS client initialization failed.");
831                 return -1;
832         }
833
834         if (conf->radius_das_port) {
835                 struct radius_das_conf das_conf;
836                 os_memset(&das_conf, 0, sizeof(das_conf));
837                 das_conf.port = conf->radius_das_port;
838                 das_conf.shared_secret = conf->radius_das_shared_secret;
839                 das_conf.shared_secret_len =
840                         conf->radius_das_shared_secret_len;
841                 das_conf.client_addr = &conf->radius_das_client_addr;
842                 das_conf.time_window = conf->radius_das_time_window;
843                 das_conf.require_event_timestamp =
844                         conf->radius_das_require_event_timestamp;
845                 das_conf.ctx = hapd;
846                 das_conf.disconnect = hostapd_das_disconnect;
847                 hapd->radius_das = radius_das_init(&das_conf);
848                 if (hapd->radius_das == NULL) {
849                         wpa_printf(MSG_ERROR, "RADIUS DAS initialization "
850                                    "failed.");
851                         return -1;
852                 }
853         }
854 #endif /* CONFIG_NO_RADIUS */
855
856         if (hostapd_acl_init(hapd)) {
857                 wpa_printf(MSG_ERROR, "ACL initialization failed.");
858                 return -1;
859         }
860         if (hostapd_init_wps(hapd, conf))
861                 return -1;
862
863         if (authsrv_init(hapd) < 0)
864                 return -1;
865
866         if (ieee802_1x_init(hapd)) {
867                 wpa_printf(MSG_ERROR, "IEEE 802.1X initialization failed.");
868                 return -1;
869         }
870
871         if ((conf->wpa || conf->osen) && hostapd_setup_wpa(hapd))
872                 return -1;
873
874         if (accounting_init(hapd)) {
875                 wpa_printf(MSG_ERROR, "Accounting initialization failed.");
876                 return -1;
877         }
878
879         if (conf->ieee802_11f &&
880             (hapd->iapp = iapp_init(hapd, conf->iapp_iface)) == NULL) {
881                 wpa_printf(MSG_ERROR, "IEEE 802.11F (IAPP) initialization "
882                            "failed.");
883                 return -1;
884         }
885
886 #ifdef CONFIG_INTERWORKING
887         if (gas_serv_init(hapd)) {
888                 wpa_printf(MSG_ERROR, "GAS server initialization failed");
889                 return -1;
890         }
891
892         if (conf->qos_map_set_len &&
893             hostapd_drv_set_qos_map(hapd, conf->qos_map_set,
894                                     conf->qos_map_set_len)) {
895                 wpa_printf(MSG_ERROR, "Failed to initialize QoS Map");
896                 return -1;
897         }
898 #endif /* CONFIG_INTERWORKING */
899
900         if (conf->bss_load_update_period && bss_load_update_init(hapd)) {
901                 wpa_printf(MSG_ERROR, "BSS Load initialization failed");
902                 return -1;
903         }
904
905         if (conf->proxy_arp) {
906                 if (x_snoop_init(hapd)) {
907                         wpa_printf(MSG_ERROR,
908                                    "Generic snooping infrastructure initialization failed");
909                         return -1;
910                 }
911
912                 if (dhcp_snoop_init(hapd)) {
913                         wpa_printf(MSG_ERROR,
914                                    "DHCP snooping initialization failed");
915                         return -1;
916                 }
917
918                 if (ndisc_snoop_init(hapd)) {
919                         wpa_printf(MSG_ERROR,
920                                    "Neighbor Discovery snooping initialization failed");
921                         return -1;
922                 }
923         }
924
925         if (!hostapd_drv_none(hapd) && vlan_init(hapd)) {
926                 wpa_printf(MSG_ERROR, "VLAN initialization failed.");
927                 return -1;
928         }
929
930         if (!conf->start_disabled && ieee802_11_set_beacon(hapd) < 0)
931                 return -1;
932
933         if (hapd->wpa_auth && wpa_init_keys(hapd->wpa_auth) < 0)
934                 return -1;
935
936         if (hapd->driver && hapd->driver->set_operstate)
937                 hapd->driver->set_operstate(hapd->drv_priv, 1);
938
939         return 0;
940 }
941
942
943 static void hostapd_tx_queue_params(struct hostapd_iface *iface)
944 {
945         struct hostapd_data *hapd = iface->bss[0];
946         int i;
947         struct hostapd_tx_queue_params *p;
948
949 #ifdef CONFIG_MESH
950         if (iface->mconf == NULL)
951                 return;
952 #endif /* CONFIG_MESH */
953
954         for (i = 0; i < NUM_TX_QUEUES; i++) {
955                 p = &iface->conf->tx_queue[i];
956
957                 if (hostapd_set_tx_queue_params(hapd, i, p->aifs, p->cwmin,
958                                                 p->cwmax, p->burst)) {
959                         wpa_printf(MSG_DEBUG, "Failed to set TX queue "
960                                    "parameters for queue %d.", i);
961                         /* Continue anyway */
962                 }
963         }
964 }
965
966
967 static int hostapd_set_acl_list(struct hostapd_data *hapd,
968                                 struct mac_acl_entry *mac_acl,
969                                 int n_entries, u8 accept_acl)
970 {
971         struct hostapd_acl_params *acl_params;
972         int i, err;
973
974         acl_params = os_zalloc(sizeof(*acl_params) +
975                                (n_entries * sizeof(acl_params->mac_acl[0])));
976         if (!acl_params)
977                 return -ENOMEM;
978
979         for (i = 0; i < n_entries; i++)
980                 os_memcpy(acl_params->mac_acl[i].addr, mac_acl[i].addr,
981                           ETH_ALEN);
982
983         acl_params->acl_policy = accept_acl;
984         acl_params->num_mac_acl = n_entries;
985
986         err = hostapd_drv_set_acl(hapd, acl_params);
987
988         os_free(acl_params);
989
990         return err;
991 }
992
993
994 static void hostapd_set_acl(struct hostapd_data *hapd)
995 {
996         struct hostapd_config *conf = hapd->iconf;
997         int err;
998         u8 accept_acl;
999
1000         if (hapd->iface->drv_max_acl_mac_addrs == 0)
1001                 return;
1002
1003         if (conf->bss[0]->macaddr_acl == DENY_UNLESS_ACCEPTED) {
1004                 accept_acl = 1;
1005                 err = hostapd_set_acl_list(hapd, conf->bss[0]->accept_mac,
1006                                            conf->bss[0]->num_accept_mac,
1007                                            accept_acl);
1008                 if (err) {
1009                         wpa_printf(MSG_DEBUG, "Failed to set accept acl");
1010                         return;
1011                 }
1012         } else if (conf->bss[0]->macaddr_acl == ACCEPT_UNLESS_DENIED) {
1013                 accept_acl = 0;
1014                 err = hostapd_set_acl_list(hapd, conf->bss[0]->deny_mac,
1015                                            conf->bss[0]->num_deny_mac,
1016                                            accept_acl);
1017                 if (err) {
1018                         wpa_printf(MSG_DEBUG, "Failed to set deny acl");
1019                         return;
1020                 }
1021         }
1022 }
1023
1024
1025 static int start_ctrl_iface_bss(struct hostapd_data *hapd)
1026 {
1027         if (!hapd->iface->interfaces ||
1028             !hapd->iface->interfaces->ctrl_iface_init)
1029                 return 0;
1030
1031         if (hapd->iface->interfaces->ctrl_iface_init(hapd)) {
1032                 wpa_printf(MSG_ERROR,
1033                            "Failed to setup control interface for %s",
1034                            hapd->conf->iface);
1035                 return -1;
1036         }
1037
1038         return 0;
1039 }
1040
1041
1042 static int start_ctrl_iface(struct hostapd_iface *iface)
1043 {
1044         size_t i;
1045
1046         if (!iface->interfaces || !iface->interfaces->ctrl_iface_init)
1047                 return 0;
1048
1049         for (i = 0; i < iface->num_bss; i++) {
1050                 struct hostapd_data *hapd = iface->bss[i];
1051                 if (iface->interfaces->ctrl_iface_init(hapd)) {
1052                         wpa_printf(MSG_ERROR,
1053                                    "Failed to setup control interface for %s",
1054                                    hapd->conf->iface);
1055                         return -1;
1056                 }
1057         }
1058
1059         return 0;
1060 }
1061
1062
1063 static void channel_list_update_timeout(void *eloop_ctx, void *timeout_ctx)
1064 {
1065         struct hostapd_iface *iface = eloop_ctx;
1066
1067         if (!iface->wait_channel_update) {
1068                 wpa_printf(MSG_INFO, "Channel list update timeout, but interface was not waiting for it");
1069                 return;
1070         }
1071
1072         /*
1073          * It is possible that the existing channel list is acceptable, so try
1074          * to proceed.
1075          */
1076         wpa_printf(MSG_DEBUG, "Channel list update timeout - try to continue anyway");
1077         setup_interface2(iface);
1078 }
1079
1080
1081 void hostapd_channel_list_updated(struct hostapd_iface *iface, int initiator)
1082 {
1083         if (!iface->wait_channel_update || initiator != REGDOM_SET_BY_USER)
1084                 return;
1085
1086         wpa_printf(MSG_DEBUG, "Channel list updated - continue setup");
1087         eloop_cancel_timeout(channel_list_update_timeout, iface, NULL);
1088         setup_interface2(iface);
1089 }
1090
1091
1092 static int setup_interface(struct hostapd_iface *iface)
1093 {
1094         struct hostapd_data *hapd = iface->bss[0];
1095         size_t i;
1096
1097         /*
1098          * It is possible that setup_interface() is called after the interface
1099          * was disabled etc., in which case driver_ap_teardown is possibly set
1100          * to 1. Clear it here so any other key/station deletion, which is not
1101          * part of a teardown flow, would also call the relevant driver
1102          * callbacks.
1103          */
1104         iface->driver_ap_teardown = 0;
1105
1106         if (!iface->phy[0]) {
1107                 const char *phy = hostapd_drv_get_radio_name(hapd);
1108                 if (phy) {
1109                         wpa_printf(MSG_DEBUG, "phy: %s", phy);
1110                         os_strlcpy(iface->phy, phy, sizeof(iface->phy));
1111                 }
1112         }
1113
1114         /*
1115          * Make sure that all BSSes get configured with a pointer to the same
1116          * driver interface.
1117          */
1118         for (i = 1; i < iface->num_bss; i++) {
1119                 iface->bss[i]->driver = hapd->driver;
1120                 iface->bss[i]->drv_priv = hapd->drv_priv;
1121         }
1122
1123         if (hostapd_validate_bssid_configuration(iface))
1124                 return -1;
1125
1126         /*
1127          * Initialize control interfaces early to allow external monitoring of
1128          * channel setup operations that may take considerable amount of time
1129          * especially for DFS cases.
1130          */
1131         if (start_ctrl_iface(iface))
1132                 return -1;
1133
1134         if (hapd->iconf->country[0] && hapd->iconf->country[1]) {
1135                 char country[4], previous_country[4];
1136
1137                 hostapd_set_state(iface, HAPD_IFACE_COUNTRY_UPDATE);
1138                 if (hostapd_get_country(hapd, previous_country) < 0)
1139                         previous_country[0] = '\0';
1140
1141                 os_memcpy(country, hapd->iconf->country, 3);
1142                 country[3] = '\0';
1143                 if (hostapd_set_country(hapd, country) < 0) {
1144                         wpa_printf(MSG_ERROR, "Failed to set country code");
1145                         return -1;
1146                 }
1147
1148                 wpa_printf(MSG_DEBUG, "Previous country code %s, new country code %s",
1149                            previous_country, country);
1150
1151                 if (os_strncmp(previous_country, country, 2) != 0) {
1152                         wpa_printf(MSG_DEBUG, "Continue interface setup after channel list update");
1153                         iface->wait_channel_update = 1;
1154                         eloop_register_timeout(5, 0,
1155                                                channel_list_update_timeout,
1156                                                iface, NULL);
1157                         return 0;
1158                 }
1159         }
1160
1161         return setup_interface2(iface);
1162 }
1163
1164
1165 static int setup_interface2(struct hostapd_iface *iface)
1166 {
1167         iface->wait_channel_update = 0;
1168
1169         if (hostapd_get_hw_features(iface)) {
1170                 /* Not all drivers support this yet, so continue without hw
1171                  * feature data. */
1172         } else {
1173                 int ret = hostapd_select_hw_mode(iface);
1174                 if (ret < 0) {
1175                         wpa_printf(MSG_ERROR, "Could not select hw_mode and "
1176                                    "channel. (%d)", ret);
1177                         goto fail;
1178                 }
1179                 if (ret == 1) {
1180                         wpa_printf(MSG_DEBUG, "Interface initialization will be completed in a callback (ACS)");
1181                         return 0;
1182                 }
1183                 ret = hostapd_check_ht_capab(iface);
1184                 if (ret < 0)
1185                         goto fail;
1186                 if (ret == 1) {
1187                         wpa_printf(MSG_DEBUG, "Interface initialization will "
1188                                    "be completed in a callback");
1189                         return 0;
1190                 }
1191
1192                 if (iface->conf->ieee80211h)
1193                         wpa_printf(MSG_DEBUG, "DFS support is enabled");
1194         }
1195         return hostapd_setup_interface_complete(iface, 0);
1196
1197 fail:
1198         hostapd_set_state(iface, HAPD_IFACE_DISABLED);
1199         wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, AP_EVENT_DISABLED);
1200         if (iface->interfaces && iface->interfaces->terminate_on_error)
1201                 eloop_terminate();
1202         return -1;
1203 }
1204
1205
1206 /**
1207  * hostapd_setup_interface_complete - Complete interface setup
1208  *
1209  * This function is called when previous steps in the interface setup has been
1210  * completed. This can also start operations, e.g., DFS, that will require
1211  * additional processing before interface is ready to be enabled. Such
1212  * operations will call this function from eloop callbacks when finished.
1213  */
1214 int hostapd_setup_interface_complete(struct hostapd_iface *iface, int err)
1215 {
1216         struct hostapd_data *hapd = iface->bss[0];
1217         size_t j;
1218         u8 *prev_addr;
1219         int delay_apply_cfg = 0;
1220
1221         if (err)
1222                 goto fail;
1223
1224         wpa_printf(MSG_DEBUG, "Completing interface initialization");
1225         if (iface->conf->channel) {
1226 #ifdef NEED_AP_MLME
1227                 int res;
1228 #endif /* NEED_AP_MLME */
1229
1230                 iface->freq = hostapd_hw_get_freq(hapd, iface->conf->channel);
1231                 wpa_printf(MSG_DEBUG, "Mode: %s  Channel: %d  "
1232                            "Frequency: %d MHz",
1233                            hostapd_hw_mode_txt(iface->conf->hw_mode),
1234                            iface->conf->channel, iface->freq);
1235
1236 #ifdef NEED_AP_MLME
1237                 /* Handle DFS only if it is not offloaded to the driver */
1238                 if (!(iface->drv_flags & WPA_DRIVER_FLAGS_DFS_OFFLOAD)) {
1239                         /* Check DFS */
1240                         res = hostapd_handle_dfs(iface);
1241                         if (res <= 0) {
1242                                 if (res < 0)
1243                                         goto fail;
1244                                 return res;
1245                         }
1246                 }
1247 #endif /* NEED_AP_MLME */
1248
1249 #ifdef CONFIG_MESH
1250                 if (iface->mconf != NULL) {
1251                         wpa_printf(MSG_DEBUG,
1252                                    "%s: Mesh configuration will be applied while joining the mesh network",
1253                                    iface->bss[0]->conf->iface);
1254                         delay_apply_cfg = 1;
1255                 }
1256 #endif /* CONFIG_MESH */
1257
1258                 if (!delay_apply_cfg &&
1259                     hostapd_set_freq(hapd, hapd->iconf->hw_mode, iface->freq,
1260                                      hapd->iconf->channel,
1261                                      hapd->iconf->ieee80211n,
1262                                      hapd->iconf->ieee80211ac,
1263                                      hapd->iconf->secondary_channel,
1264                                      hapd->iconf->vht_oper_chwidth,
1265                                      hapd->iconf->vht_oper_centr_freq_seg0_idx,
1266                                      hapd->iconf->vht_oper_centr_freq_seg1_idx)) {
1267                         wpa_printf(MSG_ERROR, "Could not set channel for "
1268                                    "kernel driver");
1269                         goto fail;
1270                 }
1271         }
1272
1273         if (iface->current_mode) {
1274                 if (hostapd_prepare_rates(iface, iface->current_mode)) {
1275                         wpa_printf(MSG_ERROR, "Failed to prepare rates "
1276                                    "table.");
1277                         hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
1278                                        HOSTAPD_LEVEL_WARNING,
1279                                        "Failed to prepare rates table.");
1280                         goto fail;
1281                 }
1282         }
1283
1284         if (hapd->iconf->rts_threshold > -1 &&
1285             hostapd_set_rts(hapd, hapd->iconf->rts_threshold)) {
1286                 wpa_printf(MSG_ERROR, "Could not set RTS threshold for "
1287                            "kernel driver");
1288                 goto fail;
1289         }
1290
1291         if (hapd->iconf->fragm_threshold > -1 &&
1292             hostapd_set_frag(hapd, hapd->iconf->fragm_threshold)) {
1293                 wpa_printf(MSG_ERROR, "Could not set fragmentation threshold "
1294                            "for kernel driver");
1295                 goto fail;
1296         }
1297
1298         prev_addr = hapd->own_addr;
1299
1300         for (j = 0; j < iface->num_bss; j++) {
1301                 hapd = iface->bss[j];
1302                 if (j)
1303                         os_memcpy(hapd->own_addr, prev_addr, ETH_ALEN);
1304                 if (hostapd_setup_bss(hapd, j == 0)) {
1305                         do {
1306                                 hapd = iface->bss[j];
1307                                 hostapd_bss_deinit_no_free(hapd);
1308                                 hostapd_free_hapd_data(hapd);
1309                         } while (j-- > 0);
1310                         goto fail;
1311                 }
1312                 if (hostapd_mac_comp_empty(hapd->conf->bssid) == 0)
1313                         prev_addr = hapd->own_addr;
1314         }
1315         hapd = iface->bss[0];
1316
1317         hostapd_tx_queue_params(iface);
1318
1319         ap_list_init(iface);
1320
1321         hostapd_set_acl(hapd);
1322
1323         if (hostapd_driver_commit(hapd) < 0) {
1324                 wpa_printf(MSG_ERROR, "%s: Failed to commit driver "
1325                            "configuration", __func__);
1326                 goto fail;
1327         }
1328
1329         /*
1330          * WPS UPnP module can be initialized only when the "upnp_iface" is up.
1331          * If "interface" and "upnp_iface" are the same (e.g., non-bridge
1332          * mode), the interface is up only after driver_commit, so initialize
1333          * WPS after driver_commit.
1334          */
1335         for (j = 0; j < iface->num_bss; j++) {
1336                 if (hostapd_init_wps_complete(iface->bss[j]))
1337                         goto fail;
1338         }
1339
1340         hostapd_set_state(iface, HAPD_IFACE_ENABLED);
1341         wpa_msg(iface->bss[0]->msg_ctx, MSG_INFO, AP_EVENT_ENABLED);
1342         if (hapd->setup_complete_cb)
1343                 hapd->setup_complete_cb(hapd->setup_complete_cb_ctx);
1344
1345         wpa_printf(MSG_DEBUG, "%s: Setup of interface done.",
1346                    iface->bss[0]->conf->iface);
1347         if (iface->interfaces && iface->interfaces->terminate_on_error > 0)
1348                 iface->interfaces->terminate_on_error--;
1349
1350         return 0;
1351
1352 fail:
1353         wpa_printf(MSG_ERROR, "Interface initialization failed");
1354         hostapd_set_state(iface, HAPD_IFACE_DISABLED);
1355         wpa_msg(hapd->msg_ctx, MSG_INFO, AP_EVENT_DISABLED);
1356         if (iface->interfaces && iface->interfaces->terminate_on_error)
1357                 eloop_terminate();
1358         return -1;
1359 }
1360
1361
1362 /**
1363  * hostapd_setup_interface - Setup of an interface
1364  * @iface: Pointer to interface data.
1365  * Returns: 0 on success, -1 on failure
1366  *
1367  * Initializes the driver interface, validates the configuration,
1368  * and sets driver parameters based on the configuration.
1369  * Flushes old stations, sets the channel, encryption,
1370  * beacons, and WDS links based on the configuration.
1371  *
1372  * If interface setup requires more time, e.g., to perform HT co-ex scans, ACS,
1373  * or DFS operations, this function returns 0 before such operations have been
1374  * completed. The pending operations are registered into eloop and will be
1375  * completed from eloop callbacks. Those callbacks end up calling
1376  * hostapd_setup_interface_complete() once setup has been completed.
1377  */
1378 int hostapd_setup_interface(struct hostapd_iface *iface)
1379 {
1380         int ret;
1381
1382         ret = setup_interface(iface);
1383         if (ret) {
1384                 wpa_printf(MSG_ERROR, "%s: Unable to setup interface.",
1385                            iface->bss[0]->conf->iface);
1386                 return -1;
1387         }
1388
1389         return 0;
1390 }
1391
1392
1393 /**
1394  * hostapd_alloc_bss_data - Allocate and initialize per-BSS data
1395  * @hapd_iface: Pointer to interface data
1396  * @conf: Pointer to per-interface configuration
1397  * @bss: Pointer to per-BSS configuration for this BSS
1398  * Returns: Pointer to allocated BSS data
1399  *
1400  * This function is used to allocate per-BSS data structure. This data will be
1401  * freed after hostapd_cleanup() is called for it during interface
1402  * deinitialization.
1403  */
1404 struct hostapd_data *
1405 hostapd_alloc_bss_data(struct hostapd_iface *hapd_iface,
1406                        struct hostapd_config *conf,
1407                        struct hostapd_bss_config *bss)
1408 {
1409         struct hostapd_data *hapd;
1410
1411         hapd = os_zalloc(sizeof(*hapd));
1412         if (hapd == NULL)
1413                 return NULL;
1414
1415         hapd->new_assoc_sta_cb = hostapd_new_assoc_sta;
1416         hapd->iconf = conf;
1417         hapd->conf = bss;
1418         hapd->iface = hapd_iface;
1419         hapd->driver = hapd->iconf->driver;
1420         hapd->ctrl_sock = -1;
1421
1422         return hapd;
1423 }
1424
1425
1426 static void hostapd_bss_deinit(struct hostapd_data *hapd)
1427 {
1428         wpa_printf(MSG_DEBUG, "%s: deinit bss %s", __func__,
1429                    hapd->conf->iface);
1430         hostapd_bss_deinit_no_free(hapd);
1431         hostapd_cleanup(hapd);
1432 }
1433
1434
1435 void hostapd_interface_deinit(struct hostapd_iface *iface)
1436 {
1437         int j;
1438
1439         wpa_printf(MSG_DEBUG, "%s(%p)", __func__, iface);
1440         if (iface == NULL)
1441                 return;
1442
1443 #ifdef CONFIG_IEEE80211N
1444 #ifdef NEED_AP_MLME
1445         hostapd_stop_setup_timers(iface);
1446         eloop_cancel_timeout(ap_ht2040_timeout, iface, NULL);
1447 #endif /* NEED_AP_MLME */
1448 #endif /* CONFIG_IEEE80211N */
1449         eloop_cancel_timeout(channel_list_update_timeout, iface, NULL);
1450         iface->wait_channel_update = 0;
1451
1452         for (j = iface->num_bss - 1; j >= 0; j--)
1453                 hostapd_bss_deinit(iface->bss[j]);
1454 }
1455
1456
1457 void hostapd_interface_free(struct hostapd_iface *iface)
1458 {
1459         size_t j;
1460         wpa_printf(MSG_DEBUG, "%s(%p)", __func__, iface);
1461         for (j = 0; j < iface->num_bss; j++) {
1462                 wpa_printf(MSG_DEBUG, "%s: free hapd %p",
1463                            __func__, iface->bss[j]);
1464                 os_free(iface->bss[j]);
1465         }
1466         hostapd_cleanup_iface(iface);
1467 }
1468
1469
1470 /**
1471  * hostapd_init - Allocate and initialize per-interface data
1472  * @config_file: Path to the configuration file
1473  * Returns: Pointer to the allocated interface data or %NULL on failure
1474  *
1475  * This function is used to allocate main data structures for per-interface
1476  * data. The allocated data buffer will be freed by calling
1477  * hostapd_cleanup_iface().
1478  */
1479 struct hostapd_iface * hostapd_init(struct hapd_interfaces *interfaces,
1480                                     const char *config_file)
1481 {
1482         struct hostapd_iface *hapd_iface = NULL;
1483         struct hostapd_config *conf = NULL;
1484         struct hostapd_data *hapd;
1485         size_t i;
1486
1487         hapd_iface = os_zalloc(sizeof(*hapd_iface));
1488         if (hapd_iface == NULL)
1489                 goto fail;
1490
1491         hapd_iface->config_fname = os_strdup(config_file);
1492         if (hapd_iface->config_fname == NULL)
1493                 goto fail;
1494
1495         conf = interfaces->config_read_cb(hapd_iface->config_fname);
1496         if (conf == NULL)
1497                 goto fail;
1498         hapd_iface->conf = conf;
1499
1500         hapd_iface->num_bss = conf->num_bss;
1501         hapd_iface->bss = os_calloc(conf->num_bss,
1502                                     sizeof(struct hostapd_data *));
1503         if (hapd_iface->bss == NULL)
1504                 goto fail;
1505
1506         for (i = 0; i < conf->num_bss; i++) {
1507                 hapd = hapd_iface->bss[i] =
1508                         hostapd_alloc_bss_data(hapd_iface, conf,
1509                                                conf->bss[i]);
1510                 if (hapd == NULL)
1511                         goto fail;
1512                 hapd->msg_ctx = hapd;
1513         }
1514
1515         return hapd_iface;
1516
1517 fail:
1518         wpa_printf(MSG_ERROR, "Failed to set up interface with %s",
1519                    config_file);
1520         if (conf)
1521                 hostapd_config_free(conf);
1522         if (hapd_iface) {
1523                 os_free(hapd_iface->config_fname);
1524                 os_free(hapd_iface->bss);
1525                 wpa_printf(MSG_DEBUG, "%s: free iface %p",
1526                            __func__, hapd_iface);
1527                 os_free(hapd_iface);
1528         }
1529         return NULL;
1530 }
1531
1532
1533 static int ifname_in_use(struct hapd_interfaces *interfaces, const char *ifname)
1534 {
1535         size_t i, j;
1536
1537         for (i = 0; i < interfaces->count; i++) {
1538                 struct hostapd_iface *iface = interfaces->iface[i];
1539                 for (j = 0; j < iface->num_bss; j++) {
1540                         struct hostapd_data *hapd = iface->bss[j];
1541                         if (os_strcmp(ifname, hapd->conf->iface) == 0)
1542                                 return 1;
1543                 }
1544         }
1545
1546         return 0;
1547 }
1548
1549
1550 /**
1551  * hostapd_interface_init_bss - Read configuration file and init BSS data
1552  *
1553  * This function is used to parse configuration file for a BSS. This BSS is
1554  * added to an existing interface sharing the same radio (if any) or a new
1555  * interface is created if this is the first interface on a radio. This
1556  * allocate memory for the BSS. No actual driver operations are started.
1557  *
1558  * This is similar to hostapd_interface_init(), but for a case where the
1559  * configuration is used to add a single BSS instead of all BSSes for a radio.
1560  */
1561 struct hostapd_iface *
1562 hostapd_interface_init_bss(struct hapd_interfaces *interfaces, const char *phy,
1563                            const char *config_fname, int debug)
1564 {
1565         struct hostapd_iface *new_iface = NULL, *iface = NULL;
1566         struct hostapd_data *hapd;
1567         int k;
1568         size_t i, bss_idx;
1569
1570         if (!phy || !*phy)
1571                 return NULL;
1572
1573         for (i = 0; i < interfaces->count; i++) {
1574                 if (os_strcmp(interfaces->iface[i]->phy, phy) == 0) {
1575                         iface = interfaces->iface[i];
1576                         break;
1577                 }
1578         }
1579
1580         wpa_printf(MSG_INFO, "Configuration file: %s (phy %s)%s",
1581                    config_fname, phy, iface ? "" : " --> new PHY");
1582         if (iface) {
1583                 struct hostapd_config *conf;
1584                 struct hostapd_bss_config **tmp_conf;
1585                 struct hostapd_data **tmp_bss;
1586                 struct hostapd_bss_config *bss;
1587                 const char *ifname;
1588
1589                 /* Add new BSS to existing iface */
1590                 conf = interfaces->config_read_cb(config_fname);
1591                 if (conf == NULL)
1592                         return NULL;
1593                 if (conf->num_bss > 1) {
1594                         wpa_printf(MSG_ERROR, "Multiple BSSes specified in BSS-config");
1595                         hostapd_config_free(conf);
1596                         return NULL;
1597                 }
1598
1599                 ifname = conf->bss[0]->iface;
1600                 if (ifname[0] != '\0' && ifname_in_use(interfaces, ifname)) {
1601                         wpa_printf(MSG_ERROR,
1602                                    "Interface name %s already in use", ifname);
1603                         hostapd_config_free(conf);
1604                         return NULL;
1605                 }
1606
1607                 tmp_conf = os_realloc_array(
1608                         iface->conf->bss, iface->conf->num_bss + 1,
1609                         sizeof(struct hostapd_bss_config *));
1610                 tmp_bss = os_realloc_array(iface->bss, iface->num_bss + 1,
1611                                            sizeof(struct hostapd_data *));
1612                 if (tmp_bss)
1613                         iface->bss = tmp_bss;
1614                 if (tmp_conf) {
1615                         iface->conf->bss = tmp_conf;
1616                         iface->conf->last_bss = tmp_conf[0];
1617                 }
1618                 if (tmp_bss == NULL || tmp_conf == NULL) {
1619                         hostapd_config_free(conf);
1620                         return NULL;
1621                 }
1622                 bss = iface->conf->bss[iface->conf->num_bss] = conf->bss[0];
1623                 iface->conf->num_bss++;
1624
1625                 hapd = hostapd_alloc_bss_data(iface, iface->conf, bss);
1626                 if (hapd == NULL) {
1627                         iface->conf->num_bss--;
1628                         hostapd_config_free(conf);
1629                         return NULL;
1630                 }
1631                 iface->conf->last_bss = bss;
1632                 iface->bss[iface->num_bss] = hapd;
1633                 hapd->msg_ctx = hapd;
1634
1635                 bss_idx = iface->num_bss++;
1636                 conf->num_bss--;
1637                 conf->bss[0] = NULL;
1638                 hostapd_config_free(conf);
1639         } else {
1640                 /* Add a new iface with the first BSS */
1641                 new_iface = iface = hostapd_init(interfaces, config_fname);
1642                 if (!iface)
1643                         return NULL;
1644                 os_strlcpy(iface->phy, phy, sizeof(iface->phy));
1645                 iface->interfaces = interfaces;
1646                 bss_idx = 0;
1647         }
1648
1649         for (k = 0; k < debug; k++) {
1650                 if (iface->bss[bss_idx]->conf->logger_stdout_level > 0)
1651                         iface->bss[bss_idx]->conf->logger_stdout_level--;
1652         }
1653
1654         if (iface->conf->bss[bss_idx]->iface[0] == '\0' &&
1655             !hostapd_drv_none(iface->bss[bss_idx])) {
1656                 wpa_printf(MSG_ERROR, "Interface name not specified in %s",
1657                            config_fname);
1658                 if (new_iface)
1659                         hostapd_interface_deinit_free(new_iface);
1660                 return NULL;
1661         }
1662
1663         return iface;
1664 }
1665
1666
1667 void hostapd_interface_deinit_free(struct hostapd_iface *iface)
1668 {
1669         const struct wpa_driver_ops *driver;
1670         void *drv_priv;
1671
1672         wpa_printf(MSG_DEBUG, "%s(%p)", __func__, iface);
1673         if (iface == NULL)
1674                 return;
1675         wpa_printf(MSG_DEBUG, "%s: num_bss=%u conf->num_bss=%u",
1676                    __func__, (unsigned int) iface->num_bss,
1677                    (unsigned int) iface->conf->num_bss);
1678         driver = iface->bss[0]->driver;
1679         drv_priv = iface->bss[0]->drv_priv;
1680         hostapd_interface_deinit(iface);
1681         wpa_printf(MSG_DEBUG, "%s: driver=%p drv_priv=%p -> hapd_deinit",
1682                    __func__, driver, drv_priv);
1683         if (driver && driver->hapd_deinit && drv_priv) {
1684                 driver->hapd_deinit(drv_priv);
1685                 iface->bss[0]->drv_priv = NULL;
1686         }
1687         hostapd_interface_free(iface);
1688 }
1689
1690
1691 static void hostapd_deinit_driver(const struct wpa_driver_ops *driver,
1692                                   void *drv_priv,
1693                                   struct hostapd_iface *hapd_iface)
1694 {
1695         size_t j;
1696
1697         wpa_printf(MSG_DEBUG, "%s: driver=%p drv_priv=%p -> hapd_deinit",
1698                    __func__, driver, drv_priv);
1699         if (driver && driver->hapd_deinit && drv_priv) {
1700                 driver->hapd_deinit(drv_priv);
1701                 for (j = 0; j < hapd_iface->num_bss; j++) {
1702                         wpa_printf(MSG_DEBUG, "%s:bss[%d]->drv_priv=%p",
1703                                    __func__, (int) j,
1704                                    hapd_iface->bss[j]->drv_priv);
1705                         if (hapd_iface->bss[j]->drv_priv == drv_priv)
1706                                 hapd_iface->bss[j]->drv_priv = NULL;
1707                 }
1708         }
1709 }
1710
1711
1712 int hostapd_enable_iface(struct hostapd_iface *hapd_iface)
1713 {
1714         size_t j;
1715
1716         if (hapd_iface->bss[0]->drv_priv != NULL) {
1717                 wpa_printf(MSG_ERROR, "Interface %s already enabled",
1718                            hapd_iface->conf->bss[0]->iface);
1719                 return -1;
1720         }
1721
1722         wpa_printf(MSG_DEBUG, "Enable interface %s",
1723                    hapd_iface->conf->bss[0]->iface);
1724
1725         for (j = 0; j < hapd_iface->num_bss; j++)
1726                 hostapd_set_security_params(hapd_iface->conf->bss[j], 1);
1727         if (hostapd_config_check(hapd_iface->conf, 1) < 0) {
1728                 wpa_printf(MSG_INFO, "Invalid configuration - cannot enable");
1729                 return -1;
1730         }
1731
1732         if (hapd_iface->interfaces == NULL ||
1733             hapd_iface->interfaces->driver_init == NULL ||
1734             hapd_iface->interfaces->driver_init(hapd_iface))
1735                 return -1;
1736
1737         if (hostapd_setup_interface(hapd_iface)) {
1738                 hostapd_deinit_driver(hapd_iface->bss[0]->driver,
1739                                       hapd_iface->bss[0]->drv_priv,
1740                                       hapd_iface);
1741                 return -1;
1742         }
1743
1744         return 0;
1745 }
1746
1747
1748 int hostapd_reload_iface(struct hostapd_iface *hapd_iface)
1749 {
1750         size_t j;
1751
1752         wpa_printf(MSG_DEBUG, "Reload interface %s",
1753                    hapd_iface->conf->bss[0]->iface);
1754         for (j = 0; j < hapd_iface->num_bss; j++)
1755                 hostapd_set_security_params(hapd_iface->conf->bss[j], 1);
1756         if (hostapd_config_check(hapd_iface->conf, 1) < 0) {
1757                 wpa_printf(MSG_ERROR, "Updated configuration is invalid");
1758                 return -1;
1759         }
1760         hostapd_clear_old(hapd_iface);
1761         for (j = 0; j < hapd_iface->num_bss; j++)
1762                 hostapd_reload_bss(hapd_iface->bss[j]);
1763
1764         return 0;
1765 }
1766
1767
1768 int hostapd_disable_iface(struct hostapd_iface *hapd_iface)
1769 {
1770         size_t j;
1771         const struct wpa_driver_ops *driver;
1772         void *drv_priv;
1773
1774         if (hapd_iface == NULL)
1775                 return -1;
1776
1777         if (hapd_iface->bss[0]->drv_priv == NULL) {
1778                 wpa_printf(MSG_INFO, "Interface %s already disabled",
1779                            hapd_iface->conf->bss[0]->iface);
1780                 return -1;
1781         }
1782
1783         wpa_msg(hapd_iface->bss[0]->msg_ctx, MSG_INFO, AP_EVENT_DISABLED);
1784         driver = hapd_iface->bss[0]->driver;
1785         drv_priv = hapd_iface->bss[0]->drv_priv;
1786
1787         hapd_iface->driver_ap_teardown =
1788                 !!(hapd_iface->drv_flags &
1789                    WPA_DRIVER_FLAGS_AP_TEARDOWN_SUPPORT);
1790
1791         /* same as hostapd_interface_deinit without deinitializing ctrl-iface */
1792         for (j = 0; j < hapd_iface->num_bss; j++) {
1793                 struct hostapd_data *hapd = hapd_iface->bss[j];
1794                 hostapd_bss_deinit_no_free(hapd);
1795                 hostapd_free_hapd_data(hapd);
1796         }
1797
1798         hostapd_deinit_driver(driver, drv_priv, hapd_iface);
1799
1800         /* From hostapd_cleanup_iface: These were initialized in
1801          * hostapd_setup_interface and hostapd_setup_interface_complete
1802          */
1803         hostapd_cleanup_iface_partial(hapd_iface);
1804
1805         wpa_printf(MSG_DEBUG, "Interface %s disabled",
1806                    hapd_iface->bss[0]->conf->iface);
1807         hostapd_set_state(hapd_iface, HAPD_IFACE_DISABLED);
1808         return 0;
1809 }
1810
1811
1812 static struct hostapd_iface *
1813 hostapd_iface_alloc(struct hapd_interfaces *interfaces)
1814 {
1815         struct hostapd_iface **iface, *hapd_iface;
1816
1817         iface = os_realloc_array(interfaces->iface, interfaces->count + 1,
1818                                  sizeof(struct hostapd_iface *));
1819         if (iface == NULL)
1820                 return NULL;
1821         interfaces->iface = iface;
1822         hapd_iface = interfaces->iface[interfaces->count] =
1823                 os_zalloc(sizeof(*hapd_iface));
1824         if (hapd_iface == NULL) {
1825                 wpa_printf(MSG_ERROR, "%s: Failed to allocate memory for "
1826                            "the interface", __func__);
1827                 return NULL;
1828         }
1829         interfaces->count++;
1830         hapd_iface->interfaces = interfaces;
1831
1832         return hapd_iface;
1833 }
1834
1835
1836 static struct hostapd_config *
1837 hostapd_config_alloc(struct hapd_interfaces *interfaces, const char *ifname,
1838                      const char *ctrl_iface)
1839 {
1840         struct hostapd_bss_config *bss;
1841         struct hostapd_config *conf;
1842
1843         /* Allocates memory for bss and conf */
1844         conf = hostapd_config_defaults();
1845         if (conf == NULL) {
1846                  wpa_printf(MSG_ERROR, "%s: Failed to allocate memory for "
1847                                 "configuration", __func__);
1848                 return NULL;
1849         }
1850
1851         conf->driver = wpa_drivers[0];
1852         if (conf->driver == NULL) {
1853                 wpa_printf(MSG_ERROR, "No driver wrappers registered!");
1854                 hostapd_config_free(conf);
1855                 return NULL;
1856         }
1857
1858         bss = conf->last_bss = conf->bss[0];
1859
1860         os_strlcpy(bss->iface, ifname, sizeof(bss->iface));
1861         bss->ctrl_interface = os_strdup(ctrl_iface);
1862         if (bss->ctrl_interface == NULL) {
1863                 hostapd_config_free(conf);
1864                 return NULL;
1865         }
1866
1867         /* Reading configuration file skipped, will be done in SET!
1868          * From reading the configuration till the end has to be done in
1869          * SET
1870          */
1871         return conf;
1872 }
1873
1874
1875 static struct hostapd_iface * hostapd_data_alloc(
1876         struct hapd_interfaces *interfaces, struct hostapd_config *conf)
1877 {
1878         size_t i;
1879         struct hostapd_iface *hapd_iface =
1880                 interfaces->iface[interfaces->count - 1];
1881         struct hostapd_data *hapd;
1882
1883         hapd_iface->conf = conf;
1884         hapd_iface->num_bss = conf->num_bss;
1885
1886         hapd_iface->bss = os_calloc(conf->num_bss,
1887                                     sizeof(struct hostapd_data *));
1888         if (hapd_iface->bss == NULL)
1889                 return NULL;
1890
1891         for (i = 0; i < conf->num_bss; i++) {
1892                 hapd = hapd_iface->bss[i] =
1893                         hostapd_alloc_bss_data(hapd_iface, conf, conf->bss[i]);
1894                 if (hapd == NULL)
1895                         return NULL;
1896                 hapd->msg_ctx = hapd;
1897         }
1898
1899         hapd_iface->interfaces = interfaces;
1900
1901         return hapd_iface;
1902 }
1903
1904
1905 int hostapd_add_iface(struct hapd_interfaces *interfaces, char *buf)
1906 {
1907         struct hostapd_config *conf = NULL;
1908         struct hostapd_iface *hapd_iface = NULL, *new_iface = NULL;
1909         struct hostapd_data *hapd;
1910         char *ptr;
1911         size_t i, j;
1912         const char *conf_file = NULL, *phy_name = NULL;
1913
1914         if (os_strncmp(buf, "bss_config=", 11) == 0) {
1915                 char *pos;
1916                 phy_name = buf + 11;
1917                 pos = os_strchr(phy_name, ':');
1918                 if (!pos)
1919                         return -1;
1920                 *pos++ = '\0';
1921                 conf_file = pos;
1922                 if (!os_strlen(conf_file))
1923                         return -1;
1924
1925                 hapd_iface = hostapd_interface_init_bss(interfaces, phy_name,
1926                                                         conf_file, 0);
1927                 if (!hapd_iface)
1928                         return -1;
1929                 for (j = 0; j < interfaces->count; j++) {
1930                         if (interfaces->iface[j] == hapd_iface)
1931                                 break;
1932                 }
1933                 if (j == interfaces->count) {
1934                         struct hostapd_iface **tmp;
1935                         tmp = os_realloc_array(interfaces->iface,
1936                                                interfaces->count + 1,
1937                                                sizeof(struct hostapd_iface *));
1938                         if (!tmp) {
1939                                 hostapd_interface_deinit_free(hapd_iface);
1940                                 return -1;
1941                         }
1942                         interfaces->iface = tmp;
1943                         interfaces->iface[interfaces->count++] = hapd_iface;
1944                         new_iface = hapd_iface;
1945                 }
1946
1947                 if (new_iface) {
1948                         if (interfaces->driver_init(hapd_iface)) {
1949                                 interfaces->count--;
1950                                 goto fail;
1951                         }
1952
1953                         if (hostapd_setup_interface(hapd_iface)) {
1954                                 interfaces->count--;
1955                                 hostapd_deinit_driver(
1956                                         hapd_iface->bss[0]->driver,
1957                                         hapd_iface->bss[0]->drv_priv,
1958                                         hapd_iface);
1959                                 goto fail;
1960                         }
1961                 } else {
1962                         /* Assign new BSS with bss[0]'s driver info */
1963                         hapd = hapd_iface->bss[hapd_iface->num_bss - 1];
1964                         hapd->driver = hapd_iface->bss[0]->driver;
1965                         hapd->drv_priv = hapd_iface->bss[0]->drv_priv;
1966                         os_memcpy(hapd->own_addr, hapd_iface->bss[0]->own_addr,
1967                                   ETH_ALEN);
1968
1969                         if (start_ctrl_iface_bss(hapd) < 0 ||
1970                             (hapd_iface->state == HAPD_IFACE_ENABLED &&
1971                              hostapd_setup_bss(hapd, -1))) {
1972                                 hostapd_cleanup(hapd);
1973                                 hapd_iface->bss[hapd_iface->num_bss - 1] = NULL;
1974                                 hapd_iface->conf->num_bss--;
1975                                 hapd_iface->num_bss--;
1976                                 wpa_printf(MSG_DEBUG, "%s: free hapd %p %s",
1977                                            __func__, hapd, hapd->conf->iface);
1978                                 os_free(hapd);
1979                                 return -1;
1980                         }
1981                 }
1982                 return 0;
1983         }
1984
1985         ptr = os_strchr(buf, ' ');
1986         if (ptr == NULL)
1987                 return -1;
1988         *ptr++ = '\0';
1989
1990         if (os_strncmp(ptr, "config=", 7) == 0)
1991                 conf_file = ptr + 7;
1992
1993         for (i = 0; i < interfaces->count; i++) {
1994                 if (!os_strcmp(interfaces->iface[i]->conf->bss[0]->iface,
1995                                buf)) {
1996                         wpa_printf(MSG_INFO, "Cannot add interface - it "
1997                                    "already exists");
1998                         return -1;
1999                 }
2000         }
2001
2002         hapd_iface = hostapd_iface_alloc(interfaces);
2003         if (hapd_iface == NULL) {
2004                 wpa_printf(MSG_ERROR, "%s: Failed to allocate memory "
2005                            "for interface", __func__);
2006                 goto fail;
2007         }
2008
2009         if (conf_file && interfaces->config_read_cb) {
2010                 conf = interfaces->config_read_cb(conf_file);
2011                 if (conf && conf->bss)
2012                         os_strlcpy(conf->bss[0]->iface, buf,
2013                                    sizeof(conf->bss[0]->iface));
2014         } else
2015                 conf = hostapd_config_alloc(interfaces, buf, ptr);
2016         if (conf == NULL || conf->bss == NULL) {
2017                 wpa_printf(MSG_ERROR, "%s: Failed to allocate memory "
2018                            "for configuration", __func__);
2019                 goto fail;
2020         }
2021
2022         hapd_iface = hostapd_data_alloc(interfaces, conf);
2023         if (hapd_iface == NULL) {
2024                 wpa_printf(MSG_ERROR, "%s: Failed to allocate memory "
2025                            "for hostapd", __func__);
2026                 goto fail;
2027         }
2028
2029         if (start_ctrl_iface(hapd_iface) < 0)
2030                 goto fail;
2031
2032         wpa_printf(MSG_INFO, "Add interface '%s'", conf->bss[0]->iface);
2033
2034         return 0;
2035
2036 fail:
2037         if (conf)
2038                 hostapd_config_free(conf);
2039         if (hapd_iface) {
2040                 if (hapd_iface->bss) {
2041                         for (i = 0; i < hapd_iface->num_bss; i++) {
2042                                 hapd = hapd_iface->bss[i];
2043                                 if (!hapd)
2044                                         continue;
2045                                 if (hapd_iface->interfaces &&
2046                                     hapd_iface->interfaces->ctrl_iface_deinit)
2047                                         hapd_iface->interfaces->
2048                                                 ctrl_iface_deinit(hapd);
2049                                 wpa_printf(MSG_DEBUG, "%s: free hapd %p (%s)",
2050                                            __func__, hapd_iface->bss[i],
2051                                            hapd->conf->iface);
2052                                 hostapd_cleanup(hapd);
2053                                 os_free(hapd);
2054                                 hapd_iface->bss[i] = NULL;
2055                         }
2056                         os_free(hapd_iface->bss);
2057                         hapd_iface->bss = NULL;
2058                 }
2059                 hostapd_cleanup_iface(hapd_iface);
2060         }
2061         return -1;
2062 }
2063
2064
2065 static int hostapd_remove_bss(struct hostapd_iface *iface, unsigned int idx)
2066 {
2067         size_t i;
2068
2069         wpa_printf(MSG_INFO, "Remove BSS '%s'", iface->conf->bss[idx]->iface);
2070
2071         /* Remove hostapd_data only if it has already been initialized */
2072         if (idx < iface->num_bss) {
2073                 struct hostapd_data *hapd = iface->bss[idx];
2074
2075                 hostapd_bss_deinit(hapd);
2076                 wpa_printf(MSG_DEBUG, "%s: free hapd %p (%s)",
2077                            __func__, hapd, hapd->conf->iface);
2078                 hostapd_config_free_bss(hapd->conf);
2079                 os_free(hapd);
2080
2081                 iface->num_bss--;
2082
2083                 for (i = idx; i < iface->num_bss; i++)
2084                         iface->bss[i] = iface->bss[i + 1];
2085         } else {
2086                 hostapd_config_free_bss(iface->conf->bss[idx]);
2087                 iface->conf->bss[idx] = NULL;
2088         }
2089
2090         iface->conf->num_bss--;
2091         for (i = idx; i < iface->conf->num_bss; i++)
2092                 iface->conf->bss[i] = iface->conf->bss[i + 1];
2093
2094         return 0;
2095 }
2096
2097
2098 int hostapd_remove_iface(struct hapd_interfaces *interfaces, char *buf)
2099 {
2100         struct hostapd_iface *hapd_iface;
2101         size_t i, j, k = 0;
2102
2103         for (i = 0; i < interfaces->count; i++) {
2104                 hapd_iface = interfaces->iface[i];
2105                 if (hapd_iface == NULL)
2106                         return -1;
2107                 if (!os_strcmp(hapd_iface->conf->bss[0]->iface, buf)) {
2108                         wpa_printf(MSG_INFO, "Remove interface '%s'", buf);
2109                         hapd_iface->driver_ap_teardown =
2110                                 !!(hapd_iface->drv_flags &
2111                                    WPA_DRIVER_FLAGS_AP_TEARDOWN_SUPPORT);
2112
2113                         hostapd_interface_deinit_free(hapd_iface);
2114                         k = i;
2115                         while (k < (interfaces->count - 1)) {
2116                                 interfaces->iface[k] =
2117                                         interfaces->iface[k + 1];
2118                                 k++;
2119                         }
2120                         interfaces->count--;
2121                         return 0;
2122                 }
2123
2124                 for (j = 0; j < hapd_iface->conf->num_bss; j++) {
2125                         if (!os_strcmp(hapd_iface->conf->bss[j]->iface, buf)) {
2126                                 hapd_iface->driver_ap_teardown =
2127                                         !(hapd_iface->drv_flags &
2128                                           WPA_DRIVER_FLAGS_AP_TEARDOWN_SUPPORT);
2129                                 return hostapd_remove_bss(hapd_iface, j);
2130                         }
2131                 }
2132         }
2133         return -1;
2134 }
2135
2136
2137 /**
2138  * hostapd_new_assoc_sta - Notify that a new station associated with the AP
2139  * @hapd: Pointer to BSS data
2140  * @sta: Pointer to the associated STA data
2141  * @reassoc: 1 to indicate this was a re-association; 0 = first association
2142  *
2143  * This function will be called whenever a station associates with the AP. It
2144  * can be called from ieee802_11.c for drivers that export MLME to hostapd and
2145  * from drv_callbacks.c based on driver events for drivers that take care of
2146  * management frames (IEEE 802.11 authentication and association) internally.
2147  */
2148 void hostapd_new_assoc_sta(struct hostapd_data *hapd, struct sta_info *sta,
2149                            int reassoc)
2150 {
2151         if (hapd->tkip_countermeasures) {
2152                 hostapd_drv_sta_deauth(hapd, sta->addr,
2153                                        WLAN_REASON_MICHAEL_MIC_FAILURE);
2154                 return;
2155         }
2156
2157         hostapd_prune_associations(hapd, sta->addr);
2158
2159         /* IEEE 802.11F (IAPP) */
2160         if (hapd->conf->ieee802_11f)
2161                 iapp_new_station(hapd->iapp, sta);
2162
2163 #ifdef CONFIG_P2P
2164         if (sta->p2p_ie == NULL && !sta->no_p2p_set) {
2165                 sta->no_p2p_set = 1;
2166                 hapd->num_sta_no_p2p++;
2167                 if (hapd->num_sta_no_p2p == 1)
2168                         hostapd_p2p_non_p2p_sta_connected(hapd);
2169         }
2170 #endif /* CONFIG_P2P */
2171
2172         /* Start accounting here, if IEEE 802.1X and WPA are not used.
2173          * IEEE 802.1X/WPA code will start accounting after the station has
2174          * been authorized. */
2175         if (!hapd->conf->ieee802_1x && !hapd->conf->wpa && !hapd->conf->osen) {
2176                 ap_sta_set_authorized(hapd, sta, 1);
2177                 os_get_reltime(&sta->connected_time);
2178                 accounting_sta_start(hapd, sta);
2179         }
2180
2181         /* Start IEEE 802.1X authentication process for new stations */
2182         ieee802_1x_new_station(hapd, sta);
2183         if (reassoc) {
2184                 if (sta->auth_alg != WLAN_AUTH_FT &&
2185                     !(sta->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS)))
2186                         wpa_auth_sm_event(sta->wpa_sm, WPA_REAUTH);
2187         } else
2188                 wpa_auth_sta_associated(hapd->wpa_auth, sta->wpa_sm);
2189
2190         if (!(hapd->iface->drv_flags & WPA_DRIVER_FLAGS_INACTIVITY_TIMER)) {
2191                 wpa_printf(MSG_DEBUG, "%s: reschedule ap_handle_timer timeout "
2192                            "for " MACSTR " (%d seconds - ap_max_inactivity)",
2193                            __func__, MAC2STR(sta->addr),
2194                            hapd->conf->ap_max_inactivity);
2195                 eloop_cancel_timeout(ap_handle_timer, hapd, sta);
2196                 eloop_register_timeout(hapd->conf->ap_max_inactivity, 0,
2197                                        ap_handle_timer, hapd, sta);
2198         }
2199 }
2200
2201
2202 const char * hostapd_state_text(enum hostapd_iface_state s)
2203 {
2204         switch (s) {
2205         case HAPD_IFACE_UNINITIALIZED:
2206                 return "UNINITIALIZED";
2207         case HAPD_IFACE_DISABLED:
2208                 return "DISABLED";
2209         case HAPD_IFACE_COUNTRY_UPDATE:
2210                 return "COUNTRY_UPDATE";
2211         case HAPD_IFACE_ACS:
2212                 return "ACS";
2213         case HAPD_IFACE_HT_SCAN:
2214                 return "HT_SCAN";
2215         case HAPD_IFACE_DFS:
2216                 return "DFS";
2217         case HAPD_IFACE_ENABLED:
2218                 return "ENABLED";
2219         }
2220
2221         return "UNKNOWN";
2222 }
2223
2224
2225 void hostapd_set_state(struct hostapd_iface *iface, enum hostapd_iface_state s)
2226 {
2227         wpa_printf(MSG_INFO, "%s: interface state %s->%s",
2228                    iface->conf->bss[0]->iface, hostapd_state_text(iface->state),
2229                    hostapd_state_text(s));
2230         iface->state = s;
2231 }
2232
2233
2234 #ifdef NEED_AP_MLME
2235
2236 static void free_beacon_data(struct beacon_data *beacon)
2237 {
2238         os_free(beacon->head);
2239         beacon->head = NULL;
2240         os_free(beacon->tail);
2241         beacon->tail = NULL;
2242         os_free(beacon->probe_resp);
2243         beacon->probe_resp = NULL;
2244         os_free(beacon->beacon_ies);
2245         beacon->beacon_ies = NULL;
2246         os_free(beacon->proberesp_ies);
2247         beacon->proberesp_ies = NULL;
2248         os_free(beacon->assocresp_ies);
2249         beacon->assocresp_ies = NULL;
2250 }
2251
2252
2253 static int hostapd_build_beacon_data(struct hostapd_data *hapd,
2254                                      struct beacon_data *beacon)
2255 {
2256         struct wpabuf *beacon_extra, *proberesp_extra, *assocresp_extra;
2257         struct wpa_driver_ap_params params;
2258         int ret;
2259
2260         os_memset(beacon, 0, sizeof(*beacon));
2261         ret = ieee802_11_build_ap_params(hapd, &params);
2262         if (ret < 0)
2263                 return ret;
2264
2265         ret = hostapd_build_ap_extra_ies(hapd, &beacon_extra,
2266                                          &proberesp_extra,
2267                                          &assocresp_extra);
2268         if (ret)
2269                 goto free_ap_params;
2270
2271         ret = -1;
2272         beacon->head = os_malloc(params.head_len);
2273         if (!beacon->head)
2274                 goto free_ap_extra_ies;
2275
2276         os_memcpy(beacon->head, params.head, params.head_len);
2277         beacon->head_len = params.head_len;
2278
2279         beacon->tail = os_malloc(params.tail_len);
2280         if (!beacon->tail)
2281                 goto free_beacon;
2282
2283         os_memcpy(beacon->tail, params.tail, params.tail_len);
2284         beacon->tail_len = params.tail_len;
2285
2286         if (params.proberesp != NULL) {
2287                 beacon->probe_resp = os_malloc(params.proberesp_len);
2288                 if (!beacon->probe_resp)
2289                         goto free_beacon;
2290
2291                 os_memcpy(beacon->probe_resp, params.proberesp,
2292                           params.proberesp_len);
2293                 beacon->probe_resp_len = params.proberesp_len;
2294         }
2295
2296         /* copy the extra ies */
2297         if (beacon_extra) {
2298                 beacon->beacon_ies = os_malloc(wpabuf_len(beacon_extra));
2299                 if (!beacon->beacon_ies)
2300                         goto free_beacon;
2301
2302                 os_memcpy(beacon->beacon_ies,
2303                           beacon_extra->buf, wpabuf_len(beacon_extra));
2304                 beacon->beacon_ies_len = wpabuf_len(beacon_extra);
2305         }
2306
2307         if (proberesp_extra) {
2308                 beacon->proberesp_ies =
2309                         os_malloc(wpabuf_len(proberesp_extra));
2310                 if (!beacon->proberesp_ies)
2311                         goto free_beacon;
2312
2313                 os_memcpy(beacon->proberesp_ies, proberesp_extra->buf,
2314                           wpabuf_len(proberesp_extra));
2315                 beacon->proberesp_ies_len = wpabuf_len(proberesp_extra);
2316         }
2317
2318         if (assocresp_extra) {
2319                 beacon->assocresp_ies =
2320                         os_malloc(wpabuf_len(assocresp_extra));
2321                 if (!beacon->assocresp_ies)
2322                         goto free_beacon;
2323
2324                 os_memcpy(beacon->assocresp_ies, assocresp_extra->buf,
2325                           wpabuf_len(assocresp_extra));
2326                 beacon->assocresp_ies_len = wpabuf_len(assocresp_extra);
2327         }
2328
2329         ret = 0;
2330 free_beacon:
2331         /* if the function fails, the caller should not free beacon data */
2332         if (ret)
2333                 free_beacon_data(beacon);
2334
2335 free_ap_extra_ies:
2336         hostapd_free_ap_extra_ies(hapd, beacon_extra, proberesp_extra,
2337                                   assocresp_extra);
2338 free_ap_params:
2339         ieee802_11_free_ap_params(&params);
2340         return ret;
2341 }
2342
2343
2344 /*
2345  * TODO: This flow currently supports only changing frequency within the
2346  * same hw_mode. Any other changes to MAC parameters or provided settings (even
2347  * width) are not supported.
2348  */
2349 static int hostapd_change_config_freq(struct hostapd_data *hapd,
2350                                       struct hostapd_config *conf,
2351                                       struct hostapd_freq_params *params,
2352                                       struct hostapd_freq_params *old_params)
2353 {
2354         int channel;
2355
2356         if (!params->channel) {
2357                 /* check if the new channel is supported by hw */
2358                 params->channel = hostapd_hw_get_channel(hapd, params->freq);
2359         }
2360
2361         channel = params->channel;
2362         if (!channel)
2363                 return -1;
2364
2365         /* if a pointer to old_params is provided we save previous state */
2366         if (old_params) {
2367                 old_params->channel = conf->channel;
2368                 old_params->ht_enabled = conf->ieee80211n;
2369                 old_params->sec_channel_offset = conf->secondary_channel;
2370         }
2371
2372         conf->channel = channel;
2373         conf->ieee80211n = params->ht_enabled;
2374         conf->secondary_channel = params->sec_channel_offset;
2375
2376         /* TODO: maybe call here hostapd_config_check here? */
2377
2378         return 0;
2379 }
2380
2381
2382 static int hostapd_fill_csa_settings(struct hostapd_data *hapd,
2383                                      struct csa_settings *settings)
2384 {
2385         struct hostapd_iface *iface = hapd->iface;
2386         struct hostapd_freq_params old_freq;
2387         int ret;
2388
2389         os_memset(&old_freq, 0, sizeof(old_freq));
2390         if (!iface || !iface->freq || hapd->csa_in_progress)
2391                 return -1;
2392
2393         ret = hostapd_change_config_freq(iface->bss[0], iface->conf,
2394                                          &settings->freq_params,
2395                                          &old_freq);
2396         if (ret)
2397                 return ret;
2398
2399         ret = hostapd_build_beacon_data(hapd, &settings->beacon_after);
2400
2401         /* change back the configuration */
2402         hostapd_change_config_freq(iface->bss[0], iface->conf,
2403                                    &old_freq, NULL);
2404
2405         if (ret)
2406                 return ret;
2407
2408         /* set channel switch parameters for csa ie */
2409         hapd->cs_freq_params = settings->freq_params;
2410         hapd->cs_count = settings->cs_count;
2411         hapd->cs_block_tx = settings->block_tx;
2412
2413         ret = hostapd_build_beacon_data(hapd, &settings->beacon_csa);
2414         if (ret) {
2415                 free_beacon_data(&settings->beacon_after);
2416                 return ret;
2417         }
2418
2419         settings->counter_offset_beacon = hapd->cs_c_off_beacon;
2420         settings->counter_offset_presp = hapd->cs_c_off_proberesp;
2421
2422         return 0;
2423 }
2424
2425
2426 void hostapd_cleanup_cs_params(struct hostapd_data *hapd)
2427 {
2428         os_memset(&hapd->cs_freq_params, 0, sizeof(hapd->cs_freq_params));
2429         hapd->cs_count = 0;
2430         hapd->cs_block_tx = 0;
2431         hapd->cs_c_off_beacon = 0;
2432         hapd->cs_c_off_proberesp = 0;
2433         hapd->csa_in_progress = 0;
2434 }
2435
2436
2437 int hostapd_switch_channel(struct hostapd_data *hapd,
2438                            struct csa_settings *settings)
2439 {
2440         int ret;
2441
2442         if (!(hapd->iface->drv_flags & WPA_DRIVER_FLAGS_AP_CSA)) {
2443                 wpa_printf(MSG_INFO, "CSA is not supported");
2444                 return -1;
2445         }
2446
2447         ret = hostapd_fill_csa_settings(hapd, settings);
2448         if (ret)
2449                 return ret;
2450
2451         ret = hostapd_drv_switch_channel(hapd, settings);
2452         free_beacon_data(&settings->beacon_csa);
2453         free_beacon_data(&settings->beacon_after);
2454
2455         if (ret) {
2456                 /* if we failed, clean cs parameters */
2457                 hostapd_cleanup_cs_params(hapd);
2458                 return ret;
2459         }
2460
2461         hapd->csa_in_progress = 1;
2462         return 0;
2463 }
2464
2465
2466 void
2467 hostapd_switch_channel_fallback(struct hostapd_iface *iface,
2468                                 const struct hostapd_freq_params *freq_params)
2469 {
2470         int vht_seg0_idx = 0, vht_seg1_idx = 0, vht_bw = VHT_CHANWIDTH_USE_HT;
2471         unsigned int i;
2472
2473         wpa_printf(MSG_DEBUG, "Restarting all CSA-related BSSes");
2474
2475         if (freq_params->center_freq1)
2476                 vht_seg0_idx = 36 + (freq_params->center_freq1 - 5180) / 5;
2477         if (freq_params->center_freq2)
2478                 vht_seg1_idx = 36 + (freq_params->center_freq2 - 5180) / 5;
2479
2480         switch (freq_params->bandwidth) {
2481         case 0:
2482         case 20:
2483         case 40:
2484                 vht_bw = VHT_CHANWIDTH_USE_HT;
2485                 break;
2486         case 80:
2487                 if (freq_params->center_freq2)
2488                         vht_bw = VHT_CHANWIDTH_80P80MHZ;
2489                 else
2490                         vht_bw = VHT_CHANWIDTH_80MHZ;
2491                 break;
2492         case 160:
2493                 vht_bw = VHT_CHANWIDTH_160MHZ;
2494                 break;
2495         default:
2496                 wpa_printf(MSG_WARNING, "Unknown CSA bandwidth: %d",
2497                            freq_params->bandwidth);
2498                 break;
2499         }
2500
2501         iface->freq = freq_params->freq;
2502         iface->conf->channel = freq_params->channel;
2503         iface->conf->secondary_channel = freq_params->sec_channel_offset;
2504         iface->conf->vht_oper_centr_freq_seg0_idx = vht_seg0_idx;
2505         iface->conf->vht_oper_centr_freq_seg1_idx = vht_seg1_idx;
2506         iface->conf->vht_oper_chwidth = vht_bw;
2507         iface->conf->ieee80211n = freq_params->ht_enabled;
2508         iface->conf->ieee80211ac = freq_params->vht_enabled;
2509
2510         /*
2511          * cs_params must not be cleared earlier because the freq_params
2512          * argument may actually point to one of these.
2513          */
2514         for (i = 0; i < iface->num_bss; i++)
2515                 hostapd_cleanup_cs_params(iface->bss[i]);
2516
2517         hostapd_disable_iface(iface);
2518         hostapd_enable_iface(iface);
2519 }
2520
2521 #endif /* NEED_AP_MLME */