Add data test functionality
[mech_eap.git] / wpa_supplicant / ap.c
1 /*
2  * WPA Supplicant - Basic AP mode support routines
3  * Copyright (c) 2003-2009, Jouni Malinen <j@w1.fi>
4  * Copyright (c) 2009, Atheros Communications
5  *
6  * This software may be distributed under the terms of the BSD license.
7  * See README for more details.
8  */
9
10 #include "utils/includes.h"
11
12 #include "utils/common.h"
13 #include "utils/eloop.h"
14 #include "utils/uuid.h"
15 #include "common/ieee802_11_defs.h"
16 #include "common/wpa_ctrl.h"
17 #include "eapol_supp/eapol_supp_sm.h"
18 #include "crypto/dh_group5.h"
19 #include "ap/hostapd.h"
20 #include "ap/ap_config.h"
21 #include "ap/ap_drv_ops.h"
22 #ifdef NEED_AP_MLME
23 #include "ap/ieee802_11.h"
24 #endif /* NEED_AP_MLME */
25 #include "ap/beacon.h"
26 #include "ap/ieee802_1x.h"
27 #include "ap/wps_hostapd.h"
28 #include "ap/ctrl_iface_ap.h"
29 #include "wps/wps.h"
30 #include "common/ieee802_11_defs.h"
31 #include "config_ssid.h"
32 #include "config.h"
33 #include "wpa_supplicant_i.h"
34 #include "driver_i.h"
35 #include "p2p_supplicant.h"
36 #include "ap.h"
37 #include "ap/sta_info.h"
38 #include "notify.h"
39
40
41 #ifdef CONFIG_WPS
42 static void wpas_wps_ap_pin_timeout(void *eloop_data, void *user_ctx);
43 #endif /* CONFIG_WPS */
44
45
46 #ifdef CONFIG_IEEE80211N
47 static void wpas_conf_ap_vht(struct wpa_supplicant *wpa_s,
48                              struct hostapd_config *conf,
49                              struct hostapd_hw_modes *mode)
50 {
51 #ifdef CONFIG_P2P
52         u8 center_chan = 0;
53         u8 channel = conf->channel;
54
55         if (!conf->secondary_channel)
56                 goto no_vht;
57
58         center_chan = wpas_p2p_get_vht80_center(wpa_s, mode, channel);
59         if (!center_chan)
60                 goto no_vht;
61
62         /* Use 80 MHz channel */
63         conf->vht_oper_chwidth = 1;
64         conf->vht_oper_centr_freq_seg0_idx = center_chan;
65         return;
66
67 no_vht:
68         conf->vht_oper_centr_freq_seg0_idx =
69                 channel + conf->secondary_channel * 2;
70 #else /* CONFIG_P2P */
71         conf->vht_oper_centr_freq_seg0_idx =
72                 conf->channel + conf->secondary_channel * 2;
73 #endif /* CONFIG_P2P */
74 }
75 #endif /* CONFIG_IEEE80211N */
76
77
78 static int wpa_supplicant_conf_ap(struct wpa_supplicant *wpa_s,
79                                   struct wpa_ssid *ssid,
80                                   struct hostapd_config *conf)
81 {
82         struct hostapd_bss_config *bss = conf->bss[0];
83
84         conf->driver = wpa_s->driver;
85
86         os_strlcpy(bss->iface, wpa_s->ifname, sizeof(bss->iface));
87
88         conf->hw_mode = ieee80211_freq_to_chan(ssid->frequency,
89                                                &conf->channel);
90         if (conf->hw_mode == NUM_HOSTAPD_MODES) {
91                 wpa_printf(MSG_ERROR, "Unsupported AP mode frequency: %d MHz",
92                            ssid->frequency);
93                 return -1;
94         }
95
96         /* TODO: enable HT40 if driver supports it;
97          * drop to 11b if driver does not support 11g */
98
99 #ifdef CONFIG_IEEE80211N
100         /*
101          * Enable HT20 if the driver supports it, by setting conf->ieee80211n
102          * and a mask of allowed capabilities within conf->ht_capab.
103          * Using default config settings for: conf->ht_op_mode_fixed,
104          * conf->secondary_channel, conf->require_ht
105          */
106         if (wpa_s->hw.modes) {
107                 struct hostapd_hw_modes *mode = NULL;
108                 int i, no_ht = 0;
109                 for (i = 0; i < wpa_s->hw.num_modes; i++) {
110                         if (wpa_s->hw.modes[i].mode == conf->hw_mode) {
111                                 mode = &wpa_s->hw.modes[i];
112                                 break;
113                         }
114                 }
115
116 #ifdef CONFIG_HT_OVERRIDES
117                 if (ssid->disable_ht) {
118                         conf->ieee80211n = 0;
119                         conf->ht_capab = 0;
120                         no_ht = 1;
121                 }
122 #endif /* CONFIG_HT_OVERRIDES */
123
124                 if (!no_ht && mode && mode->ht_capab) {
125                         conf->ieee80211n = 1;
126 #ifdef CONFIG_P2P
127                         if (conf->hw_mode == HOSTAPD_MODE_IEEE80211A &&
128                             (mode->ht_capab &
129                              HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET) &&
130                             ssid->ht40)
131                                 conf->secondary_channel =
132                                         wpas_p2p_get_ht40_mode(wpa_s, mode,
133                                                                conf->channel);
134                         if (conf->secondary_channel)
135                                 conf->ht_capab |=
136                                         HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET;
137 #endif /* CONFIG_P2P */
138
139                         /*
140                          * white-list capabilities that won't cause issues
141                          * to connecting stations, while leaving the current
142                          * capabilities intact (currently disabled SMPS).
143                          */
144                         conf->ht_capab |= mode->ht_capab &
145                                 (HT_CAP_INFO_GREEN_FIELD |
146                                  HT_CAP_INFO_SHORT_GI20MHZ |
147                                  HT_CAP_INFO_SHORT_GI40MHZ |
148                                  HT_CAP_INFO_RX_STBC_MASK |
149                                  HT_CAP_INFO_MAX_AMSDU_SIZE);
150
151                         if (mode->vht_capab && ssid->vht) {
152                                 conf->ieee80211ac = 1;
153                                 wpas_conf_ap_vht(wpa_s, conf, mode);
154                         }
155                 }
156         }
157 #endif /* CONFIG_IEEE80211N */
158
159 #ifdef CONFIG_P2P
160         if (conf->hw_mode == HOSTAPD_MODE_IEEE80211G &&
161             (ssid->mode == WPAS_MODE_P2P_GO ||
162              ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)) {
163                 /* Remove 802.11b rates from supported and basic rate sets */
164                 int *list = os_malloc(4 * sizeof(int));
165                 if (list) {
166                         list[0] = 60;
167                         list[1] = 120;
168                         list[2] = 240;
169                         list[3] = -1;
170                 }
171                 conf->basic_rates = list;
172
173                 list = os_malloc(9 * sizeof(int));
174                 if (list) {
175                         list[0] = 60;
176                         list[1] = 90;
177                         list[2] = 120;
178                         list[3] = 180;
179                         list[4] = 240;
180                         list[5] = 360;
181                         list[6] = 480;
182                         list[7] = 540;
183                         list[8] = -1;
184                 }
185                 conf->supported_rates = list;
186         }
187
188         bss->isolate = !wpa_s->conf->p2p_intra_bss;
189         bss->force_per_enrollee_psk = wpa_s->global->p2p_per_sta_psk;
190
191         if (ssid->p2p_group) {
192                 os_memcpy(bss->ip_addr_go, wpa_s->parent->conf->ip_addr_go, 4);
193                 os_memcpy(bss->ip_addr_mask, wpa_s->parent->conf->ip_addr_mask,
194                           4);
195                 os_memcpy(bss->ip_addr_start,
196                           wpa_s->parent->conf->ip_addr_start, 4);
197                 os_memcpy(bss->ip_addr_end, wpa_s->parent->conf->ip_addr_end,
198                           4);
199         }
200 #endif /* CONFIG_P2P */
201
202         if (ssid->ssid_len == 0) {
203                 wpa_printf(MSG_ERROR, "No SSID configured for AP mode");
204                 return -1;
205         }
206         os_memcpy(bss->ssid.ssid, ssid->ssid, ssid->ssid_len);
207         bss->ssid.ssid_len = ssid->ssid_len;
208         bss->ssid.ssid_set = 1;
209
210         bss->ignore_broadcast_ssid = ssid->ignore_broadcast_ssid;
211
212         if (ssid->auth_alg)
213                 bss->auth_algs = ssid->auth_alg;
214
215         if (wpa_key_mgmt_wpa_psk(ssid->key_mgmt))
216                 bss->wpa = ssid->proto;
217         bss->wpa_key_mgmt = ssid->key_mgmt;
218         bss->wpa_pairwise = ssid->pairwise_cipher;
219         if (ssid->psk_set) {
220                 os_free(bss->ssid.wpa_psk);
221                 bss->ssid.wpa_psk = os_zalloc(sizeof(struct hostapd_wpa_psk));
222                 if (bss->ssid.wpa_psk == NULL)
223                         return -1;
224                 os_memcpy(bss->ssid.wpa_psk->psk, ssid->psk, PMK_LEN);
225                 bss->ssid.wpa_psk->group = 1;
226         } else if (ssid->passphrase) {
227                 bss->ssid.wpa_passphrase = os_strdup(ssid->passphrase);
228         } else if (ssid->wep_key_len[0] || ssid->wep_key_len[1] ||
229                    ssid->wep_key_len[2] || ssid->wep_key_len[3]) {
230                 struct hostapd_wep_keys *wep = &bss->ssid.wep;
231                 int i;
232                 for (i = 0; i < NUM_WEP_KEYS; i++) {
233                         if (ssid->wep_key_len[i] == 0)
234                                 continue;
235                         wep->key[i] = os_malloc(ssid->wep_key_len[i]);
236                         if (wep->key[i] == NULL)
237                                 return -1;
238                         os_memcpy(wep->key[i], ssid->wep_key[i],
239                                   ssid->wep_key_len[i]);
240                         wep->len[i] = ssid->wep_key_len[i];
241                 }
242                 wep->idx = ssid->wep_tx_keyidx;
243                 wep->keys_set = 1;
244         }
245
246         if (ssid->ap_max_inactivity)
247                 bss->ap_max_inactivity = ssid->ap_max_inactivity;
248
249         if (ssid->dtim_period)
250                 bss->dtim_period = ssid->dtim_period;
251         else if (wpa_s->conf->dtim_period)
252                 bss->dtim_period = wpa_s->conf->dtim_period;
253
254         if (ssid->beacon_int)
255                 conf->beacon_int = ssid->beacon_int;
256         else if (wpa_s->conf->beacon_int)
257                 conf->beacon_int = wpa_s->conf->beacon_int;
258
259         if ((bss->wpa & 2) && bss->rsn_pairwise == 0)
260                 bss->rsn_pairwise = bss->wpa_pairwise;
261         bss->wpa_group = wpa_select_ap_group_cipher(bss->wpa, bss->wpa_pairwise,
262                                                     bss->rsn_pairwise);
263
264         if (bss->wpa && bss->ieee802_1x)
265                 bss->ssid.security_policy = SECURITY_WPA;
266         else if (bss->wpa)
267                 bss->ssid.security_policy = SECURITY_WPA_PSK;
268         else if (bss->ieee802_1x) {
269                 int cipher = WPA_CIPHER_NONE;
270                 bss->ssid.security_policy = SECURITY_IEEE_802_1X;
271                 bss->ssid.wep.default_len = bss->default_wep_key_len;
272                 if (bss->default_wep_key_len)
273                         cipher = bss->default_wep_key_len >= 13 ?
274                                 WPA_CIPHER_WEP104 : WPA_CIPHER_WEP40;
275                 bss->wpa_group = cipher;
276                 bss->wpa_pairwise = cipher;
277                 bss->rsn_pairwise = cipher;
278         } else if (bss->ssid.wep.keys_set) {
279                 int cipher = WPA_CIPHER_WEP40;
280                 if (bss->ssid.wep.len[0] >= 13)
281                         cipher = WPA_CIPHER_WEP104;
282                 bss->ssid.security_policy = SECURITY_STATIC_WEP;
283                 bss->wpa_group = cipher;
284                 bss->wpa_pairwise = cipher;
285                 bss->rsn_pairwise = cipher;
286         } else {
287                 bss->ssid.security_policy = SECURITY_PLAINTEXT;
288                 bss->wpa_group = WPA_CIPHER_NONE;
289                 bss->wpa_pairwise = WPA_CIPHER_NONE;
290                 bss->rsn_pairwise = WPA_CIPHER_NONE;
291         }
292
293         if (bss->wpa_group_rekey < 86400 && (bss->wpa & 2) &&
294             (bss->wpa_group == WPA_CIPHER_CCMP ||
295              bss->wpa_group == WPA_CIPHER_GCMP ||
296              bss->wpa_group == WPA_CIPHER_CCMP_256 ||
297              bss->wpa_group == WPA_CIPHER_GCMP_256)) {
298                 /*
299                  * Strong ciphers do not need frequent rekeying, so increase
300                  * the default GTK rekeying period to 24 hours.
301                  */
302                 bss->wpa_group_rekey = 86400;
303         }
304
305 #ifdef CONFIG_IEEE80211W
306         if (ssid->ieee80211w != MGMT_FRAME_PROTECTION_DEFAULT)
307                 bss->ieee80211w = ssid->ieee80211w;
308 #endif /* CONFIG_IEEE80211W */
309
310 #ifdef CONFIG_WPS
311         /*
312          * Enable WPS by default for open and WPA/WPA2-Personal network, but
313          * require user interaction to actually use it. Only the internal
314          * Registrar is supported.
315          */
316         if (bss->ssid.security_policy != SECURITY_WPA_PSK &&
317             bss->ssid.security_policy != SECURITY_PLAINTEXT)
318                 goto no_wps;
319         if (bss->ssid.security_policy == SECURITY_WPA_PSK &&
320             (!(bss->rsn_pairwise & WPA_CIPHER_CCMP) || !(bss->wpa & 2)))
321                 goto no_wps; /* WPS2 does not allow WPA/TKIP-only
322                               * configuration */
323         bss->eap_server = 1;
324
325         if (!ssid->ignore_broadcast_ssid)
326                 bss->wps_state = 2;
327
328         bss->ap_setup_locked = 2;
329         if (wpa_s->conf->config_methods)
330                 bss->config_methods = os_strdup(wpa_s->conf->config_methods);
331         os_memcpy(bss->device_type, wpa_s->conf->device_type,
332                   WPS_DEV_TYPE_LEN);
333         if (wpa_s->conf->device_name) {
334                 bss->device_name = os_strdup(wpa_s->conf->device_name);
335                 bss->friendly_name = os_strdup(wpa_s->conf->device_name);
336         }
337         if (wpa_s->conf->manufacturer)
338                 bss->manufacturer = os_strdup(wpa_s->conf->manufacturer);
339         if (wpa_s->conf->model_name)
340                 bss->model_name = os_strdup(wpa_s->conf->model_name);
341         if (wpa_s->conf->model_number)
342                 bss->model_number = os_strdup(wpa_s->conf->model_number);
343         if (wpa_s->conf->serial_number)
344                 bss->serial_number = os_strdup(wpa_s->conf->serial_number);
345         if (is_nil_uuid(wpa_s->conf->uuid))
346                 os_memcpy(bss->uuid, wpa_s->wps->uuid, WPS_UUID_LEN);
347         else
348                 os_memcpy(bss->uuid, wpa_s->conf->uuid, WPS_UUID_LEN);
349         os_memcpy(bss->os_version, wpa_s->conf->os_version, 4);
350         bss->pbc_in_m1 = wpa_s->conf->pbc_in_m1;
351 no_wps:
352 #endif /* CONFIG_WPS */
353
354         if (wpa_s->max_stations &&
355             wpa_s->max_stations < wpa_s->conf->max_num_sta)
356                 bss->max_num_sta = wpa_s->max_stations;
357         else
358                 bss->max_num_sta = wpa_s->conf->max_num_sta;
359
360         bss->disassoc_low_ack = wpa_s->conf->disassoc_low_ack;
361
362         if (wpa_s->conf->ap_vendor_elements) {
363                 bss->vendor_elements =
364                         wpabuf_dup(wpa_s->conf->ap_vendor_elements);
365         }
366
367         return 0;
368 }
369
370
371 static void ap_public_action_rx(void *ctx, const u8 *buf, size_t len, int freq)
372 {
373 #ifdef CONFIG_P2P
374         struct wpa_supplicant *wpa_s = ctx;
375         const struct ieee80211_mgmt *mgmt;
376
377         mgmt = (const struct ieee80211_mgmt *) buf;
378         if (len < IEEE80211_HDRLEN + 1)
379                 return;
380         if (mgmt->u.action.category != WLAN_ACTION_PUBLIC)
381                 return;
382         wpas_p2p_rx_action(wpa_s, mgmt->da, mgmt->sa, mgmt->bssid,
383                            mgmt->u.action.category,
384                            buf + IEEE80211_HDRLEN + 1,
385                            len - IEEE80211_HDRLEN - 1, freq);
386 #endif /* CONFIG_P2P */
387 }
388
389
390 static void ap_wps_event_cb(void *ctx, enum wps_event event,
391                             union wps_event_data *data)
392 {
393 #ifdef CONFIG_P2P
394         struct wpa_supplicant *wpa_s = ctx;
395
396         if (event == WPS_EV_FAIL) {
397                 struct wps_event_fail *fail = &data->fail;
398
399                 if (wpa_s->parent && wpa_s->parent != wpa_s &&
400                     wpa_s == wpa_s->global->p2p_group_formation) {
401                         /*
402                          * src/ap/wps_hostapd.c has already sent this on the
403                          * main interface, so only send on the parent interface
404                          * here if needed.
405                          */
406                         wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_FAIL
407                                 "msg=%d config_error=%d",
408                                 fail->msg, fail->config_error);
409                 }
410                 wpas_p2p_wps_failed(wpa_s, fail);
411         }
412 #endif /* CONFIG_P2P */
413 }
414
415
416 static void ap_sta_authorized_cb(void *ctx, const u8 *mac_addr,
417                                  int authorized, const u8 *p2p_dev_addr)
418 {
419         wpas_notify_sta_authorized(ctx, mac_addr, authorized, p2p_dev_addr);
420 }
421
422
423 #ifdef CONFIG_P2P
424 static void ap_new_psk_cb(void *ctx, const u8 *mac_addr, const u8 *p2p_dev_addr,
425                           const u8 *psk, size_t psk_len)
426 {
427
428         struct wpa_supplicant *wpa_s = ctx;
429         if (wpa_s->ap_iface == NULL || wpa_s->current_ssid == NULL)
430                 return;
431         wpas_p2p_new_psk_cb(wpa_s, mac_addr, p2p_dev_addr, psk, psk_len);
432 }
433 #endif /* CONFIG_P2P */
434
435
436 static int ap_vendor_action_rx(void *ctx, const u8 *buf, size_t len, int freq)
437 {
438 #ifdef CONFIG_P2P
439         struct wpa_supplicant *wpa_s = ctx;
440         const struct ieee80211_mgmt *mgmt;
441
442         mgmt = (const struct ieee80211_mgmt *) buf;
443         if (len < IEEE80211_HDRLEN + 1)
444                 return -1;
445         wpas_p2p_rx_action(wpa_s, mgmt->da, mgmt->sa, mgmt->bssid,
446                            mgmt->u.action.category,
447                            buf + IEEE80211_HDRLEN + 1,
448                            len - IEEE80211_HDRLEN - 1, freq);
449 #endif /* CONFIG_P2P */
450         return 0;
451 }
452
453
454 static int ap_probe_req_rx(void *ctx, const u8 *sa, const u8 *da,
455                            const u8 *bssid, const u8 *ie, size_t ie_len,
456                            int ssi_signal)
457 {
458         struct wpa_supplicant *wpa_s = ctx;
459         return wpas_p2p_probe_req_rx(wpa_s, sa, da, bssid, ie, ie_len,
460                                      ssi_signal);
461 }
462
463
464 static void ap_wps_reg_success_cb(void *ctx, const u8 *mac_addr,
465                                   const u8 *uuid_e)
466 {
467         struct wpa_supplicant *wpa_s = ctx;
468         wpas_p2p_wps_success(wpa_s, mac_addr, 1);
469 }
470
471
472 static void wpas_ap_configured_cb(void *ctx)
473 {
474         struct wpa_supplicant *wpa_s = ctx;
475
476         wpa_supplicant_set_state(wpa_s, WPA_COMPLETED);
477
478         if (wpa_s->ap_configured_cb)
479                 wpa_s->ap_configured_cb(wpa_s->ap_configured_cb_ctx,
480                                         wpa_s->ap_configured_cb_data);
481 }
482
483
484 int wpa_supplicant_create_ap(struct wpa_supplicant *wpa_s,
485                              struct wpa_ssid *ssid)
486 {
487         struct wpa_driver_associate_params params;
488         struct hostapd_iface *hapd_iface;
489         struct hostapd_config *conf;
490         size_t i;
491
492         if (ssid->ssid == NULL || ssid->ssid_len == 0) {
493                 wpa_printf(MSG_ERROR, "No SSID configured for AP mode");
494                 return -1;
495         }
496
497         wpa_supplicant_ap_deinit(wpa_s);
498
499         wpa_printf(MSG_DEBUG, "Setting up AP (SSID='%s')",
500                    wpa_ssid_txt(ssid->ssid, ssid->ssid_len));
501
502         os_memset(&params, 0, sizeof(params));
503         params.ssid = ssid->ssid;
504         params.ssid_len = ssid->ssid_len;
505         switch (ssid->mode) {
506         case WPAS_MODE_AP:
507         case WPAS_MODE_P2P_GO:
508         case WPAS_MODE_P2P_GROUP_FORMATION:
509                 params.mode = IEEE80211_MODE_AP;
510                 break;
511         default:
512                 return -1;
513         }
514         if (ssid->frequency == 0)
515                 ssid->frequency = 2462; /* default channel 11 */
516         params.freq.freq = ssid->frequency;
517
518         params.wpa_proto = ssid->proto;
519         if (ssid->key_mgmt & WPA_KEY_MGMT_PSK)
520                 wpa_s->key_mgmt = WPA_KEY_MGMT_PSK;
521         else
522                 wpa_s->key_mgmt = WPA_KEY_MGMT_NONE;
523         params.key_mgmt_suite = wpa_s->key_mgmt;
524
525         wpa_s->pairwise_cipher = wpa_pick_pairwise_cipher(ssid->pairwise_cipher,
526                                                           1);
527         if (wpa_s->pairwise_cipher < 0) {
528                 wpa_printf(MSG_WARNING, "WPA: Failed to select pairwise "
529                            "cipher.");
530                 return -1;
531         }
532         params.pairwise_suite = wpa_s->pairwise_cipher;
533         params.group_suite = params.pairwise_suite;
534
535 #ifdef CONFIG_P2P
536         if (ssid->mode == WPAS_MODE_P2P_GO ||
537             ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)
538                 params.p2p = 1;
539 #endif /* CONFIG_P2P */
540
541         if (wpa_s->parent->set_ap_uapsd)
542                 params.uapsd = wpa_s->parent->ap_uapsd;
543         else if (params.p2p && (wpa_s->drv_flags & WPA_DRIVER_FLAGS_AP_UAPSD))
544                 params.uapsd = 1; /* mandatory for P2P GO */
545         else
546                 params.uapsd = -1;
547
548         if (wpa_drv_associate(wpa_s, &params) < 0) {
549                 wpa_msg(wpa_s, MSG_INFO, "Failed to start AP functionality");
550                 return -1;
551         }
552
553         wpa_s->ap_iface = hapd_iface = os_zalloc(sizeof(*wpa_s->ap_iface));
554         if (hapd_iface == NULL)
555                 return -1;
556         hapd_iface->owner = wpa_s;
557         hapd_iface->drv_flags = wpa_s->drv_flags;
558         hapd_iface->probe_resp_offloads = wpa_s->probe_resp_offloads;
559         hapd_iface->extended_capa = wpa_s->extended_capa;
560         hapd_iface->extended_capa_mask = wpa_s->extended_capa_mask;
561         hapd_iface->extended_capa_len = wpa_s->extended_capa_len;
562
563         wpa_s->ap_iface->conf = conf = hostapd_config_defaults();
564         if (conf == NULL) {
565                 wpa_supplicant_ap_deinit(wpa_s);
566                 return -1;
567         }
568
569         os_memcpy(wpa_s->ap_iface->conf->wmm_ac_params,
570                   wpa_s->conf->wmm_ac_params,
571                   sizeof(wpa_s->conf->wmm_ac_params));
572
573         if (params.uapsd > 0) {
574                 conf->bss[0]->wmm_enabled = 1;
575                 conf->bss[0]->wmm_uapsd = 1;
576         }
577
578         if (wpa_supplicant_conf_ap(wpa_s, ssid, conf)) {
579                 wpa_printf(MSG_ERROR, "Failed to create AP configuration");
580                 wpa_supplicant_ap_deinit(wpa_s);
581                 return -1;
582         }
583
584 #ifdef CONFIG_P2P
585         if (ssid->mode == WPAS_MODE_P2P_GO)
586                 conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER;
587         else if (ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)
588                 conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER |
589                         P2P_GROUP_FORMATION;
590 #endif /* CONFIG_P2P */
591
592         hapd_iface->num_bss = conf->num_bss;
593         hapd_iface->bss = os_calloc(conf->num_bss,
594                                     sizeof(struct hostapd_data *));
595         if (hapd_iface->bss == NULL) {
596                 wpa_supplicant_ap_deinit(wpa_s);
597                 return -1;
598         }
599
600         for (i = 0; i < conf->num_bss; i++) {
601                 hapd_iface->bss[i] =
602                         hostapd_alloc_bss_data(hapd_iface, conf,
603                                                conf->bss[i]);
604                 if (hapd_iface->bss[i] == NULL) {
605                         wpa_supplicant_ap_deinit(wpa_s);
606                         return -1;
607                 }
608
609                 hapd_iface->bss[i]->msg_ctx = wpa_s;
610                 hapd_iface->bss[i]->msg_ctx_parent = wpa_s->parent;
611                 hapd_iface->bss[i]->public_action_cb = ap_public_action_rx;
612                 hapd_iface->bss[i]->public_action_cb_ctx = wpa_s;
613                 hapd_iface->bss[i]->vendor_action_cb = ap_vendor_action_rx;
614                 hapd_iface->bss[i]->vendor_action_cb_ctx = wpa_s;
615                 hostapd_register_probereq_cb(hapd_iface->bss[i],
616                                              ap_probe_req_rx, wpa_s);
617                 hapd_iface->bss[i]->wps_reg_success_cb = ap_wps_reg_success_cb;
618                 hapd_iface->bss[i]->wps_reg_success_cb_ctx = wpa_s;
619                 hapd_iface->bss[i]->wps_event_cb = ap_wps_event_cb;
620                 hapd_iface->bss[i]->wps_event_cb_ctx = wpa_s;
621                 hapd_iface->bss[i]->sta_authorized_cb = ap_sta_authorized_cb;
622                 hapd_iface->bss[i]->sta_authorized_cb_ctx = wpa_s;
623 #ifdef CONFIG_P2P
624                 hapd_iface->bss[i]->new_psk_cb = ap_new_psk_cb;
625                 hapd_iface->bss[i]->new_psk_cb_ctx = wpa_s;
626                 hapd_iface->bss[i]->p2p = wpa_s->global->p2p;
627                 hapd_iface->bss[i]->p2p_group = wpas_p2p_group_init(wpa_s,
628                                                                     ssid);
629 #endif /* CONFIG_P2P */
630                 hapd_iface->bss[i]->setup_complete_cb = wpas_ap_configured_cb;
631                 hapd_iface->bss[i]->setup_complete_cb_ctx = wpa_s;
632 #ifdef CONFIG_TESTING_OPTIONS
633                 hapd_iface->bss[i]->ext_eapol_frame_io =
634                         wpa_s->ext_eapol_frame_io;
635 #endif /* CONFIG_TESTING_OPTIONS */
636         }
637
638         os_memcpy(hapd_iface->bss[0]->own_addr, wpa_s->own_addr, ETH_ALEN);
639         hapd_iface->bss[0]->driver = wpa_s->driver;
640         hapd_iface->bss[0]->drv_priv = wpa_s->drv_priv;
641
642         wpa_s->current_ssid = ssid;
643         eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
644         os_memcpy(wpa_s->bssid, wpa_s->own_addr, ETH_ALEN);
645         wpa_s->assoc_freq = ssid->frequency;
646
647         if (hostapd_setup_interface(wpa_s->ap_iface)) {
648                 wpa_printf(MSG_ERROR, "Failed to initialize AP interface");
649                 wpa_supplicant_ap_deinit(wpa_s);
650                 return -1;
651         }
652
653         return 0;
654 }
655
656
657 void wpa_supplicant_ap_deinit(struct wpa_supplicant *wpa_s)
658 {
659 #ifdef CONFIG_WPS
660         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
661 #endif /* CONFIG_WPS */
662
663         if (wpa_s->ap_iface == NULL)
664                 return;
665
666         wpa_s->current_ssid = NULL;
667         eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
668         wpa_s->assoc_freq = 0;
669         wpas_p2p_ap_deinit(wpa_s);
670         wpa_s->ap_iface->driver_ap_teardown =
671                 !!(wpa_s->drv_flags & WPA_DRIVER_FLAGS_AP_TEARDOWN_SUPPORT);
672
673         hostapd_interface_deinit(wpa_s->ap_iface);
674         hostapd_interface_free(wpa_s->ap_iface);
675         wpa_s->ap_iface = NULL;
676         wpa_drv_deinit_ap(wpa_s);
677 }
678
679
680 void ap_tx_status(void *ctx, const u8 *addr,
681                   const u8 *buf, size_t len, int ack)
682 {
683 #ifdef NEED_AP_MLME
684         struct wpa_supplicant *wpa_s = ctx;
685         hostapd_tx_status(wpa_s->ap_iface->bss[0], addr, buf, len, ack);
686 #endif /* NEED_AP_MLME */
687 }
688
689
690 void ap_eapol_tx_status(void *ctx, const u8 *dst,
691                         const u8 *data, size_t len, int ack)
692 {
693 #ifdef NEED_AP_MLME
694         struct wpa_supplicant *wpa_s = ctx;
695         if (!wpa_s->ap_iface)
696                 return;
697         hostapd_tx_status(wpa_s->ap_iface->bss[0], dst, data, len, ack);
698 #endif /* NEED_AP_MLME */
699 }
700
701
702 void ap_client_poll_ok(void *ctx, const u8 *addr)
703 {
704 #ifdef NEED_AP_MLME
705         struct wpa_supplicant *wpa_s = ctx;
706         if (wpa_s->ap_iface)
707                 hostapd_client_poll_ok(wpa_s->ap_iface->bss[0], addr);
708 #endif /* NEED_AP_MLME */
709 }
710
711
712 void ap_rx_from_unknown_sta(void *ctx, const u8 *addr, int wds)
713 {
714 #ifdef NEED_AP_MLME
715         struct wpa_supplicant *wpa_s = ctx;
716         ieee802_11_rx_from_unknown(wpa_s->ap_iface->bss[0], addr, wds);
717 #endif /* NEED_AP_MLME */
718 }
719
720
721 void ap_mgmt_rx(void *ctx, struct rx_mgmt *rx_mgmt)
722 {
723 #ifdef NEED_AP_MLME
724         struct wpa_supplicant *wpa_s = ctx;
725         struct hostapd_frame_info fi;
726         os_memset(&fi, 0, sizeof(fi));
727         fi.datarate = rx_mgmt->datarate;
728         fi.ssi_signal = rx_mgmt->ssi_signal;
729         ieee802_11_mgmt(wpa_s->ap_iface->bss[0], rx_mgmt->frame,
730                         rx_mgmt->frame_len, &fi);
731 #endif /* NEED_AP_MLME */
732 }
733
734
735 void ap_mgmt_tx_cb(void *ctx, const u8 *buf, size_t len, u16 stype, int ok)
736 {
737 #ifdef NEED_AP_MLME
738         struct wpa_supplicant *wpa_s = ctx;
739         ieee802_11_mgmt_cb(wpa_s->ap_iface->bss[0], buf, len, stype, ok);
740 #endif /* NEED_AP_MLME */
741 }
742
743
744 void wpa_supplicant_ap_rx_eapol(struct wpa_supplicant *wpa_s,
745                                 const u8 *src_addr, const u8 *buf, size_t len)
746 {
747         ieee802_1x_receive(wpa_s->ap_iface->bss[0], src_addr, buf, len);
748 }
749
750
751 #ifdef CONFIG_WPS
752
753 int wpa_supplicant_ap_wps_pbc(struct wpa_supplicant *wpa_s, const u8 *bssid,
754                               const u8 *p2p_dev_addr)
755 {
756         if (!wpa_s->ap_iface)
757                 return -1;
758         return hostapd_wps_button_pushed(wpa_s->ap_iface->bss[0],
759                                          p2p_dev_addr);
760 }
761
762
763 int wpa_supplicant_ap_wps_cancel(struct wpa_supplicant *wpa_s)
764 {
765         struct wps_registrar *reg;
766         int reg_sel = 0, wps_sta = 0;
767
768         if (!wpa_s->ap_iface || !wpa_s->ap_iface->bss[0]->wps)
769                 return -1;
770
771         reg = wpa_s->ap_iface->bss[0]->wps->registrar;
772         reg_sel = wps_registrar_wps_cancel(reg);
773         wps_sta = ap_for_each_sta(wpa_s->ap_iface->bss[0],
774                                   ap_sta_wps_cancel, NULL);
775
776         if (!reg_sel && !wps_sta) {
777                 wpa_printf(MSG_DEBUG, "No WPS operation in progress at this "
778                            "time");
779                 return -1;
780         }
781
782         /*
783          * There are 2 cases to return wps cancel as success:
784          * 1. When wps cancel was initiated but no connection has been
785          *    established with client yet.
786          * 2. Client is in the middle of exchanging WPS messages.
787          */
788
789         return 0;
790 }
791
792
793 int wpa_supplicant_ap_wps_pin(struct wpa_supplicant *wpa_s, const u8 *bssid,
794                               const char *pin, char *buf, size_t buflen,
795                               int timeout)
796 {
797         int ret, ret_len = 0;
798
799         if (!wpa_s->ap_iface)
800                 return -1;
801
802         if (pin == NULL) {
803                 unsigned int rpin = wps_generate_pin();
804                 ret_len = os_snprintf(buf, buflen, "%08d", rpin);
805                 pin = buf;
806         } else
807                 ret_len = os_snprintf(buf, buflen, "%s", pin);
808
809         ret = hostapd_wps_add_pin(wpa_s->ap_iface->bss[0], bssid, "any", pin,
810                                   timeout);
811         if (ret)
812                 return -1;
813         return ret_len;
814 }
815
816
817 static void wpas_wps_ap_pin_timeout(void *eloop_data, void *user_ctx)
818 {
819         struct wpa_supplicant *wpa_s = eloop_data;
820         wpa_printf(MSG_DEBUG, "WPS: AP PIN timed out");
821         wpas_wps_ap_pin_disable(wpa_s);
822 }
823
824
825 static void wpas_wps_ap_pin_enable(struct wpa_supplicant *wpa_s, int timeout)
826 {
827         struct hostapd_data *hapd;
828
829         if (wpa_s->ap_iface == NULL)
830                 return;
831         hapd = wpa_s->ap_iface->bss[0];
832         wpa_printf(MSG_DEBUG, "WPS: Enabling AP PIN (timeout=%d)", timeout);
833         hapd->ap_pin_failures = 0;
834         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
835         if (timeout > 0)
836                 eloop_register_timeout(timeout, 0,
837                                        wpas_wps_ap_pin_timeout, wpa_s, NULL);
838 }
839
840
841 void wpas_wps_ap_pin_disable(struct wpa_supplicant *wpa_s)
842 {
843         struct hostapd_data *hapd;
844
845         if (wpa_s->ap_iface == NULL)
846                 return;
847         wpa_printf(MSG_DEBUG, "WPS: Disabling AP PIN");
848         hapd = wpa_s->ap_iface->bss[0];
849         os_free(hapd->conf->ap_pin);
850         hapd->conf->ap_pin = NULL;
851         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
852 }
853
854
855 const char * wpas_wps_ap_pin_random(struct wpa_supplicant *wpa_s, int timeout)
856 {
857         struct hostapd_data *hapd;
858         unsigned int pin;
859         char pin_txt[9];
860
861         if (wpa_s->ap_iface == NULL)
862                 return NULL;
863         hapd = wpa_s->ap_iface->bss[0];
864         pin = wps_generate_pin();
865         os_snprintf(pin_txt, sizeof(pin_txt), "%08u", pin);
866         os_free(hapd->conf->ap_pin);
867         hapd->conf->ap_pin = os_strdup(pin_txt);
868         if (hapd->conf->ap_pin == NULL)
869                 return NULL;
870         wpas_wps_ap_pin_enable(wpa_s, timeout);
871
872         return hapd->conf->ap_pin;
873 }
874
875
876 const char * wpas_wps_ap_pin_get(struct wpa_supplicant *wpa_s)
877 {
878         struct hostapd_data *hapd;
879         if (wpa_s->ap_iface == NULL)
880                 return NULL;
881         hapd = wpa_s->ap_iface->bss[0];
882         return hapd->conf->ap_pin;
883 }
884
885
886 int wpas_wps_ap_pin_set(struct wpa_supplicant *wpa_s, const char *pin,
887                         int timeout)
888 {
889         struct hostapd_data *hapd;
890         char pin_txt[9];
891         int ret;
892
893         if (wpa_s->ap_iface == NULL)
894                 return -1;
895         hapd = wpa_s->ap_iface->bss[0];
896         ret = os_snprintf(pin_txt, sizeof(pin_txt), "%s", pin);
897         if (ret < 0 || ret >= (int) sizeof(pin_txt))
898                 return -1;
899         os_free(hapd->conf->ap_pin);
900         hapd->conf->ap_pin = os_strdup(pin_txt);
901         if (hapd->conf->ap_pin == NULL)
902                 return -1;
903         wpas_wps_ap_pin_enable(wpa_s, timeout);
904
905         return 0;
906 }
907
908
909 void wpa_supplicant_ap_pwd_auth_fail(struct wpa_supplicant *wpa_s)
910 {
911         struct hostapd_data *hapd;
912
913         if (wpa_s->ap_iface == NULL)
914                 return;
915         hapd = wpa_s->ap_iface->bss[0];
916
917         /*
918          * Registrar failed to prove its knowledge of the AP PIN. Disable AP
919          * PIN if this happens multiple times to slow down brute force attacks.
920          */
921         hapd->ap_pin_failures++;
922         wpa_printf(MSG_DEBUG, "WPS: AP PIN authentication failure number %u",
923                    hapd->ap_pin_failures);
924         if (hapd->ap_pin_failures < 3)
925                 return;
926
927         wpa_printf(MSG_DEBUG, "WPS: Disable AP PIN");
928         hapd->ap_pin_failures = 0;
929         os_free(hapd->conf->ap_pin);
930         hapd->conf->ap_pin = NULL;
931 }
932
933
934 #ifdef CONFIG_WPS_NFC
935
936 struct wpabuf * wpas_ap_wps_nfc_config_token(struct wpa_supplicant *wpa_s,
937                                              int ndef)
938 {
939         struct hostapd_data *hapd;
940
941         if (wpa_s->ap_iface == NULL)
942                 return NULL;
943         hapd = wpa_s->ap_iface->bss[0];
944         return hostapd_wps_nfc_config_token(hapd, ndef);
945 }
946
947
948 struct wpabuf * wpas_ap_wps_nfc_handover_sel(struct wpa_supplicant *wpa_s,
949                                              int ndef)
950 {
951         struct hostapd_data *hapd;
952
953         if (wpa_s->ap_iface == NULL)
954                 return NULL;
955         hapd = wpa_s->ap_iface->bss[0];
956         return hostapd_wps_nfc_hs_cr(hapd, ndef);
957 }
958
959
960 int wpas_ap_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
961                                     const struct wpabuf *req,
962                                     const struct wpabuf *sel)
963 {
964         struct hostapd_data *hapd;
965
966         if (wpa_s->ap_iface == NULL)
967                 return -1;
968         hapd = wpa_s->ap_iface->bss[0];
969         return hostapd_wps_nfc_report_handover(hapd, req, sel);
970 }
971
972 #endif /* CONFIG_WPS_NFC */
973
974 #endif /* CONFIG_WPS */
975
976
977 #ifdef CONFIG_CTRL_IFACE
978
979 int ap_ctrl_iface_sta_first(struct wpa_supplicant *wpa_s,
980                             char *buf, size_t buflen)
981 {
982         if (wpa_s->ap_iface == NULL)
983                 return -1;
984         return hostapd_ctrl_iface_sta_first(wpa_s->ap_iface->bss[0],
985                                             buf, buflen);
986 }
987
988
989 int ap_ctrl_iface_sta(struct wpa_supplicant *wpa_s, const char *txtaddr,
990                       char *buf, size_t buflen)
991 {
992         if (wpa_s->ap_iface == NULL)
993                 return -1;
994         return hostapd_ctrl_iface_sta(wpa_s->ap_iface->bss[0], txtaddr,
995                                       buf, buflen);
996 }
997
998
999 int ap_ctrl_iface_sta_next(struct wpa_supplicant *wpa_s, const char *txtaddr,
1000                            char *buf, size_t buflen)
1001 {
1002         if (wpa_s->ap_iface == NULL)
1003                 return -1;
1004         return hostapd_ctrl_iface_sta_next(wpa_s->ap_iface->bss[0], txtaddr,
1005                                            buf, buflen);
1006 }
1007
1008
1009 int ap_ctrl_iface_sta_disassociate(struct wpa_supplicant *wpa_s,
1010                                    const char *txtaddr)
1011 {
1012         if (wpa_s->ap_iface == NULL)
1013                 return -1;
1014         return hostapd_ctrl_iface_disassociate(wpa_s->ap_iface->bss[0],
1015                                                txtaddr);
1016 }
1017
1018
1019 int ap_ctrl_iface_sta_deauthenticate(struct wpa_supplicant *wpa_s,
1020                                      const char *txtaddr)
1021 {
1022         if (wpa_s->ap_iface == NULL)
1023                 return -1;
1024         return hostapd_ctrl_iface_deauthenticate(wpa_s->ap_iface->bss[0],
1025                                                  txtaddr);
1026 }
1027
1028
1029 int ap_ctrl_iface_wpa_get_status(struct wpa_supplicant *wpa_s, char *buf,
1030                                  size_t buflen, int verbose)
1031 {
1032         char *pos = buf, *end = buf + buflen;
1033         int ret;
1034         struct hostapd_bss_config *conf;
1035
1036         if (wpa_s->ap_iface == NULL)
1037                 return -1;
1038
1039         conf = wpa_s->ap_iface->bss[0]->conf;
1040         if (conf->wpa == 0)
1041                 return 0;
1042
1043         ret = os_snprintf(pos, end - pos,
1044                           "pairwise_cipher=%s\n"
1045                           "group_cipher=%s\n"
1046                           "key_mgmt=%s\n",
1047                           wpa_cipher_txt(conf->rsn_pairwise),
1048                           wpa_cipher_txt(conf->wpa_group),
1049                           wpa_key_mgmt_txt(conf->wpa_key_mgmt,
1050                                            conf->wpa));
1051         if (ret < 0 || ret >= end - pos)
1052                 return pos - buf;
1053         pos += ret;
1054         return pos - buf;
1055 }
1056
1057 #endif /* CONFIG_CTRL_IFACE */
1058
1059
1060 int wpa_supplicant_ap_update_beacon(struct wpa_supplicant *wpa_s)
1061 {
1062         struct hostapd_iface *iface = wpa_s->ap_iface;
1063         struct wpa_ssid *ssid = wpa_s->current_ssid;
1064         struct hostapd_data *hapd;
1065
1066         if (ssid == NULL || wpa_s->ap_iface == NULL ||
1067             ssid->mode == WPAS_MODE_INFRA ||
1068             ssid->mode == WPAS_MODE_IBSS)
1069                 return -1;
1070
1071 #ifdef CONFIG_P2P
1072         if (ssid->mode == WPAS_MODE_P2P_GO)
1073                 iface->conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER;
1074         else if (ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)
1075                 iface->conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER |
1076                         P2P_GROUP_FORMATION;
1077 #endif /* CONFIG_P2P */
1078
1079         hapd = iface->bss[0];
1080         if (hapd->drv_priv == NULL)
1081                 return -1;
1082         ieee802_11_set_beacons(iface);
1083         hostapd_set_ap_wps_ie(hapd);
1084
1085         return 0;
1086 }
1087
1088
1089 int ap_switch_channel(struct wpa_supplicant *wpa_s,
1090                       struct csa_settings *settings)
1091 {
1092 #ifdef NEED_AP_MLME
1093         if (!wpa_s->ap_iface || !wpa_s->ap_iface->bss[0])
1094                 return -1;
1095
1096         return hostapd_switch_channel(wpa_s->ap_iface->bss[0], settings);
1097 #else /* NEED_AP_MLME */
1098         return -1;
1099 #endif /* NEED_AP_MLME */
1100 }
1101
1102
1103 int ap_ctrl_iface_chanswitch(struct wpa_supplicant *wpa_s, const char *pos)
1104 {
1105         struct csa_settings settings;
1106         int ret = hostapd_parse_csa_settings(pos, &settings);
1107
1108         if (ret)
1109                 return ret;
1110
1111         return ap_switch_channel(wpa_s, &settings);
1112 }
1113
1114
1115 void wpas_ap_ch_switch(struct wpa_supplicant *wpa_s, int freq, int ht,
1116                        int offset, int width, int cf1, int cf2)
1117 {
1118         if (!wpa_s->ap_iface)
1119                 return;
1120
1121         wpa_s->assoc_freq = freq;
1122         hostapd_event_ch_switch(wpa_s->ap_iface->bss[0], freq, ht, offset, width, cf1, cf1);
1123 }
1124
1125
1126 int wpa_supplicant_ap_mac_addr_filter(struct wpa_supplicant *wpa_s,
1127                                       const u8 *addr)
1128 {
1129         struct hostapd_data *hapd;
1130         struct hostapd_bss_config *conf;
1131
1132         if (!wpa_s->ap_iface)
1133                 return -1;
1134
1135         if (addr)
1136                 wpa_printf(MSG_DEBUG, "AP: Set MAC address filter: " MACSTR,
1137                            MAC2STR(addr));
1138         else
1139                 wpa_printf(MSG_DEBUG, "AP: Clear MAC address filter");
1140
1141         hapd = wpa_s->ap_iface->bss[0];
1142         conf = hapd->conf;
1143
1144         os_free(conf->accept_mac);
1145         conf->accept_mac = NULL;
1146         conf->num_accept_mac = 0;
1147         os_free(conf->deny_mac);
1148         conf->deny_mac = NULL;
1149         conf->num_deny_mac = 0;
1150
1151         if (addr == NULL) {
1152                 conf->macaddr_acl = ACCEPT_UNLESS_DENIED;
1153                 return 0;
1154         }
1155
1156         conf->macaddr_acl = DENY_UNLESS_ACCEPTED;
1157         conf->accept_mac = os_zalloc(sizeof(struct mac_acl_entry));
1158         if (conf->accept_mac == NULL)
1159                 return -1;
1160         os_memcpy(conf->accept_mac[0].addr, addr, ETH_ALEN);
1161         conf->num_accept_mac = 1;
1162
1163         return 0;
1164 }
1165
1166
1167 #ifdef CONFIG_WPS_NFC
1168 int wpas_ap_wps_add_nfc_pw(struct wpa_supplicant *wpa_s, u16 pw_id,
1169                            const struct wpabuf *pw, const u8 *pubkey_hash)
1170 {
1171         struct hostapd_data *hapd;
1172         struct wps_context *wps;
1173
1174         if (!wpa_s->ap_iface)
1175                 return -1;
1176         hapd = wpa_s->ap_iface->bss[0];
1177         wps = hapd->wps;
1178
1179         if (wpa_s->parent->conf->wps_nfc_dh_pubkey == NULL ||
1180             wpa_s->parent->conf->wps_nfc_dh_privkey == NULL) {
1181                 wpa_printf(MSG_DEBUG, "P2P: No NFC DH key known");
1182                 return -1;
1183         }
1184
1185         dh5_free(wps->dh_ctx);
1186         wpabuf_free(wps->dh_pubkey);
1187         wpabuf_free(wps->dh_privkey);
1188         wps->dh_privkey = wpabuf_dup(
1189                 wpa_s->parent->conf->wps_nfc_dh_privkey);
1190         wps->dh_pubkey = wpabuf_dup(
1191                 wpa_s->parent->conf->wps_nfc_dh_pubkey);
1192         if (wps->dh_privkey == NULL || wps->dh_pubkey == NULL) {
1193                 wps->dh_ctx = NULL;
1194                 wpabuf_free(wps->dh_pubkey);
1195                 wps->dh_pubkey = NULL;
1196                 wpabuf_free(wps->dh_privkey);
1197                 wps->dh_privkey = NULL;
1198                 return -1;
1199         }
1200         wps->dh_ctx = dh5_init_fixed(wps->dh_privkey, wps->dh_pubkey);
1201         if (wps->dh_ctx == NULL)
1202                 return -1;
1203
1204         return wps_registrar_add_nfc_pw_token(hapd->wps->registrar, pubkey_hash,
1205                                               pw_id,
1206                                               pw ? wpabuf_head(pw) : NULL,
1207                                               pw ? wpabuf_len(pw) : 0, 1);
1208 }
1209 #endif /* CONFIG_WPS_NFC */