P2P: Preparations for adding P2P IE into Beacon/Probe Response frames
[libeap.git] / src / ap / hostapd.c
1 /*
2  * hostapd / Initialization and configuration
3  * Copyright (c) 2002-2009, Jouni Malinen <j@w1.fi>
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License version 2 as
7  * published by the Free Software Foundation.
8  *
9  * Alternatively, this software may be distributed under the terms of BSD
10  * license.
11  *
12  * See README and COPYING for more details.
13  */
14
15 #include "utils/includes.h"
16
17 #include "utils/common.h"
18 #include "utils/eloop.h"
19 #include "common/ieee802_11_defs.h"
20 #include "radius/radius_client.h"
21 #include "drivers/driver.h"
22 #include "hostapd.h"
23 #include "authsrv.h"
24 #include "sta_info.h"
25 #include "accounting.h"
26 #include "ap_list.h"
27 #include "beacon.h"
28 #include "iapp.h"
29 #include "ieee802_1x.h"
30 #include "ieee802_11_auth.h"
31 #include "vlan_init.h"
32 #include "wpa_auth.h"
33 #include "wps_hostapd.h"
34 #include "hw_features.h"
35 #include "wpa_auth_glue.h"
36 #include "ap_drv_ops.h"
37 #include "ap_config.h"
38
39
40 static int hostapd_flush_old_stations(struct hostapd_data *hapd);
41 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd);
42
43 extern int wpa_debug_level;
44
45
46 int hostapd_reload_config(struct hostapd_iface *iface)
47 {
48         struct hostapd_data *hapd = iface->bss[0];
49         struct hostapd_config *newconf, *oldconf;
50         size_t j;
51
52         if (iface->config_read_cb == NULL)
53                 return -1;
54         newconf = iface->config_read_cb(iface->config_fname);
55         if (newconf == NULL)
56                 return -1;
57
58         /*
59          * Deauthenticate all stations since the new configuration may not
60          * allow them to use the BSS anymore.
61          */
62         for (j = 0; j < iface->num_bss; j++)
63                 hostapd_flush_old_stations(iface->bss[j]);
64
65 #ifndef CONFIG_NO_RADIUS
66         /* TODO: update dynamic data based on changed configuration
67          * items (e.g., open/close sockets, etc.) */
68         radius_client_flush(hapd->radius, 0);
69 #endif /* CONFIG_NO_RADIUS */
70
71         oldconf = hapd->iconf;
72         hapd->iconf = newconf;
73         hapd->conf = &newconf->bss[0];
74         iface->conf = newconf;
75
76         if (hostapd_setup_wpa_psk(hapd->conf)) {
77                 wpa_printf(MSG_ERROR, "Failed to re-configure WPA PSK "
78                            "after reloading configuration");
79         }
80
81         if (hapd->conf->ieee802_1x || hapd->conf->wpa)
82                 hapd->drv.set_drv_ieee8021x(hapd, hapd->conf->iface, 1);
83         else
84                 hapd->drv.set_drv_ieee8021x(hapd, hapd->conf->iface, 0);
85
86         if (hapd->conf->wpa && hapd->wpa_auth == NULL)
87                 hostapd_setup_wpa(hapd);
88         else if (hapd->conf->wpa) {
89                 const u8 *wpa_ie;
90                 size_t wpa_ie_len;
91                 hostapd_reconfig_wpa(hapd);
92                 wpa_ie = wpa_auth_get_wpa_ie(hapd->wpa_auth, &wpa_ie_len);
93                 if (hostapd_set_generic_elem(hapd, wpa_ie, wpa_ie_len))
94                         wpa_printf(MSG_ERROR, "Failed to configure WPA IE for "
95                                    "the kernel driver.");
96         } else if (hapd->wpa_auth) {
97                 wpa_deinit(hapd->wpa_auth);
98                 hapd->wpa_auth = NULL;
99                 hostapd_set_privacy(hapd, 0);
100                 hostapd_setup_encryption(hapd->conf->iface, hapd);
101                 hostapd_set_generic_elem(hapd, (u8 *) "", 0);
102         }
103
104         ieee802_11_set_beacon(hapd);
105         hostapd_update_wps(hapd);
106
107         if (hapd->conf->ssid.ssid_set &&
108             hostapd_set_ssid(hapd, (u8 *) hapd->conf->ssid.ssid,
109                              hapd->conf->ssid.ssid_len)) {
110                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
111                 /* try to continue */
112         }
113
114         hostapd_config_free(oldconf);
115
116         wpa_printf(MSG_DEBUG, "Reconfigured interface %s", hapd->conf->iface);
117
118         return 0;
119 }
120
121
122 static void hostapd_broadcast_key_clear_iface(struct hostapd_data *hapd,
123                                               char *ifname)
124 {
125         int i;
126
127         for (i = 0; i < NUM_WEP_KEYS; i++) {
128                 if (hapd->drv.set_key(ifname, hapd, WPA_ALG_NONE, NULL, i,
129                                       i == 0 ? 1 : 0, NULL, 0, NULL, 0)) {
130                         wpa_printf(MSG_DEBUG, "Failed to clear default "
131                                    "encryption keys (ifname=%s keyidx=%d)",
132                                    ifname, i);
133                 }
134         }
135 #ifdef CONFIG_IEEE80211W
136         if (hapd->conf->ieee80211w) {
137                 for (i = NUM_WEP_KEYS; i < NUM_WEP_KEYS + 2; i++) {
138                         if (hapd->drv.set_key(ifname, hapd, WPA_ALG_NONE, NULL,
139                                               i, i == 0 ? 1 : 0, NULL, 0,
140                                               NULL, 0)) {
141                                 wpa_printf(MSG_DEBUG, "Failed to clear "
142                                            "default mgmt encryption keys "
143                                            "(ifname=%s keyidx=%d)", ifname, i);
144                         }
145                 }
146         }
147 #endif /* CONFIG_IEEE80211W */
148 }
149
150
151 static int hostapd_broadcast_wep_clear(struct hostapd_data *hapd)
152 {
153         hostapd_broadcast_key_clear_iface(hapd, hapd->conf->iface);
154         return 0;
155 }
156
157
158 static int hostapd_broadcast_wep_set(struct hostapd_data *hapd)
159 {
160         int errors = 0, idx;
161         struct hostapd_ssid *ssid = &hapd->conf->ssid;
162
163         idx = ssid->wep.idx;
164         if (ssid->wep.default_len &&
165             hapd->drv.set_key(hapd->conf->iface,
166                               hapd, WPA_ALG_WEP, NULL, idx,
167                               idx == ssid->wep.idx,
168                               NULL, 0, ssid->wep.key[idx],
169                               ssid->wep.len[idx])) {
170                 wpa_printf(MSG_WARNING, "Could not set WEP encryption.");
171                 errors++;
172         }
173
174         if (ssid->dyn_vlan_keys) {
175                 size_t i;
176                 for (i = 0; i <= ssid->max_dyn_vlan_keys; i++) {
177                         const char *ifname;
178                         struct hostapd_wep_keys *key = ssid->dyn_vlan_keys[i];
179                         if (key == NULL)
180                                 continue;
181                         ifname = hostapd_get_vlan_id_ifname(hapd->conf->vlan,
182                                                             i);
183                         if (ifname == NULL)
184                                 continue;
185
186                         idx = key->idx;
187                         if (hapd->drv.set_key(ifname, hapd, WPA_ALG_WEP, NULL,
188                                               idx, idx == key->idx, NULL, 0,
189                                               key->key[idx], key->len[idx])) {
190                                 wpa_printf(MSG_WARNING, "Could not set "
191                                            "dynamic VLAN WEP encryption.");
192                                 errors++;
193                         }
194                 }
195         }
196
197         return errors;
198 }
199
200 /**
201  * hostapd_cleanup - Per-BSS cleanup (deinitialization)
202  * @hapd: Pointer to BSS data
203  *
204  * This function is used to free all per-BSS data structures and resources.
205  * This gets called in a loop for each BSS between calls to
206  * hostapd_cleanup_iface_pre() and hostapd_cleanup_iface() when an interface
207  * is deinitialized. Most of the modules that are initialized in
208  * hostapd_setup_bss() are deinitialized here.
209  */
210 static void hostapd_cleanup(struct hostapd_data *hapd)
211 {
212         if (hapd->iface->ctrl_iface_deinit)
213                 hapd->iface->ctrl_iface_deinit(hapd);
214
215         iapp_deinit(hapd->iapp);
216         hapd->iapp = NULL;
217         accounting_deinit(hapd);
218         hostapd_deinit_wpa(hapd);
219         vlan_deinit(hapd);
220         hostapd_acl_deinit(hapd);
221 #ifndef CONFIG_NO_RADIUS
222         radius_client_deinit(hapd->radius);
223         hapd->radius = NULL;
224 #endif /* CONFIG_NO_RADIUS */
225
226         hostapd_deinit_wps(hapd);
227
228         authsrv_deinit(hapd);
229
230         if (hapd->interface_added &&
231             hostapd_if_remove(hapd, WPA_IF_AP_BSS, hapd->conf->iface)) {
232                 wpa_printf(MSG_WARNING, "Failed to remove BSS interface %s",
233                            hapd->conf->iface);
234         }
235
236         os_free(hapd->probereq_cb);
237         hapd->probereq_cb = NULL;
238
239 #ifdef CONFIG_P2P
240         wpabuf_free(hapd->p2p_beacon_ie);
241         hapd->p2p_beacon_ie = NULL;
242         wpabuf_free(hapd->p2p_probe_resp_ie);
243         hapd->p2p_probe_resp_ie = NULL;
244 #endif /* CONFIG_P2P */
245 }
246
247
248 /**
249  * hostapd_cleanup_iface_pre - Preliminary per-interface cleanup
250  * @iface: Pointer to interface data
251  *
252  * This function is called before per-BSS data structures are deinitialized
253  * with hostapd_cleanup().
254  */
255 static void hostapd_cleanup_iface_pre(struct hostapd_iface *iface)
256 {
257 }
258
259
260 /**
261  * hostapd_cleanup_iface - Complete per-interface cleanup
262  * @iface: Pointer to interface data
263  *
264  * This function is called after per-BSS data structures are deinitialized
265  * with hostapd_cleanup().
266  */
267 static void hostapd_cleanup_iface(struct hostapd_iface *iface)
268 {
269         hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
270         iface->hw_features = NULL;
271         os_free(iface->current_rates);
272         iface->current_rates = NULL;
273         ap_list_deinit(iface);
274         hostapd_config_free(iface->conf);
275         iface->conf = NULL;
276
277         os_free(iface->config_fname);
278         os_free(iface->bss);
279         os_free(iface);
280 }
281
282
283 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd)
284 {
285         int i;
286
287         hostapd_broadcast_wep_set(hapd);
288
289         if (hapd->conf->ssid.wep.default_len) {
290                 hostapd_set_privacy(hapd, 1);
291                 return 0;
292         }
293
294         for (i = 0; i < 4; i++) {
295                 if (hapd->conf->ssid.wep.key[i] &&
296                     hapd->drv.set_key(iface, hapd, WPA_ALG_WEP, NULL, i,
297                                       i == hapd->conf->ssid.wep.idx, NULL, 0,
298                                       hapd->conf->ssid.wep.key[i],
299                                       hapd->conf->ssid.wep.len[i])) {
300                         wpa_printf(MSG_WARNING, "Could not set WEP "
301                                    "encryption.");
302                         return -1;
303                 }
304                 if (hapd->conf->ssid.wep.key[i] &&
305                     i == hapd->conf->ssid.wep.idx)
306                         hostapd_set_privacy(hapd, 1);
307         }
308
309         return 0;
310 }
311
312
313 static int hostapd_flush_old_stations(struct hostapd_data *hapd)
314 {
315         int ret = 0;
316
317         if (hostapd_drv_none(hapd) || hapd->drv_priv == NULL)
318                 return 0;
319
320         wpa_printf(MSG_DEBUG, "Flushing old station entries");
321         if (hostapd_flush(hapd)) {
322                 wpa_printf(MSG_WARNING, "Could not connect to kernel driver.");
323                 ret = -1;
324         }
325         wpa_printf(MSG_DEBUG, "Deauthenticate all stations");
326
327         /* New Prism2.5/3 STA firmware versions seem to have issues with this
328          * broadcast deauth frame. This gets the firmware in odd state where
329          * nothing works correctly, so let's skip sending this for the hostap
330          * driver. */
331         if (hapd->driver && os_strcmp(hapd->driver->name, "hostap") != 0) {
332                 u8 addr[ETH_ALEN];
333                 os_memset(addr, 0xff, ETH_ALEN);
334                 hapd->drv.sta_deauth(hapd, addr,
335                                      WLAN_REASON_PREV_AUTH_NOT_VALID);
336         }
337
338         return ret;
339 }
340
341
342 /**
343  * hostapd_validate_bssid_configuration - Validate BSSID configuration
344  * @iface: Pointer to interface data
345  * Returns: 0 on success, -1 on failure
346  *
347  * This function is used to validate that the configured BSSIDs are valid.
348  */
349 static int hostapd_validate_bssid_configuration(struct hostapd_iface *iface)
350 {
351         u8 mask[ETH_ALEN] = { 0 };
352         struct hostapd_data *hapd = iface->bss[0];
353         unsigned int i = iface->conf->num_bss, bits = 0, j;
354         int res;
355         int auto_addr = 0;
356
357         if (hostapd_drv_none(hapd))
358                 return 0;
359
360         /* Generate BSSID mask that is large enough to cover the BSSIDs. */
361
362         /* Determine the bits necessary to cover the number of BSSIDs. */
363         for (i--; i; i >>= 1)
364                 bits++;
365
366         /* Determine the bits necessary to any configured BSSIDs,
367            if they are higher than the number of BSSIDs. */
368         for (j = 0; j < iface->conf->num_bss; j++) {
369                 if (hostapd_mac_comp_empty(iface->conf->bss[j].bssid) == 0) {
370                         if (j)
371                                 auto_addr++;
372                         continue;
373                 }
374
375                 for (i = 0; i < ETH_ALEN; i++) {
376                         mask[i] |=
377                                 iface->conf->bss[j].bssid[i] ^
378                                 hapd->own_addr[i];
379                 }
380         }
381
382         if (!auto_addr)
383                 goto skip_mask_ext;
384
385         for (i = 0; i < ETH_ALEN && mask[i] == 0; i++)
386                 ;
387         j = 0;
388         if (i < ETH_ALEN) {
389                 j = (5 - i) * 8;
390
391                 while (mask[i] != 0) {
392                         mask[i] >>= 1;
393                         j++;
394                 }
395         }
396
397         if (bits < j)
398                 bits = j;
399
400         if (bits > 40) {
401                 wpa_printf(MSG_ERROR, "Too many bits in the BSSID mask (%u)",
402                            bits);
403                 return -1;
404         }
405
406         os_memset(mask, 0xff, ETH_ALEN);
407         j = bits / 8;
408         for (i = 5; i > 5 - j; i--)
409                 mask[i] = 0;
410         j = bits % 8;
411         while (j--)
412                 mask[i] <<= 1;
413
414 skip_mask_ext:
415         wpa_printf(MSG_DEBUG, "BSS count %lu, BSSID mask " MACSTR " (%d bits)",
416                    (unsigned long) iface->conf->num_bss, MAC2STR(mask), bits);
417
418         res = hostapd_valid_bss_mask(hapd, hapd->own_addr, mask);
419         if (res == 0)
420                 return 0;
421
422         if (res < 0) {
423                 wpa_printf(MSG_ERROR, "Driver did not accept BSSID mask "
424                            MACSTR " for start address " MACSTR ".",
425                            MAC2STR(mask), MAC2STR(hapd->own_addr));
426                 return -1;
427         }
428
429         if (!auto_addr)
430                 return 0;
431
432         for (i = 0; i < ETH_ALEN; i++) {
433                 if ((hapd->own_addr[i] & mask[i]) != hapd->own_addr[i]) {
434                         wpa_printf(MSG_ERROR, "Invalid BSSID mask " MACSTR
435                                    " for start address " MACSTR ".",
436                                    MAC2STR(mask), MAC2STR(hapd->own_addr));
437                         wpa_printf(MSG_ERROR, "Start address must be the "
438                                    "first address in the block (i.e., addr "
439                                    "AND mask == addr).");
440                         return -1;
441                 }
442         }
443
444         return 0;
445 }
446
447
448 static int mac_in_conf(struct hostapd_config *conf, const void *a)
449 {
450         size_t i;
451
452         for (i = 0; i < conf->num_bss; i++) {
453                 if (hostapd_mac_comp(conf->bss[i].bssid, a) == 0) {
454                         return 1;
455                 }
456         }
457
458         return 0;
459 }
460
461
462
463
464 /**
465  * hostapd_setup_bss - Per-BSS setup (initialization)
466  * @hapd: Pointer to BSS data
467  * @first: Whether this BSS is the first BSS of an interface
468  *
469  * This function is used to initialize all per-BSS data structures and
470  * resources. This gets called in a loop for each BSS when an interface is
471  * initialized. Most of the modules that are initialized here will be
472  * deinitialized in hostapd_cleanup().
473  */
474 static int hostapd_setup_bss(struct hostapd_data *hapd, int first)
475 {
476         struct hostapd_bss_config *conf = hapd->conf;
477         u8 ssid[HOSTAPD_MAX_SSID_LEN + 1];
478         int ssid_len, set_ssid;
479         char force_ifname[IFNAMSIZ];
480         u8 if_addr[ETH_ALEN];
481
482         if (!first) {
483                 if (hostapd_mac_comp_empty(hapd->conf->bssid) == 0) {
484                         /* Allocate the next available BSSID. */
485                         do {
486                                 inc_byte_array(hapd->own_addr, ETH_ALEN);
487                         } while (mac_in_conf(hapd->iconf, hapd->own_addr));
488                 } else {
489                         /* Allocate the configured BSSID. */
490                         os_memcpy(hapd->own_addr, hapd->conf->bssid, ETH_ALEN);
491
492                         if (hostapd_mac_comp(hapd->own_addr,
493                                              hapd->iface->bss[0]->own_addr) ==
494                             0) {
495                                 wpa_printf(MSG_ERROR, "BSS '%s' may not have "
496                                            "BSSID set to the MAC address of "
497                                            "the radio", hapd->conf->iface);
498                                 return -1;
499                         }
500                 }
501
502                 hapd->interface_added = 1;
503                 if (hostapd_if_add(hapd->iface->bss[0], WPA_IF_AP_BSS,
504                                    hapd->conf->iface, hapd->own_addr, hapd,
505                                    &hapd->drv_priv, force_ifname, if_addr)) {
506                         wpa_printf(MSG_ERROR, "Failed to add BSS (BSSID="
507                                    MACSTR ")", MAC2STR(hapd->own_addr));
508                         return -1;
509                 }
510         }
511
512         hostapd_flush_old_stations(hapd);
513         hostapd_set_privacy(hapd, 0);
514
515         hostapd_broadcast_wep_clear(hapd);
516         if (hostapd_setup_encryption(hapd->conf->iface, hapd))
517                 return -1;
518
519         /*
520          * Fetch the SSID from the system and use it or,
521          * if one was specified in the config file, verify they
522          * match.
523          */
524         ssid_len = hostapd_get_ssid(hapd, ssid, sizeof(ssid));
525         if (ssid_len < 0) {
526                 wpa_printf(MSG_ERROR, "Could not read SSID from system");
527                 return -1;
528         }
529         if (conf->ssid.ssid_set) {
530                 /*
531                  * If SSID is specified in the config file and it differs
532                  * from what is being used then force installation of the
533                  * new SSID.
534                  */
535                 set_ssid = (conf->ssid.ssid_len != (size_t) ssid_len ||
536                             os_memcmp(conf->ssid.ssid, ssid, ssid_len) != 0);
537         } else {
538                 /*
539                  * No SSID in the config file; just use the one we got
540                  * from the system.
541                  */
542                 set_ssid = 0;
543                 conf->ssid.ssid_len = ssid_len;
544                 os_memcpy(conf->ssid.ssid, ssid, conf->ssid.ssid_len);
545                 conf->ssid.ssid[conf->ssid.ssid_len] = '\0';
546         }
547
548         if (!hostapd_drv_none(hapd)) {
549                 wpa_printf(MSG_ERROR, "Using interface %s with hwaddr " MACSTR
550                            " and ssid '%s'",
551                            hapd->conf->iface, MAC2STR(hapd->own_addr),
552                            hapd->conf->ssid.ssid);
553         }
554
555         if (hostapd_setup_wpa_psk(conf)) {
556                 wpa_printf(MSG_ERROR, "WPA-PSK setup failed.");
557                 return -1;
558         }
559
560         /* Set SSID for the kernel driver (to be used in beacon and probe
561          * response frames) */
562         if (set_ssid && hostapd_set_ssid(hapd, (u8 *) conf->ssid.ssid,
563                                          conf->ssid.ssid_len)) {
564                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
565                 return -1;
566         }
567
568         if (wpa_debug_level == MSG_MSGDUMP)
569                 conf->radius->msg_dumps = 1;
570 #ifndef CONFIG_NO_RADIUS
571         hapd->radius = radius_client_init(hapd, conf->radius);
572         if (hapd->radius == NULL) {
573                 wpa_printf(MSG_ERROR, "RADIUS client initialization failed.");
574                 return -1;
575         }
576 #endif /* CONFIG_NO_RADIUS */
577
578         if (hostapd_acl_init(hapd)) {
579                 wpa_printf(MSG_ERROR, "ACL initialization failed.");
580                 return -1;
581         }
582         if (hostapd_init_wps(hapd, conf))
583                 return -1;
584
585         if (authsrv_init(hapd) < 0)
586                 return -1;
587
588         if (ieee802_1x_init(hapd)) {
589                 wpa_printf(MSG_ERROR, "IEEE 802.1X initialization failed.");
590                 return -1;
591         }
592
593         if (hapd->conf->wpa && hostapd_setup_wpa(hapd))
594                 return -1;
595
596         if (accounting_init(hapd)) {
597                 wpa_printf(MSG_ERROR, "Accounting initialization failed.");
598                 return -1;
599         }
600
601         if (hapd->conf->ieee802_11f &&
602             (hapd->iapp = iapp_init(hapd, hapd->conf->iapp_iface)) == NULL) {
603                 wpa_printf(MSG_ERROR, "IEEE 802.11F (IAPP) initialization "
604                            "failed.");
605                 return -1;
606         }
607
608         if (hapd->iface->ctrl_iface_init &&
609             hapd->iface->ctrl_iface_init(hapd)) {
610                 wpa_printf(MSG_ERROR, "Failed to setup control interface");
611                 return -1;
612         }
613
614         if (!hostapd_drv_none(hapd) && vlan_init(hapd)) {
615                 wpa_printf(MSG_ERROR, "VLAN initialization failed.");
616                 return -1;
617         }
618
619         ieee802_11_set_beacon(hapd);
620
621         return 0;
622 }
623
624
625 static void hostapd_tx_queue_params(struct hostapd_iface *iface)
626 {
627         struct hostapd_data *hapd = iface->bss[0];
628         int i;
629         struct hostapd_tx_queue_params *p;
630
631         for (i = 0; i < NUM_TX_QUEUES; i++) {
632                 p = &iface->conf->tx_queue[i];
633
634                 if (!p->configured)
635                         continue;
636
637                 if (hostapd_set_tx_queue_params(hapd, i, p->aifs, p->cwmin,
638                                                 p->cwmax, p->burst)) {
639                         wpa_printf(MSG_DEBUG, "Failed to set TX queue "
640                                    "parameters for queue %d.", i);
641                         /* Continue anyway */
642                 }
643         }
644 }
645
646
647 static int setup_interface(struct hostapd_iface *iface)
648 {
649         struct hostapd_data *hapd = iface->bss[0];
650         size_t i;
651         char country[4];
652
653         /*
654          * Make sure that all BSSes get configured with a pointer to the same
655          * driver interface.
656          */
657         for (i = 1; i < iface->num_bss; i++) {
658                 iface->bss[i]->driver = hapd->driver;
659                 iface->bss[i]->drv_priv = hapd->drv_priv;
660         }
661
662         if (hostapd_validate_bssid_configuration(iface))
663                 return -1;
664
665         if (hapd->iconf->country[0] && hapd->iconf->country[1]) {
666                 os_memcpy(country, hapd->iconf->country, 3);
667                 country[3] = '\0';
668                 if (hostapd_set_country(hapd, country) < 0) {
669                         wpa_printf(MSG_ERROR, "Failed to set country code");
670                         return -1;
671                 }
672         }
673
674         if (hostapd_get_hw_features(iface)) {
675                 /* Not all drivers support this yet, so continue without hw
676                  * feature data. */
677         } else {
678                 int ret = hostapd_select_hw_mode(iface);
679                 if (ret < 0) {
680                         wpa_printf(MSG_ERROR, "Could not select hw_mode and "
681                                    "channel. (%d)", ret);
682                         return -1;
683                 }
684                 ret = hostapd_check_ht_capab(iface);
685                 if (ret < 0)
686                         return -1;
687                 if (ret == 1) {
688                         wpa_printf(MSG_DEBUG, "Interface initialization will "
689                                    "be completed in a callback");
690                         return 0;
691                 }
692         }
693         return hostapd_setup_interface_complete(iface, 0);
694 }
695
696
697 int hostapd_setup_interface_complete(struct hostapd_iface *iface, int err)
698 {
699         struct hostapd_data *hapd = iface->bss[0];
700         size_t j;
701         u8 *prev_addr;
702
703         if (err) {
704                 wpa_printf(MSG_ERROR, "Interface initialization failed");
705                 eloop_terminate();
706                 return -1;
707         }
708
709         wpa_printf(MSG_DEBUG, "Completing interface initialization");
710         if (hapd->iconf->channel) {
711                 iface->freq = hostapd_hw_get_freq(hapd, hapd->iconf->channel);
712                 wpa_printf(MSG_DEBUG, "Mode: %s  Channel: %d  "
713                            "Frequency: %d MHz",
714                            hostapd_hw_mode_txt(hapd->iconf->hw_mode),
715                            hapd->iconf->channel, iface->freq);
716
717                 if (hostapd_set_freq(hapd, hapd->iconf->hw_mode, iface->freq,
718                                      hapd->iconf->channel,
719                                      hapd->iconf->ieee80211n,
720                                      hapd->iconf->secondary_channel)) {
721                         wpa_printf(MSG_ERROR, "Could not set channel for "
722                                    "kernel driver");
723                         return -1;
724                 }
725         }
726
727         if (hapd->iconf->rts_threshold > -1 &&
728             hostapd_set_rts(hapd, hapd->iconf->rts_threshold)) {
729                 wpa_printf(MSG_ERROR, "Could not set RTS threshold for "
730                            "kernel driver");
731                 return -1;
732         }
733
734         if (hapd->iconf->fragm_threshold > -1 &&
735             hostapd_set_frag(hapd, hapd->iconf->fragm_threshold)) {
736                 wpa_printf(MSG_ERROR, "Could not set fragmentation threshold "
737                            "for kernel driver");
738                 return -1;
739         }
740
741         prev_addr = hapd->own_addr;
742
743         for (j = 0; j < iface->num_bss; j++) {
744                 hapd = iface->bss[j];
745                 if (j)
746                         os_memcpy(hapd->own_addr, prev_addr, ETH_ALEN);
747                 if (hostapd_setup_bss(hapd, j == 0))
748                         return -1;
749                 if (hostapd_mac_comp_empty(hapd->conf->bssid) == 0)
750                         prev_addr = hapd->own_addr;
751         }
752
753         hostapd_tx_queue_params(iface);
754
755         ap_list_init(iface);
756
757         if (hostapd_driver_commit(hapd) < 0) {
758                 wpa_printf(MSG_ERROR, "%s: Failed to commit driver "
759                            "configuration", __func__);
760                 return -1;
761         }
762
763         wpa_printf(MSG_DEBUG, "%s: Setup of interface done.",
764                    iface->bss[0]->conf->iface);
765
766         return 0;
767 }
768
769
770 /**
771  * hostapd_setup_interface - Setup of an interface
772  * @iface: Pointer to interface data.
773  * Returns: 0 on success, -1 on failure
774  *
775  * Initializes the driver interface, validates the configuration,
776  * and sets driver parameters based on the configuration.
777  * Flushes old stations, sets the channel, encryption,
778  * beacons, and WDS links based on the configuration.
779  */
780 int hostapd_setup_interface(struct hostapd_iface *iface)
781 {
782         int ret;
783
784         ret = setup_interface(iface);
785         if (ret) {
786                 wpa_printf(MSG_ERROR, "%s: Unable to setup interface.",
787                            iface->bss[0]->conf->iface);
788                 return -1;
789         }
790
791         return 0;
792 }
793
794
795 /**
796  * hostapd_alloc_bss_data - Allocate and initialize per-BSS data
797  * @hapd_iface: Pointer to interface data
798  * @conf: Pointer to per-interface configuration
799  * @bss: Pointer to per-BSS configuration for this BSS
800  * Returns: Pointer to allocated BSS data
801  *
802  * This function is used to allocate per-BSS data structure. This data will be
803  * freed after hostapd_cleanup() is called for it during interface
804  * deinitialization.
805  */
806 struct hostapd_data *
807 hostapd_alloc_bss_data(struct hostapd_iface *hapd_iface,
808                        struct hostapd_config *conf,
809                        struct hostapd_bss_config *bss)
810 {
811         struct hostapd_data *hapd;
812
813         hapd = os_zalloc(sizeof(*hapd));
814         if (hapd == NULL)
815                 return NULL;
816
817         hostapd_set_driver_ops(&hapd->drv);
818         hapd->new_assoc_sta_cb = hostapd_new_assoc_sta;
819         hapd->iconf = conf;
820         hapd->conf = bss;
821         hapd->iface = hapd_iface;
822         hapd->driver = hapd->iconf->driver;
823
824         return hapd;
825 }
826
827
828 void hostapd_interface_deinit(struct hostapd_iface *iface)
829 {
830         size_t j;
831
832         if (iface == NULL)
833                 return;
834
835         hostapd_cleanup_iface_pre(iface);
836         for (j = 0; j < iface->num_bss; j++) {
837                 struct hostapd_data *hapd = iface->bss[j];
838                 hostapd_free_stas(hapd);
839                 hostapd_flush_old_stations(hapd);
840                 hostapd_cleanup(hapd);
841         }
842 }
843
844
845 void hostapd_interface_free(struct hostapd_iface *iface)
846 {
847         size_t j;
848         for (j = 0; j < iface->num_bss; j++)
849                 os_free(iface->bss[j]);
850         hostapd_cleanup_iface(iface);
851 }
852
853
854 /**
855  * hostapd_new_assoc_sta - Notify that a new station associated with the AP
856  * @hapd: Pointer to BSS data
857  * @sta: Pointer to the associated STA data
858  * @reassoc: 1 to indicate this was a re-association; 0 = first association
859  *
860  * This function will be called whenever a station associates with the AP. It
861  * can be called from ieee802_11.c for drivers that export MLME to hostapd and
862  * from drv_callbacks.c based on driver events for drivers that take care of
863  * management frames (IEEE 802.11 authentication and association) internally.
864  */
865 void hostapd_new_assoc_sta(struct hostapd_data *hapd, struct sta_info *sta,
866                            int reassoc)
867 {
868         if (hapd->tkip_countermeasures) {
869                 hapd->drv.sta_deauth(hapd, sta->addr,
870                                      WLAN_REASON_MICHAEL_MIC_FAILURE);
871                 return;
872         }
873
874         hostapd_prune_associations(hapd, sta->addr);
875
876         /* IEEE 802.11F (IAPP) */
877         if (hapd->conf->ieee802_11f)
878                 iapp_new_station(hapd->iapp, sta);
879
880         /* Start accounting here, if IEEE 802.1X and WPA are not used.
881          * IEEE 802.1X/WPA code will start accounting after the station has
882          * been authorized. */
883         if (!hapd->conf->ieee802_1x && !hapd->conf->wpa)
884                 accounting_sta_start(hapd, sta);
885
886         /* Start IEEE 802.1X authentication process for new stations */
887         ieee802_1x_new_station(hapd, sta);
888         if (reassoc) {
889                 if (sta->auth_alg != WLAN_AUTH_FT &&
890                     !(sta->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS)))
891                         wpa_auth_sm_event(sta->wpa_sm, WPA_REAUTH);
892         } else
893                 wpa_auth_sta_associated(hapd->wpa_auth, sta->wpa_sm);
894 }