ec6e868719b6a9b7fdef6ebef573d35825aeec4b
[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->smps_modes = wpa_s->drv_smps_modes;
559         hapd_iface->probe_resp_offloads = wpa_s->probe_resp_offloads;
560         hapd_iface->extended_capa = wpa_s->extended_capa;
561         hapd_iface->extended_capa_mask = wpa_s->extended_capa_mask;
562         hapd_iface->extended_capa_len = wpa_s->extended_capa_len;
563
564         wpa_s->ap_iface->conf = conf = hostapd_config_defaults();
565         if (conf == NULL) {
566                 wpa_supplicant_ap_deinit(wpa_s);
567                 return -1;
568         }
569
570         os_memcpy(wpa_s->ap_iface->conf->wmm_ac_params,
571                   wpa_s->conf->wmm_ac_params,
572                   sizeof(wpa_s->conf->wmm_ac_params));
573
574         if (params.uapsd > 0) {
575                 conf->bss[0]->wmm_enabled = 1;
576                 conf->bss[0]->wmm_uapsd = 1;
577         }
578
579         if (wpa_supplicant_conf_ap(wpa_s, ssid, conf)) {
580                 wpa_printf(MSG_ERROR, "Failed to create AP configuration");
581                 wpa_supplicant_ap_deinit(wpa_s);
582                 return -1;
583         }
584
585 #ifdef CONFIG_P2P
586         if (ssid->mode == WPAS_MODE_P2P_GO)
587                 conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER;
588         else if (ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)
589                 conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER |
590                         P2P_GROUP_FORMATION;
591 #endif /* CONFIG_P2P */
592
593         hapd_iface->num_bss = conf->num_bss;
594         hapd_iface->bss = os_calloc(conf->num_bss,
595                                     sizeof(struct hostapd_data *));
596         if (hapd_iface->bss == NULL) {
597                 wpa_supplicant_ap_deinit(wpa_s);
598                 return -1;
599         }
600
601         for (i = 0; i < conf->num_bss; i++) {
602                 hapd_iface->bss[i] =
603                         hostapd_alloc_bss_data(hapd_iface, conf,
604                                                conf->bss[i]);
605                 if (hapd_iface->bss[i] == NULL) {
606                         wpa_supplicant_ap_deinit(wpa_s);
607                         return -1;
608                 }
609
610                 hapd_iface->bss[i]->msg_ctx = wpa_s;
611                 hapd_iface->bss[i]->msg_ctx_parent = wpa_s->parent;
612                 hapd_iface->bss[i]->public_action_cb = ap_public_action_rx;
613                 hapd_iface->bss[i]->public_action_cb_ctx = wpa_s;
614                 hapd_iface->bss[i]->vendor_action_cb = ap_vendor_action_rx;
615                 hapd_iface->bss[i]->vendor_action_cb_ctx = wpa_s;
616                 hostapd_register_probereq_cb(hapd_iface->bss[i],
617                                              ap_probe_req_rx, wpa_s);
618                 hapd_iface->bss[i]->wps_reg_success_cb = ap_wps_reg_success_cb;
619                 hapd_iface->bss[i]->wps_reg_success_cb_ctx = wpa_s;
620                 hapd_iface->bss[i]->wps_event_cb = ap_wps_event_cb;
621                 hapd_iface->bss[i]->wps_event_cb_ctx = wpa_s;
622                 hapd_iface->bss[i]->sta_authorized_cb = ap_sta_authorized_cb;
623                 hapd_iface->bss[i]->sta_authorized_cb_ctx = wpa_s;
624 #ifdef CONFIG_P2P
625                 hapd_iface->bss[i]->new_psk_cb = ap_new_psk_cb;
626                 hapd_iface->bss[i]->new_psk_cb_ctx = wpa_s;
627                 hapd_iface->bss[i]->p2p = wpa_s->global->p2p;
628                 hapd_iface->bss[i]->p2p_group = wpas_p2p_group_init(wpa_s,
629                                                                     ssid);
630 #endif /* CONFIG_P2P */
631                 hapd_iface->bss[i]->setup_complete_cb = wpas_ap_configured_cb;
632                 hapd_iface->bss[i]->setup_complete_cb_ctx = wpa_s;
633 #ifdef CONFIG_TESTING_OPTIONS
634                 hapd_iface->bss[i]->ext_eapol_frame_io =
635                         wpa_s->ext_eapol_frame_io;
636 #endif /* CONFIG_TESTING_OPTIONS */
637         }
638
639         os_memcpy(hapd_iface->bss[0]->own_addr, wpa_s->own_addr, ETH_ALEN);
640         hapd_iface->bss[0]->driver = wpa_s->driver;
641         hapd_iface->bss[0]->drv_priv = wpa_s->drv_priv;
642
643         wpa_s->current_ssid = ssid;
644         eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
645         os_memcpy(wpa_s->bssid, wpa_s->own_addr, ETH_ALEN);
646         wpa_s->assoc_freq = ssid->frequency;
647
648         if (hostapd_setup_interface(wpa_s->ap_iface)) {
649                 wpa_printf(MSG_ERROR, "Failed to initialize AP interface");
650                 wpa_supplicant_ap_deinit(wpa_s);
651                 return -1;
652         }
653
654         return 0;
655 }
656
657
658 void wpa_supplicant_ap_deinit(struct wpa_supplicant *wpa_s)
659 {
660 #ifdef CONFIG_WPS
661         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
662 #endif /* CONFIG_WPS */
663
664         if (wpa_s->ap_iface == NULL)
665                 return;
666
667         wpa_s->current_ssid = NULL;
668         eapol_sm_notify_config(wpa_s->eapol, NULL, NULL);
669         wpa_s->assoc_freq = 0;
670         wpas_p2p_ap_deinit(wpa_s);
671         wpa_s->ap_iface->driver_ap_teardown =
672                 !!(wpa_s->drv_flags & WPA_DRIVER_FLAGS_AP_TEARDOWN_SUPPORT);
673
674         hostapd_interface_deinit(wpa_s->ap_iface);
675         hostapd_interface_free(wpa_s->ap_iface);
676         wpa_s->ap_iface = NULL;
677         wpa_drv_deinit_ap(wpa_s);
678 }
679
680
681 void ap_tx_status(void *ctx, const u8 *addr,
682                   const u8 *buf, size_t len, int ack)
683 {
684 #ifdef NEED_AP_MLME
685         struct wpa_supplicant *wpa_s = ctx;
686         hostapd_tx_status(wpa_s->ap_iface->bss[0], addr, buf, len, ack);
687 #endif /* NEED_AP_MLME */
688 }
689
690
691 void ap_eapol_tx_status(void *ctx, const u8 *dst,
692                         const u8 *data, size_t len, int ack)
693 {
694 #ifdef NEED_AP_MLME
695         struct wpa_supplicant *wpa_s = ctx;
696         if (!wpa_s->ap_iface)
697                 return;
698         hostapd_tx_status(wpa_s->ap_iface->bss[0], dst, data, len, ack);
699 #endif /* NEED_AP_MLME */
700 }
701
702
703 void ap_client_poll_ok(void *ctx, const u8 *addr)
704 {
705 #ifdef NEED_AP_MLME
706         struct wpa_supplicant *wpa_s = ctx;
707         if (wpa_s->ap_iface)
708                 hostapd_client_poll_ok(wpa_s->ap_iface->bss[0], addr);
709 #endif /* NEED_AP_MLME */
710 }
711
712
713 void ap_rx_from_unknown_sta(void *ctx, const u8 *addr, int wds)
714 {
715 #ifdef NEED_AP_MLME
716         struct wpa_supplicant *wpa_s = ctx;
717         ieee802_11_rx_from_unknown(wpa_s->ap_iface->bss[0], addr, wds);
718 #endif /* NEED_AP_MLME */
719 }
720
721
722 void ap_mgmt_rx(void *ctx, struct rx_mgmt *rx_mgmt)
723 {
724 #ifdef NEED_AP_MLME
725         struct wpa_supplicant *wpa_s = ctx;
726         struct hostapd_frame_info fi;
727         os_memset(&fi, 0, sizeof(fi));
728         fi.datarate = rx_mgmt->datarate;
729         fi.ssi_signal = rx_mgmt->ssi_signal;
730         ieee802_11_mgmt(wpa_s->ap_iface->bss[0], rx_mgmt->frame,
731                         rx_mgmt->frame_len, &fi);
732 #endif /* NEED_AP_MLME */
733 }
734
735
736 void ap_mgmt_tx_cb(void *ctx, const u8 *buf, size_t len, u16 stype, int ok)
737 {
738 #ifdef NEED_AP_MLME
739         struct wpa_supplicant *wpa_s = ctx;
740         ieee802_11_mgmt_cb(wpa_s->ap_iface->bss[0], buf, len, stype, ok);
741 #endif /* NEED_AP_MLME */
742 }
743
744
745 void wpa_supplicant_ap_rx_eapol(struct wpa_supplicant *wpa_s,
746                                 const u8 *src_addr, const u8 *buf, size_t len)
747 {
748         ieee802_1x_receive(wpa_s->ap_iface->bss[0], src_addr, buf, len);
749 }
750
751
752 #ifdef CONFIG_WPS
753
754 int wpa_supplicant_ap_wps_pbc(struct wpa_supplicant *wpa_s, const u8 *bssid,
755                               const u8 *p2p_dev_addr)
756 {
757         if (!wpa_s->ap_iface)
758                 return -1;
759         return hostapd_wps_button_pushed(wpa_s->ap_iface->bss[0],
760                                          p2p_dev_addr);
761 }
762
763
764 int wpa_supplicant_ap_wps_cancel(struct wpa_supplicant *wpa_s)
765 {
766         struct wps_registrar *reg;
767         int reg_sel = 0, wps_sta = 0;
768
769         if (!wpa_s->ap_iface || !wpa_s->ap_iface->bss[0]->wps)
770                 return -1;
771
772         reg = wpa_s->ap_iface->bss[0]->wps->registrar;
773         reg_sel = wps_registrar_wps_cancel(reg);
774         wps_sta = ap_for_each_sta(wpa_s->ap_iface->bss[0],
775                                   ap_sta_wps_cancel, NULL);
776
777         if (!reg_sel && !wps_sta) {
778                 wpa_printf(MSG_DEBUG, "No WPS operation in progress at this "
779                            "time");
780                 return -1;
781         }
782
783         /*
784          * There are 2 cases to return wps cancel as success:
785          * 1. When wps cancel was initiated but no connection has been
786          *    established with client yet.
787          * 2. Client is in the middle of exchanging WPS messages.
788          */
789
790         return 0;
791 }
792
793
794 int wpa_supplicant_ap_wps_pin(struct wpa_supplicant *wpa_s, const u8 *bssid,
795                               const char *pin, char *buf, size_t buflen,
796                               int timeout)
797 {
798         int ret, ret_len = 0;
799
800         if (!wpa_s->ap_iface)
801                 return -1;
802
803         if (pin == NULL) {
804                 unsigned int rpin = wps_generate_pin();
805                 ret_len = os_snprintf(buf, buflen, "%08d", rpin);
806                 pin = buf;
807         } else
808                 ret_len = os_snprintf(buf, buflen, "%s", pin);
809
810         ret = hostapd_wps_add_pin(wpa_s->ap_iface->bss[0], bssid, "any", pin,
811                                   timeout);
812         if (ret)
813                 return -1;
814         return ret_len;
815 }
816
817
818 static void wpas_wps_ap_pin_timeout(void *eloop_data, void *user_ctx)
819 {
820         struct wpa_supplicant *wpa_s = eloop_data;
821         wpa_printf(MSG_DEBUG, "WPS: AP PIN timed out");
822         wpas_wps_ap_pin_disable(wpa_s);
823 }
824
825
826 static void wpas_wps_ap_pin_enable(struct wpa_supplicant *wpa_s, int timeout)
827 {
828         struct hostapd_data *hapd;
829
830         if (wpa_s->ap_iface == NULL)
831                 return;
832         hapd = wpa_s->ap_iface->bss[0];
833         wpa_printf(MSG_DEBUG, "WPS: Enabling AP PIN (timeout=%d)", timeout);
834         hapd->ap_pin_failures = 0;
835         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
836         if (timeout > 0)
837                 eloop_register_timeout(timeout, 0,
838                                        wpas_wps_ap_pin_timeout, wpa_s, NULL);
839 }
840
841
842 void wpas_wps_ap_pin_disable(struct wpa_supplicant *wpa_s)
843 {
844         struct hostapd_data *hapd;
845
846         if (wpa_s->ap_iface == NULL)
847                 return;
848         wpa_printf(MSG_DEBUG, "WPS: Disabling AP PIN");
849         hapd = wpa_s->ap_iface->bss[0];
850         os_free(hapd->conf->ap_pin);
851         hapd->conf->ap_pin = NULL;
852         eloop_cancel_timeout(wpas_wps_ap_pin_timeout, wpa_s, NULL);
853 }
854
855
856 const char * wpas_wps_ap_pin_random(struct wpa_supplicant *wpa_s, int timeout)
857 {
858         struct hostapd_data *hapd;
859         unsigned int pin;
860         char pin_txt[9];
861
862         if (wpa_s->ap_iface == NULL)
863                 return NULL;
864         hapd = wpa_s->ap_iface->bss[0];
865         pin = wps_generate_pin();
866         os_snprintf(pin_txt, sizeof(pin_txt), "%08u", pin);
867         os_free(hapd->conf->ap_pin);
868         hapd->conf->ap_pin = os_strdup(pin_txt);
869         if (hapd->conf->ap_pin == NULL)
870                 return NULL;
871         wpas_wps_ap_pin_enable(wpa_s, timeout);
872
873         return hapd->conf->ap_pin;
874 }
875
876
877 const char * wpas_wps_ap_pin_get(struct wpa_supplicant *wpa_s)
878 {
879         struct hostapd_data *hapd;
880         if (wpa_s->ap_iface == NULL)
881                 return NULL;
882         hapd = wpa_s->ap_iface->bss[0];
883         return hapd->conf->ap_pin;
884 }
885
886
887 int wpas_wps_ap_pin_set(struct wpa_supplicant *wpa_s, const char *pin,
888                         int timeout)
889 {
890         struct hostapd_data *hapd;
891         char pin_txt[9];
892         int ret;
893
894         if (wpa_s->ap_iface == NULL)
895                 return -1;
896         hapd = wpa_s->ap_iface->bss[0];
897         ret = os_snprintf(pin_txt, sizeof(pin_txt), "%s", pin);
898         if (ret < 0 || ret >= (int) sizeof(pin_txt))
899                 return -1;
900         os_free(hapd->conf->ap_pin);
901         hapd->conf->ap_pin = os_strdup(pin_txt);
902         if (hapd->conf->ap_pin == NULL)
903                 return -1;
904         wpas_wps_ap_pin_enable(wpa_s, timeout);
905
906         return 0;
907 }
908
909
910 void wpa_supplicant_ap_pwd_auth_fail(struct wpa_supplicant *wpa_s)
911 {
912         struct hostapd_data *hapd;
913
914         if (wpa_s->ap_iface == NULL)
915                 return;
916         hapd = wpa_s->ap_iface->bss[0];
917
918         /*
919          * Registrar failed to prove its knowledge of the AP PIN. Disable AP
920          * PIN if this happens multiple times to slow down brute force attacks.
921          */
922         hapd->ap_pin_failures++;
923         wpa_printf(MSG_DEBUG, "WPS: AP PIN authentication failure number %u",
924                    hapd->ap_pin_failures);
925         if (hapd->ap_pin_failures < 3)
926                 return;
927
928         wpa_printf(MSG_DEBUG, "WPS: Disable AP PIN");
929         hapd->ap_pin_failures = 0;
930         os_free(hapd->conf->ap_pin);
931         hapd->conf->ap_pin = NULL;
932 }
933
934
935 #ifdef CONFIG_WPS_NFC
936
937 struct wpabuf * wpas_ap_wps_nfc_config_token(struct wpa_supplicant *wpa_s,
938                                              int ndef)
939 {
940         struct hostapd_data *hapd;
941
942         if (wpa_s->ap_iface == NULL)
943                 return NULL;
944         hapd = wpa_s->ap_iface->bss[0];
945         return hostapd_wps_nfc_config_token(hapd, ndef);
946 }
947
948
949 struct wpabuf * wpas_ap_wps_nfc_handover_sel(struct wpa_supplicant *wpa_s,
950                                              int ndef)
951 {
952         struct hostapd_data *hapd;
953
954         if (wpa_s->ap_iface == NULL)
955                 return NULL;
956         hapd = wpa_s->ap_iface->bss[0];
957         return hostapd_wps_nfc_hs_cr(hapd, ndef);
958 }
959
960
961 int wpas_ap_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
962                                     const struct wpabuf *req,
963                                     const struct wpabuf *sel)
964 {
965         struct hostapd_data *hapd;
966
967         if (wpa_s->ap_iface == NULL)
968                 return -1;
969         hapd = wpa_s->ap_iface->bss[0];
970         return hostapd_wps_nfc_report_handover(hapd, req, sel);
971 }
972
973 #endif /* CONFIG_WPS_NFC */
974
975 #endif /* CONFIG_WPS */
976
977
978 #ifdef CONFIG_CTRL_IFACE
979
980 int ap_ctrl_iface_sta_first(struct wpa_supplicant *wpa_s,
981                             char *buf, size_t buflen)
982 {
983         if (wpa_s->ap_iface == NULL)
984                 return -1;
985         return hostapd_ctrl_iface_sta_first(wpa_s->ap_iface->bss[0],
986                                             buf, buflen);
987 }
988
989
990 int ap_ctrl_iface_sta(struct wpa_supplicant *wpa_s, const char *txtaddr,
991                       char *buf, size_t buflen)
992 {
993         if (wpa_s->ap_iface == NULL)
994                 return -1;
995         return hostapd_ctrl_iface_sta(wpa_s->ap_iface->bss[0], txtaddr,
996                                       buf, buflen);
997 }
998
999
1000 int ap_ctrl_iface_sta_next(struct wpa_supplicant *wpa_s, const char *txtaddr,
1001                            char *buf, size_t buflen)
1002 {
1003         if (wpa_s->ap_iface == NULL)
1004                 return -1;
1005         return hostapd_ctrl_iface_sta_next(wpa_s->ap_iface->bss[0], txtaddr,
1006                                            buf, buflen);
1007 }
1008
1009
1010 int ap_ctrl_iface_sta_disassociate(struct wpa_supplicant *wpa_s,
1011                                    const char *txtaddr)
1012 {
1013         if (wpa_s->ap_iface == NULL)
1014                 return -1;
1015         return hostapd_ctrl_iface_disassociate(wpa_s->ap_iface->bss[0],
1016                                                txtaddr);
1017 }
1018
1019
1020 int ap_ctrl_iface_sta_deauthenticate(struct wpa_supplicant *wpa_s,
1021                                      const char *txtaddr)
1022 {
1023         if (wpa_s->ap_iface == NULL)
1024                 return -1;
1025         return hostapd_ctrl_iface_deauthenticate(wpa_s->ap_iface->bss[0],
1026                                                  txtaddr);
1027 }
1028
1029
1030 int ap_ctrl_iface_wpa_get_status(struct wpa_supplicant *wpa_s, char *buf,
1031                                  size_t buflen, int verbose)
1032 {
1033         char *pos = buf, *end = buf + buflen;
1034         int ret;
1035         struct hostapd_bss_config *conf;
1036
1037         if (wpa_s->ap_iface == NULL)
1038                 return -1;
1039
1040         conf = wpa_s->ap_iface->bss[0]->conf;
1041         if (conf->wpa == 0)
1042                 return 0;
1043
1044         ret = os_snprintf(pos, end - pos,
1045                           "pairwise_cipher=%s\n"
1046                           "group_cipher=%s\n"
1047                           "key_mgmt=%s\n",
1048                           wpa_cipher_txt(conf->rsn_pairwise),
1049                           wpa_cipher_txt(conf->wpa_group),
1050                           wpa_key_mgmt_txt(conf->wpa_key_mgmt,
1051                                            conf->wpa));
1052         if (ret < 0 || ret >= end - pos)
1053                 return pos - buf;
1054         pos += ret;
1055         return pos - buf;
1056 }
1057
1058 #endif /* CONFIG_CTRL_IFACE */
1059
1060
1061 int wpa_supplicant_ap_update_beacon(struct wpa_supplicant *wpa_s)
1062 {
1063         struct hostapd_iface *iface = wpa_s->ap_iface;
1064         struct wpa_ssid *ssid = wpa_s->current_ssid;
1065         struct hostapd_data *hapd;
1066
1067         if (ssid == NULL || wpa_s->ap_iface == NULL ||
1068             ssid->mode == WPAS_MODE_INFRA ||
1069             ssid->mode == WPAS_MODE_IBSS)
1070                 return -1;
1071
1072 #ifdef CONFIG_P2P
1073         if (ssid->mode == WPAS_MODE_P2P_GO)
1074                 iface->conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER;
1075         else if (ssid->mode == WPAS_MODE_P2P_GROUP_FORMATION)
1076                 iface->conf->bss[0]->p2p = P2P_ENABLED | P2P_GROUP_OWNER |
1077                         P2P_GROUP_FORMATION;
1078 #endif /* CONFIG_P2P */
1079
1080         hapd = iface->bss[0];
1081         if (hapd->drv_priv == NULL)
1082                 return -1;
1083         ieee802_11_set_beacons(iface);
1084         hostapd_set_ap_wps_ie(hapd);
1085
1086         return 0;
1087 }
1088
1089
1090 int ap_switch_channel(struct wpa_supplicant *wpa_s,
1091                       struct csa_settings *settings)
1092 {
1093 #ifdef NEED_AP_MLME
1094         if (!wpa_s->ap_iface || !wpa_s->ap_iface->bss[0])
1095                 return -1;
1096
1097         return hostapd_switch_channel(wpa_s->ap_iface->bss[0], settings);
1098 #else /* NEED_AP_MLME */
1099         return -1;
1100 #endif /* NEED_AP_MLME */
1101 }
1102
1103
1104 int ap_ctrl_iface_chanswitch(struct wpa_supplicant *wpa_s, const char *pos)
1105 {
1106         struct csa_settings settings;
1107         int ret = hostapd_parse_csa_settings(pos, &settings);
1108
1109         if (ret)
1110                 return ret;
1111
1112         return ap_switch_channel(wpa_s, &settings);
1113 }
1114
1115
1116 void wpas_ap_ch_switch(struct wpa_supplicant *wpa_s, int freq, int ht,
1117                        int offset, int width, int cf1, int cf2)
1118 {
1119         if (!wpa_s->ap_iface)
1120                 return;
1121
1122         wpa_s->assoc_freq = freq;
1123         hostapd_event_ch_switch(wpa_s->ap_iface->bss[0], freq, ht, offset, width, cf1, cf1);
1124 }
1125
1126
1127 int wpa_supplicant_ap_mac_addr_filter(struct wpa_supplicant *wpa_s,
1128                                       const u8 *addr)
1129 {
1130         struct hostapd_data *hapd;
1131         struct hostapd_bss_config *conf;
1132
1133         if (!wpa_s->ap_iface)
1134                 return -1;
1135
1136         if (addr)
1137                 wpa_printf(MSG_DEBUG, "AP: Set MAC address filter: " MACSTR,
1138                            MAC2STR(addr));
1139         else
1140                 wpa_printf(MSG_DEBUG, "AP: Clear MAC address filter");
1141
1142         hapd = wpa_s->ap_iface->bss[0];
1143         conf = hapd->conf;
1144
1145         os_free(conf->accept_mac);
1146         conf->accept_mac = NULL;
1147         conf->num_accept_mac = 0;
1148         os_free(conf->deny_mac);
1149         conf->deny_mac = NULL;
1150         conf->num_deny_mac = 0;
1151
1152         if (addr == NULL) {
1153                 conf->macaddr_acl = ACCEPT_UNLESS_DENIED;
1154                 return 0;
1155         }
1156
1157         conf->macaddr_acl = DENY_UNLESS_ACCEPTED;
1158         conf->accept_mac = os_zalloc(sizeof(struct mac_acl_entry));
1159         if (conf->accept_mac == NULL)
1160                 return -1;
1161         os_memcpy(conf->accept_mac[0].addr, addr, ETH_ALEN);
1162         conf->num_accept_mac = 1;
1163
1164         return 0;
1165 }
1166
1167
1168 #ifdef CONFIG_WPS_NFC
1169 int wpas_ap_wps_add_nfc_pw(struct wpa_supplicant *wpa_s, u16 pw_id,
1170                            const struct wpabuf *pw, const u8 *pubkey_hash)
1171 {
1172         struct hostapd_data *hapd;
1173         struct wps_context *wps;
1174
1175         if (!wpa_s->ap_iface)
1176                 return -1;
1177         hapd = wpa_s->ap_iface->bss[0];
1178         wps = hapd->wps;
1179
1180         if (wpa_s->parent->conf->wps_nfc_dh_pubkey == NULL ||
1181             wpa_s->parent->conf->wps_nfc_dh_privkey == NULL) {
1182                 wpa_printf(MSG_DEBUG, "P2P: No NFC DH key known");
1183                 return -1;
1184         }
1185
1186         dh5_free(wps->dh_ctx);
1187         wpabuf_free(wps->dh_pubkey);
1188         wpabuf_free(wps->dh_privkey);
1189         wps->dh_privkey = wpabuf_dup(
1190                 wpa_s->parent->conf->wps_nfc_dh_privkey);
1191         wps->dh_pubkey = wpabuf_dup(
1192                 wpa_s->parent->conf->wps_nfc_dh_pubkey);
1193         if (wps->dh_privkey == NULL || wps->dh_pubkey == NULL) {
1194                 wps->dh_ctx = NULL;
1195                 wpabuf_free(wps->dh_pubkey);
1196                 wps->dh_pubkey = NULL;
1197                 wpabuf_free(wps->dh_privkey);
1198                 wps->dh_privkey = NULL;
1199                 return -1;
1200         }
1201         wps->dh_ctx = dh5_init_fixed(wps->dh_privkey, wps->dh_pubkey);
1202         if (wps->dh_ctx == NULL)
1203                 return -1;
1204
1205         return wps_registrar_add_nfc_pw_token(hapd->wps->registrar, pubkey_hash,
1206                                               pw_id,
1207                                               pw ? wpabuf_head(pw) : NULL,
1208                                               pw ? wpabuf_len(pw) : 0, 1);
1209 }
1210 #endif /* CONFIG_WPS_NFC */