nl80211: Replace hostapd WEXT events with nl80211 events
[wpasupplicant] / hostapd / 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 "includes.h"
16
17 #include "eloop.h"
18 #include "hostapd.h"
19 #include "ieee802_1x.h"
20 #include "beacon.h"
21 #include "hw_features.h"
22 #include "accounting.h"
23 #include "eapol_sm.h"
24 #include "iapp.h"
25 #include "ieee802_11_defs.h"
26 #include "ieee802_11_auth.h"
27 #include "sta_info.h"
28 #include "ap_list.h"
29 #include "driver_i.h"
30 #include "radius/radius_client.h"
31 #include "radius/radius_server.h"
32 #include "wpa.h"
33 #include "preauth.h"
34 #include "vlan_init.h"
35 #include "ctrl_iface.h"
36 #include "tls.h"
37 #include "eap_server/eap_sim_db.h"
38 #include "eap_server/eap.h"
39 #include "eap_server/tncs.h"
40 #include "version.h"
41 #include "l2_packet/l2_packet.h"
42 #include "wps_hostapd.h"
43 #include "tkip_countermeasures.h"
44
45
46 static int hostapd_radius_get_eap_user(void *ctx, const u8 *identity,
47                                        size_t identity_len, int phase2,
48                                        struct eap_user *user);
49 static int hostapd_flush_old_stations(struct hostapd_data *hapd);
50 static int hostapd_setup_wpa(struct hostapd_data *hapd);
51 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd);
52
53 extern int wpa_debug_level;
54
55
56 #ifdef EAP_SERVER
57 static int hostapd_sim_db_cb_sta(struct hostapd_data *hapd,
58                                  struct sta_info *sta, void *ctx)
59 {
60         if (eapol_auth_eap_pending_cb(sta->eapol_sm, ctx) == 0)
61                 return 1;
62         return 0;
63 }
64
65
66 static void hostapd_sim_db_cb(void *ctx, void *session_ctx)
67 {
68         struct hostapd_data *hapd = ctx;
69         if (ap_for_each_sta(hapd, hostapd_sim_db_cb_sta, session_ctx) == 0)
70                 radius_server_eap_pending_cb(hapd->radius_srv, session_ctx);
71 }
72 #endif /* EAP_SERVER */
73
74
75 static void hostapd_wpa_auth_conf(struct hostapd_bss_config *conf,
76                                   struct wpa_auth_config *wconf)
77 {
78         wconf->wpa = conf->wpa;
79         wconf->wpa_key_mgmt = conf->wpa_key_mgmt;
80         wconf->wpa_pairwise = conf->wpa_pairwise;
81         wconf->wpa_group = conf->wpa_group;
82         wconf->wpa_group_rekey = conf->wpa_group_rekey;
83         wconf->wpa_strict_rekey = conf->wpa_strict_rekey;
84         wconf->wpa_gmk_rekey = conf->wpa_gmk_rekey;
85         wconf->wpa_ptk_rekey = conf->wpa_ptk_rekey;
86         wconf->rsn_pairwise = conf->rsn_pairwise;
87         wconf->rsn_preauth = conf->rsn_preauth;
88         wconf->eapol_version = conf->eapol_version;
89         wconf->peerkey = conf->peerkey;
90         wconf->wmm_enabled = conf->wmm_enabled;
91         wconf->okc = conf->okc;
92 #ifdef CONFIG_IEEE80211W
93         wconf->ieee80211w = conf->ieee80211w;
94 #endif /* CONFIG_IEEE80211W */
95 #ifdef CONFIG_IEEE80211R
96         wconf->ssid_len = conf->ssid.ssid_len;
97         if (wconf->ssid_len > SSID_LEN)
98                 wconf->ssid_len = SSID_LEN;
99         os_memcpy(wconf->ssid, conf->ssid.ssid, wconf->ssid_len);
100         os_memcpy(wconf->mobility_domain, conf->mobility_domain,
101                   MOBILITY_DOMAIN_ID_LEN);
102         if (conf->nas_identifier &&
103             os_strlen(conf->nas_identifier) <= FT_R0KH_ID_MAX_LEN) {
104                 wconf->r0_key_holder_len = os_strlen(conf->nas_identifier);
105                 os_memcpy(wconf->r0_key_holder, conf->nas_identifier,
106                           wconf->r0_key_holder_len);
107         }
108         os_memcpy(wconf->r1_key_holder, conf->r1_key_holder, FT_R1KH_ID_LEN);
109         wconf->r0_key_lifetime = conf->r0_key_lifetime;
110         wconf->reassociation_deadline = conf->reassociation_deadline;
111         wconf->r0kh_list = conf->r0kh_list;
112         wconf->r1kh_list = conf->r1kh_list;
113         wconf->pmk_r1_push = conf->pmk_r1_push;
114 #endif /* CONFIG_IEEE80211R */
115 }
116
117
118 int hostapd_reload_config(struct hostapd_iface *iface)
119 {
120         struct hostapd_data *hapd = iface->bss[0];
121         struct hostapd_config *newconf, *oldconf;
122         struct wpa_auth_config wpa_auth_conf;
123         size_t j;
124
125         newconf = hostapd_config_read(iface->config_fname);
126         if (newconf == NULL)
127                 return -1;
128
129         /*
130          * Deauthenticate all stations since the new configuration may not
131          * allow them to use the BSS anymore.
132          */
133         for (j = 0; j < iface->num_bss; j++)
134                 hostapd_flush_old_stations(iface->bss[j]);
135
136         /* TODO: update dynamic data based on changed configuration
137          * items (e.g., open/close sockets, etc.) */
138         radius_client_flush(hapd->radius, 0);
139
140         oldconf = hapd->iconf;
141         hapd->iconf = newconf;
142         hapd->conf = &newconf->bss[0];
143         iface->conf = newconf;
144
145         if (hostapd_setup_wpa_psk(hapd->conf)) {
146                 wpa_printf(MSG_ERROR, "Failed to re-configure WPA PSK "
147                            "after reloading configuration");
148         }
149
150         if (hapd->conf->wpa && hapd->wpa_auth == NULL)
151                 hostapd_setup_wpa(hapd);
152         else if (hapd->conf->wpa) {
153                 hostapd_wpa_auth_conf(&newconf->bss[0], &wpa_auth_conf);
154                 wpa_reconfig(hapd->wpa_auth, &wpa_auth_conf);
155         } else if (hapd->wpa_auth) {
156                 wpa_deinit(hapd->wpa_auth);
157                 hapd->wpa_auth = NULL;
158                 hostapd_set_privacy(hapd, 0);
159                 hostapd_setup_encryption(hapd->conf->iface, hapd);
160         }
161
162         ieee802_11_set_beacon(hapd);
163
164         if (hapd->conf->ssid.ssid_set &&
165             hostapd_set_ssid(hapd, (u8 *) hapd->conf->ssid.ssid,
166                              hapd->conf->ssid.ssid_len)) {
167                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
168                 /* try to continue */
169         }
170
171         if (hapd->conf->ieee802_1x || hapd->conf->wpa)
172                 hostapd_set_ieee8021x(hapd->conf->iface, hapd, 1);
173
174         hostapd_config_free(oldconf);
175
176         wpa_printf(MSG_DEBUG, "Reconfigured interface %s", hapd->conf->iface);
177
178         return 0;
179 }
180
181
182 int handle_reload_iface(struct hostapd_iface *iface, void *ctx)
183 {
184         if (hostapd_reload_config(iface) < 0) {
185                 wpa_printf(MSG_WARNING, "Failed to read new configuration "
186                            "file - continuing with old.");
187         }
188         return 0;
189 }
190
191
192 #ifdef HOSTAPD_DUMP_STATE
193 /**
194  * hostapd_dump_state - SIGUSR1 handler to dump hostapd state to a text file
195  */
196 static void hostapd_dump_state(struct hostapd_data *hapd)
197 {
198         FILE *f;
199         time_t now;
200         struct sta_info *sta;
201         int i;
202         char *buf;
203
204         if (!hapd->conf->dump_log_name) {
205                 wpa_printf(MSG_DEBUG, "Dump file not defined - ignoring dump "
206                            "request");
207                 return;
208         }
209
210         wpa_printf(MSG_DEBUG, "Dumping hostapd state to '%s'",
211                    hapd->conf->dump_log_name);
212         f = fopen(hapd->conf->dump_log_name, "w");
213         if (f == NULL) {
214                 wpa_printf(MSG_WARNING, "Could not open dump file '%s' for "
215                            "writing.", hapd->conf->dump_log_name);
216                 return;
217         }
218
219         time(&now);
220         fprintf(f, "hostapd state dump - %s", ctime(&now));
221         fprintf(f, "num_sta=%d num_sta_non_erp=%d "
222                 "num_sta_no_short_slot_time=%d\n"
223                 "num_sta_no_short_preamble=%d\n",
224                 hapd->num_sta, hapd->iface->num_sta_non_erp,
225                 hapd->iface->num_sta_no_short_slot_time,
226                 hapd->iface->num_sta_no_short_preamble);
227
228         for (sta = hapd->sta_list; sta != NULL; sta = sta->next) {
229                 fprintf(f, "\nSTA=" MACSTR "\n", MAC2STR(sta->addr));
230
231                 fprintf(f,
232                         "  AID=%d flags=0x%x %s%s%s%s%s%s%s%s%s%s%s%s%s%s\n"
233                         "  capability=0x%x listen_interval=%d\n",
234                         sta->aid,
235                         sta->flags,
236                         (sta->flags & WLAN_STA_AUTH ? "[AUTH]" : ""),
237                         (sta->flags & WLAN_STA_ASSOC ? "[ASSOC]" : ""),
238                         (sta->flags & WLAN_STA_PS ? "[PS]" : ""),
239                         (sta->flags & WLAN_STA_TIM ? "[TIM]" : ""),
240                         (sta->flags & WLAN_STA_PERM ? "[PERM]" : ""),
241                         (sta->flags & WLAN_STA_AUTHORIZED ? "[AUTHORIZED]" :
242                          ""),
243                         (sta->flags & WLAN_STA_PENDING_POLL ? "[PENDING_POLL" :
244                          ""),
245                         (sta->flags & WLAN_STA_SHORT_PREAMBLE ?
246                          "[SHORT_PREAMBLE]" : ""),
247                         (sta->flags & WLAN_STA_PREAUTH ? "[PREAUTH]" : ""),
248                         (sta->flags & WLAN_STA_WMM ? "[WMM]" : ""),
249                         (sta->flags & WLAN_STA_MFP ? "[MFP]" : ""),
250                         (sta->flags & WLAN_STA_WPS ? "[WPS]" : ""),
251                         (sta->flags & WLAN_STA_MAYBE_WPS ? "[MAYBE_WPS]" : ""),
252                         (sta->flags & WLAN_STA_NONERP ? "[NonERP]" : ""),
253                         sta->capability,
254                         sta->listen_interval);
255
256                 fprintf(f, "  supported_rates=");
257                 for (i = 0; i < sta->supported_rates_len; i++)
258                         fprintf(f, "%02x ", sta->supported_rates[i]);
259                 fprintf(f, "\n");
260
261                 fprintf(f,
262                         "  timeout_next=%s\n",
263                         (sta->timeout_next == STA_NULLFUNC ? "NULLFUNC POLL" :
264                          (sta->timeout_next == STA_DISASSOC ? "DISASSOC" :
265                           "DEAUTH")));
266
267                 ieee802_1x_dump_state(f, "  ", sta);
268         }
269
270         buf = os_malloc(4096);
271         if (buf) {
272                 int count = radius_client_get_mib(hapd->radius, buf, 4096);
273                 if (count < 0)
274                         count = 0;
275                 else if (count > 4095)
276                         count = 4095;
277                 buf[count] = '\0';
278                 fprintf(f, "%s", buf);
279
280                 count = radius_server_get_mib(hapd->radius_srv, buf, 4096);
281                 if (count < 0)
282                         count = 0;
283                 else if (count > 4095)
284                         count = 4095;
285                 buf[count] = '\0';
286                 fprintf(f, "%s", buf);
287                 os_free(buf);
288         }
289         fclose(f);
290 }
291
292
293 int handle_dump_state_iface(struct hostapd_iface *iface, void *ctx)
294 {
295         size_t i;
296
297         for (i = 0; i < iface->num_bss; i++)
298                 hostapd_dump_state(iface->bss[i]);
299
300         return 0;
301 }
302 #endif /* HOSTAPD_DUMP_STATE */
303
304
305 static void hostapd_broadcast_key_clear_iface(struct hostapd_data *hapd,
306                                               char *ifname)
307 {
308         int i;
309
310         for (i = 0; i < NUM_WEP_KEYS; i++) {
311                 if (hostapd_set_key(ifname, hapd, WPA_ALG_NONE, NULL, i,
312                                     i == 0 ? 1 : 0, NULL, 0, NULL, 0)) {
313                         wpa_printf(MSG_DEBUG, "Failed to clear default "
314                                    "encryption keys (ifname=%s keyidx=%d)",
315                                    ifname, i);
316                 }
317         }
318 #ifdef CONFIG_IEEE80211W
319         if (hapd->conf->ieee80211w) {
320                 for (i = NUM_WEP_KEYS; i < NUM_WEP_KEYS + 2; i++) {
321                         if (hostapd_set_key(ifname, hapd, WPA_ALG_NONE, NULL,
322                                             i, i == 0 ? 1 : 0, NULL, 0,
323                                             NULL, 0)) {
324                                 wpa_printf(MSG_DEBUG, "Failed to clear "
325                                            "default mgmt encryption keys "
326                                            "(ifname=%s keyidx=%d)", ifname, i);
327                         }
328                 }
329         }
330 #endif /* CONFIG_IEEE80211W */
331 }
332
333
334 static int hostapd_broadcast_wep_clear(struct hostapd_data *hapd)
335 {
336         hostapd_broadcast_key_clear_iface(hapd, hapd->conf->iface);
337         return 0;
338 }
339
340
341 static int hostapd_broadcast_wep_set(struct hostapd_data *hapd)
342 {
343         int errors = 0, idx;
344         struct hostapd_ssid *ssid = &hapd->conf->ssid;
345
346         idx = ssid->wep.idx;
347         if (ssid->wep.default_len &&
348             hostapd_set_key(hapd->conf->iface,
349                             hapd, WPA_ALG_WEP, NULL, idx, idx == ssid->wep.idx,
350                             NULL, 0, ssid->wep.key[idx], ssid->wep.len[idx])) {
351                 wpa_printf(MSG_WARNING, "Could not set WEP encryption.");
352                 errors++;
353         }
354
355         if (ssid->dyn_vlan_keys) {
356                 size_t i;
357                 for (i = 0; i <= ssid->max_dyn_vlan_keys; i++) {
358                         const char *ifname;
359                         struct hostapd_wep_keys *key = ssid->dyn_vlan_keys[i];
360                         if (key == NULL)
361                                 continue;
362                         ifname = hostapd_get_vlan_id_ifname(hapd->conf->vlan,
363                                                             i);
364                         if (ifname == NULL)
365                                 continue;
366
367                         idx = key->idx;
368                         if (hostapd_set_key(ifname, hapd, WPA_ALG_WEP, NULL,
369                                             idx, idx == key->idx, NULL, 0,
370                                             key->key[idx], key->len[idx])) {
371                                 wpa_printf(MSG_WARNING, "Could not set "
372                                            "dynamic VLAN WEP encryption.");
373                                 errors++;
374                         }
375                 }
376         }
377
378         return errors;
379 }
380
381 /**
382  * hostapd_cleanup - Per-BSS cleanup (deinitialization)
383  * @hapd: Pointer to BSS data
384  *
385  * This function is used to free all per-BSS data structures and resources.
386  * This gets called in a loop for each BSS between calls to
387  * hostapd_cleanup_iface_pre() and hostapd_cleanup_iface() when an interface
388  * is deinitialized. Most of the modules that are initialized in
389  * hostapd_setup_bss() are deinitialized here.
390  */
391 static void hostapd_cleanup(struct hostapd_data *hapd)
392 {
393         hostapd_ctrl_iface_deinit(hapd);
394
395         os_free(hapd->default_wep_key);
396         hapd->default_wep_key = NULL;
397         iapp_deinit(hapd->iapp);
398         hapd->iapp = NULL;
399         accounting_deinit(hapd);
400         rsn_preauth_iface_deinit(hapd);
401         if (hapd->wpa_auth) {
402                 wpa_deinit(hapd->wpa_auth);
403                 hapd->wpa_auth = NULL;
404
405                 if (hostapd_set_privacy(hapd, 0)) {
406                         wpa_printf(MSG_DEBUG, "Could not disable "
407                                    "PrivacyInvoked for interface %s",
408                                    hapd->conf->iface);
409                 }
410
411                 if (hostapd_set_generic_elem(hapd, (u8 *) "", 0)) {
412                         wpa_printf(MSG_DEBUG, "Could not remove generic "
413                                    "information element from interface %s",
414                                    hapd->conf->iface);
415                 }
416         }
417         ieee802_1x_deinit(hapd);
418         vlan_deinit(hapd);
419         hostapd_acl_deinit(hapd);
420         radius_client_deinit(hapd->radius);
421         hapd->radius = NULL;
422         radius_server_deinit(hapd->radius_srv);
423         hapd->radius_srv = NULL;
424
425 #ifdef CONFIG_IEEE80211R
426         l2_packet_deinit(hapd->l2);
427 #endif /* CONFIG_IEEE80211R */
428
429         hostapd_deinit_wps(hapd);
430
431 #ifdef EAP_TLS_FUNCS
432         if (hapd->ssl_ctx) {
433                 tls_deinit(hapd->ssl_ctx);
434                 hapd->ssl_ctx = NULL;
435         }
436 #endif /* EAP_TLS_FUNCS */
437
438 #ifdef EAP_SERVER
439         if (hapd->eap_sim_db_priv) {
440                 eap_sim_db_deinit(hapd->eap_sim_db_priv);
441                 hapd->eap_sim_db_priv = NULL;
442         }
443 #endif /* EAP_SERVER */
444
445         if (hapd->interface_added &&
446             hostapd_bss_remove(hapd, hapd->conf->iface)) {
447                 wpa_printf(MSG_WARNING, "Failed to remove BSS interface %s",
448                            hapd->conf->iface);
449         }
450 }
451
452
453 /**
454  * hostapd_cleanup_iface_pre - Preliminary per-interface cleanup
455  * @iface: Pointer to interface data
456  *
457  * This function is called before per-BSS data structures are deinitialized
458  * with hostapd_cleanup().
459  */
460 static void hostapd_cleanup_iface_pre(struct hostapd_iface *iface)
461 {
462 }
463
464
465 /**
466  * hostapd_cleanup_iface - Complete per-interface cleanup
467  * @iface: Pointer to interface data
468  *
469  * This function is called after per-BSS data structures are deinitialized
470  * with hostapd_cleanup().
471  */
472 static void hostapd_cleanup_iface(struct hostapd_iface *iface)
473 {
474         hostapd_free_hw_features(iface->hw_features, iface->num_hw_features);
475         iface->hw_features = NULL;
476         os_free(iface->current_rates);
477         iface->current_rates = NULL;
478         ap_list_deinit(iface);
479         hostapd_config_free(iface->conf);
480         iface->conf = NULL;
481
482         os_free(iface->config_fname);
483         os_free(iface->bss);
484         os_free(iface);
485 }
486
487
488 static int hostapd_setup_encryption(char *iface, struct hostapd_data *hapd)
489 {
490         int i;
491
492         hostapd_broadcast_wep_set(hapd);
493
494         if (hapd->conf->ssid.wep.default_len)
495                 return 0;
496
497         for (i = 0; i < 4; i++) {
498                 if (hapd->conf->ssid.wep.key[i] &&
499                     hostapd_set_key(iface, hapd, WPA_ALG_WEP, NULL, i,
500                                     i == hapd->conf->ssid.wep.idx, NULL, 0,
501                                     hapd->conf->ssid.wep.key[i],
502                                     hapd->conf->ssid.wep.len[i])) {
503                         wpa_printf(MSG_WARNING, "Could not set WEP "
504                                    "encryption.");
505                         return -1;
506                 }
507                 if (hapd->conf->ssid.wep.key[i] &&
508                     i == hapd->conf->ssid.wep.idx)
509                         hostapd_set_privacy(hapd, 1);
510         }
511
512         return 0;
513 }
514
515
516 static int hostapd_flush_old_stations(struct hostapd_data *hapd)
517 {
518         int ret = 0;
519
520         if (hostapd_drv_none(hapd))
521                 return 0;
522
523         wpa_printf(MSG_DEBUG, "Flushing old station entries");
524         if (hostapd_flush(hapd)) {
525                 wpa_printf(MSG_WARNING, "Could not connect to kernel driver.");
526                 ret = -1;
527         }
528         wpa_printf(MSG_DEBUG, "Deauthenticate all stations");
529
530         /* New Prism2.5/3 STA firmware versions seem to have issues with this
531          * broadcast deauth frame. This gets the firmware in odd state where
532          * nothing works correctly, so let's skip sending this for the hostap
533          * driver. */
534         if (hapd->driver && os_strcmp(hapd->driver->name, "hostap") != 0) {
535                 u8 addr[ETH_ALEN];
536                 os_memset(addr, 0xff, ETH_ALEN);
537                 hostapd_sta_deauth(hapd, addr,
538                                    WLAN_REASON_PREV_AUTH_NOT_VALID);
539         }
540
541         return ret;
542 }
543
544
545 static void hostapd_wpa_auth_logger(void *ctx, const u8 *addr,
546                                     logger_level level, const char *txt)
547 {
548 #ifndef CONFIG_NO_HOSTAPD_LOGGER
549         struct hostapd_data *hapd = ctx;
550         int hlevel;
551
552         switch (level) {
553         case LOGGER_WARNING:
554                 hlevel = HOSTAPD_LEVEL_WARNING;
555                 break;
556         case LOGGER_INFO:
557                 hlevel = HOSTAPD_LEVEL_INFO;
558                 break;
559         case LOGGER_DEBUG:
560         default:
561                 hlevel = HOSTAPD_LEVEL_DEBUG;
562                 break;
563         }
564
565         hostapd_logger(hapd, addr, HOSTAPD_MODULE_WPA, hlevel, "%s", txt);
566 #endif /* CONFIG_NO_HOSTAPD_LOGGER */
567 }
568
569
570 static void hostapd_wpa_auth_disconnect(void *ctx, const u8 *addr,
571                                         u16 reason)
572 {
573         struct hostapd_data *hapd = ctx;
574         struct sta_info *sta;
575
576         wpa_printf(MSG_DEBUG, "%s: WPA authenticator requests disconnect: "
577                    "STA " MACSTR " reason %d",
578                    __func__, MAC2STR(addr), reason);
579
580         sta = ap_get_sta(hapd, addr);
581         hostapd_sta_deauth(hapd, addr, reason);
582         if (sta == NULL)
583                 return;
584         sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC | WLAN_STA_AUTHORIZED);
585         eloop_cancel_timeout(ap_handle_timer, hapd, sta);
586         eloop_register_timeout(0, 0, ap_handle_timer, hapd, sta);
587         sta->timeout_next = STA_REMOVE;
588 }
589
590
591 static void hostapd_wpa_auth_mic_failure_report(void *ctx, const u8 *addr)
592 {
593         struct hostapd_data *hapd = ctx;
594         michael_mic_failure(hapd, addr, 0);
595 }
596
597
598 static void hostapd_wpa_auth_set_eapol(void *ctx, const u8 *addr,
599                                        wpa_eapol_variable var, int value)
600 {
601         struct hostapd_data *hapd = ctx;
602         struct sta_info *sta = ap_get_sta(hapd, addr);
603         if (sta == NULL)
604                 return;
605         switch (var) {
606         case WPA_EAPOL_portEnabled:
607                 ieee802_1x_notify_port_enabled(sta->eapol_sm, value);
608                 break;
609         case WPA_EAPOL_portValid:
610                 ieee802_1x_notify_port_valid(sta->eapol_sm, value);
611                 break;
612         case WPA_EAPOL_authorized:
613                 ieee802_1x_set_sta_authorized(hapd, sta, value);
614                 break;
615         case WPA_EAPOL_portControl_Auto:
616                 if (sta->eapol_sm)
617                         sta->eapol_sm->portControl = Auto;
618                 break;
619         case WPA_EAPOL_keyRun:
620                 if (sta->eapol_sm)
621                         sta->eapol_sm->keyRun = value ? TRUE : FALSE;
622                 break;
623         case WPA_EAPOL_keyAvailable:
624                 if (sta->eapol_sm)
625                         sta->eapol_sm->eap_if->eapKeyAvailable =
626                                 value ? TRUE : FALSE;
627                 break;
628         case WPA_EAPOL_keyDone:
629                 if (sta->eapol_sm)
630                         sta->eapol_sm->keyDone = value ? TRUE : FALSE;
631                 break;
632         case WPA_EAPOL_inc_EapolFramesTx:
633                 if (sta->eapol_sm)
634                         sta->eapol_sm->dot1xAuthEapolFramesTx++;
635                 break;
636         }
637 }
638
639
640 static int hostapd_wpa_auth_get_eapol(void *ctx, const u8 *addr,
641                                       wpa_eapol_variable var)
642 {
643         struct hostapd_data *hapd = ctx;
644         struct sta_info *sta = ap_get_sta(hapd, addr);
645         if (sta == NULL || sta->eapol_sm == NULL)
646                 return -1;
647         switch (var) {
648         case WPA_EAPOL_keyRun:
649                 return sta->eapol_sm->keyRun;
650         case WPA_EAPOL_keyAvailable:
651                 return sta->eapol_sm->eap_if->eapKeyAvailable;
652         default:
653                 return -1;
654         }
655 }
656
657
658 static const u8 * hostapd_wpa_auth_get_psk(void *ctx, const u8 *addr,
659                                            const u8 *prev_psk)
660 {
661         struct hostapd_data *hapd = ctx;
662         return hostapd_get_psk(hapd->conf, addr, prev_psk);
663 }
664
665
666 static int hostapd_wpa_auth_get_msk(void *ctx, const u8 *addr, u8 *msk,
667                                     size_t *len)
668 {
669         struct hostapd_data *hapd = ctx;
670         const u8 *key;
671         size_t keylen;
672         struct sta_info *sta;
673
674         sta = ap_get_sta(hapd, addr);
675         if (sta == NULL)
676                 return -1;
677
678         key = ieee802_1x_get_key(sta->eapol_sm, &keylen);
679         if (key == NULL)
680                 return -1;
681
682         if (keylen > *len)
683                 keylen = *len;
684         os_memcpy(msk, key, keylen);
685         *len = keylen;
686
687         return 0;
688 }
689
690
691 static int hostapd_wpa_auth_set_key(void *ctx, int vlan_id, wpa_alg alg,
692                                     const u8 *addr, int idx, u8 *key,
693                                     size_t key_len)
694 {
695         struct hostapd_data *hapd = ctx;
696         const char *ifname = hapd->conf->iface;
697
698         if (vlan_id > 0) {
699                 ifname = hostapd_get_vlan_id_ifname(hapd->conf->vlan, vlan_id);
700                 if (ifname == NULL)
701                         return -1;
702         }
703
704         return hostapd_set_key(ifname, hapd, alg, addr, idx, 1, NULL, 0,
705                                key, key_len);
706 }
707
708
709 static int hostapd_wpa_auth_get_seqnum(void *ctx, const u8 *addr, int idx,
710                                        u8 *seq)
711 {
712         struct hostapd_data *hapd = ctx;
713         return hostapd_get_seqnum(hapd->conf->iface, hapd, addr, idx, seq);
714 }
715
716
717 static int hostapd_wpa_auth_get_seqnum_igtk(void *ctx, const u8 *addr, int idx,
718                                             u8 *seq)
719 {
720         struct hostapd_data *hapd = ctx;
721         return hostapd_get_seqnum_igtk(hapd->conf->iface, hapd, addr, idx,
722                                        seq);
723 }
724
725
726 static int hostapd_wpa_auth_send_eapol(void *ctx, const u8 *addr,
727                                        const u8 *data, size_t data_len,
728                                        int encrypt)
729 {
730         struct hostapd_data *hapd = ctx;
731         return hostapd_send_eapol(hapd, addr, data, data_len, encrypt);
732 }
733
734
735 static int hostapd_wpa_auth_for_each_sta(
736         void *ctx, int (*cb)(struct wpa_state_machine *sm, void *ctx),
737         void *cb_ctx)
738 {
739         struct hostapd_data *hapd = ctx;
740         struct sta_info *sta;
741
742         for (sta = hapd->sta_list; sta; sta = sta->next) {
743                 if (sta->wpa_sm && cb(sta->wpa_sm, cb_ctx))
744                         return 1;
745         }
746         return 0;
747 }
748
749
750 struct wpa_auth_iface_iter_data {
751         int (*cb)(struct wpa_authenticator *sm, void *ctx);
752         void *cb_ctx;
753 };
754
755 static int wpa_auth_iface_iter(struct hostapd_iface *iface, void *ctx)
756 {
757         struct wpa_auth_iface_iter_data *data = ctx;
758         size_t i;
759         for (i = 0; i < iface->num_bss; i++) {
760                 if (data->cb(iface->bss[i]->wpa_auth, data->cb_ctx))
761                         return 1;
762         }
763         return 0;
764 }
765
766
767 static int hostapd_wpa_auth_for_each_auth(
768         void *ctx, int (*cb)(struct wpa_authenticator *sm, void *ctx),
769         void *cb_ctx)
770 {
771         struct wpa_auth_iface_iter_data data;
772         data.cb = cb;
773         data.cb_ctx = cb_ctx;
774         return hostapd_for_each_interface(wpa_auth_iface_iter, &data);
775 }
776
777
778 static int hostapd_wpa_auth_send_ether(void *ctx, const u8 *dst, u16 proto,
779                                        const u8 *data, size_t data_len)
780 {
781         struct hostapd_data *hapd = ctx;
782
783         if (hapd->driver && hapd->driver->send_ether)
784                 return hapd->driver->send_ether(hapd->drv_priv, dst,
785                                                 hapd->own_addr, proto,
786                                                 data, data_len);
787         if (hapd->l2 == NULL)
788                 return -1;
789         return l2_packet_send(hapd->l2, dst, proto, data, data_len);
790 }
791
792
793 #ifdef CONFIG_IEEE80211R
794
795 static int hostapd_wpa_auth_send_ft_action(void *ctx, const u8 *dst,
796                                            const u8 *data, size_t data_len)
797 {
798         struct hostapd_data *hapd = ctx;
799         int res;
800         struct ieee80211_mgmt *m;
801         size_t mlen;
802         struct sta_info *sta;
803
804         sta = ap_get_sta(hapd, dst);
805         if (sta == NULL || sta->wpa_sm == NULL)
806                 return -1;
807
808         m = os_zalloc(sizeof(*m) + data_len);
809         if (m == NULL)
810                 return -1;
811         mlen = ((u8 *) &m->u - (u8 *) m) + data_len;
812         m->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
813                                         WLAN_FC_STYPE_ACTION);
814         os_memcpy(m->da, dst, ETH_ALEN);
815         os_memcpy(m->sa, hapd->own_addr, ETH_ALEN);
816         os_memcpy(m->bssid, hapd->own_addr, ETH_ALEN);
817         os_memcpy(&m->u, data, data_len);
818
819         res = hostapd_send_mgmt_frame(hapd, (u8 *) m, mlen, 0);
820         os_free(m);
821         return res;
822 }
823
824
825 static struct wpa_state_machine *
826 hostapd_wpa_auth_add_sta(void *ctx, const u8 *sta_addr)
827 {
828         struct hostapd_data *hapd = ctx;
829         struct sta_info *sta;
830
831         sta = ap_sta_add(hapd, sta_addr);
832         if (sta == NULL)
833                 return NULL;
834         if (sta->wpa_sm)
835                 return sta->wpa_sm;
836
837         sta->wpa_sm = wpa_auth_sta_init(hapd->wpa_auth, sta->addr);
838         if (sta->wpa_sm == NULL) {
839                 ap_free_sta(hapd, sta);
840                 return NULL;
841         }
842         sta->auth_alg = WLAN_AUTH_FT;
843
844         return sta->wpa_sm;
845 }
846
847
848 static void hostapd_rrb_receive(void *ctx, const u8 *src_addr, const u8 *buf,
849                                 size_t len)
850 {
851         struct hostapd_data *hapd = ctx;
852         wpa_ft_rrb_rx(hapd->wpa_auth, src_addr, buf, len);
853 }
854
855 #endif /* CONFIG_IEEE80211R */
856
857
858 /**
859  * hostapd_validate_bssid_configuration - Validate BSSID configuration
860  * @iface: Pointer to interface data
861  * Returns: 0 on success, -1 on failure
862  *
863  * This function is used to validate that the configured BSSIDs are valid.
864  */
865 static int hostapd_validate_bssid_configuration(struct hostapd_iface *iface)
866 {
867         u8 mask[ETH_ALEN] = { 0 };
868         struct hostapd_data *hapd = iface->bss[0];
869         unsigned int i = iface->conf->num_bss, bits = 0, j;
870         int res;
871         int auto_addr = 0;
872
873         if (hostapd_drv_none(hapd))
874                 return 0;
875
876         /* Generate BSSID mask that is large enough to cover the BSSIDs. */
877
878         /* Determine the bits necessary to cover the number of BSSIDs. */
879         for (i--; i; i >>= 1)
880                 bits++;
881
882         /* Determine the bits necessary to any configured BSSIDs,
883            if they are higher than the number of BSSIDs. */
884         for (j = 0; j < iface->conf->num_bss; j++) {
885                 if (hostapd_mac_comp_empty(iface->conf->bss[j].bssid) == 0) {
886                         if (j)
887                                 auto_addr++;
888                         continue;
889                 }
890
891                 for (i = 0; i < ETH_ALEN; i++) {
892                         mask[i] |=
893                                 iface->conf->bss[j].bssid[i] ^
894                                 hapd->own_addr[i];
895                 }
896         }
897
898         if (!auto_addr)
899                 goto skip_mask_ext;
900
901         for (i = 0; i < ETH_ALEN && mask[i] == 0; i++)
902                 ;
903         j = 0;
904         if (i < ETH_ALEN) {
905                 j = (5 - i) * 8;
906
907                 while (mask[i] != 0) {
908                         mask[i] >>= 1;
909                         j++;
910                 }
911         }
912
913         if (bits < j)
914                 bits = j;
915
916         if (bits > 40) {
917                 wpa_printf(MSG_ERROR, "Too many bits in the BSSID mask (%u)",
918                            bits);
919                 return -1;
920         }
921
922         os_memset(mask, 0xff, ETH_ALEN);
923         j = bits / 8;
924         for (i = 5; i > 5 - j; i--)
925                 mask[i] = 0;
926         j = bits % 8;
927         while (j--)
928                 mask[i] <<= 1;
929
930 skip_mask_ext:
931         wpa_printf(MSG_DEBUG, "BSS count %lu, BSSID mask " MACSTR " (%d bits)",
932                    (unsigned long) iface->conf->num_bss, MAC2STR(mask), bits);
933
934         res = hostapd_valid_bss_mask(hapd, hapd->own_addr, mask);
935         if (res == 0)
936                 return 0;
937
938         if (res < 0) {
939                 wpa_printf(MSG_ERROR, "Driver did not accept BSSID mask "
940                            MACSTR " for start address " MACSTR ".",
941                            MAC2STR(mask), MAC2STR(hapd->own_addr));
942                 return -1;
943         }
944
945         if (!auto_addr)
946                 return 0;
947
948         for (i = 0; i < ETH_ALEN; i++) {
949                 if ((hapd->own_addr[i] & mask[i]) != hapd->own_addr[i]) {
950                         wpa_printf(MSG_ERROR, "Invalid BSSID mask " MACSTR
951                                    " for start address " MACSTR ".",
952                                    MAC2STR(mask), MAC2STR(hapd->own_addr));
953                         wpa_printf(MSG_ERROR, "Start address must be the "
954                                    "first address in the block (i.e., addr "
955                                    "AND mask == addr).");
956                         return -1;
957                 }
958         }
959
960         return 0;
961 }
962
963
964 static int mac_in_conf(struct hostapd_config *conf, const void *a)
965 {
966         size_t i;
967
968         for (i = 0; i < conf->num_bss; i++) {
969                 if (hostapd_mac_comp(conf->bss[i].bssid, a) == 0) {
970                         return 1;
971                 }
972         }
973
974         return 0;
975 }
976
977
978 static int hostapd_setup_wpa(struct hostapd_data *hapd)
979 {
980         struct wpa_auth_config _conf;
981         struct wpa_auth_callbacks cb;
982         const u8 *wpa_ie;
983         size_t wpa_ie_len;
984
985         hostapd_wpa_auth_conf(hapd->conf, &_conf);
986         os_memset(&cb, 0, sizeof(cb));
987         cb.ctx = hapd;
988         cb.logger = hostapd_wpa_auth_logger;
989         cb.disconnect = hostapd_wpa_auth_disconnect;
990         cb.mic_failure_report = hostapd_wpa_auth_mic_failure_report;
991         cb.set_eapol = hostapd_wpa_auth_set_eapol;
992         cb.get_eapol = hostapd_wpa_auth_get_eapol;
993         cb.get_psk = hostapd_wpa_auth_get_psk;
994         cb.get_msk = hostapd_wpa_auth_get_msk;
995         cb.set_key = hostapd_wpa_auth_set_key;
996         cb.get_seqnum = hostapd_wpa_auth_get_seqnum;
997         cb.get_seqnum_igtk = hostapd_wpa_auth_get_seqnum_igtk;
998         cb.send_eapol = hostapd_wpa_auth_send_eapol;
999         cb.for_each_sta = hostapd_wpa_auth_for_each_sta;
1000         cb.for_each_auth = hostapd_wpa_auth_for_each_auth;
1001         cb.send_ether = hostapd_wpa_auth_send_ether;
1002 #ifdef CONFIG_IEEE80211R
1003         cb.send_ft_action = hostapd_wpa_auth_send_ft_action;
1004         cb.add_sta = hostapd_wpa_auth_add_sta;
1005 #endif /* CONFIG_IEEE80211R */
1006         hapd->wpa_auth = wpa_init(hapd->own_addr, &_conf, &cb);
1007         if (hapd->wpa_auth == NULL) {
1008                 wpa_printf(MSG_ERROR, "WPA initialization failed.");
1009                 return -1;
1010         }
1011
1012         if (hostapd_set_privacy(hapd, 1)) {
1013                 wpa_printf(MSG_ERROR, "Could not set PrivacyInvoked "
1014                            "for interface %s", hapd->conf->iface);
1015                 return -1;
1016         }
1017
1018         wpa_ie = wpa_auth_get_wpa_ie(hapd->wpa_auth, &wpa_ie_len);
1019         if (hostapd_set_generic_elem(hapd, wpa_ie, wpa_ie_len)) {
1020                 wpa_printf(MSG_ERROR, "Failed to configure WPA IE for "
1021                            "the kernel driver.");
1022                 return -1;
1023         }
1024
1025         if (rsn_preauth_iface_init(hapd)) {
1026                 wpa_printf(MSG_ERROR, "Initialization of RSN "
1027                            "pre-authentication failed.");
1028                 return -1;
1029         }
1030
1031         return 0;
1032
1033 }
1034
1035
1036 static int hostapd_setup_radius_srv(struct hostapd_data *hapd,
1037                                     struct hostapd_bss_config *conf)
1038 {
1039         struct radius_server_conf srv;
1040         os_memset(&srv, 0, sizeof(srv));
1041         srv.client_file = conf->radius_server_clients;
1042         srv.auth_port = conf->radius_server_auth_port;
1043         srv.conf_ctx = conf;
1044         srv.eap_sim_db_priv = hapd->eap_sim_db_priv;
1045         srv.ssl_ctx = hapd->ssl_ctx;
1046         srv.pac_opaque_encr_key = conf->pac_opaque_encr_key;
1047         srv.eap_fast_a_id = conf->eap_fast_a_id;
1048         srv.eap_fast_a_id_len = conf->eap_fast_a_id_len;
1049         srv.eap_fast_a_id_info = conf->eap_fast_a_id_info;
1050         srv.eap_fast_prov = conf->eap_fast_prov;
1051         srv.pac_key_lifetime = conf->pac_key_lifetime;
1052         srv.pac_key_refresh_time = conf->pac_key_refresh_time;
1053         srv.eap_sim_aka_result_ind = conf->eap_sim_aka_result_ind;
1054         srv.tnc = conf->tnc;
1055         srv.wps = hapd->wps;
1056         srv.ipv6 = conf->radius_server_ipv6;
1057         srv.get_eap_user = hostapd_radius_get_eap_user;
1058         srv.eap_req_id_text = conf->eap_req_id_text;
1059         srv.eap_req_id_text_len = conf->eap_req_id_text_len;
1060
1061         hapd->radius_srv = radius_server_init(&srv);
1062         if (hapd->radius_srv == NULL) {
1063                 wpa_printf(MSG_ERROR, "RADIUS server initialization failed.");
1064                 return -1;
1065         }
1066
1067         return 0;
1068 }
1069
1070
1071 /**
1072  * hostapd_setup_bss - Per-BSS setup (initialization)
1073  * @hapd: Pointer to BSS data
1074  * @first: Whether this BSS is the first BSS of an interface
1075  *
1076  * This function is used to initialize all per-BSS data structures and
1077  * resources. This gets called in a loop for each BSS when an interface is
1078  * initialized. Most of the modules that are initialized here will be
1079  * deinitialized in hostapd_cleanup().
1080  */
1081 static int hostapd_setup_bss(struct hostapd_data *hapd, int first)
1082 {
1083         struct hostapd_bss_config *conf = hapd->conf;
1084         u8 ssid[HOSTAPD_MAX_SSID_LEN + 1];
1085         int ssid_len, set_ssid;
1086
1087         if (!first) {
1088                 if (hostapd_mac_comp_empty(hapd->conf->bssid) == 0) {
1089                         /* Allocate the next available BSSID. */
1090                         do {
1091                                 inc_byte_array(hapd->own_addr, ETH_ALEN);
1092                         } while (mac_in_conf(hapd->iconf, hapd->own_addr));
1093                 } else {
1094                         /* Allocate the configured BSSID. */
1095                         os_memcpy(hapd->own_addr, hapd->conf->bssid, ETH_ALEN);
1096
1097                         if (hostapd_mac_comp(hapd->own_addr,
1098                                              hapd->iface->bss[0]->own_addr) ==
1099                             0) {
1100                                 wpa_printf(MSG_ERROR, "BSS '%s' may not have "
1101                                            "BSSID set to the MAC address of "
1102                                            "the radio", hapd->conf->iface);
1103                                 return -1;
1104                         }
1105                 }
1106
1107                 hapd->interface_added = 1;
1108                 if (hostapd_bss_add(hapd->iface->bss[0], hapd->conf->iface,
1109                                     hapd->own_addr)) {
1110                         wpa_printf(MSG_ERROR, "Failed to add BSS (BSSID="
1111                                    MACSTR ")", MAC2STR(hapd->own_addr));
1112                         return -1;
1113                 }
1114         }
1115
1116         hostapd_flush_old_stations(hapd);
1117         hostapd_set_privacy(hapd, 0);
1118
1119         hostapd_broadcast_wep_clear(hapd);
1120         if (hostapd_setup_encryption(hapd->conf->iface, hapd))
1121                 return -1;
1122
1123         /*
1124          * Fetch the SSID from the system and use it or,
1125          * if one was specified in the config file, verify they
1126          * match.
1127          */
1128         ssid_len = hostapd_get_ssid(hapd, ssid, sizeof(ssid));
1129         if (ssid_len < 0) {
1130                 wpa_printf(MSG_ERROR, "Could not read SSID from system");
1131                 return -1;
1132         }
1133         if (conf->ssid.ssid_set) {
1134                 /*
1135                  * If SSID is specified in the config file and it differs
1136                  * from what is being used then force installation of the
1137                  * new SSID.
1138                  */
1139                 set_ssid = (conf->ssid.ssid_len != (size_t) ssid_len ||
1140                             os_memcmp(conf->ssid.ssid, ssid, ssid_len) != 0);
1141         } else {
1142                 /*
1143                  * No SSID in the config file; just use the one we got
1144                  * from the system.
1145                  */
1146                 set_ssid = 0;
1147                 conf->ssid.ssid_len = ssid_len;
1148                 os_memcpy(conf->ssid.ssid, ssid, conf->ssid.ssid_len);
1149                 conf->ssid.ssid[conf->ssid.ssid_len] = '\0';
1150         }
1151
1152         if (!hostapd_drv_none(hapd)) {
1153                 wpa_printf(MSG_ERROR, "Using interface %s with hwaddr " MACSTR
1154                            " and ssid '%s'",
1155                            hapd->conf->iface, MAC2STR(hapd->own_addr),
1156                            hapd->conf->ssid.ssid);
1157         }
1158
1159         if (hostapd_setup_wpa_psk(conf)) {
1160                 wpa_printf(MSG_ERROR, "WPA-PSK setup failed.");
1161                 return -1;
1162         }
1163
1164         /* Set flag for whether SSID is broadcast in beacons */
1165         if (hostapd_set_broadcast_ssid(hapd,
1166                                        !!hapd->conf->ignore_broadcast_ssid)) {
1167                 wpa_printf(MSG_ERROR, "Could not set broadcast SSID flag for "
1168                            "kernel driver");
1169                 return -1;
1170         }
1171
1172         /* Set SSID for the kernel driver (to be used in beacon and probe
1173          * response frames) */
1174         if (set_ssid && hostapd_set_ssid(hapd, (u8 *) conf->ssid.ssid,
1175                                          conf->ssid.ssid_len)) {
1176                 wpa_printf(MSG_ERROR, "Could not set SSID for kernel driver");
1177                 return -1;
1178         }
1179
1180         if (wpa_debug_level == MSG_MSGDUMP)
1181                 conf->radius->msg_dumps = 1;
1182         hapd->radius = radius_client_init(hapd, conf->radius);
1183         if (hapd->radius == NULL) {
1184                 wpa_printf(MSG_ERROR, "RADIUS client initialization failed.");
1185                 return -1;
1186         }
1187
1188         if (hostapd_acl_init(hapd)) {
1189                 wpa_printf(MSG_ERROR, "ACL initialization failed.");
1190                 return -1;
1191         }
1192         if (hostapd_init_wps(hapd, conf))
1193                 return -1;
1194
1195         if (ieee802_1x_init(hapd)) {
1196                 wpa_printf(MSG_ERROR, "IEEE 802.1X initialization failed.");
1197                 return -1;
1198         }
1199
1200         if (hapd->conf->wpa && hostapd_setup_wpa(hapd))
1201                 return -1;
1202
1203         if (accounting_init(hapd)) {
1204                 wpa_printf(MSG_ERROR, "Accounting initialization failed.");
1205                 return -1;
1206         }
1207
1208         if (hapd->conf->ieee802_11f &&
1209             (hapd->iapp = iapp_init(hapd, hapd->conf->iapp_iface)) == NULL) {
1210                 wpa_printf(MSG_ERROR, "IEEE 802.11F (IAPP) initialization "
1211                            "failed.");
1212                 return -1;
1213         }
1214
1215         if (hostapd_ctrl_iface_init(hapd)) {
1216                 wpa_printf(MSG_ERROR, "Failed to setup control interface");
1217                 return -1;
1218         }
1219
1220         if (!hostapd_drv_none(hapd) && vlan_init(hapd)) {
1221                 wpa_printf(MSG_ERROR, "VLAN initialization failed.");
1222                 return -1;
1223         }
1224
1225 #ifdef CONFIG_IEEE80211R
1226         if (!hostapd_drv_none(hapd)) {
1227                 hapd->l2 = l2_packet_init(hapd->conf->iface, NULL, ETH_P_RRB,
1228                                           hostapd_rrb_receive, hapd, 0);
1229                 if (hapd->l2 == NULL &&
1230                     (hapd->driver == NULL ||
1231                      hapd->driver->send_ether == NULL)) {
1232                         wpa_printf(MSG_ERROR, "Failed to open l2_packet "
1233                                    "interface");
1234                         return -1;
1235                 }
1236         }
1237 #endif /* CONFIG_IEEE80211R */
1238
1239         ieee802_11_set_beacon(hapd);
1240
1241         if (conf->radius_server_clients &&
1242             hostapd_setup_radius_srv(hapd, conf))
1243                 return -1;
1244
1245         return 0;
1246 }
1247
1248
1249 static void hostapd_tx_queue_params(struct hostapd_iface *iface)
1250 {
1251         struct hostapd_data *hapd = iface->bss[0];
1252         int i;
1253         struct hostapd_tx_queue_params *p;
1254
1255         for (i = 0; i < NUM_TX_QUEUES; i++) {
1256                 p = &iface->conf->tx_queue[i];
1257
1258                 if (!p->configured)
1259                         continue;
1260
1261                 if (hostapd_set_tx_queue_params(hapd, i, p->aifs, p->cwmin,
1262                                                 p->cwmax, p->burst)) {
1263                         wpa_printf(MSG_DEBUG, "Failed to set TX queue "
1264                                    "parameters for queue %d.", i);
1265                         /* Continue anyway */
1266                 }
1267         }
1268 }
1269
1270
1271 static int hostapd_radius_get_eap_user(void *ctx, const u8 *identity,
1272                                        size_t identity_len, int phase2,
1273                                        struct eap_user *user)
1274 {
1275         const struct hostapd_eap_user *eap_user;
1276         int i, count;
1277
1278         eap_user = hostapd_get_eap_user(ctx, identity, identity_len, phase2);
1279         if (eap_user == NULL)
1280                 return -1;
1281
1282         if (user == NULL)
1283                 return 0;
1284
1285         os_memset(user, 0, sizeof(*user));
1286         count = EAP_USER_MAX_METHODS;
1287         if (count > EAP_MAX_METHODS)
1288                 count = EAP_MAX_METHODS;
1289         for (i = 0; i < count; i++) {
1290                 user->methods[i].vendor = eap_user->methods[i].vendor;
1291                 user->methods[i].method = eap_user->methods[i].method;
1292         }
1293
1294         if (eap_user->password) {
1295                 user->password = os_malloc(eap_user->password_len);
1296                 if (user->password == NULL)
1297                         return -1;
1298                 os_memcpy(user->password, eap_user->password,
1299                           eap_user->password_len);
1300                 user->password_len = eap_user->password_len;
1301                 user->password_hash = eap_user->password_hash;
1302         }
1303         user->force_version = eap_user->force_version;
1304         user->ttls_auth = eap_user->ttls_auth;
1305
1306         return 0;
1307 }
1308
1309
1310 static int setup_interface(struct hostapd_iface *iface)
1311 {
1312         struct hostapd_data *hapd = iface->bss[0];
1313         struct hostapd_bss_config *conf = hapd->conf;
1314         size_t i;
1315         char country[4];
1316         u8 *b = conf->bssid;
1317         int freq;
1318         size_t j;
1319         u8 *prev_addr;
1320
1321         /*
1322          * Initialize the driver interface and make sure that all BSSes get
1323          * configured with a pointer to this driver interface.
1324          */
1325         if (b[0] | b[1] | b[2] | b[3] | b[4] | b[5]) {
1326                 hapd->drv_priv = hostapd_driver_init_bssid(hapd, b);
1327         } else {
1328                 hapd->drv_priv = hostapd_driver_init(hapd);
1329         }
1330
1331         if (hapd->drv_priv == NULL) {
1332                 wpa_printf(MSG_ERROR, "%s driver initialization failed.",
1333                            hapd->driver ? hapd->driver->name : "Unknown");
1334                 hapd->driver = NULL;
1335                 return -1;
1336         }
1337         for (i = 0; i < iface->num_bss; i++) {
1338                 iface->bss[i]->driver = hapd->driver;
1339                 iface->bss[i]->drv_priv = hapd->drv_priv;
1340         }
1341
1342         if (hostapd_validate_bssid_configuration(iface))
1343                 return -1;
1344
1345 #ifdef CONFIG_IEEE80211N
1346         SET_2BIT_LE16(&iface->ht_op_mode,
1347                       HT_INFO_OPERATION_MODE_OP_MODE_OFFSET,
1348                       OP_MODE_PURE);
1349 #endif /* CONFIG_IEEE80211N */
1350
1351         if (hapd->iconf->country[0] && hapd->iconf->country[1]) {
1352                 os_memcpy(country, hapd->iconf->country, 3);
1353                 country[3] = '\0';
1354                 if (hostapd_set_country(hapd, country) < 0) {
1355                         wpa_printf(MSG_ERROR, "Failed to set country code");
1356                         return -1;
1357                 }
1358         }
1359
1360         if (hapd->iconf->ieee80211d &&
1361             hostapd_set_ieee80211d(hapd, 1) < 0) {
1362                 wpa_printf(MSG_ERROR, "Failed to set ieee80211d (%d)",
1363                            hapd->iconf->ieee80211d);
1364                 return -1;
1365         }
1366
1367         if (hapd->iconf->bridge_packets != INTERNAL_BRIDGE_DO_NOT_CONTROL &&
1368             hostapd_set_internal_bridge(hapd, hapd->iconf->bridge_packets)) {
1369                 wpa_printf(MSG_ERROR, "Failed to set bridge_packets for "
1370                            "kernel driver");
1371                 return -1;
1372         }
1373
1374         if (hostapd_get_hw_features(iface)) {
1375                 /* Not all drivers support this yet, so continue without hw
1376                  * feature data. */
1377         } else {
1378                 int ret = hostapd_select_hw_mode(iface);
1379                 if (ret < 0) {
1380                         wpa_printf(MSG_ERROR, "Could not select hw_mode and "
1381                                    "channel. (%d)", ret);
1382                         return -1;
1383                 }
1384         }
1385
1386         if (hapd->iconf->channel) {
1387                 freq = hostapd_hw_get_freq(hapd, hapd->iconf->channel);
1388                 wpa_printf(MSG_DEBUG, "Mode: %s  Channel: %d  "
1389                            "Frequency: %d MHz",
1390                            hostapd_hw_mode_txt(hapd->iconf->hw_mode),
1391                            hapd->iconf->channel, freq);
1392
1393                 if (hostapd_set_freq(hapd, hapd->iconf->hw_mode, freq,
1394                                      hapd->iconf->channel,
1395                                      hapd->iconf->ieee80211n,
1396                                      hapd->iconf->secondary_channel)) {
1397                         wpa_printf(MSG_ERROR, "Could not set channel for "
1398                                    "kernel driver");
1399                         return -1;
1400                 }
1401         }
1402
1403         hostapd_set_beacon_int(hapd, hapd->iconf->beacon_int);
1404
1405         if (hapd->iconf->rts_threshold > -1 &&
1406             hostapd_set_rts(hapd, hapd->iconf->rts_threshold)) {
1407                 wpa_printf(MSG_ERROR, "Could not set RTS threshold for "
1408                            "kernel driver");
1409                 return -1;
1410         }
1411
1412         if (hapd->iconf->fragm_threshold > -1 &&
1413             hostapd_set_frag(hapd, hapd->iconf->fragm_threshold)) {
1414                 wpa_printf(MSG_ERROR, "Could not set fragmentation threshold "
1415                            "for kernel driver");
1416                 return -1;
1417         }
1418
1419         prev_addr = hapd->own_addr;
1420
1421         for (j = 0; j < iface->num_bss; j++) {
1422                 hapd = iface->bss[j];
1423                 if (j)
1424                         os_memcpy(hapd->own_addr, prev_addr, ETH_ALEN);
1425                 if (hostapd_setup_bss(hapd, j == 0))
1426                         return -1;
1427                 if (hostapd_mac_comp_empty(hapd->conf->bssid) == 0)
1428                         prev_addr = hapd->own_addr;
1429         }
1430
1431         hostapd_tx_queue_params(iface);
1432
1433         ap_list_init(iface);
1434
1435         if (hostapd_driver_commit(hapd) < 0) {
1436                 wpa_printf(MSG_ERROR, "%s: Failed to commit driver "
1437                            "configuration", __func__);
1438                 return -1;
1439         }
1440
1441         return 0;
1442 }
1443
1444
1445 /**
1446  * hostapd_setup_interface - Setup of an interface
1447  * @iface: Pointer to interface data.
1448  * Returns: 0 on success, -1 on failure
1449  *
1450  * Initializes the driver interface, validates the configuration,
1451  * and sets driver parameters based on the configuration.
1452  * Flushes old stations, sets the channel, encryption,
1453  * beacons, and WDS links based on the configuration.
1454  */
1455 int hostapd_setup_interface(struct hostapd_iface *iface)
1456 {
1457         int ret;
1458
1459         ret = setup_interface(iface);
1460         if (ret) {
1461                 wpa_printf(MSG_DEBUG, "%s: Unable to setup interface.",
1462                            iface->bss[0]->conf->iface);
1463                 eloop_terminate();
1464                 return -1;
1465         } else if (!hostapd_drv_none(iface->bss[0])) {
1466                 wpa_printf(MSG_DEBUG, "%s: Setup of interface done.",
1467                            iface->bss[0]->conf->iface);
1468         }
1469
1470         return 0;
1471 }
1472
1473
1474 /**
1475  * hostapd_alloc_bss_data - Allocate and initialize per-BSS data
1476  * @hapd_iface: Pointer to interface data
1477  * @conf: Pointer to per-interface configuration
1478  * @bss: Pointer to per-BSS configuration for this BSS
1479  * Returns: Pointer to allocated BSS data
1480  *
1481  * This function is used to allocate per-BSS data structure. This data will be
1482  * freed after hostapd_cleanup() is called for it during interface
1483  * deinitialization.
1484  */
1485 struct hostapd_data *
1486 hostapd_alloc_bss_data(struct hostapd_iface *hapd_iface,
1487                        struct hostapd_config *conf,
1488                        struct hostapd_bss_config *bss)
1489 {
1490         struct hostapd_data *hapd;
1491
1492         hapd = os_zalloc(sizeof(*hapd));
1493         if (hapd == NULL)
1494                 return NULL;
1495
1496         hapd->iconf = conf;
1497         hapd->conf = bss;
1498         hapd->iface = hapd_iface;
1499
1500         if (hapd->conf->individual_wep_key_len > 0) {
1501                 /* use key0 in individual key and key1 in broadcast key */
1502                 hapd->default_wep_key_idx = 1;
1503         }
1504
1505 #ifdef EAP_TLS_FUNCS
1506         if (hapd->conf->eap_server &&
1507             (hapd->conf->ca_cert || hapd->conf->server_cert ||
1508              hapd->conf->dh_file)) {
1509                 struct tls_connection_params params;
1510
1511                 hapd->ssl_ctx = tls_init(NULL);
1512                 if (hapd->ssl_ctx == NULL) {
1513                         wpa_printf(MSG_ERROR, "Failed to initialize TLS");
1514                         goto fail;
1515                 }
1516
1517                 os_memset(&params, 0, sizeof(params));
1518                 params.ca_cert = hapd->conf->ca_cert;
1519                 params.client_cert = hapd->conf->server_cert;
1520                 params.private_key = hapd->conf->private_key;
1521                 params.private_key_passwd = hapd->conf->private_key_passwd;
1522                 params.dh_file = hapd->conf->dh_file;
1523
1524                 if (tls_global_set_params(hapd->ssl_ctx, &params)) {
1525                         wpa_printf(MSG_ERROR, "Failed to set TLS parameters");
1526                         goto fail;
1527                 }
1528
1529                 if (tls_global_set_verify(hapd->ssl_ctx,
1530                                           hapd->conf->check_crl)) {
1531                         wpa_printf(MSG_ERROR, "Failed to enable check_crl");
1532                         goto fail;
1533                 }
1534         }
1535 #endif /* EAP_TLS_FUNCS */
1536
1537 #ifdef EAP_SERVER
1538         if (hapd->conf->eap_sim_db) {
1539                 hapd->eap_sim_db_priv =
1540                         eap_sim_db_init(hapd->conf->eap_sim_db,
1541                                         hostapd_sim_db_cb, hapd);
1542                 if (hapd->eap_sim_db_priv == NULL) {
1543                         wpa_printf(MSG_ERROR, "Failed to initialize EAP-SIM "
1544                                    "database interface");
1545                         goto fail;
1546                 }
1547         }
1548 #endif /* EAP_SERVER */
1549
1550         hapd->driver = hapd->iconf->driver;
1551
1552         return hapd;
1553
1554 #if defined(EAP_TLS_FUNCS) || defined(EAP_SERVER)
1555 fail:
1556 #endif
1557         /* TODO: cleanup allocated resources(?) */
1558         os_free(hapd);
1559         return NULL;
1560 }
1561
1562
1563 void hostapd_interface_deinit(struct hostapd_iface *iface)
1564 {
1565         size_t j;
1566
1567         if (iface == NULL)
1568                 return;
1569
1570         hostapd_cleanup_iface_pre(iface);
1571         for (j = 0; j < iface->num_bss; j++) {
1572                 struct hostapd_data *hapd = iface->bss[j];
1573                 hostapd_free_stas(hapd);
1574                 hostapd_flush_old_stations(hapd);
1575                 hostapd_cleanup(hapd);
1576                 if (j == iface->num_bss - 1 && hapd->driver)
1577                         hostapd_driver_deinit(hapd);
1578         }
1579         for (j = 0; j < iface->num_bss; j++)
1580                 os_free(iface->bss[j]);
1581         hostapd_cleanup_iface(iface);
1582 }