3 * Copyright (c) 2009-2010, Atheros Communications
4 * Copyright (c) 2010-2014, Jouni Malinen <j@w1.fi>
6 * This software may be distributed under the terms of the BSD license.
7 * See README for more details.
14 #include "common/ieee802_11_common.h"
15 #include "common/ieee802_11_defs.h"
16 #include "common/wpa_ctrl.h"
17 #include "wps/wps_i.h"
19 #include "ap/hostapd.h"
20 #include "ap/ap_config.h"
21 #include "ap/sta_info.h"
22 #include "ap/ap_drv_ops.h"
23 #include "ap/p2p_hostapd.h"
24 #include "eapol_supp/eapol_supp_sm.h"
25 #include "rsn_supp/wpa.h"
26 #include "wpa_supplicant_i.h"
29 #include "config_ssid.h"
34 #include "offchannel.h"
35 #include "wps_supplicant.h"
36 #include "p2p_supplicant.h"
37 #include "wifi_display.h"
41 * How many times to try to scan to find the GO before giving up on join
44 #define P2P_MAX_JOIN_SCAN_ATTEMPTS 10
46 #define P2P_AUTO_PD_SCAN_ATTEMPTS 5
48 #ifndef P2P_MAX_CLIENT_IDLE
50 * How many seconds to try to reconnect to the GO when connection in P2P client
53 #define P2P_MAX_CLIENT_IDLE 10
54 #endif /* P2P_MAX_CLIENT_IDLE */
56 #ifndef P2P_MAX_INITIAL_CONN_WAIT
58 * How many seconds to wait for initial 4-way handshake to get completed after
59 * WPS provisioning step.
61 #define P2P_MAX_INITIAL_CONN_WAIT 10
62 #endif /* P2P_MAX_INITIAL_CONN_WAIT */
64 #ifndef P2P_MAX_INITIAL_CONN_WAIT_GO
66 * How many seconds to wait for initial 4-way handshake to get completed after
67 * WPS provisioning step on the GO. This controls the extra time the P2P
68 * operation is considered to be in progress (e.g., to delay other scans) after
69 * WPS provisioning has been completed on the GO during group formation.
71 #define P2P_MAX_INITIAL_CONN_WAIT_GO 10
72 #endif /* P2P_MAX_INITIAL_CONN_WAIT_GO */
74 #ifndef P2P_MAX_INITIAL_CONN_WAIT_GO_REINVOKE
76 * How many seconds to wait for initial 4-way handshake to get completed after
77 * re-invocation of a persistent group on the GO when the client is expected
78 * to connect automatically (no user interaction).
80 #define P2P_MAX_INITIAL_CONN_WAIT_GO_REINVOKE 15
81 #endif /* P2P_MAX_INITIAL_CONN_WAIT_GO_REINVOKE */
83 #ifndef P2P_CONCURRENT_SEARCH_DELAY
84 #define P2P_CONCURRENT_SEARCH_DELAY 500
85 #endif /* P2P_CONCURRENT_SEARCH_DELAY */
87 #define P2P_MGMT_DEVICE_PREFIX "p2p-dev-"
89 enum p2p_group_removal_reason
{
90 P2P_GROUP_REMOVAL_UNKNOWN
,
91 P2P_GROUP_REMOVAL_SILENT
,
92 P2P_GROUP_REMOVAL_FORMATION_FAILED
,
93 P2P_GROUP_REMOVAL_REQUESTED
,
94 P2P_GROUP_REMOVAL_IDLE_TIMEOUT
,
95 P2P_GROUP_REMOVAL_UNAVAILABLE
,
96 P2P_GROUP_REMOVAL_GO_ENDING_SESSION
,
97 P2P_GROUP_REMOVAL_PSK_FAILURE
,
98 P2P_GROUP_REMOVAL_FREQ_CONFLICT
102 static void wpas_p2p_long_listen_timeout(void *eloop_ctx
, void *timeout_ctx
);
103 static struct wpa_supplicant
*
104 wpas_p2p_get_group_iface(struct wpa_supplicant
*wpa_s
, int addr_allocated
,
106 static int wpas_p2p_join_start(struct wpa_supplicant
*wpa_s
);
107 static void wpas_p2p_join_scan_req(struct wpa_supplicant
*wpa_s
, int freq
,
108 const u8
*ssid
, size_t ssid_len
);
109 static void wpas_p2p_join_scan(void *eloop_ctx
, void *timeout_ctx
);
110 static int wpas_p2p_join(struct wpa_supplicant
*wpa_s
, const u8
*iface_addr
,
111 const u8
*dev_addr
, enum p2p_wps_method wps_method
,
112 int auto_join
, const u8
*ssid
, size_t ssid_len
);
113 static int wpas_p2p_create_iface(struct wpa_supplicant
*wpa_s
);
114 static void wpas_p2p_cross_connect_setup(struct wpa_supplicant
*wpa_s
);
115 static void wpas_p2p_group_idle_timeout(void *eloop_ctx
, void *timeout_ctx
);
116 static void wpas_p2p_set_group_idle_timeout(struct wpa_supplicant
*wpa_s
);
117 static void wpas_p2p_group_formation_timeout(void *eloop_ctx
,
119 static void wpas_p2p_group_freq_conflict(void *eloop_ctx
, void *timeout_ctx
);
120 static void wpas_p2p_fallback_to_go_neg(struct wpa_supplicant
*wpa_s
,
122 static int wpas_p2p_stop_find_oper(struct wpa_supplicant
*wpa_s
);
126 * Get the number of concurrent channels that the HW can operate, but that are
127 * currently not in use by any of the wpa_supplicant interfaces.
129 static int wpas_p2p_num_unused_channels(struct wpa_supplicant
*wpa_s
)
134 freqs
= os_calloc(wpa_s
->num_multichan_concurrent
, sizeof(int));
138 num
= get_shared_radio_freqs(wpa_s
, freqs
,
139 wpa_s
->num_multichan_concurrent
);
142 unused
= wpa_s
->num_multichan_concurrent
- num
;
143 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: num_unused_channels: %d", unused
);
149 * Get the frequencies that are currently in use by one or more of the virtual
150 * interfaces, and that are also valid for P2P operation.
152 static int wpas_p2p_valid_oper_freqs(struct wpa_supplicant
*wpa_s
,
153 int *p2p_freqs
, unsigned int len
)
156 unsigned int num
, i
, j
;
158 freqs
= os_calloc(wpa_s
->num_multichan_concurrent
, sizeof(int));
162 num
= get_shared_radio_freqs(wpa_s
, freqs
,
163 wpa_s
->num_multichan_concurrent
);
165 os_memset(p2p_freqs
, 0, sizeof(int) * len
);
167 for (i
= 0, j
= 0; i
< num
&& j
< len
; i
++) {
168 if (p2p_supported_freq(wpa_s
->global
->p2p
, freqs
[i
]))
169 p2p_freqs
[j
++] = freqs
[i
];
174 dump_freq_array(wpa_s
, "valid for P2P", p2p_freqs
, j
);
180 static void wpas_p2p_set_own_freq_preference(struct wpa_supplicant
*wpa_s
,
183 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
185 if (wpa_s
->parent
->conf
->p2p_ignore_shared_freq
&&
186 freq
> 0 && wpa_s
->num_multichan_concurrent
> 1 &&
187 wpas_p2p_num_unused_channels(wpa_s
) > 0) {
188 wpa_printf(MSG_DEBUG
, "P2P: Ignore own channel preference %d MHz due to p2p_ignore_shared_freq=1 configuration",
192 p2p_set_own_freq_preference(wpa_s
->global
->p2p
, freq
);
196 static void wpas_p2p_scan_res_handler(struct wpa_supplicant
*wpa_s
,
197 struct wpa_scan_results
*scan_res
)
201 if (wpa_s
->p2p_scan_work
) {
202 struct wpa_radio_work
*work
= wpa_s
->p2p_scan_work
;
203 wpa_s
->p2p_scan_work
= NULL
;
204 radio_work_done(work
);
207 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
210 wpa_printf(MSG_DEBUG
, "P2P: Scan results received (%d BSS)",
211 (int) scan_res
->num
);
213 for (i
= 0; i
< scan_res
->num
; i
++) {
214 struct wpa_scan_res
*bss
= scan_res
->res
[i
];
215 struct os_reltime time_tmp_age
, entry_ts
;
219 time_tmp_age
.sec
= bss
->age
/ 1000;
220 time_tmp_age
.usec
= (bss
->age
% 1000) * 1000;
221 os_reltime_sub(&scan_res
->fetch_time
, &time_tmp_age
, &entry_ts
);
223 ies
= (const u8
*) (bss
+ 1);
224 ies_len
= bss
->ie_len
;
225 if (bss
->beacon_ie_len
> 0 &&
226 !wpa_scan_get_vendor_ie(bss
, P2P_IE_VENDOR_TYPE
) &&
227 wpa_scan_get_vendor_ie_beacon(bss
, P2P_IE_VENDOR_TYPE
)) {
228 wpa_printf(MSG_DEBUG
, "P2P: Use P2P IE(s) from Beacon frame since no P2P IE(s) in Probe Response frames received for "
229 MACSTR
, MAC2STR(bss
->bssid
));
231 ies_len
= bss
->beacon_ie_len
;
235 if (p2p_scan_res_handler(wpa_s
->global
->p2p
, bss
->bssid
,
236 bss
->freq
, &entry_ts
, bss
->level
,
241 p2p_scan_res_handled(wpa_s
->global
->p2p
);
245 static void wpas_p2p_trigger_scan_cb(struct wpa_radio_work
*work
, int deinit
)
247 struct wpa_supplicant
*wpa_s
= work
->wpa_s
;
248 struct wpa_driver_scan_params
*params
= work
->ctx
;
252 wpa_scan_free_params(params
);
256 ret
= wpa_drv_scan(wpa_s
, params
);
257 wpa_scan_free_params(params
);
260 radio_work_done(work
);
264 os_get_reltime(&wpa_s
->scan_trigger_time
);
265 wpa_s
->scan_res_handler
= wpas_p2p_scan_res_handler
;
266 wpa_s
->own_scan_requested
= 1;
267 wpa_s
->p2p_scan_work
= work
;
271 static int wpas_p2p_scan(void *ctx
, enum p2p_scan_type type
, int freq
,
272 unsigned int num_req_dev_types
,
273 const u8
*req_dev_types
, const u8
*dev_id
, u16 pw_id
)
275 struct wpa_supplicant
*wpa_s
= ctx
;
276 struct wpa_driver_scan_params
*params
= NULL
;
277 struct wpabuf
*wps_ie
, *ies
;
281 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
284 if (wpa_s
->p2p_scan_work
) {
285 wpa_dbg(wpa_s
, MSG_INFO
, "P2P: Reject scan trigger since one is already pending");
289 params
= os_zalloc(sizeof(*params
));
293 /* P2P Wildcard SSID */
294 params
->num_ssids
= 1;
295 n
= os_malloc(P2P_WILDCARD_SSID_LEN
);
298 os_memcpy(n
, P2P_WILDCARD_SSID
, P2P_WILDCARD_SSID_LEN
);
299 params
->ssids
[0].ssid
= n
;
300 params
->ssids
[0].ssid_len
= P2P_WILDCARD_SSID_LEN
;
302 wpa_s
->wps
->dev
.p2p
= 1;
303 wps_ie
= wps_build_probe_req_ie(pw_id
, &wpa_s
->wps
->dev
,
304 wpa_s
->wps
->uuid
, WPS_REQ_ENROLLEE
,
305 num_req_dev_types
, req_dev_types
);
309 ielen
= p2p_scan_ie_buf_len(wpa_s
->global
->p2p
);
310 ies
= wpabuf_alloc(wpabuf_len(wps_ie
) + ielen
);
315 wpabuf_put_buf(ies
, wps_ie
);
318 p2p_scan_ie(wpa_s
->global
->p2p
, ies
, dev_id
);
320 params
->p2p_probe
= 1;
321 n
= os_malloc(wpabuf_len(ies
));
326 os_memcpy(n
, wpabuf_head(ies
), wpabuf_len(ies
));
327 params
->extra_ies
= n
;
328 params
->extra_ies_len
= wpabuf_len(ies
);
332 case P2P_SCAN_SOCIAL
:
333 params
->freqs
= os_malloc(4 * sizeof(int));
334 if (params
->freqs
== NULL
)
336 params
->freqs
[0] = 2412;
337 params
->freqs
[1] = 2437;
338 params
->freqs
[2] = 2462;
339 params
->freqs
[3] = 0;
343 case P2P_SCAN_SOCIAL_PLUS_ONE
:
344 params
->freqs
= os_malloc(5 * sizeof(int));
345 if (params
->freqs
== NULL
)
347 params
->freqs
[0] = 2412;
348 params
->freqs
[1] = 2437;
349 params
->freqs
[2] = 2462;
350 params
->freqs
[3] = freq
;
351 params
->freqs
[4] = 0;
355 radio_remove_unstarted_work(wpa_s
, "p2p-scan");
356 if (radio_add_work(wpa_s
, 0, "p2p-scan", 0, wpas_p2p_trigger_scan_cb
,
362 wpa_scan_free_params(params
);
367 static enum wpa_driver_if_type
wpas_p2p_if_type(int p2p_group_interface
)
369 switch (p2p_group_interface
) {
370 case P2P_GROUP_INTERFACE_PENDING
:
371 return WPA_IF_P2P_GROUP
;
372 case P2P_GROUP_INTERFACE_GO
:
373 return WPA_IF_P2P_GO
;
374 case P2P_GROUP_INTERFACE_CLIENT
:
375 return WPA_IF_P2P_CLIENT
;
378 return WPA_IF_P2P_GROUP
;
382 static struct wpa_supplicant
* wpas_get_p2p_group(struct wpa_supplicant
*wpa_s
,
384 size_t ssid_len
, int *go
)
388 for (wpa_s
= wpa_s
->global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
389 for (s
= wpa_s
->conf
->ssid
; s
; s
= s
->next
) {
390 if (s
->disabled
!= 0 || !s
->p2p_group
||
391 s
->ssid_len
!= ssid_len
||
392 os_memcmp(ssid
, s
->ssid
, ssid_len
) != 0)
394 if (s
->mode
== WPAS_MODE_P2P_GO
&&
395 s
!= wpa_s
->current_ssid
)
398 *go
= s
->mode
== WPAS_MODE_P2P_GO
;
407 static int wpas_p2p_group_delete(struct wpa_supplicant
*wpa_s
,
408 enum p2p_group_removal_reason removal_reason
)
410 struct wpa_ssid
*ssid
;
414 ssid
= wpa_s
->current_ssid
;
417 * The current SSID was not known, but there may still be a
418 * pending P2P group interface waiting for provisioning or a
419 * P2P group that is trying to reconnect.
421 ssid
= wpa_s
->conf
->ssid
;
423 if (ssid
->p2p_group
&& ssid
->disabled
!= 2)
428 wpa_s
->p2p_group_interface
== NOT_P2P_GROUP_INTERFACE
)
430 wpa_printf(MSG_ERROR
, "P2P: P2P group interface "
435 if (wpa_s
->p2p_group_interface
== P2P_GROUP_INTERFACE_GO
)
437 else if (wpa_s
->p2p_group_interface
== P2P_GROUP_INTERFACE_CLIENT
||
438 (ssid
&& ssid
->mode
== WPAS_MODE_INFRA
)) {
439 wpa_s
->reassociate
= 0;
440 wpa_s
->disconnected
= 1;
441 wpa_supplicant_deauthenticate(wpa_s
,
442 WLAN_REASON_DEAUTH_LEAVING
);
446 if (wpa_s
->cross_connect_in_use
) {
447 wpa_s
->cross_connect_in_use
= 0;
448 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
449 P2P_EVENT_CROSS_CONNECT_DISABLE
"%s %s",
450 wpa_s
->ifname
, wpa_s
->cross_connect_uplink
);
452 switch (removal_reason
) {
453 case P2P_GROUP_REMOVAL_REQUESTED
:
454 reason
= " reason=REQUESTED";
456 case P2P_GROUP_REMOVAL_FORMATION_FAILED
:
457 reason
= " reason=FORMATION_FAILED";
459 case P2P_GROUP_REMOVAL_IDLE_TIMEOUT
:
460 reason
= " reason=IDLE";
462 case P2P_GROUP_REMOVAL_UNAVAILABLE
:
463 reason
= " reason=UNAVAILABLE";
465 case P2P_GROUP_REMOVAL_GO_ENDING_SESSION
:
466 reason
= " reason=GO_ENDING_SESSION";
468 case P2P_GROUP_REMOVAL_PSK_FAILURE
:
469 reason
= " reason=PSK_FAILURE";
471 case P2P_GROUP_REMOVAL_FREQ_CONFLICT
:
472 reason
= " reason=FREQ_CONFLICT";
478 if (removal_reason
!= P2P_GROUP_REMOVAL_SILENT
) {
479 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
480 P2P_EVENT_GROUP_REMOVED
"%s %s%s",
481 wpa_s
->ifname
, gtype
, reason
);
484 if (eloop_cancel_timeout(wpas_p2p_group_freq_conflict
, wpa_s
, NULL
) > 0)
485 wpa_printf(MSG_DEBUG
, "P2P: Cancelled P2P group freq_conflict timeout");
486 if (eloop_cancel_timeout(wpas_p2p_group_idle_timeout
, wpa_s
, NULL
) > 0)
487 wpa_printf(MSG_DEBUG
, "P2P: Cancelled P2P group idle timeout");
488 if (eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
489 wpa_s
->parent
, NULL
) > 0) {
490 wpa_printf(MSG_DEBUG
, "P2P: Cancelled P2P group formation "
492 wpa_s
->p2p_in_provisioning
= 0;
496 * Make sure wait for the first client does not remain active after the
497 * group has been removed.
499 wpa_s
->global
->p2p_go_wait_client
.sec
= 0;
501 if (removal_reason
!= P2P_GROUP_REMOVAL_SILENT
&& ssid
)
502 wpas_notify_p2p_group_removed(wpa_s
, ssid
, gtype
);
504 if (wpa_s
->p2p_group_interface
!= NOT_P2P_GROUP_INTERFACE
) {
505 struct wpa_global
*global
;
507 enum wpa_driver_if_type type
;
508 wpa_printf(MSG_DEBUG
, "P2P: Remove group interface %s",
510 global
= wpa_s
->global
;
511 ifname
= os_strdup(wpa_s
->ifname
);
512 type
= wpas_p2p_if_type(wpa_s
->p2p_group_interface
);
513 wpa_supplicant_remove_iface(wpa_s
->global
, wpa_s
, 0);
514 wpa_s
= global
->ifaces
;
516 wpa_drv_if_remove(wpa_s
, type
, ifname
);
521 if (!wpa_s
->p2p_go_group_formation_completed
) {
522 wpa_s
->global
->p2p_group_formation
= NULL
;
523 wpa_s
->p2p_in_provisioning
= 0;
526 wpa_s
->show_group_started
= 0;
527 os_free(wpa_s
->go_params
);
528 wpa_s
->go_params
= NULL
;
530 wpa_s
->waiting_presence_resp
= 0;
532 wpa_printf(MSG_DEBUG
, "P2P: Remove temporary group network");
533 if (ssid
&& (ssid
->p2p_group
||
534 ssid
->mode
== WPAS_MODE_P2P_GROUP_FORMATION
||
535 (ssid
->key_mgmt
& WPA_KEY_MGMT_WPS
))) {
537 if (ssid
== wpa_s
->current_ssid
) {
538 wpa_sm_set_config(wpa_s
->wpa
, NULL
);
539 eapol_sm_notify_config(wpa_s
->eapol
, NULL
, NULL
);
540 wpa_s
->current_ssid
= NULL
;
543 * Networks objects created during any P2P activities are not
544 * exposed out as they might/will confuse certain non-P2P aware
545 * applications since these network objects won't behave like
548 * Likewise, we don't send out network removed signals for such
551 wpa_config_remove_network(wpa_s
->conf
, id
);
552 wpa_supplicant_clear_status(wpa_s
);
553 wpa_supplicant_cancel_sched_scan(wpa_s
);
555 wpa_printf(MSG_DEBUG
, "P2P: Temporary group network not "
559 wpa_supplicant_ap_deinit(wpa_s
);
561 wpa_drv_deinit_p2p_cli(wpa_s
);
567 static int wpas_p2p_persistent_group(struct wpa_supplicant
*wpa_s
,
569 const u8
*ssid
, size_t ssid_len
)
577 if (wpa_s
->go_params
)
578 bssid
= wpa_s
->go_params
->peer_interface_addr
;
580 bssid
= wpa_s
->bssid
;
582 bss
= wpa_bss_get(wpa_s
, bssid
, ssid
, ssid_len
);
584 u8 iface_addr
[ETH_ALEN
];
585 if (p2p_get_interface_addr(wpa_s
->global
->p2p
, bssid
,
587 bss
= wpa_bss_get(wpa_s
, iface_addr
, ssid
, ssid_len
);
590 wpa_printf(MSG_DEBUG
, "P2P: Could not figure out whether "
591 "group is persistent - BSS " MACSTR
" not found",
596 p2p
= wpa_bss_get_vendor_ie_multi(bss
, P2P_IE_VENDOR_TYPE
);
598 p2p
= wpa_bss_get_vendor_ie_multi_beacon(bss
,
601 wpa_printf(MSG_DEBUG
, "P2P: Could not figure out whether "
602 "group is persistent - BSS " MACSTR
603 " did not include P2P IE", MAC2STR(bssid
));
604 wpa_hexdump(MSG_DEBUG
, "P2P: Probe Response IEs",
605 (u8
*) (bss
+ 1), bss
->ie_len
);
606 wpa_hexdump(MSG_DEBUG
, "P2P: Beacon IEs",
607 ((u8
*) bss
+ 1) + bss
->ie_len
,
612 group_capab
= p2p_get_group_capab(p2p
);
613 addr
= p2p_get_go_dev_addr(p2p
);
614 wpa_printf(MSG_DEBUG
, "P2P: Checking whether group is persistent: "
615 "group_capab=0x%x", group_capab
);
617 os_memcpy(go_dev_addr
, addr
, ETH_ALEN
);
618 wpa_printf(MSG_DEBUG
, "P2P: GO Device Address " MACSTR
,
621 os_memset(go_dev_addr
, 0, ETH_ALEN
);
624 wpa_printf(MSG_DEBUG
, "P2P: BSS " MACSTR
" group_capab=0x%x "
625 "go_dev_addr=" MACSTR
,
626 MAC2STR(bssid
), group_capab
, MAC2STR(go_dev_addr
));
628 return group_capab
& P2P_GROUP_CAPAB_PERSISTENT_GROUP
;
632 static int wpas_p2p_store_persistent_group(struct wpa_supplicant
*wpa_s
,
633 struct wpa_ssid
*ssid
,
634 const u8
*go_dev_addr
)
639 wpa_printf(MSG_DEBUG
, "P2P: Storing credentials for a persistent "
640 "group (GO Dev Addr " MACSTR
")", MAC2STR(go_dev_addr
));
641 for (s
= wpa_s
->conf
->ssid
; s
; s
= s
->next
) {
642 if (s
->disabled
== 2 &&
643 os_memcmp(go_dev_addr
, s
->bssid
, ETH_ALEN
) == 0 &&
644 s
->ssid_len
== ssid
->ssid_len
&&
645 os_memcmp(ssid
->ssid
, s
->ssid
, ssid
->ssid_len
) == 0)
650 wpa_printf(MSG_DEBUG
, "P2P: Update existing persistent group "
652 if (ssid
->passphrase
&& !s
->passphrase
)
654 else if (ssid
->passphrase
&& s
->passphrase
&&
655 os_strcmp(ssid
->passphrase
, s
->passphrase
) != 0)
658 wpa_printf(MSG_DEBUG
, "P2P: Create a new persistent group "
661 s
= wpa_config_add_network(wpa_s
->conf
);
666 * Instead of network_added we emit persistent_group_added
667 * notification. Also to keep the defense checks in
668 * persistent_group obj registration method, we set the
669 * relevant flags in s to designate it as a persistent group.
672 s
->p2p_persistent_group
= 1;
673 wpas_notify_persistent_group_added(wpa_s
, s
);
674 wpa_config_set_network_defaults(s
);
678 s
->p2p_persistent_group
= 1;
681 os_memcpy(s
->bssid
, go_dev_addr
, ETH_ALEN
);
682 s
->mode
= ssid
->mode
;
683 s
->auth_alg
= WPA_AUTH_ALG_OPEN
;
684 s
->key_mgmt
= WPA_KEY_MGMT_PSK
;
685 s
->proto
= WPA_PROTO_RSN
;
686 s
->pairwise_cipher
= WPA_CIPHER_CCMP
;
688 if (ssid
->passphrase
) {
689 os_free(s
->passphrase
);
690 s
->passphrase
= os_strdup(ssid
->passphrase
);
694 os_memcpy(s
->psk
, ssid
->psk
, 32);
696 if (s
->passphrase
&& !s
->psk_set
)
697 wpa_config_update_psk(s
);
698 if (s
->ssid
== NULL
|| s
->ssid_len
< ssid
->ssid_len
) {
700 s
->ssid
= os_malloc(ssid
->ssid_len
);
703 s
->ssid_len
= ssid
->ssid_len
;
704 os_memcpy(s
->ssid
, ssid
->ssid
, s
->ssid_len
);
706 if (ssid
->mode
== WPAS_MODE_P2P_GO
&& wpa_s
->global
->add_psk
) {
707 dl_list_add(&s
->psk_list
, &wpa_s
->global
->add_psk
->list
);
708 wpa_s
->global
->add_psk
= NULL
;
712 #ifndef CONFIG_NO_CONFIG_WRITE
713 if (changed
&& wpa_s
->conf
->update_config
&&
714 wpa_config_write(wpa_s
->confname
, wpa_s
->conf
)) {
715 wpa_printf(MSG_DEBUG
, "P2P: Failed to update configuration");
717 #endif /* CONFIG_NO_CONFIG_WRITE */
723 static void wpas_p2p_add_persistent_group_client(struct wpa_supplicant
*wpa_s
,
726 struct wpa_ssid
*ssid
, *s
;
731 ssid
= wpa_s
->current_ssid
;
732 if (ssid
== NULL
|| ssid
->mode
!= WPAS_MODE_P2P_GO
||
733 !ssid
->p2p_persistent_group
)
736 for (s
= wpa_s
->parent
->conf
->ssid
; s
; s
= s
->next
) {
737 if (s
->disabled
!= 2 || s
->mode
!= WPAS_MODE_P2P_GO
)
740 if (s
->ssid_len
== ssid
->ssid_len
&&
741 os_memcmp(s
->ssid
, ssid
->ssid
, s
->ssid_len
) == 0)
748 for (i
= 0; s
->p2p_client_list
&& i
< s
->num_p2p_clients
; i
++) {
749 if (os_memcmp(s
->p2p_client_list
+ i
* ETH_ALEN
, addr
,
753 if (i
== s
->num_p2p_clients
- 1)
754 return; /* already the most recent entry */
756 /* move the entry to mark it most recent */
757 os_memmove(s
->p2p_client_list
+ i
* ETH_ALEN
,
758 s
->p2p_client_list
+ (i
+ 1) * ETH_ALEN
,
759 (s
->num_p2p_clients
- i
- 1) * ETH_ALEN
);
760 os_memcpy(s
->p2p_client_list
+
761 (s
->num_p2p_clients
- 1) * ETH_ALEN
, addr
, ETH_ALEN
);
766 if (!found
&& s
->num_p2p_clients
< P2P_MAX_STORED_CLIENTS
) {
767 n
= os_realloc_array(s
->p2p_client_list
,
768 s
->num_p2p_clients
+ 1, ETH_ALEN
);
771 os_memcpy(n
+ s
->num_p2p_clients
* ETH_ALEN
, addr
, ETH_ALEN
);
772 s
->p2p_client_list
= n
;
773 s
->num_p2p_clients
++;
775 /* Not enough room for an additional entry - drop the oldest
777 os_memmove(s
->p2p_client_list
,
778 s
->p2p_client_list
+ ETH_ALEN
,
779 (s
->num_p2p_clients
- 1) * ETH_ALEN
);
780 os_memcpy(s
->p2p_client_list
+
781 (s
->num_p2p_clients
- 1) * ETH_ALEN
,
785 #ifndef CONFIG_NO_CONFIG_WRITE
786 if (wpa_s
->parent
->conf
->update_config
&&
787 wpa_config_write(wpa_s
->parent
->confname
, wpa_s
->parent
->conf
))
788 wpa_printf(MSG_DEBUG
, "P2P: Failed to update configuration");
789 #endif /* CONFIG_NO_CONFIG_WRITE */
793 static void wpas_group_formation_completed(struct wpa_supplicant
*wpa_s
,
796 struct wpa_ssid
*ssid
;
797 const char *ssid_txt
;
800 u8 go_dev_addr
[ETH_ALEN
];
804 * This callback is likely called for the main interface. Update wpa_s
805 * to use the group interface if a new interface was created for the
808 if (wpa_s
->global
->p2p_group_formation
)
809 wpa_s
= wpa_s
->global
->p2p_group_formation
;
810 if (wpa_s
->p2p_go_group_formation_completed
) {
811 wpa_s
->global
->p2p_group_formation
= NULL
;
812 wpa_s
->p2p_in_provisioning
= 0;
816 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
817 P2P_EVENT_GROUP_FORMATION_FAILURE
);
818 wpas_p2p_group_delete(wpa_s
,
819 P2P_GROUP_REMOVAL_FORMATION_FAILED
);
823 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
824 P2P_EVENT_GROUP_FORMATION_SUCCESS
);
826 ssid
= wpa_s
->current_ssid
;
827 if (ssid
&& ssid
->mode
== WPAS_MODE_P2P_GROUP_FORMATION
) {
828 ssid
->mode
= WPAS_MODE_P2P_GO
;
829 p2p_group_notif_formation_done(wpa_s
->p2p_group
);
830 wpa_supplicant_ap_mac_addr_filter(wpa_s
, NULL
);
835 ssid_txt
= wpa_ssid_txt(ssid
->ssid
, ssid
->ssid_len
);
836 client
= ssid
->mode
== WPAS_MODE_INFRA
;
837 if (ssid
->mode
== WPAS_MODE_P2P_GO
) {
838 persistent
= ssid
->p2p_persistent_group
;
839 os_memcpy(go_dev_addr
, wpa_s
->global
->p2p_dev_addr
,
842 persistent
= wpas_p2p_persistent_group(wpa_s
,
848 client
= wpa_s
->p2p_group_interface
==
849 P2P_GROUP_INTERFACE_CLIENT
;
850 os_memset(go_dev_addr
, 0, ETH_ALEN
);
853 wpa_s
->show_group_started
= 0;
856 * Indicate event only after successfully completed 4-way
857 * handshake, i.e., when the interface is ready for data
860 wpa_s
->show_group_started
= 1;
861 } else if (ssid
&& ssid
->passphrase
== NULL
&& ssid
->psk_set
) {
863 wpa_snprintf_hex(psk
, sizeof(psk
), ssid
->psk
, 32);
864 wpa_msg_global(wpa_s
->parent
, MSG_INFO
, P2P_EVENT_GROUP_STARTED
865 "%s GO ssid=\"%s\" freq=%d psk=%s go_dev_addr="
867 wpa_s
->ifname
, ssid_txt
, ssid
->frequency
, psk
,
868 MAC2STR(go_dev_addr
),
869 persistent
? " [PERSISTENT]" : "");
870 wpas_p2p_cross_connect_setup(wpa_s
);
871 wpas_p2p_set_group_idle_timeout(wpa_s
);
873 wpa_msg_global(wpa_s
->parent
, MSG_INFO
, P2P_EVENT_GROUP_STARTED
874 "%s GO ssid=\"%s\" freq=%d passphrase=\"%s\" "
875 "go_dev_addr=" MACSTR
"%s",
876 wpa_s
->ifname
, ssid_txt
,
877 ssid
? ssid
->frequency
: 0,
878 ssid
&& ssid
->passphrase
? ssid
->passphrase
: "",
879 MAC2STR(go_dev_addr
),
880 persistent
? " [PERSISTENT]" : "");
881 wpas_p2p_cross_connect_setup(wpa_s
);
882 wpas_p2p_set_group_idle_timeout(wpa_s
);
886 network_id
= wpas_p2p_store_persistent_group(wpa_s
->parent
,
889 os_free(wpa_s
->global
->add_psk
);
890 wpa_s
->global
->add_psk
= NULL
;
892 if (network_id
< 0 && ssid
)
893 network_id
= ssid
->id
;
895 wpas_notify_p2p_group_started(wpa_s
, ssid
, network_id
, 0);
896 os_get_reltime(&wpa_s
->global
->p2p_go_wait_client
);
901 struct send_action_work
{
907 unsigned int wait_time
;
912 static void wpas_p2p_send_action_work_timeout(void *eloop_ctx
,
915 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
917 if (!wpa_s
->p2p_send_action_work
)
920 wpa_printf(MSG_DEBUG
, "P2P: Send Action frame radio work timed out");
921 os_free(wpa_s
->p2p_send_action_work
->ctx
);
922 radio_work_done(wpa_s
->p2p_send_action_work
);
923 wpa_s
->p2p_send_action_work
= NULL
;
927 static void wpas_p2p_send_action_tx_status(struct wpa_supplicant
*wpa_s
,
929 const u8
*dst
, const u8
*src
,
931 const u8
*data
, size_t data_len
,
932 enum offchannel_send_action_result
935 enum p2p_send_action_result res
= P2P_SEND_ACTION_SUCCESS
;
937 if (wpa_s
->p2p_send_action_work
) {
938 struct send_action_work
*awork
;
939 awork
= wpa_s
->p2p_send_action_work
->ctx
;
940 if (awork
->wait_time
== 0) {
942 radio_work_done(wpa_s
->p2p_send_action_work
);
943 wpa_s
->p2p_send_action_work
= NULL
;
946 * In theory, this should not be needed, but number of
947 * places in the P2P code is still using non-zero wait
948 * time for the last Action frame in the sequence and
949 * some of these do not call send_action_done().
951 eloop_cancel_timeout(wpas_p2p_send_action_work_timeout
,
953 eloop_register_timeout(
954 0, awork
->wait_time
* 1000,
955 wpas_p2p_send_action_work_timeout
,
960 if (wpa_s
->global
->p2p
== NULL
|| wpa_s
->global
->p2p_disabled
)
964 case OFFCHANNEL_SEND_ACTION_SUCCESS
:
965 res
= P2P_SEND_ACTION_SUCCESS
;
967 case OFFCHANNEL_SEND_ACTION_NO_ACK
:
968 res
= P2P_SEND_ACTION_NO_ACK
;
970 case OFFCHANNEL_SEND_ACTION_FAILED
:
971 res
= P2P_SEND_ACTION_FAILED
;
975 p2p_send_action_cb(wpa_s
->global
->p2p
, freq
, dst
, src
, bssid
, res
);
977 if (result
!= OFFCHANNEL_SEND_ACTION_SUCCESS
&&
978 wpa_s
->pending_pd_before_join
&&
979 (os_memcmp(dst
, wpa_s
->pending_join_dev_addr
, ETH_ALEN
) == 0 ||
980 os_memcmp(dst
, wpa_s
->pending_join_iface_addr
, ETH_ALEN
) == 0) &&
981 wpa_s
->p2p_fallback_to_go_neg
) {
982 wpa_s
->pending_pd_before_join
= 0;
983 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: No ACK for PD Req "
984 "during p2p_connect-auto");
985 wpas_p2p_fallback_to_go_neg(wpa_s
, 0);
991 static void wpas_send_action_cb(struct wpa_radio_work
*work
, int deinit
)
993 struct wpa_supplicant
*wpa_s
= work
->wpa_s
;
994 struct send_action_work
*awork
= work
->ctx
;
1001 if (offchannel_send_action(wpa_s
, awork
->freq
, awork
->dst
, awork
->src
,
1002 awork
->bssid
, awork
->buf
, awork
->len
,
1004 wpas_p2p_send_action_tx_status
, 1) < 0) {
1006 radio_work_done(work
);
1009 wpa_s
->p2p_send_action_work
= work
;
1013 static int wpas_send_action_work(struct wpa_supplicant
*wpa_s
,
1014 unsigned int freq
, const u8
*dst
,
1015 const u8
*src
, const u8
*bssid
, const u8
*buf
,
1016 size_t len
, unsigned int wait_time
)
1018 struct send_action_work
*awork
;
1020 if (wpa_s
->p2p_send_action_work
) {
1021 wpa_printf(MSG_DEBUG
, "P2P: Cannot schedule new p2p-send-action work since one is already pending");
1025 awork
= os_zalloc(sizeof(*awork
) + len
);
1030 os_memcpy(awork
->dst
, dst
, ETH_ALEN
);
1031 os_memcpy(awork
->src
, src
, ETH_ALEN
);
1032 os_memcpy(awork
->bssid
, bssid
, ETH_ALEN
);
1034 awork
->wait_time
= wait_time
;
1035 os_memcpy(awork
->buf
, buf
, len
);
1037 if (radio_add_work(wpa_s
, freq
, "p2p-send-action", 0,
1038 wpas_send_action_cb
, awork
) < 0) {
1047 static int wpas_send_action(void *ctx
, unsigned int freq
, const u8
*dst
,
1048 const u8
*src
, const u8
*bssid
, const u8
*buf
,
1049 size_t len
, unsigned int wait_time
)
1051 struct wpa_supplicant
*wpa_s
= ctx
;
1052 int listen_freq
= -1, send_freq
= -1;
1054 if (wpa_s
->p2p_listen_work
)
1055 listen_freq
= wpa_s
->p2p_listen_work
->freq
;
1056 if (wpa_s
->p2p_send_action_work
)
1057 send_freq
= wpa_s
->p2p_send_action_work
->freq
;
1058 if (listen_freq
!= (int) freq
&& send_freq
!= (int) freq
) {
1059 wpa_printf(MSG_DEBUG
, "P2P: Schedule new radio work for Action frame TX (listen_freq=%d send_freq=%d)",
1060 listen_freq
, send_freq
);
1061 return wpas_send_action_work(wpa_s
, freq
, dst
, src
, bssid
, buf
,
1065 wpa_printf(MSG_DEBUG
, "P2P: Use ongoing radio work for Action frame TX");
1066 return offchannel_send_action(wpa_s
, freq
, dst
, src
, bssid
, buf
, len
,
1068 wpas_p2p_send_action_tx_status
, 1);
1072 static void wpas_send_action_done(void *ctx
)
1074 struct wpa_supplicant
*wpa_s
= ctx
;
1076 if (wpa_s
->p2p_send_action_work
) {
1077 eloop_cancel_timeout(wpas_p2p_send_action_work_timeout
,
1079 os_free(wpa_s
->p2p_send_action_work
->ctx
);
1080 radio_work_done(wpa_s
->p2p_send_action_work
);
1081 wpa_s
->p2p_send_action_work
= NULL
;
1084 offchannel_send_action_done(wpa_s
);
1088 static int wpas_copy_go_neg_results(struct wpa_supplicant
*wpa_s
,
1089 struct p2p_go_neg_results
*params
)
1091 if (wpa_s
->go_params
== NULL
) {
1092 wpa_s
->go_params
= os_malloc(sizeof(*params
));
1093 if (wpa_s
->go_params
== NULL
)
1096 os_memcpy(wpa_s
->go_params
, params
, sizeof(*params
));
1101 static void wpas_start_wps_enrollee(struct wpa_supplicant
*wpa_s
,
1102 struct p2p_go_neg_results
*res
)
1104 wpa_printf(MSG_DEBUG
, "P2P: Start WPS Enrollee for peer " MACSTR
,
1105 MAC2STR(res
->peer_interface_addr
));
1106 wpa_hexdump_ascii(MSG_DEBUG
, "P2P: Start WPS Enrollee for SSID",
1107 res
->ssid
, res
->ssid_len
);
1108 wpa_supplicant_ap_deinit(wpa_s
);
1109 wpas_copy_go_neg_results(wpa_s
, res
);
1110 if (res
->wps_method
== WPS_PBC
) {
1111 wpas_wps_start_pbc(wpa_s
, res
->peer_interface_addr
, 1);
1112 #ifdef CONFIG_WPS_NFC
1113 } else if (res
->wps_method
== WPS_NFC
) {
1114 wpas_wps_start_nfc(wpa_s
, res
->peer_interface_addr
,
1115 wpa_s
->parent
->p2p_oob_dev_pw
,
1116 wpa_s
->parent
->p2p_oob_dev_pw_id
, 1,
1117 wpa_s
->parent
->p2p_oob_dev_pw_id
==
1118 DEV_PW_NFC_CONNECTION_HANDOVER
?
1119 wpa_s
->parent
->p2p_peer_oob_pubkey_hash
:
1122 #endif /* CONFIG_WPS_NFC */
1124 u16 dev_pw_id
= DEV_PW_DEFAULT
;
1125 if (wpa_s
->p2p_wps_method
== WPS_PIN_KEYPAD
)
1126 dev_pw_id
= DEV_PW_REGISTRAR_SPECIFIED
;
1127 wpas_wps_start_pin(wpa_s
, res
->peer_interface_addr
,
1128 wpa_s
->p2p_pin
, 1, dev_pw_id
);
1133 static void wpas_p2p_add_psk_list(struct wpa_supplicant
*wpa_s
,
1134 struct wpa_ssid
*ssid
)
1136 struct wpa_ssid
*persistent
;
1137 struct psk_list_entry
*psk
;
1138 struct hostapd_data
*hapd
;
1140 if (!wpa_s
->ap_iface
)
1143 persistent
= wpas_p2p_get_persistent(wpa_s
->parent
, NULL
, ssid
->ssid
,
1145 if (persistent
== NULL
)
1148 hapd
= wpa_s
->ap_iface
->bss
[0];
1150 dl_list_for_each(psk
, &persistent
->psk_list
, struct psk_list_entry
,
1152 struct hostapd_wpa_psk
*hpsk
;
1154 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Add persistent group PSK entry for "
1156 MAC2STR(psk
->addr
), psk
->p2p
);
1157 hpsk
= os_zalloc(sizeof(*hpsk
));
1160 os_memcpy(hpsk
->psk
, psk
->psk
, PMK_LEN
);
1162 os_memcpy(hpsk
->p2p_dev_addr
, psk
->addr
, ETH_ALEN
);
1164 os_memcpy(hpsk
->addr
, psk
->addr
, ETH_ALEN
);
1165 hpsk
->next
= hapd
->conf
->ssid
.wpa_psk
;
1166 hapd
->conf
->ssid
.wpa_psk
= hpsk
;
1171 static void p2p_go_configured(void *ctx
, void *data
)
1173 struct wpa_supplicant
*wpa_s
= ctx
;
1174 struct p2p_go_neg_results
*params
= data
;
1175 struct wpa_ssid
*ssid
;
1176 int network_id
= -1;
1178 ssid
= wpa_s
->current_ssid
;
1179 if (ssid
&& ssid
->mode
== WPAS_MODE_P2P_GO
) {
1180 wpa_printf(MSG_DEBUG
, "P2P: Group setup without provisioning");
1181 if (wpa_s
->global
->p2p_group_formation
== wpa_s
)
1182 wpa_s
->global
->p2p_group_formation
= NULL
;
1183 if (os_strlen(params
->passphrase
) > 0) {
1184 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
1185 P2P_EVENT_GROUP_STARTED
1186 "%s GO ssid=\"%s\" freq=%d "
1187 "passphrase=\"%s\" go_dev_addr=" MACSTR
1188 "%s", wpa_s
->ifname
,
1189 wpa_ssid_txt(ssid
->ssid
, ssid
->ssid_len
),
1190 ssid
->frequency
, params
->passphrase
,
1191 MAC2STR(wpa_s
->global
->p2p_dev_addr
),
1192 params
->persistent_group
?
1193 " [PERSISTENT]" : "");
1196 wpa_snprintf_hex(psk
, sizeof(psk
), params
->psk
,
1197 sizeof(params
->psk
));
1198 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
1199 P2P_EVENT_GROUP_STARTED
1200 "%s GO ssid=\"%s\" freq=%d psk=%s "
1201 "go_dev_addr=" MACSTR
"%s",
1203 wpa_ssid_txt(ssid
->ssid
, ssid
->ssid_len
),
1204 ssid
->frequency
, psk
,
1205 MAC2STR(wpa_s
->global
->p2p_dev_addr
),
1206 params
->persistent_group
?
1207 " [PERSISTENT]" : "");
1210 os_get_reltime(&wpa_s
->global
->p2p_go_wait_client
);
1211 if (params
->persistent_group
) {
1212 network_id
= wpas_p2p_store_persistent_group(
1213 wpa_s
->parent
, ssid
,
1214 wpa_s
->global
->p2p_dev_addr
);
1215 wpas_p2p_add_psk_list(wpa_s
, ssid
);
1218 network_id
= ssid
->id
;
1219 wpas_notify_p2p_group_started(wpa_s
, ssid
, network_id
, 0);
1220 wpas_p2p_cross_connect_setup(wpa_s
);
1221 wpas_p2p_set_group_idle_timeout(wpa_s
);
1223 if (wpa_s
->p2p_first_connection_timeout
) {
1224 wpa_dbg(wpa_s
, MSG_DEBUG
,
1225 "P2P: Start group formation timeout of %d seconds until first data connection on GO",
1226 wpa_s
->p2p_first_connection_timeout
);
1227 wpa_s
->p2p_go_group_formation_completed
= 0;
1228 wpa_s
->global
->p2p_group_formation
= wpa_s
;
1229 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
1230 wpa_s
->parent
, NULL
);
1231 eloop_register_timeout(
1232 wpa_s
->p2p_first_connection_timeout
, 0,
1233 wpas_p2p_group_formation_timeout
,
1234 wpa_s
->parent
, NULL
);
1240 wpa_printf(MSG_DEBUG
, "P2P: Setting up WPS for GO provisioning");
1241 if (wpa_supplicant_ap_mac_addr_filter(wpa_s
,
1242 params
->peer_interface_addr
)) {
1243 wpa_printf(MSG_DEBUG
, "P2P: Failed to setup MAC address "
1247 if (params
->wps_method
== WPS_PBC
) {
1248 wpa_supplicant_ap_wps_pbc(wpa_s
, params
->peer_interface_addr
,
1249 params
->peer_device_addr
);
1250 #ifdef CONFIG_WPS_NFC
1251 } else if (params
->wps_method
== WPS_NFC
) {
1252 if (wpa_s
->parent
->p2p_oob_dev_pw_id
!=
1253 DEV_PW_NFC_CONNECTION_HANDOVER
&&
1254 !wpa_s
->parent
->p2p_oob_dev_pw
) {
1255 wpa_printf(MSG_DEBUG
, "P2P: No NFC Dev Pw known");
1258 wpas_ap_wps_add_nfc_pw(
1259 wpa_s
, wpa_s
->parent
->p2p_oob_dev_pw_id
,
1260 wpa_s
->parent
->p2p_oob_dev_pw
,
1261 wpa_s
->parent
->p2p_peer_oob_pk_hash_known
?
1262 wpa_s
->parent
->p2p_peer_oob_pubkey_hash
: NULL
);
1263 #endif /* CONFIG_WPS_NFC */
1264 } else if (wpa_s
->p2p_pin
[0])
1265 wpa_supplicant_ap_wps_pin(wpa_s
, params
->peer_interface_addr
,
1266 wpa_s
->p2p_pin
, NULL
, 0, 0);
1267 os_free(wpa_s
->go_params
);
1268 wpa_s
->go_params
= NULL
;
1272 static void wpas_start_wps_go(struct wpa_supplicant
*wpa_s
,
1273 struct p2p_go_neg_results
*params
,
1274 int group_formation
)
1276 struct wpa_ssid
*ssid
;
1278 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Starting GO");
1279 if (wpas_copy_go_neg_results(wpa_s
, params
) < 0) {
1280 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Could not copy GO Negotiation "
1285 ssid
= wpa_config_add_network(wpa_s
->conf
);
1287 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Could not add network for GO");
1291 wpa_s
->show_group_started
= 0;
1293 wpa_config_set_network_defaults(ssid
);
1294 ssid
->temporary
= 1;
1295 ssid
->p2p_group
= 1;
1296 ssid
->p2p_persistent_group
= params
->persistent_group
;
1297 ssid
->mode
= group_formation
? WPAS_MODE_P2P_GROUP_FORMATION
:
1299 ssid
->frequency
= params
->freq
;
1300 ssid
->ht40
= params
->ht40
;
1301 ssid
->vht
= params
->vht
;
1302 ssid
->ssid
= os_zalloc(params
->ssid_len
+ 1);
1304 os_memcpy(ssid
->ssid
, params
->ssid
, params
->ssid_len
);
1305 ssid
->ssid_len
= params
->ssid_len
;
1307 ssid
->auth_alg
= WPA_AUTH_ALG_OPEN
;
1308 ssid
->key_mgmt
= WPA_KEY_MGMT_PSK
;
1309 ssid
->proto
= WPA_PROTO_RSN
;
1310 ssid
->pairwise_cipher
= WPA_CIPHER_CCMP
;
1311 if (os_strlen(params
->passphrase
) > 0) {
1312 ssid
->passphrase
= os_strdup(params
->passphrase
);
1313 if (ssid
->passphrase
== NULL
) {
1314 wpa_msg_global(wpa_s
, MSG_ERROR
,
1315 "P2P: Failed to copy passphrase for GO");
1316 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
1320 ssid
->passphrase
= NULL
;
1321 ssid
->psk_set
= params
->psk_set
;
1323 os_memcpy(ssid
->psk
, params
->psk
, sizeof(ssid
->psk
));
1324 else if (ssid
->passphrase
)
1325 wpa_config_update_psk(ssid
);
1326 ssid
->ap_max_inactivity
= wpa_s
->parent
->conf
->p2p_go_max_inactivity
;
1328 wpa_s
->ap_configured_cb
= p2p_go_configured
;
1329 wpa_s
->ap_configured_cb_ctx
= wpa_s
;
1330 wpa_s
->ap_configured_cb_data
= wpa_s
->go_params
;
1331 wpa_s
->connect_without_scan
= ssid
;
1332 wpa_s
->reassociate
= 1;
1333 wpa_s
->disconnected
= 0;
1334 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Request scan (that will be skipped) to "
1336 wpa_supplicant_req_scan(wpa_s
, 0, 0);
1340 static void wpas_p2p_clone_config(struct wpa_supplicant
*dst
,
1341 const struct wpa_supplicant
*src
)
1343 struct wpa_config
*d
;
1344 const struct wpa_config
*s
;
1349 #define C(n) if (s->n) d->n = os_strdup(s->n)
1358 os_memcpy(d
->device_type
, s
->device_type
, WPS_DEV_TYPE_LEN
);
1359 os_memcpy(d
->sec_device_type
, s
->sec_device_type
,
1360 sizeof(d
->sec_device_type
));
1361 d
->num_sec_device_types
= s
->num_sec_device_types
;
1363 d
->p2p_group_idle
= s
->p2p_group_idle
;
1364 d
->p2p_intra_bss
= s
->p2p_intra_bss
;
1365 d
->persistent_reconnect
= s
->persistent_reconnect
;
1366 d
->max_num_sta
= s
->max_num_sta
;
1367 d
->pbc_in_m1
= s
->pbc_in_m1
;
1368 d
->ignore_old_scan_res
= s
->ignore_old_scan_res
;
1369 d
->beacon_int
= s
->beacon_int
;
1370 d
->dtim_period
= s
->dtim_period
;
1371 d
->disassoc_low_ack
= s
->disassoc_low_ack
;
1372 d
->disable_scan_offload
= s
->disable_scan_offload
;
1376 static void wpas_p2p_get_group_ifname(struct wpa_supplicant
*wpa_s
,
1377 char *ifname
, size_t len
)
1379 char *ifname_ptr
= wpa_s
->ifname
;
1381 if (os_strncmp(wpa_s
->ifname
, P2P_MGMT_DEVICE_PREFIX
,
1382 os_strlen(P2P_MGMT_DEVICE_PREFIX
)) == 0) {
1383 ifname_ptr
= os_strrchr(wpa_s
->ifname
, '-') + 1;
1386 os_snprintf(ifname
, len
, "p2p-%s-%d", ifname_ptr
, wpa_s
->p2p_group_idx
);
1387 if (os_strlen(ifname
) >= IFNAMSIZ
&&
1388 os_strlen(wpa_s
->ifname
) < IFNAMSIZ
) {
1389 /* Try to avoid going over the IFNAMSIZ length limit */
1390 os_snprintf(ifname
, len
, "p2p-%d", wpa_s
->p2p_group_idx
);
1395 static int wpas_p2p_add_group_interface(struct wpa_supplicant
*wpa_s
,
1396 enum wpa_driver_if_type type
)
1398 char ifname
[120], force_ifname
[120];
1400 if (wpa_s
->pending_interface_name
[0]) {
1401 wpa_printf(MSG_DEBUG
, "P2P: Pending virtual interface exists "
1402 "- skip creation of a new one");
1403 if (is_zero_ether_addr(wpa_s
->pending_interface_addr
)) {
1404 wpa_printf(MSG_DEBUG
, "P2P: Pending virtual address "
1405 "unknown?! ifname='%s'",
1406 wpa_s
->pending_interface_name
);
1412 wpas_p2p_get_group_ifname(wpa_s
, ifname
, sizeof(ifname
));
1413 force_ifname
[0] = '\0';
1415 wpa_printf(MSG_DEBUG
, "P2P: Create a new interface %s for the group",
1417 wpa_s
->p2p_group_idx
++;
1419 wpa_s
->pending_interface_type
= type
;
1420 if (wpa_drv_if_add(wpa_s
, type
, ifname
, NULL
, NULL
, force_ifname
,
1421 wpa_s
->pending_interface_addr
, NULL
) < 0) {
1422 wpa_printf(MSG_ERROR
, "P2P: Failed to create new group "
1427 if (force_ifname
[0]) {
1428 wpa_printf(MSG_DEBUG
, "P2P: Driver forced interface name %s",
1430 os_strlcpy(wpa_s
->pending_interface_name
, force_ifname
,
1431 sizeof(wpa_s
->pending_interface_name
));
1433 os_strlcpy(wpa_s
->pending_interface_name
, ifname
,
1434 sizeof(wpa_s
->pending_interface_name
));
1435 wpa_printf(MSG_DEBUG
, "P2P: Created pending virtual interface %s addr "
1436 MACSTR
, wpa_s
->pending_interface_name
,
1437 MAC2STR(wpa_s
->pending_interface_addr
));
1443 static void wpas_p2p_remove_pending_group_interface(
1444 struct wpa_supplicant
*wpa_s
)
1446 if (!wpa_s
->pending_interface_name
[0] ||
1447 is_zero_ether_addr(wpa_s
->pending_interface_addr
))
1448 return; /* No pending virtual interface */
1450 wpa_printf(MSG_DEBUG
, "P2P: Removing pending group interface %s",
1451 wpa_s
->pending_interface_name
);
1452 wpa_drv_if_remove(wpa_s
, wpa_s
->pending_interface_type
,
1453 wpa_s
->pending_interface_name
);
1454 os_memset(wpa_s
->pending_interface_addr
, 0, ETH_ALEN
);
1455 wpa_s
->pending_interface_name
[0] = '\0';
1459 static struct wpa_supplicant
*
1460 wpas_p2p_init_group_interface(struct wpa_supplicant
*wpa_s
, int go
)
1462 struct wpa_interface iface
;
1463 struct wpa_supplicant
*group_wpa_s
;
1465 if (!wpa_s
->pending_interface_name
[0]) {
1466 wpa_printf(MSG_ERROR
, "P2P: No pending group interface");
1467 if (!wpas_p2p_create_iface(wpa_s
))
1470 * Something has forced us to remove the pending interface; try
1471 * to create a new one and hope for the best that we will get
1472 * the same local address.
1474 if (wpas_p2p_add_group_interface(wpa_s
, go
? WPA_IF_P2P_GO
:
1475 WPA_IF_P2P_CLIENT
) < 0)
1479 os_memset(&iface
, 0, sizeof(iface
));
1480 iface
.ifname
= wpa_s
->pending_interface_name
;
1481 iface
.driver
= wpa_s
->driver
->name
;
1482 if (wpa_s
->conf
->ctrl_interface
== NULL
&&
1483 wpa_s
->parent
!= wpa_s
&&
1485 (wpa_s
->drv_flags
& WPA_DRIVER_FLAGS_DEDICATED_P2P_DEVICE
))
1486 iface
.ctrl_interface
= wpa_s
->parent
->conf
->ctrl_interface
;
1488 iface
.ctrl_interface
= wpa_s
->conf
->ctrl_interface
;
1489 iface
.driver_param
= wpa_s
->conf
->driver_param
;
1490 group_wpa_s
= wpa_supplicant_add_iface(wpa_s
->global
, &iface
);
1491 if (group_wpa_s
== NULL
) {
1492 wpa_printf(MSG_ERROR
, "P2P: Failed to create new "
1493 "wpa_supplicant interface");
1496 wpa_s
->pending_interface_name
[0] = '\0';
1497 group_wpa_s
->parent
= wpa_s
;
1498 group_wpa_s
->p2p_group_interface
= go
? P2P_GROUP_INTERFACE_GO
:
1499 P2P_GROUP_INTERFACE_CLIENT
;
1500 wpa_s
->global
->p2p_group_formation
= group_wpa_s
;
1502 wpas_p2p_clone_config(group_wpa_s
, wpa_s
);
1508 static void wpas_p2p_group_formation_timeout(void *eloop_ctx
,
1511 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
1512 wpa_printf(MSG_DEBUG
, "P2P: Group Formation timed out");
1513 wpas_p2p_group_formation_failed(wpa_s
);
1517 void wpas_p2p_group_formation_failed(struct wpa_supplicant
*wpa_s
)
1519 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
1520 wpa_s
->parent
, NULL
);
1521 if (wpa_s
->global
->p2p
)
1522 p2p_group_formation_failed(wpa_s
->global
->p2p
);
1523 wpas_group_formation_completed(wpa_s
, 0);
1527 static void wpas_p2p_grpform_fail_after_wps(struct wpa_supplicant
*wpa_s
)
1529 wpa_printf(MSG_DEBUG
, "P2P: Reject group formation due to WPS provisioning failure");
1530 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
1531 wpa_s
->parent
, NULL
);
1532 eloop_register_timeout(0, 0, wpas_p2p_group_formation_timeout
,
1533 wpa_s
->parent
, NULL
);
1534 wpa_s
->global
->p2p_fail_on_wps_complete
= 0;
1538 void wpas_p2p_ap_setup_failed(struct wpa_supplicant
*wpa_s
)
1540 if (wpa_s
->global
->p2p_group_formation
!= wpa_s
)
1542 /* Speed up group formation timeout since this cannot succeed */
1543 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
1544 wpa_s
->parent
, NULL
);
1545 eloop_register_timeout(0, 0, wpas_p2p_group_formation_timeout
,
1546 wpa_s
->parent
, NULL
);
1550 static void wpas_go_neg_completed(void *ctx
, struct p2p_go_neg_results
*res
)
1552 struct wpa_supplicant
*wpa_s
= ctx
;
1554 if (wpa_s
->off_channel_freq
|| wpa_s
->roc_waiting_drv_freq
) {
1555 wpa_drv_cancel_remain_on_channel(wpa_s
);
1556 wpa_s
->off_channel_freq
= 0;
1557 wpa_s
->roc_waiting_drv_freq
= 0;
1561 wpa_msg_global(wpa_s
, MSG_INFO
,
1562 P2P_EVENT_GO_NEG_FAILURE
"status=%d",
1564 wpas_notify_p2p_go_neg_completed(wpa_s
, res
);
1565 wpas_p2p_remove_pending_group_interface(wpa_s
);
1569 if (wpa_s
->p2p_go_ht40
)
1571 if (wpa_s
->p2p_go_vht
)
1574 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_GO_NEG_SUCCESS
"role=%s "
1575 "freq=%d ht40=%d peer_dev=" MACSTR
" peer_iface=" MACSTR
1577 res
->role_go
? "GO" : "client", res
->freq
, res
->ht40
,
1578 MAC2STR(res
->peer_device_addr
),
1579 MAC2STR(res
->peer_interface_addr
),
1580 p2p_wps_method_text(res
->wps_method
));
1581 wpas_notify_p2p_go_neg_completed(wpa_s
, res
);
1583 if (res
->role_go
&& wpa_s
->p2p_persistent_id
>= 0) {
1584 struct wpa_ssid
*ssid
;
1585 ssid
= wpa_config_get_network(wpa_s
->conf
,
1586 wpa_s
->p2p_persistent_id
);
1587 if (ssid
&& ssid
->disabled
== 2 &&
1588 ssid
->mode
== WPAS_MODE_P2P_GO
&& ssid
->passphrase
) {
1589 size_t len
= os_strlen(ssid
->passphrase
);
1590 wpa_printf(MSG_DEBUG
, "P2P: Override passphrase based "
1591 "on requested persistent group");
1592 os_memcpy(res
->passphrase
, ssid
->passphrase
, len
);
1593 res
->passphrase
[len
] = '\0';
1597 if (wpa_s
->create_p2p_iface
) {
1598 struct wpa_supplicant
*group_wpa_s
=
1599 wpas_p2p_init_group_interface(wpa_s
, res
->role_go
);
1600 if (group_wpa_s
== NULL
) {
1601 wpas_p2p_remove_pending_group_interface(wpa_s
);
1604 if (group_wpa_s
!= wpa_s
) {
1605 os_memcpy(group_wpa_s
->p2p_pin
, wpa_s
->p2p_pin
,
1606 sizeof(group_wpa_s
->p2p_pin
));
1607 group_wpa_s
->p2p_wps_method
= wpa_s
->p2p_wps_method
;
1609 os_memset(wpa_s
->pending_interface_addr
, 0, ETH_ALEN
);
1610 wpa_s
->pending_interface_name
[0] = '\0';
1611 group_wpa_s
->p2p_in_provisioning
= 1;
1614 wpas_start_wps_go(group_wpa_s
, res
, 1);
1616 wpas_start_wps_enrollee(group_wpa_s
, res
);
1618 wpa_s
->p2p_in_provisioning
= 1;
1619 wpa_s
->global
->p2p_group_formation
= wpa_s
;
1622 wpas_start_wps_go(wpa_s
, res
, 1);
1624 wpas_start_wps_enrollee(ctx
, res
);
1627 wpa_s
->p2p_long_listen
= 0;
1628 eloop_cancel_timeout(wpas_p2p_long_listen_timeout
, wpa_s
, NULL
);
1630 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
, wpa_s
, NULL
);
1631 eloop_register_timeout(15 + res
->peer_config_timeout
/ 100,
1632 (res
->peer_config_timeout
% 100) * 10000,
1633 wpas_p2p_group_formation_timeout
, wpa_s
, NULL
);
1637 static void wpas_go_neg_req_rx(void *ctx
, const u8
*src
, u16 dev_passwd_id
)
1639 struct wpa_supplicant
*wpa_s
= ctx
;
1640 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_GO_NEG_REQUEST MACSTR
1641 " dev_passwd_id=%u", MAC2STR(src
), dev_passwd_id
);
1643 wpas_notify_p2p_go_neg_req(wpa_s
, src
, dev_passwd_id
);
1647 static void wpas_dev_found(void *ctx
, const u8
*addr
,
1648 const struct p2p_peer_info
*info
,
1651 #ifndef CONFIG_NO_STDOUT_DEBUG
1652 struct wpa_supplicant
*wpa_s
= ctx
;
1653 char devtype
[WPS_DEV_TYPE_BUFSIZE
];
1654 char *wfd_dev_info_hex
= NULL
;
1656 #ifdef CONFIG_WIFI_DISPLAY
1657 wfd_dev_info_hex
= wifi_display_subelem_hex(info
->wfd_subelems
,
1658 WFD_SUBELEM_DEVICE_INFO
);
1659 #endif /* CONFIG_WIFI_DISPLAY */
1661 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_DEVICE_FOUND MACSTR
1662 " p2p_dev_addr=" MACSTR
1663 " pri_dev_type=%s name='%s' config_methods=0x%x "
1664 "dev_capab=0x%x group_capab=0x%x%s%s",
1665 MAC2STR(addr
), MAC2STR(info
->p2p_device_addr
),
1666 wps_dev_type_bin2str(info
->pri_dev_type
, devtype
,
1668 info
->device_name
, info
->config_methods
,
1669 info
->dev_capab
, info
->group_capab
,
1670 wfd_dev_info_hex
? " wfd_dev_info=0x" : "",
1671 wfd_dev_info_hex
? wfd_dev_info_hex
: "");
1672 #endif /* CONFIG_NO_STDOUT_DEBUG */
1674 os_free(wfd_dev_info_hex
);
1676 wpas_notify_p2p_device_found(ctx
, info
->p2p_device_addr
, new_device
);
1680 static void wpas_dev_lost(void *ctx
, const u8
*dev_addr
)
1682 struct wpa_supplicant
*wpa_s
= ctx
;
1684 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_DEVICE_LOST
1685 "p2p_dev_addr=" MACSTR
, MAC2STR(dev_addr
));
1687 wpas_notify_p2p_device_lost(wpa_s
, dev_addr
);
1691 static void wpas_find_stopped(void *ctx
)
1693 struct wpa_supplicant
*wpa_s
= ctx
;
1694 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_FIND_STOPPED
);
1698 struct wpas_p2p_listen_work
{
1700 unsigned int duration
;
1701 struct wpabuf
*probe_resp_ie
;
1705 static void wpas_p2p_listen_work_free(struct wpas_p2p_listen_work
*lwork
)
1709 wpabuf_free(lwork
->probe_resp_ie
);
1714 static void wpas_p2p_listen_work_done(struct wpa_supplicant
*wpa_s
)
1716 struct wpas_p2p_listen_work
*lwork
;
1718 if (!wpa_s
->p2p_listen_work
)
1721 lwork
= wpa_s
->p2p_listen_work
->ctx
;
1722 wpas_p2p_listen_work_free(lwork
);
1723 radio_work_done(wpa_s
->p2p_listen_work
);
1724 wpa_s
->p2p_listen_work
= NULL
;
1728 static void wpas_start_listen_cb(struct wpa_radio_work
*work
, int deinit
)
1730 struct wpa_supplicant
*wpa_s
= work
->wpa_s
;
1731 struct wpas_p2p_listen_work
*lwork
= work
->ctx
;
1734 wpas_p2p_listen_work_free(lwork
);
1738 wpa_s
->p2p_listen_work
= work
;
1740 wpa_drv_set_ap_wps_ie(wpa_s
, NULL
, lwork
->probe_resp_ie
, NULL
);
1742 if (wpa_drv_probe_req_report(wpa_s
, 1) < 0) {
1743 wpa_printf(MSG_DEBUG
, "P2P: Failed to request the driver to "
1744 "report received Probe Request frames");
1745 wpas_p2p_listen_work_done(wpa_s
);
1749 wpa_s
->pending_listen_freq
= lwork
->freq
;
1750 wpa_s
->pending_listen_duration
= lwork
->duration
;
1752 if (wpa_drv_remain_on_channel(wpa_s
, lwork
->freq
, lwork
->duration
) < 0)
1754 wpa_printf(MSG_DEBUG
, "P2P: Failed to request the driver "
1755 "to remain on channel (%u MHz) for Listen "
1756 "state", lwork
->freq
);
1757 wpas_p2p_listen_work_done(wpa_s
);
1758 wpa_s
->pending_listen_freq
= 0;
1761 wpa_s
->off_channel_freq
= 0;
1762 wpa_s
->roc_waiting_drv_freq
= lwork
->freq
;
1766 static int wpas_start_listen(void *ctx
, unsigned int freq
,
1767 unsigned int duration
,
1768 const struct wpabuf
*probe_resp_ie
)
1770 struct wpa_supplicant
*wpa_s
= ctx
;
1771 struct wpas_p2p_listen_work
*lwork
;
1773 if (wpa_s
->p2p_listen_work
) {
1774 wpa_printf(MSG_DEBUG
, "P2P: Reject start_listen since p2p_listen_work already exists");
1778 lwork
= os_zalloc(sizeof(*lwork
));
1782 lwork
->duration
= duration
;
1783 if (probe_resp_ie
) {
1784 lwork
->probe_resp_ie
= wpabuf_dup(probe_resp_ie
);
1785 if (lwork
->probe_resp_ie
== NULL
) {
1786 wpas_p2p_listen_work_free(lwork
);
1791 if (radio_add_work(wpa_s
, freq
, "p2p-listen", 0, wpas_start_listen_cb
,
1793 wpas_p2p_listen_work_free(lwork
);
1801 static void wpas_stop_listen(void *ctx
)
1803 struct wpa_supplicant
*wpa_s
= ctx
;
1804 if (wpa_s
->off_channel_freq
|| wpa_s
->roc_waiting_drv_freq
) {
1805 wpa_drv_cancel_remain_on_channel(wpa_s
);
1806 wpa_s
->off_channel_freq
= 0;
1807 wpa_s
->roc_waiting_drv_freq
= 0;
1809 wpa_drv_set_ap_wps_ie(wpa_s
, NULL
, NULL
, NULL
);
1810 wpa_drv_probe_req_report(wpa_s
, 0);
1811 wpas_p2p_listen_work_done(wpa_s
);
1815 static int wpas_send_probe_resp(void *ctx
, const struct wpabuf
*buf
)
1817 struct wpa_supplicant
*wpa_s
= ctx
;
1818 return wpa_drv_send_mlme(wpa_s
, wpabuf_head(buf
), wpabuf_len(buf
), 1);
1823 * DNS Header section is used only to calculate compression pointers, so the
1824 * contents of this data does not matter, but the length needs to be reserved
1825 * in the virtual packet.
1827 #define DNS_HEADER_LEN 12
1830 * 27-octet in-memory packet from P2P specification containing two implied
1831 * queries for _tcp.lcoal. PTR IN and _udp.local. PTR IN
1833 #define P2P_SD_IN_MEMORY_LEN 27
1835 static int p2p_sd_dns_uncompress_label(char **upos
, char *uend
, u8
*start
,
1836 u8
**spos
, const u8
*end
)
1838 while (*spos
< end
) {
1839 u8 val
= ((*spos
)[0] & 0xc0) >> 6;
1842 if (val
== 1 || val
== 2) {
1843 /* These are reserved values in RFC 1035 */
1844 wpa_printf(MSG_DEBUG
, "P2P: Invalid domain name "
1845 "sequence starting with 0x%x", val
);
1854 if (*spos
+ 2 > end
) {
1855 wpa_printf(MSG_DEBUG
, "P2P: No room for full "
1856 "DNS offset field");
1860 offset
= (((*spos
)[0] & 0x3f) << 8) | (*spos
)[1];
1861 if (offset
>= *spos
- start
) {
1862 wpa_printf(MSG_DEBUG
, "P2P: Invalid DNS "
1863 "pointer offset %u", offset
);
1868 spos_tmp
= start
+ offset
;
1869 return p2p_sd_dns_uncompress_label(upos
, uend
, start
,
1875 len
= (*spos
)[0] & 0x3f;
1880 if (*spos
+ len
> end
) {
1881 wpa_printf(MSG_DEBUG
, "P2P: Invalid domain name "
1882 "sequence - no room for label with length "
1887 if (*upos
+ len
+ 2 > uend
)
1890 os_memcpy(*upos
, *spos
, len
);
1902 /* Uncompress domain names per RFC 1035 using the P2P SD in-memory packet.
1903 * Returns -1 on parsing error (invalid input sequence), -2 if output buffer is
1904 * not large enough */
1905 static int p2p_sd_dns_uncompress(char *buf
, size_t buf_len
, const u8
*msg
,
1906 size_t msg_len
, size_t offset
)
1908 /* 27-octet in-memory packet from P2P specification */
1909 const char *prefix
= "\x04_tcp\x05local\x00\x00\x0C\x00\x01"
1910 "\x04_udp\xC0\x11\x00\x0C\x00\x01";
1911 u8
*tmp
, *end
, *spos
;
1917 if (offset
> msg_len
)
1920 tmp
= os_malloc(DNS_HEADER_LEN
+ P2P_SD_IN_MEMORY_LEN
+ msg_len
);
1923 spos
= tmp
+ DNS_HEADER_LEN
+ P2P_SD_IN_MEMORY_LEN
;
1924 end
= spos
+ msg_len
;
1927 os_memset(tmp
, 0, DNS_HEADER_LEN
);
1928 os_memcpy(tmp
+ DNS_HEADER_LEN
, prefix
, P2P_SD_IN_MEMORY_LEN
);
1929 os_memcpy(tmp
+ DNS_HEADER_LEN
+ P2P_SD_IN_MEMORY_LEN
, msg
, msg_len
);
1932 uend
= buf
+ buf_len
;
1934 ret
= p2p_sd_dns_uncompress_label(&upos
, uend
, tmp
, &spos
, end
);
1943 } else if (upos
[-1] == '.')
1951 static struct p2p_srv_bonjour
*
1952 wpas_p2p_service_get_bonjour(struct wpa_supplicant
*wpa_s
,
1953 const struct wpabuf
*query
)
1955 struct p2p_srv_bonjour
*bsrv
;
1958 len
= wpabuf_len(query
);
1959 dl_list_for_each(bsrv
, &wpa_s
->global
->p2p_srv_bonjour
,
1960 struct p2p_srv_bonjour
, list
) {
1961 if (len
== wpabuf_len(bsrv
->query
) &&
1962 os_memcmp(wpabuf_head(query
), wpabuf_head(bsrv
->query
),
1970 static struct p2p_srv_upnp
*
1971 wpas_p2p_service_get_upnp(struct wpa_supplicant
*wpa_s
, u8 version
,
1972 const char *service
)
1974 struct p2p_srv_upnp
*usrv
;
1976 dl_list_for_each(usrv
, &wpa_s
->global
->p2p_srv_upnp
,
1977 struct p2p_srv_upnp
, list
) {
1978 if (version
== usrv
->version
&&
1979 os_strcmp(service
, usrv
->service
) == 0)
1986 static void wpas_sd_add_proto_not_avail(struct wpabuf
*resp
, u8 srv_proto
,
1991 if (wpabuf_tailroom(resp
) < 5)
1994 /* Length (to be filled) */
1995 len_pos
= wpabuf_put(resp
, 2);
1996 wpabuf_put_u8(resp
, srv_proto
);
1997 wpabuf_put_u8(resp
, srv_trans_id
);
1999 wpabuf_put_u8(resp
, P2P_SD_PROTO_NOT_AVAILABLE
);
2000 /* Response Data: empty */
2001 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
- 2);
2005 static void wpas_sd_all_bonjour(struct wpa_supplicant
*wpa_s
,
2006 struct wpabuf
*resp
, u8 srv_trans_id
)
2008 struct p2p_srv_bonjour
*bsrv
;
2011 wpa_printf(MSG_DEBUG
, "P2P: SD Request for all Bonjour services");
2013 if (dl_list_empty(&wpa_s
->global
->p2p_srv_bonjour
)) {
2014 wpa_printf(MSG_DEBUG
, "P2P: Bonjour protocol not available");
2018 dl_list_for_each(bsrv
, &wpa_s
->global
->p2p_srv_bonjour
,
2019 struct p2p_srv_bonjour
, list
) {
2020 if (wpabuf_tailroom(resp
) <
2021 5 + wpabuf_len(bsrv
->query
) + wpabuf_len(bsrv
->resp
))
2023 /* Length (to be filled) */
2024 len_pos
= wpabuf_put(resp
, 2);
2025 wpabuf_put_u8(resp
, P2P_SERV_BONJOUR
);
2026 wpabuf_put_u8(resp
, srv_trans_id
);
2028 wpabuf_put_u8(resp
, P2P_SD_SUCCESS
);
2029 wpa_hexdump_ascii(MSG_DEBUG
, "P2P: Matching Bonjour service",
2030 wpabuf_head(bsrv
->resp
),
2031 wpabuf_len(bsrv
->resp
));
2033 wpabuf_put_buf(resp
, bsrv
->query
); /* Key */
2034 wpabuf_put_buf(resp
, bsrv
->resp
); /* Value */
2035 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
-
2041 static int match_bonjour_query(struct p2p_srv_bonjour
*bsrv
, const u8
*query
,
2044 char str_rx
[256], str_srv
[256];
2046 if (query_len
< 3 || wpabuf_len(bsrv
->query
) < 3)
2047 return 0; /* Too short to include DNS Type and Version */
2048 if (os_memcmp(query
+ query_len
- 3,
2049 wpabuf_head_u8(bsrv
->query
) + wpabuf_len(bsrv
->query
) - 3,
2051 return 0; /* Mismatch in DNS Type or Version */
2052 if (query_len
== wpabuf_len(bsrv
->query
) &&
2053 os_memcmp(query
, wpabuf_head(bsrv
->query
), query_len
- 3) == 0)
2054 return 1; /* Binary match */
2056 if (p2p_sd_dns_uncompress(str_rx
, sizeof(str_rx
), query
, query_len
- 3,
2058 return 0; /* Failed to uncompress query */
2059 if (p2p_sd_dns_uncompress(str_srv
, sizeof(str_srv
),
2060 wpabuf_head(bsrv
->query
),
2061 wpabuf_len(bsrv
->query
) - 3, 0))
2062 return 0; /* Failed to uncompress service */
2064 return os_strcmp(str_rx
, str_srv
) == 0;
2068 static void wpas_sd_req_bonjour(struct wpa_supplicant
*wpa_s
,
2069 struct wpabuf
*resp
, u8 srv_trans_id
,
2070 const u8
*query
, size_t query_len
)
2072 struct p2p_srv_bonjour
*bsrv
;
2076 wpa_hexdump_ascii(MSG_DEBUG
, "P2P: SD Request for Bonjour",
2078 if (dl_list_empty(&wpa_s
->global
->p2p_srv_bonjour
)) {
2079 wpa_printf(MSG_DEBUG
, "P2P: Bonjour protocol not available");
2080 wpas_sd_add_proto_not_avail(resp
, P2P_SERV_BONJOUR
,
2085 if (query_len
== 0) {
2086 wpas_sd_all_bonjour(wpa_s
, resp
, srv_trans_id
);
2090 dl_list_for_each(bsrv
, &wpa_s
->global
->p2p_srv_bonjour
,
2091 struct p2p_srv_bonjour
, list
) {
2092 if (!match_bonjour_query(bsrv
, query
, query_len
))
2095 if (wpabuf_tailroom(resp
) <
2096 5 + query_len
+ wpabuf_len(bsrv
->resp
))
2101 /* Length (to be filled) */
2102 len_pos
= wpabuf_put(resp
, 2);
2103 wpabuf_put_u8(resp
, P2P_SERV_BONJOUR
);
2104 wpabuf_put_u8(resp
, srv_trans_id
);
2107 wpabuf_put_u8(resp
, P2P_SD_SUCCESS
);
2108 wpa_hexdump_ascii(MSG_DEBUG
, "P2P: Matching Bonjour service",
2109 wpabuf_head(bsrv
->resp
),
2110 wpabuf_len(bsrv
->resp
));
2113 wpabuf_put_data(resp
, query
, query_len
); /* Key */
2114 wpabuf_put_buf(resp
, bsrv
->resp
); /* Value */
2116 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
- 2);
2120 wpa_printf(MSG_DEBUG
, "P2P: Requested Bonjour service not "
2122 if (wpabuf_tailroom(resp
) < 5)
2125 /* Length (to be filled) */
2126 len_pos
= wpabuf_put(resp
, 2);
2127 wpabuf_put_u8(resp
, P2P_SERV_BONJOUR
);
2128 wpabuf_put_u8(resp
, srv_trans_id
);
2131 wpabuf_put_u8(resp
, P2P_SD_REQUESTED_INFO_NOT_AVAILABLE
);
2132 /* Response Data: empty */
2133 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
-
2139 static void wpas_sd_all_upnp(struct wpa_supplicant
*wpa_s
,
2140 struct wpabuf
*resp
, u8 srv_trans_id
)
2142 struct p2p_srv_upnp
*usrv
;
2145 wpa_printf(MSG_DEBUG
, "P2P: SD Request for all UPnP services");
2147 if (dl_list_empty(&wpa_s
->global
->p2p_srv_upnp
)) {
2148 wpa_printf(MSG_DEBUG
, "P2P: UPnP protocol not available");
2152 dl_list_for_each(usrv
, &wpa_s
->global
->p2p_srv_upnp
,
2153 struct p2p_srv_upnp
, list
) {
2154 if (wpabuf_tailroom(resp
) < 5 + 1 + os_strlen(usrv
->service
))
2157 /* Length (to be filled) */
2158 len_pos
= wpabuf_put(resp
, 2);
2159 wpabuf_put_u8(resp
, P2P_SERV_UPNP
);
2160 wpabuf_put_u8(resp
, srv_trans_id
);
2163 wpabuf_put_u8(resp
, P2P_SD_SUCCESS
);
2165 wpabuf_put_u8(resp
, usrv
->version
);
2166 wpa_printf(MSG_DEBUG
, "P2P: Matching UPnP Service: %s",
2168 wpabuf_put_str(resp
, usrv
->service
);
2169 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
-
2175 static void wpas_sd_req_upnp(struct wpa_supplicant
*wpa_s
,
2176 struct wpabuf
*resp
, u8 srv_trans_id
,
2177 const u8
*query
, size_t query_len
)
2179 struct p2p_srv_upnp
*usrv
;
2185 wpa_hexdump_ascii(MSG_DEBUG
, "P2P: SD Request for UPnP",
2188 if (dl_list_empty(&wpa_s
->global
->p2p_srv_upnp
)) {
2189 wpa_printf(MSG_DEBUG
, "P2P: UPnP protocol not available");
2190 wpas_sd_add_proto_not_avail(resp
, P2P_SERV_UPNP
,
2195 if (query_len
== 0) {
2196 wpas_sd_all_upnp(wpa_s
, resp
, srv_trans_id
);
2200 if (wpabuf_tailroom(resp
) < 5)
2203 /* Length (to be filled) */
2204 len_pos
= wpabuf_put(resp
, 2);
2205 wpabuf_put_u8(resp
, P2P_SERV_UPNP
);
2206 wpabuf_put_u8(resp
, srv_trans_id
);
2209 str
= os_malloc(query_len
);
2212 os_memcpy(str
, query
+ 1, query_len
- 1);
2213 str
[query_len
- 1] = '\0';
2215 dl_list_for_each(usrv
, &wpa_s
->global
->p2p_srv_upnp
,
2216 struct p2p_srv_upnp
, list
) {
2217 if (version
!= usrv
->version
)
2220 if (os_strcmp(str
, "ssdp:all") != 0 &&
2221 os_strstr(usrv
->service
, str
) == NULL
)
2224 if (wpabuf_tailroom(resp
) < 2)
2228 wpabuf_put_u8(resp
, P2P_SD_SUCCESS
);
2230 wpabuf_put_u8(resp
, version
);
2232 wpabuf_put_u8(resp
, ',');
2236 wpa_printf(MSG_DEBUG
, "P2P: Matching UPnP Service: %s",
2238 if (wpabuf_tailroom(resp
) < os_strlen(usrv
->service
))
2240 wpabuf_put_str(resp
, usrv
->service
);
2245 wpa_printf(MSG_DEBUG
, "P2P: Requested UPnP service not "
2248 wpabuf_put_u8(resp
, P2P_SD_REQUESTED_INFO_NOT_AVAILABLE
);
2249 /* Response Data: empty */
2252 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
- 2);
2256 #ifdef CONFIG_WIFI_DISPLAY
2257 static void wpas_sd_req_wfd(struct wpa_supplicant
*wpa_s
,
2258 struct wpabuf
*resp
, u8 srv_trans_id
,
2259 const u8
*query
, size_t query_len
)
2265 wpa_hexdump(MSG_DEBUG
, "P2P: SD Request for WFD", query
, query_len
);
2267 if (!wpa_s
->global
->wifi_display
) {
2268 wpa_printf(MSG_DEBUG
, "P2P: WFD protocol not available");
2269 wpas_sd_add_proto_not_avail(resp
, P2P_SERV_WIFI_DISPLAY
,
2274 if (query_len
< 1) {
2275 wpa_printf(MSG_DEBUG
, "P2P: Missing WFD Requested Device "
2280 if (wpabuf_tailroom(resp
) < 5)
2285 wpa_printf(MSG_DEBUG
, "P2P: WSD for device role 0x%x", role
);
2287 /* TODO: role specific handling */
2289 /* Length (to be filled) */
2290 len_pos
= wpabuf_put(resp
, 2);
2291 wpabuf_put_u8(resp
, P2P_SERV_WIFI_DISPLAY
);
2292 wpabuf_put_u8(resp
, srv_trans_id
);
2293 wpabuf_put_u8(resp
, P2P_SD_SUCCESS
); /* Status Code */
2295 while (pos
< query
+ query_len
) {
2296 if (*pos
< MAX_WFD_SUBELEMS
&&
2297 wpa_s
->global
->wfd_subelem
[*pos
] &&
2298 wpabuf_tailroom(resp
) >=
2299 wpabuf_len(wpa_s
->global
->wfd_subelem
[*pos
])) {
2300 wpa_printf(MSG_DEBUG
, "P2P: Add WSD response "
2301 "subelement %u", *pos
);
2302 wpabuf_put_buf(resp
, wpa_s
->global
->wfd_subelem
[*pos
]);
2307 WPA_PUT_LE16(len_pos
, (u8
*) wpabuf_put(resp
, 0) - len_pos
- 2);
2309 #endif /* CONFIG_WIFI_DISPLAY */
2312 static void wpas_sd_request(void *ctx
, int freq
, const u8
*sa
, u8 dialog_token
,
2313 u16 update_indic
, const u8
*tlvs
, size_t tlvs_len
)
2315 struct wpa_supplicant
*wpa_s
= ctx
;
2316 const u8
*pos
= tlvs
;
2317 const u8
*end
= tlvs
+ tlvs_len
;
2320 struct wpabuf
*resp
;
2321 u8 srv_proto
, srv_trans_id
;
2325 wpa_hexdump(MSG_MSGDUMP
, "P2P: Service Discovery Request TLVs",
2327 buf_len
= 2 * tlvs_len
+ 1;
2328 buf
= os_malloc(buf_len
);
2330 wpa_snprintf_hex(buf
, buf_len
, tlvs
, tlvs_len
);
2331 wpa_msg_ctrl(wpa_s
, MSG_INFO
, P2P_EVENT_SERV_DISC_REQ
"%d "
2333 freq
, MAC2STR(sa
), dialog_token
, update_indic
,
2338 if (wpa_s
->p2p_sd_over_ctrl_iface
) {
2339 wpas_notify_p2p_sd_request(wpa_s
, freq
, sa
, dialog_token
,
2340 update_indic
, tlvs
, tlvs_len
);
2341 return; /* to be processed by an external program */
2344 resp
= wpabuf_alloc(10000);
2348 while (pos
+ 1 < end
) {
2349 wpa_printf(MSG_DEBUG
, "P2P: Service Request TLV");
2350 slen
= WPA_GET_LE16(pos
);
2352 if (pos
+ slen
> end
|| slen
< 2) {
2353 wpa_printf(MSG_DEBUG
, "P2P: Unexpected Query Data "
2358 tlv_end
= pos
+ slen
;
2361 wpa_printf(MSG_DEBUG
, "P2P: Service Protocol Type %u",
2363 srv_trans_id
= *pos
++;
2364 wpa_printf(MSG_DEBUG
, "P2P: Service Transaction ID %u",
2367 wpa_hexdump(MSG_MSGDUMP
, "P2P: Query Data",
2368 pos
, tlv_end
- pos
);
2371 if (wpa_s
->force_long_sd
) {
2372 wpa_printf(MSG_DEBUG
, "P2P: SD test - force long "
2374 wpas_sd_all_bonjour(wpa_s
, resp
, srv_trans_id
);
2375 wpas_sd_all_upnp(wpa_s
, resp
, srv_trans_id
);
2379 switch (srv_proto
) {
2380 case P2P_SERV_ALL_SERVICES
:
2381 wpa_printf(MSG_DEBUG
, "P2P: Service Discovery Request "
2382 "for all services");
2383 if (dl_list_empty(&wpa_s
->global
->p2p_srv_upnp
) &&
2384 dl_list_empty(&wpa_s
->global
->p2p_srv_bonjour
)) {
2385 wpa_printf(MSG_DEBUG
, "P2P: No service "
2386 "discovery protocols available");
2387 wpas_sd_add_proto_not_avail(
2388 resp
, P2P_SERV_ALL_SERVICES
,
2392 wpas_sd_all_bonjour(wpa_s
, resp
, srv_trans_id
);
2393 wpas_sd_all_upnp(wpa_s
, resp
, srv_trans_id
);
2395 case P2P_SERV_BONJOUR
:
2396 wpas_sd_req_bonjour(wpa_s
, resp
, srv_trans_id
,
2397 pos
, tlv_end
- pos
);
2400 wpas_sd_req_upnp(wpa_s
, resp
, srv_trans_id
,
2401 pos
, tlv_end
- pos
);
2403 #ifdef CONFIG_WIFI_DISPLAY
2404 case P2P_SERV_WIFI_DISPLAY
:
2405 wpas_sd_req_wfd(wpa_s
, resp
, srv_trans_id
,
2406 pos
, tlv_end
- pos
);
2408 #endif /* CONFIG_WIFI_DISPLAY */
2410 wpa_printf(MSG_DEBUG
, "P2P: Unavailable service "
2411 "protocol %u", srv_proto
);
2412 wpas_sd_add_proto_not_avail(resp
, srv_proto
,
2421 wpas_notify_p2p_sd_request(wpa_s
, freq
, sa
, dialog_token
,
2422 update_indic
, tlvs
, tlvs_len
);
2424 wpas_p2p_sd_response(wpa_s
, freq
, sa
, dialog_token
, resp
);
2430 static void wpas_sd_response(void *ctx
, const u8
*sa
, u16 update_indic
,
2431 const u8
*tlvs
, size_t tlvs_len
)
2433 struct wpa_supplicant
*wpa_s
= ctx
;
2434 const u8
*pos
= tlvs
;
2435 const u8
*end
= tlvs
+ tlvs_len
;
2441 wpa_hexdump(MSG_MSGDUMP
, "P2P: Service Discovery Response TLVs",
2443 if (tlvs_len
> 1500) {
2444 /* TODO: better way for handling this */
2445 wpa_msg_ctrl(wpa_s
, MSG_INFO
,
2446 P2P_EVENT_SERV_DISC_RESP MACSTR
2447 " %u <long response: %u bytes>",
2448 MAC2STR(sa
), update_indic
,
2449 (unsigned int) tlvs_len
);
2451 buf_len
= 2 * tlvs_len
+ 1;
2452 buf
= os_malloc(buf_len
);
2454 wpa_snprintf_hex(buf
, buf_len
, tlvs
, tlvs_len
);
2455 wpa_msg_ctrl(wpa_s
, MSG_INFO
,
2456 P2P_EVENT_SERV_DISC_RESP MACSTR
" %u %s",
2457 MAC2STR(sa
), update_indic
, buf
);
2463 u8 srv_proto
, srv_trans_id
, status
;
2465 wpa_printf(MSG_DEBUG
, "P2P: Service Response TLV");
2466 slen
= WPA_GET_LE16(pos
);
2468 if (pos
+ slen
> end
|| slen
< 3) {
2469 wpa_printf(MSG_DEBUG
, "P2P: Unexpected Response Data "
2473 tlv_end
= pos
+ slen
;
2476 wpa_printf(MSG_DEBUG
, "P2P: Service Protocol Type %u",
2478 srv_trans_id
= *pos
++;
2479 wpa_printf(MSG_DEBUG
, "P2P: Service Transaction ID %u",
2482 wpa_printf(MSG_DEBUG
, "P2P: Status Code ID %u",
2485 wpa_hexdump(MSG_MSGDUMP
, "P2P: Response Data",
2486 pos
, tlv_end
- pos
);
2491 wpas_notify_p2p_sd_response(wpa_s
, sa
, update_indic
, tlvs
, tlvs_len
);
2495 u64
wpas_p2p_sd_request(struct wpa_supplicant
*wpa_s
, const u8
*dst
,
2496 const struct wpabuf
*tlvs
)
2498 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
2500 return (uintptr_t) p2p_sd_request(wpa_s
->global
->p2p
, dst
, tlvs
);
2504 u64
wpas_p2p_sd_request_upnp(struct wpa_supplicant
*wpa_s
, const u8
*dst
,
2505 u8 version
, const char *query
)
2507 struct wpabuf
*tlvs
;
2510 tlvs
= wpabuf_alloc(2 + 1 + 1 + 1 + os_strlen(query
));
2513 wpabuf_put_le16(tlvs
, 1 + 1 + 1 + os_strlen(query
));
2514 wpabuf_put_u8(tlvs
, P2P_SERV_UPNP
); /* Service Protocol Type */
2515 wpabuf_put_u8(tlvs
, 1); /* Service Transaction ID */
2516 wpabuf_put_u8(tlvs
, version
);
2517 wpabuf_put_str(tlvs
, query
);
2518 ret
= wpas_p2p_sd_request(wpa_s
, dst
, tlvs
);
2524 #ifdef CONFIG_WIFI_DISPLAY
2526 static u64
wpas_p2p_sd_request_wfd(struct wpa_supplicant
*wpa_s
, const u8
*dst
,
2527 const struct wpabuf
*tlvs
)
2529 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
2531 return (uintptr_t) p2p_sd_request_wfd(wpa_s
->global
->p2p
, dst
, tlvs
);
2535 #define MAX_WFD_SD_SUBELEMS 20
2537 static void wfd_add_sd_req_role(struct wpabuf
*tlvs
, u8 id
, u8 role
,
2538 const char *subelems
)
2545 len
= wpabuf_put(tlvs
, 2);
2546 wpabuf_put_u8(tlvs
, P2P_SERV_WIFI_DISPLAY
); /* Service Protocol Type */
2547 wpabuf_put_u8(tlvs
, id
); /* Service Transaction ID */
2549 wpabuf_put_u8(tlvs
, role
);
2554 if (val
>= 0 && val
< 256) {
2555 wpabuf_put_u8(tlvs
, val
);
2557 if (count
== MAX_WFD_SD_SUBELEMS
)
2560 pos
= os_strchr(pos
+ 1, ',');
2566 WPA_PUT_LE16(len
, (u8
*) wpabuf_put(tlvs
, 0) - len
- 2);
2570 u64
wpas_p2p_sd_request_wifi_display(struct wpa_supplicant
*wpa_s
,
2571 const u8
*dst
, const char *role
)
2573 struct wpabuf
*tlvs
;
2575 const char *subelems
;
2578 subelems
= os_strchr(role
, ' ');
2579 if (subelems
== NULL
)
2583 tlvs
= wpabuf_alloc(4 * (2 + 1 + 1 + 1 + MAX_WFD_SD_SUBELEMS
));
2587 if (os_strstr(role
, "[source]"))
2588 wfd_add_sd_req_role(tlvs
, id
++, 0x00, subelems
);
2589 if (os_strstr(role
, "[pri-sink]"))
2590 wfd_add_sd_req_role(tlvs
, id
++, 0x01, subelems
);
2591 if (os_strstr(role
, "[sec-sink]"))
2592 wfd_add_sd_req_role(tlvs
, id
++, 0x02, subelems
);
2593 if (os_strstr(role
, "[source+sink]"))
2594 wfd_add_sd_req_role(tlvs
, id
++, 0x03, subelems
);
2596 ret
= wpas_p2p_sd_request_wfd(wpa_s
, dst
, tlvs
);
2601 #endif /* CONFIG_WIFI_DISPLAY */
2604 int wpas_p2p_sd_cancel_request(struct wpa_supplicant
*wpa_s
, u64 req
)
2606 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
2608 return p2p_sd_cancel_request(wpa_s
->global
->p2p
,
2609 (void *) (uintptr_t) req
);
2613 void wpas_p2p_sd_response(struct wpa_supplicant
*wpa_s
, int freq
,
2614 const u8
*dst
, u8 dialog_token
,
2615 const struct wpabuf
*resp_tlvs
)
2617 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
2619 p2p_sd_response(wpa_s
->global
->p2p
, freq
, dst
, dialog_token
,
2624 void wpas_p2p_sd_service_update(struct wpa_supplicant
*wpa_s
)
2626 if (wpa_s
->global
->p2p
)
2627 p2p_sd_service_update(wpa_s
->global
->p2p
);
2631 static void wpas_p2p_srv_bonjour_free(struct p2p_srv_bonjour
*bsrv
)
2633 dl_list_del(&bsrv
->list
);
2634 wpabuf_free(bsrv
->query
);
2635 wpabuf_free(bsrv
->resp
);
2640 static void wpas_p2p_srv_upnp_free(struct p2p_srv_upnp
*usrv
)
2642 dl_list_del(&usrv
->list
);
2643 os_free(usrv
->service
);
2648 void wpas_p2p_service_flush(struct wpa_supplicant
*wpa_s
)
2650 struct p2p_srv_bonjour
*bsrv
, *bn
;
2651 struct p2p_srv_upnp
*usrv
, *un
;
2653 dl_list_for_each_safe(bsrv
, bn
, &wpa_s
->global
->p2p_srv_bonjour
,
2654 struct p2p_srv_bonjour
, list
)
2655 wpas_p2p_srv_bonjour_free(bsrv
);
2657 dl_list_for_each_safe(usrv
, un
, &wpa_s
->global
->p2p_srv_upnp
,
2658 struct p2p_srv_upnp
, list
)
2659 wpas_p2p_srv_upnp_free(usrv
);
2661 wpas_p2p_sd_service_update(wpa_s
);
2665 int wpas_p2p_service_add_bonjour(struct wpa_supplicant
*wpa_s
,
2666 struct wpabuf
*query
, struct wpabuf
*resp
)
2668 struct p2p_srv_bonjour
*bsrv
;
2670 bsrv
= os_zalloc(sizeof(*bsrv
));
2673 bsrv
->query
= query
;
2675 dl_list_add(&wpa_s
->global
->p2p_srv_bonjour
, &bsrv
->list
);
2677 wpas_p2p_sd_service_update(wpa_s
);
2682 int wpas_p2p_service_del_bonjour(struct wpa_supplicant
*wpa_s
,
2683 const struct wpabuf
*query
)
2685 struct p2p_srv_bonjour
*bsrv
;
2687 bsrv
= wpas_p2p_service_get_bonjour(wpa_s
, query
);
2690 wpas_p2p_srv_bonjour_free(bsrv
);
2691 wpas_p2p_sd_service_update(wpa_s
);
2696 int wpas_p2p_service_add_upnp(struct wpa_supplicant
*wpa_s
, u8 version
,
2697 const char *service
)
2699 struct p2p_srv_upnp
*usrv
;
2701 if (wpas_p2p_service_get_upnp(wpa_s
, version
, service
))
2702 return 0; /* Already listed */
2703 usrv
= os_zalloc(sizeof(*usrv
));
2706 usrv
->version
= version
;
2707 usrv
->service
= os_strdup(service
);
2708 if (usrv
->service
== NULL
) {
2712 dl_list_add(&wpa_s
->global
->p2p_srv_upnp
, &usrv
->list
);
2714 wpas_p2p_sd_service_update(wpa_s
);
2719 int wpas_p2p_service_del_upnp(struct wpa_supplicant
*wpa_s
, u8 version
,
2720 const char *service
)
2722 struct p2p_srv_upnp
*usrv
;
2724 usrv
= wpas_p2p_service_get_upnp(wpa_s
, version
, service
);
2727 wpas_p2p_srv_upnp_free(usrv
);
2728 wpas_p2p_sd_service_update(wpa_s
);
2733 static void wpas_prov_disc_local_display(struct wpa_supplicant
*wpa_s
,
2734 const u8
*peer
, const char *params
,
2735 unsigned int generated_pin
)
2737 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_PROV_DISC_SHOW_PIN MACSTR
2738 " %08d%s", MAC2STR(peer
), generated_pin
, params
);
2742 static void wpas_prov_disc_local_keypad(struct wpa_supplicant
*wpa_s
,
2743 const u8
*peer
, const char *params
)
2745 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_PROV_DISC_ENTER_PIN MACSTR
2746 "%s", MAC2STR(peer
), params
);
2750 static void wpas_prov_disc_req(void *ctx
, const u8
*peer
, u16 config_methods
,
2751 const u8
*dev_addr
, const u8
*pri_dev_type
,
2752 const char *dev_name
, u16 supp_config_methods
,
2753 u8 dev_capab
, u8 group_capab
, const u8
*group_id
,
2754 size_t group_id_len
)
2756 struct wpa_supplicant
*wpa_s
= ctx
;
2757 char devtype
[WPS_DEV_TYPE_BUFSIZE
];
2759 u8 empty_dev_type
[8];
2760 unsigned int generated_pin
= 0;
2761 struct wpa_supplicant
*group
= NULL
;
2764 for (group
= wpa_s
->global
->ifaces
; group
; group
= group
->next
)
2766 struct wpa_ssid
*s
= group
->current_ssid
;
2768 s
->mode
== WPAS_MODE_P2P_GO
&&
2769 group_id_len
- ETH_ALEN
== s
->ssid_len
&&
2770 os_memcmp(group_id
+ ETH_ALEN
, s
->ssid
,
2776 if (pri_dev_type
== NULL
) {
2777 os_memset(empty_dev_type
, 0, sizeof(empty_dev_type
));
2778 pri_dev_type
= empty_dev_type
;
2780 os_snprintf(params
, sizeof(params
), " p2p_dev_addr=" MACSTR
2781 " pri_dev_type=%s name='%s' config_methods=0x%x "
2782 "dev_capab=0x%x group_capab=0x%x%s%s",
2784 wps_dev_type_bin2str(pri_dev_type
, devtype
,
2786 dev_name
, supp_config_methods
, dev_capab
, group_capab
,
2787 group
? " group=" : "",
2788 group
? group
->ifname
: "");
2789 params
[sizeof(params
) - 1] = '\0';
2791 if (config_methods
& WPS_CONFIG_DISPLAY
) {
2792 generated_pin
= wps_generate_pin();
2793 wpas_prov_disc_local_display(wpa_s
, peer
, params
,
2795 } else if (config_methods
& WPS_CONFIG_KEYPAD
)
2796 wpas_prov_disc_local_keypad(wpa_s
, peer
, params
);
2797 else if (config_methods
& WPS_CONFIG_PUSHBUTTON
)
2798 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_PROV_DISC_PBC_REQ
2799 MACSTR
"%s", MAC2STR(peer
), params
);
2801 wpas_notify_p2p_provision_discovery(wpa_s
, peer
, 1 /* request */,
2802 P2P_PROV_DISC_SUCCESS
,
2803 config_methods
, generated_pin
);
2807 static void wpas_prov_disc_resp(void *ctx
, const u8
*peer
, u16 config_methods
)
2809 struct wpa_supplicant
*wpa_s
= ctx
;
2810 unsigned int generated_pin
= 0;
2813 if (wpa_s
->pending_pd_before_join
&&
2814 (os_memcmp(peer
, wpa_s
->pending_join_dev_addr
, ETH_ALEN
) == 0 ||
2815 os_memcmp(peer
, wpa_s
->pending_join_iface_addr
, ETH_ALEN
) == 0)) {
2816 wpa_s
->pending_pd_before_join
= 0;
2817 wpa_printf(MSG_DEBUG
, "P2P: Starting pending "
2818 "join-existing-group operation");
2819 wpas_p2p_join_start(wpa_s
);
2823 if (wpa_s
->pending_pd_use
== AUTO_PD_JOIN
||
2824 wpa_s
->pending_pd_use
== AUTO_PD_GO_NEG
)
2825 os_snprintf(params
, sizeof(params
), " peer_go=%d",
2826 wpa_s
->pending_pd_use
== AUTO_PD_JOIN
);
2830 if (config_methods
& WPS_CONFIG_DISPLAY
)
2831 wpas_prov_disc_local_keypad(wpa_s
, peer
, params
);
2832 else if (config_methods
& WPS_CONFIG_KEYPAD
) {
2833 generated_pin
= wps_generate_pin();
2834 wpas_prov_disc_local_display(wpa_s
, peer
, params
,
2836 } else if (config_methods
& WPS_CONFIG_PUSHBUTTON
)
2837 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_PROV_DISC_PBC_RESP
2838 MACSTR
"%s", MAC2STR(peer
), params
);
2840 wpas_notify_p2p_provision_discovery(wpa_s
, peer
, 0 /* response */,
2841 P2P_PROV_DISC_SUCCESS
,
2842 config_methods
, generated_pin
);
2846 static void wpas_prov_disc_fail(void *ctx
, const u8
*peer
,
2847 enum p2p_prov_disc_status status
)
2849 struct wpa_supplicant
*wpa_s
= ctx
;
2851 if (wpa_s
->p2p_fallback_to_go_neg
) {
2852 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: PD for p2p_connect-auto "
2853 "failed - fall back to GO Negotiation");
2854 wpas_p2p_fallback_to_go_neg(wpa_s
, 0);
2858 if (status
== P2P_PROV_DISC_TIMEOUT_JOIN
) {
2859 wpa_s
->pending_pd_before_join
= 0;
2860 wpa_printf(MSG_DEBUG
, "P2P: Starting pending "
2861 "join-existing-group operation (no ACK for PD "
2863 wpas_p2p_join_start(wpa_s
);
2867 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_PROV_DISC_FAILURE
2868 " p2p_dev_addr=" MACSTR
" status=%d",
2869 MAC2STR(peer
), status
);
2871 wpas_notify_p2p_provision_discovery(wpa_s
, peer
, 0 /* response */,
2876 static int freq_included(const struct p2p_channels
*channels
, unsigned int freq
)
2878 if (channels
== NULL
)
2879 return 1; /* Assume no restrictions */
2880 return p2p_channels_includes_freq(channels
, freq
);
2885 static u8
wpas_invitation_process(void *ctx
, const u8
*sa
, const u8
*bssid
,
2886 const u8
*go_dev_addr
, const u8
*ssid
,
2887 size_t ssid_len
, int *go
, u8
*group_bssid
,
2888 int *force_freq
, int persistent_group
,
2889 const struct p2p_channels
*channels
)
2891 struct wpa_supplicant
*wpa_s
= ctx
;
2894 struct wpa_supplicant
*grp
;
2896 if (!persistent_group
) {
2897 wpa_printf(MSG_DEBUG
, "P2P: Invitation from " MACSTR
2898 " to join an active group (SSID: %s)",
2899 MAC2STR(sa
), wpa_ssid_txt(ssid
, ssid_len
));
2900 if (!is_zero_ether_addr(wpa_s
->p2p_auth_invite
) &&
2901 (os_memcmp(go_dev_addr
, wpa_s
->p2p_auth_invite
, ETH_ALEN
)
2903 os_memcmp(sa
, wpa_s
->p2p_auth_invite
, ETH_ALEN
) == 0)) {
2904 wpa_printf(MSG_DEBUG
, "P2P: Accept previously "
2905 "authorized invitation");
2909 * Do not accept the invitation automatically; notify user and
2912 return P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE
;
2915 grp
= wpas_get_p2p_group(wpa_s
, ssid
, ssid_len
, go
);
2917 wpa_printf(MSG_DEBUG
, "P2P: Accept invitation to already "
2918 "running persistent group");
2920 os_memcpy(group_bssid
, grp
->own_addr
, ETH_ALEN
);
2924 if (!is_zero_ether_addr(wpa_s
->p2p_auth_invite
) &&
2925 os_memcmp(sa
, wpa_s
->p2p_auth_invite
, ETH_ALEN
) == 0) {
2926 wpa_printf(MSG_DEBUG
, "P2P: Accept previously initiated "
2927 "invitation to re-invoke a persistent group");
2928 } else if (!wpa_s
->conf
->persistent_reconnect
)
2929 return P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE
;
2931 for (s
= wpa_s
->conf
->ssid
; s
; s
= s
->next
) {
2932 if (s
->disabled
== 2 &&
2933 os_memcmp(s
->bssid
, go_dev_addr
, ETH_ALEN
) == 0 &&
2934 s
->ssid_len
== ssid_len
&&
2935 os_memcmp(ssid
, s
->ssid
, ssid_len
) == 0)
2940 wpa_printf(MSG_DEBUG
, "P2P: Invitation from " MACSTR
2941 " requested reinvocation of an unknown group",
2943 return P2P_SC_FAIL_UNKNOWN_GROUP
;
2946 if (s
->mode
== WPAS_MODE_P2P_GO
&& !wpas_p2p_create_iface(wpa_s
)) {
2948 if (wpa_s
->wpa_state
>= WPA_AUTHENTICATING
) {
2949 wpa_printf(MSG_DEBUG
, "P2P: The only available "
2950 "interface is already in use - reject "
2952 return P2P_SC_FAIL_UNABLE_TO_ACCOMMODATE
;
2954 os_memcpy(group_bssid
, wpa_s
->own_addr
, ETH_ALEN
);
2955 } else if (s
->mode
== WPAS_MODE_P2P_GO
) {
2957 if (wpas_p2p_add_group_interface(wpa_s
, WPA_IF_P2P_GO
) < 0)
2959 wpa_printf(MSG_ERROR
, "P2P: Failed to allocate a new "
2960 "interface address for the group");
2961 return P2P_SC_FAIL_UNABLE_TO_ACCOMMODATE
;
2963 os_memcpy(group_bssid
, wpa_s
->pending_interface_addr
,
2968 wpas_p2p_set_own_freq_preference(wpa_s
, 0);
2970 /* Get one of the frequencies currently in use */
2971 if (wpas_p2p_valid_oper_freqs(wpa_s
, &res
, 1) > 0) {
2972 wpa_printf(MSG_DEBUG
, "P2P: Trying to prefer a channel already used by one of the interfaces");
2973 wpas_p2p_set_own_freq_preference(wpa_s
, res
);
2975 if (wpa_s
->num_multichan_concurrent
< 2 ||
2976 wpas_p2p_num_unused_channels(wpa_s
) < 1) {
2977 wpa_printf(MSG_DEBUG
, "P2P: No extra channels available - trying to force channel to match a channel already used by one of the interfaces");
2982 if (*force_freq
> 0 && wpa_s
->num_multichan_concurrent
> 1 &&
2983 wpas_p2p_num_unused_channels(wpa_s
) > 0) {
2985 /* We are the client */
2986 wpa_printf(MSG_DEBUG
, "P2P: Peer was found to be "
2987 "running a GO but we are capable of MCC, "
2988 "figure out the best channel to use");
2990 } else if (!freq_included(channels
, *force_freq
)) {
2991 /* We are the GO, and *force_freq is not in the
2993 wpa_printf(MSG_DEBUG
, "P2P: Forced GO freq %d MHz not "
2994 "in intersection but we are capable of MCC, "
2995 "figure out the best channel to use",
3001 return P2P_SC_SUCCESS
;
3005 static void wpas_invitation_received(void *ctx
, const u8
*sa
, const u8
*bssid
,
3006 const u8
*ssid
, size_t ssid_len
,
3007 const u8
*go_dev_addr
, u8 status
,
3010 struct wpa_supplicant
*wpa_s
= ctx
;
3013 for (s
= wpa_s
->conf
->ssid
; s
; s
= s
->next
) {
3014 if (s
->disabled
== 2 &&
3015 s
->ssid_len
== ssid_len
&&
3016 os_memcmp(ssid
, s
->ssid
, ssid_len
) == 0)
3020 if (status
== P2P_SC_SUCCESS
) {
3021 wpa_printf(MSG_DEBUG
, "P2P: Invitation from peer " MACSTR
3022 " was accepted; op_freq=%d MHz, SSID=%s",
3023 MAC2STR(sa
), op_freq
, wpa_ssid_txt(ssid
, ssid_len
));
3025 int go
= s
->mode
== WPAS_MODE_P2P_GO
;
3026 wpas_p2p_group_add_persistent(
3027 wpa_s
, s
, go
, go
? op_freq
: 0, 0, 0, NULL
,
3028 go
? P2P_MAX_INITIAL_CONN_WAIT_GO_REINVOKE
: 0);
3030 wpa_s
->user_initiated_pd
= 0;
3031 wpas_p2p_join(wpa_s
, bssid
, go_dev_addr
,
3032 wpa_s
->p2p_wps_method
, 0,
3038 if (status
!= P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE
) {
3039 wpa_printf(MSG_DEBUG
, "P2P: Invitation from peer " MACSTR
3040 " was rejected (status %u)", MAC2STR(sa
), status
);
3046 wpa_msg_global(wpa_s
, MSG_INFO
,
3047 P2P_EVENT_INVITATION_RECEIVED
3048 "sa=" MACSTR
" go_dev_addr=" MACSTR
3049 " bssid=" MACSTR
" unknown-network",
3050 MAC2STR(sa
), MAC2STR(go_dev_addr
),
3053 wpa_msg_global(wpa_s
, MSG_INFO
,
3054 P2P_EVENT_INVITATION_RECEIVED
3055 "sa=" MACSTR
" go_dev_addr=" MACSTR
3057 MAC2STR(sa
), MAC2STR(go_dev_addr
));
3062 if (s
->mode
== WPAS_MODE_P2P_GO
&& op_freq
) {
3063 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_INVITATION_RECEIVED
3064 "sa=" MACSTR
" persistent=%d freq=%d",
3065 MAC2STR(sa
), s
->id
, op_freq
);
3067 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_INVITATION_RECEIVED
3068 "sa=" MACSTR
" persistent=%d",
3069 MAC2STR(sa
), s
->id
);
3074 static void wpas_remove_persistent_peer(struct wpa_supplicant
*wpa_s
,
3075 struct wpa_ssid
*ssid
,
3076 const u8
*peer
, int inv
)
3083 for (i
= 0; ssid
->p2p_client_list
&& i
< ssid
->num_p2p_clients
; i
++) {
3084 if (os_memcmp(ssid
->p2p_client_list
+ i
* ETH_ALEN
, peer
,
3088 if (i
>= ssid
->num_p2p_clients
) {
3089 if (ssid
->mode
!= WPAS_MODE_P2P_GO
&&
3090 os_memcmp(ssid
->bssid
, peer
, ETH_ALEN
) == 0) {
3091 wpa_printf(MSG_DEBUG
, "P2P: Remove persistent group %d "
3092 "due to invitation result", ssid
->id
);
3093 wpas_notify_network_removed(wpa_s
, ssid
);
3094 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
3097 return; /* Peer not found in client list */
3100 wpa_printf(MSG_DEBUG
, "P2P: Remove peer " MACSTR
" from persistent "
3101 "group %d client list%s",
3102 MAC2STR(peer
), ssid
->id
,
3103 inv
? " due to invitation result" : "");
3104 os_memmove(ssid
->p2p_client_list
+ i
* ETH_ALEN
,
3105 ssid
->p2p_client_list
+ (i
+ 1) * ETH_ALEN
,
3106 (ssid
->num_p2p_clients
- i
- 1) * ETH_ALEN
);
3107 ssid
->num_p2p_clients
--;
3108 #ifndef CONFIG_NO_CONFIG_WRITE
3109 if (wpa_s
->parent
->conf
->update_config
&&
3110 wpa_config_write(wpa_s
->parent
->confname
, wpa_s
->parent
->conf
))
3111 wpa_printf(MSG_DEBUG
, "P2P: Failed to update configuration");
3112 #endif /* CONFIG_NO_CONFIG_WRITE */
3116 static void wpas_remove_persistent_client(struct wpa_supplicant
*wpa_s
,
3119 struct wpa_ssid
*ssid
;
3121 wpa_s
= wpa_s
->global
->p2p_invite_group
;
3123 return; /* No known invitation group */
3124 ssid
= wpa_s
->current_ssid
;
3125 if (ssid
== NULL
|| ssid
->mode
!= WPAS_MODE_P2P_GO
||
3126 !ssid
->p2p_persistent_group
)
3127 return; /* Not operating as a GO in persistent group */
3128 ssid
= wpas_p2p_get_persistent(wpa_s
->parent
, peer
,
3129 ssid
->ssid
, ssid
->ssid_len
);
3130 wpas_remove_persistent_peer(wpa_s
, ssid
, peer
, 1);
3134 static void wpas_invitation_result(void *ctx
, int status
, const u8
*bssid
,
3135 const struct p2p_channels
*channels
,
3136 const u8
*peer
, int neg_freq
)
3138 struct wpa_supplicant
*wpa_s
= ctx
;
3139 struct wpa_ssid
*ssid
;
3143 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_INVITATION_RESULT
3144 "status=%d " MACSTR
,
3145 status
, MAC2STR(bssid
));
3147 wpa_msg_global(wpa_s
, MSG_INFO
, P2P_EVENT_INVITATION_RESULT
3148 "status=%d ", status
);
3150 wpas_notify_p2p_invitation_result(wpa_s
, status
, bssid
);
3152 wpa_printf(MSG_DEBUG
, "P2P: Invitation result - status=%d peer=" MACSTR
,
3153 status
, MAC2STR(peer
));
3154 if (wpa_s
->pending_invite_ssid_id
== -1) {
3155 if (status
== P2P_SC_FAIL_UNKNOWN_GROUP
)
3156 wpas_remove_persistent_client(wpa_s
, peer
);
3157 return; /* Invitation to active group */
3160 if (status
== P2P_SC_FAIL_INFO_CURRENTLY_UNAVAILABLE
) {
3161 wpa_printf(MSG_DEBUG
, "P2P: Waiting for peer to start another "
3162 "invitation exchange to indicate readiness for "
3166 if (status
!= P2P_SC_SUCCESS
) {
3167 if (status
== P2P_SC_FAIL_UNKNOWN_GROUP
) {
3168 ssid
= wpa_config_get_network(
3169 wpa_s
->conf
, wpa_s
->pending_invite_ssid_id
);
3170 wpas_remove_persistent_peer(wpa_s
, ssid
, peer
, 1);
3172 wpas_p2p_remove_pending_group_interface(wpa_s
);
3176 ssid
= wpa_config_get_network(wpa_s
->conf
,
3177 wpa_s
->pending_invite_ssid_id
);
3179 wpa_printf(MSG_ERROR
, "P2P: Could not find persistent group "
3180 "data matching with invitation");
3185 * The peer could have missed our ctrl::ack frame for Invitation
3186 * Response and continue retransmitting the frame. To reduce the
3187 * likelihood of the peer not getting successful TX status for the
3188 * Invitation Response frame, wait a short time here before starting
3189 * the persistent group so that we will remain on the current channel to
3190 * acknowledge any possible retransmission from the peer.
3192 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: 50 ms wait on current channel before "
3193 "starting persistent group");
3196 freq
= wpa_s
->p2p_persistent_go_freq
;
3197 if (neg_freq
> 0 && ssid
->mode
== WPAS_MODE_P2P_GO
&&
3198 freq_included(channels
, neg_freq
)) {
3199 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Use frequence %d MHz from invitation for GO mode",
3204 wpas_p2p_group_add_persistent(wpa_s
, ssid
,
3205 ssid
->mode
== WPAS_MODE_P2P_GO
,
3207 wpa_s
->p2p_go_ht40
, wpa_s
->p2p_go_vht
,
3209 ssid
->mode
== WPAS_MODE_P2P_GO
?
3210 P2P_MAX_INITIAL_CONN_WAIT_GO_REINVOKE
:
3215 static int wpas_p2p_disallowed_freq(struct wpa_global
*global
,
3218 if (freq_range_list_includes(&global
->p2p_go_avoid_freq
, freq
))
3220 return freq_range_list_includes(&global
->p2p_disallow_freq
, freq
);
3224 static void wpas_p2p_add_chan(struct p2p_reg_class
*reg
, u8 chan
)
3226 reg
->channel
[reg
->channels
] = chan
;
3231 static int wpas_p2p_default_channels(struct wpa_supplicant
*wpa_s
,
3232 struct p2p_channels
*chan
,
3233 struct p2p_channels
*cli_chan
)
3237 os_memset(cli_chan
, 0, sizeof(*cli_chan
));
3239 wpa_printf(MSG_DEBUG
, "P2P: Enable operating classes for 2.4 GHz "
3242 /* Operating class 81 - 2.4 GHz band channels 1..13 */
3243 chan
->reg_class
[cla
].reg_class
= 81;
3244 chan
->reg_class
[cla
].channels
= 0;
3245 for (i
= 0; i
< 11; i
++) {
3246 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 2412 + i
* 5))
3247 wpas_p2p_add_chan(&chan
->reg_class
[cla
], i
+ 1);
3249 if (chan
->reg_class
[cla
].channels
)
3252 wpa_printf(MSG_DEBUG
, "P2P: Enable operating classes for lower 5 GHz "
3255 /* Operating class 115 - 5 GHz, channels 36-48 */
3256 chan
->reg_class
[cla
].reg_class
= 115;
3257 chan
->reg_class
[cla
].channels
= 0;
3258 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 36 * 5))
3259 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 36);
3260 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 40 * 5))
3261 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 40);
3262 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 44 * 5))
3263 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 44);
3264 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 48 * 5))
3265 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 48);
3266 if (chan
->reg_class
[cla
].channels
)
3269 wpa_printf(MSG_DEBUG
, "P2P: Enable operating classes for higher 5 GHz "
3272 /* Operating class 124 - 5 GHz, channels 149,153,157,161 */
3273 chan
->reg_class
[cla
].reg_class
= 124;
3274 chan
->reg_class
[cla
].channels
= 0;
3275 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 149 * 5))
3276 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 149);
3277 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 153 * 5))
3278 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 153);
3279 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 156 * 5))
3280 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 157);
3281 if (!wpas_p2p_disallowed_freq(wpa_s
->global
, 5000 + 161 * 5))
3282 wpas_p2p_add_chan(&chan
->reg_class
[cla
], 161);
3283 if (chan
->reg_class
[cla
].channels
)
3286 chan
->reg_classes
= cla
;
3291 static struct hostapd_hw_modes
* get_mode(struct hostapd_hw_modes
*modes
,
3293 enum hostapd_hw_mode mode
)
3297 for (i
= 0; i
< num_modes
; i
++) {
3298 if (modes
[i
].mode
== mode
)
3307 NOT_ALLOWED
, PASSIVE_ONLY
, ALLOWED
3310 static int has_channel(struct wpa_global
*global
,
3311 struct hostapd_hw_modes
*mode
, u8 chan
, int *flags
)
3316 freq
= (mode
->mode
== HOSTAPD_MODE_IEEE80211A
? 5000 : 2407) +
3318 if (wpas_p2p_disallowed_freq(global
, freq
))
3321 for (i
= 0; i
< mode
->num_channels
; i
++) {
3322 if (mode
->channels
[i
].chan
== chan
) {
3324 *flags
= mode
->channels
[i
].flag
;
3325 if (mode
->channels
[i
].flag
&
3326 (HOSTAPD_CHAN_DISABLED
|
3327 HOSTAPD_CHAN_RADAR
))
3329 if (mode
->channels
[i
].flag
&
3330 (HOSTAPD_CHAN_PASSIVE_SCAN
|
3331 HOSTAPD_CHAN_NO_IBSS
))
3332 return PASSIVE_ONLY
;
3341 struct p2p_oper_class_map
{
3342 enum hostapd_hw_mode mode
;
3347 enum { BW20
, BW40PLUS
, BW40MINUS
, BW80
} bw
;
3350 static struct p2p_oper_class_map op_class
[] = {
3351 { HOSTAPD_MODE_IEEE80211G
, 81, 1, 13, 1, BW20
},
3352 #if 0 /* Do not enable HT40 on 2 GHz for now */
3353 { HOSTAPD_MODE_IEEE80211G
, 83, 1, 9, 1, BW40PLUS
},
3354 { HOSTAPD_MODE_IEEE80211G
, 84, 5, 13, 1, BW40MINUS
},
3356 { HOSTAPD_MODE_IEEE80211A
, 115, 36, 48, 4, BW20
},
3357 { HOSTAPD_MODE_IEEE80211A
, 124, 149, 161, 4, BW20
},
3358 { HOSTAPD_MODE_IEEE80211A
, 116, 36, 44, 8, BW40PLUS
},
3359 { HOSTAPD_MODE_IEEE80211A
, 117, 40, 48, 8, BW40MINUS
},
3360 { HOSTAPD_MODE_IEEE80211A
, 126, 149, 157, 8, BW40PLUS
},
3361 { HOSTAPD_MODE_IEEE80211A
, 127, 153, 161, 8, BW40MINUS
},
3364 * IEEE P802.11ac/D7.0 Table E-4 actually talks about channel center
3365 * frequency index 42, 58, 106, 122, 138, 155 with channel spacing of
3366 * 80 MHz, but currently use the following definition for simplicity
3367 * (these center frequencies are not actual channels, which makes
3368 * has_channel() fail). wpas_p2p_verify_80mhz() should take care of
3369 * removing invalid channels.
3371 { HOSTAPD_MODE_IEEE80211A
, 128, 36, 161, 4, BW80
},
3372 { -1, 0, 0, 0, 0, BW20
}
3376 static int wpas_p2p_get_center_80mhz(struct wpa_supplicant
*wpa_s
,
3377 struct hostapd_hw_modes
*mode
,
3380 u8 center_channels
[] = { 42, 58, 106, 122, 138, 155 };
3383 if (mode
->mode
!= HOSTAPD_MODE_IEEE80211A
)
3386 for (i
= 0; i
< ARRAY_SIZE(center_channels
); i
++)
3388 * In 80 MHz, the bandwidth "spans" 12 channels (e.g., 36-48),
3389 * so the center channel is 6 channels away from the start/end.
3391 if (channel
>= center_channels
[i
] - 6 &&
3392 channel
<= center_channels
[i
] + 6)
3393 return center_channels
[i
];
3399 static enum chan_allowed
wpas_p2p_verify_80mhz(struct wpa_supplicant
*wpa_s
,
3400 struct hostapd_hw_modes
*mode
,
3405 enum chan_allowed res
, ret
= ALLOWED
;
3407 center_chan
= wpas_p2p_get_center_80mhz(wpa_s
, mode
, channel
);
3410 if (center_chan
>= 58 && center_chan
<= 138)
3411 return NOT_ALLOWED
; /* Do not allow DFS channels for P2P */
3413 /* check all the channels are available */
3414 for (i
= 0; i
< 4; i
++) {
3415 int adj_chan
= center_chan
- 6 + i
* 4;
3417 res
= has_channel(wpa_s
->global
, mode
, adj_chan
, &flags
);
3418 if (res
== NOT_ALLOWED
)
3420 if (res
== PASSIVE_ONLY
)
3423 if (i
== 0 && !(flags
& HOSTAPD_CHAN_VHT_10_70
))
3425 if (i
== 1 && !(flags
& HOSTAPD_CHAN_VHT_30_50
))
3427 if (i
== 2 && !(flags
& HOSTAPD_CHAN_VHT_50_30
))
3429 if (i
== 3 && !(flags
& HOSTAPD_CHAN_VHT_70_10
))
3437 static enum chan_allowed
wpas_p2p_verify_channel(struct wpa_supplicant
*wpa_s
,
3438 struct hostapd_hw_modes
*mode
,
3442 enum chan_allowed res
, res2
;
3444 res2
= res
= has_channel(wpa_s
->global
, mode
, channel
, &flag
);
3445 if (bw
== BW40MINUS
) {
3446 if (!(flag
& HOSTAPD_CHAN_HT40MINUS
))
3448 res2
= has_channel(wpa_s
->global
, mode
, channel
- 4, NULL
);
3449 } else if (bw
== BW40PLUS
) {
3450 if (!(flag
& HOSTAPD_CHAN_HT40PLUS
))
3452 res2
= has_channel(wpa_s
->global
, mode
, channel
+ 4, NULL
);
3453 } else if (bw
== BW80
) {
3454 res2
= wpas_p2p_verify_80mhz(wpa_s
, mode
, channel
, bw
);
3457 if (res
== NOT_ALLOWED
|| res2
== NOT_ALLOWED
)
3459 if (res
== PASSIVE_ONLY
|| res2
== PASSIVE_ONLY
)
3460 return PASSIVE_ONLY
;
3465 static int wpas_p2p_setup_channels(struct wpa_supplicant
*wpa_s
,
3466 struct p2p_channels
*chan
,
3467 struct p2p_channels
*cli_chan
)
3469 struct hostapd_hw_modes
*mode
;
3470 int cla
, op
, cli_cla
;
3472 if (wpa_s
->hw
.modes
== NULL
) {
3473 wpa_printf(MSG_DEBUG
, "P2P: Driver did not support fetching "
3474 "of all supported channels; assume dualband "
3476 return wpas_p2p_default_channels(wpa_s
, chan
, cli_chan
);
3481 for (op
= 0; op_class
[op
].op_class
; op
++) {
3482 struct p2p_oper_class_map
*o
= &op_class
[op
];
3484 struct p2p_reg_class
*reg
= NULL
, *cli_reg
= NULL
;
3486 mode
= get_mode(wpa_s
->hw
.modes
, wpa_s
->hw
.num_modes
, o
->mode
);
3489 for (ch
= o
->min_chan
; ch
<= o
->max_chan
; ch
+= o
->inc
) {
3490 enum chan_allowed res
;
3491 res
= wpas_p2p_verify_channel(wpa_s
, mode
, ch
, o
->bw
);
3492 if (res
== ALLOWED
) {
3494 wpa_printf(MSG_DEBUG
, "P2P: Add operating class %u",
3496 reg
= &chan
->reg_class
[cla
];
3498 reg
->reg_class
= o
->op_class
;
3500 reg
->channel
[reg
->channels
] = ch
;
3502 } else if (res
== PASSIVE_ONLY
&&
3503 wpa_s
->conf
->p2p_add_cli_chan
) {
3504 if (cli_reg
== NULL
) {
3505 wpa_printf(MSG_DEBUG
, "P2P: Add operating class %u (client only)",
3507 cli_reg
= &cli_chan
->reg_class
[cli_cla
];
3509 cli_reg
->reg_class
= o
->op_class
;
3511 cli_reg
->channel
[cli_reg
->channels
] = ch
;
3512 cli_reg
->channels
++;
3516 wpa_hexdump(MSG_DEBUG
, "P2P: Channels",
3517 reg
->channel
, reg
->channels
);
3520 wpa_hexdump(MSG_DEBUG
, "P2P: Channels (client only)",
3521 cli_reg
->channel
, cli_reg
->channels
);
3525 chan
->reg_classes
= cla
;
3526 cli_chan
->reg_classes
= cli_cla
;
3532 int wpas_p2p_get_ht40_mode(struct wpa_supplicant
*wpa_s
,
3533 struct hostapd_hw_modes
*mode
, u8 channel
)
3536 enum chan_allowed ret
;
3538 for (op
= 0; op_class
[op
].op_class
; op
++) {
3539 struct p2p_oper_class_map
*o
= &op_class
[op
];
3542 for (ch
= o
->min_chan
; ch
<= o
->max_chan
; ch
+= o
->inc
) {
3543 if (o
->mode
!= HOSTAPD_MODE_IEEE80211A
||
3544 o
->bw
== BW20
|| ch
!= channel
)
3546 ret
= wpas_p2p_verify_channel(wpa_s
, mode
, ch
, o
->bw
);
3548 return (o
->bw
== BW40MINUS
) ? -1 : 1;
3555 int wpas_p2p_get_vht80_center(struct wpa_supplicant
*wpa_s
,
3556 struct hostapd_hw_modes
*mode
, u8 channel
)
3558 if (!wpas_p2p_verify_channel(wpa_s
, mode
, channel
, BW80
))
3561 return wpas_p2p_get_center_80mhz(wpa_s
, mode
, channel
);
3565 static int wpas_get_noa(void *ctx
, const u8
*interface_addr
, u8
*buf
,
3568 struct wpa_supplicant
*wpa_s
= ctx
;
3570 for (wpa_s
= wpa_s
->global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
3571 if (os_memcmp(wpa_s
->own_addr
, interface_addr
, ETH_ALEN
) == 0)
3577 return wpa_drv_get_noa(wpa_s
, buf
, buf_len
);
3581 static int wpas_go_connected(void *ctx
, const u8
*dev_addr
)
3583 struct wpa_supplicant
*wpa_s
= ctx
;
3585 for (wpa_s
= wpa_s
->global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
3586 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
3589 if (ssid
->mode
!= WPAS_MODE_INFRA
)
3591 if (wpa_s
->wpa_state
!= WPA_COMPLETED
&&
3592 wpa_s
->wpa_state
!= WPA_GROUP_HANDSHAKE
)
3594 if (os_memcmp(wpa_s
->go_dev_addr
, dev_addr
, ETH_ALEN
) == 0)
3602 static int wpas_is_concurrent_session_active(void *ctx
)
3604 struct wpa_supplicant
*wpa_s
= ctx
;
3605 struct wpa_supplicant
*ifs
;
3607 for (ifs
= wpa_s
->global
->ifaces
; ifs
; ifs
= ifs
->next
) {
3610 if (ifs
->wpa_state
> WPA_ASSOCIATED
)
3617 static void wpas_p2p_debug_print(void *ctx
, int level
, const char *msg
)
3619 struct wpa_supplicant
*wpa_s
= ctx
;
3620 wpa_msg_global(wpa_s
, level
, "P2P: %s", msg
);
3624 int wpas_p2p_add_p2pdev_interface(struct wpa_supplicant
*wpa_s
)
3626 struct wpa_interface iface
;
3627 struct wpa_supplicant
*p2pdev_wpa_s
;
3629 char force_name
[100];
3632 os_snprintf(ifname
, sizeof(ifname
), P2P_MGMT_DEVICE_PREFIX
"%s",
3634 force_name
[0] = '\0';
3635 wpa_s
->pending_interface_type
= WPA_IF_P2P_DEVICE
;
3636 ret
= wpa_drv_if_add(wpa_s
, WPA_IF_P2P_DEVICE
, ifname
, NULL
, NULL
,
3637 force_name
, wpa_s
->pending_interface_addr
, NULL
);
3639 wpa_printf(MSG_DEBUG
, "P2P: Failed to create P2P Device interface");
3642 os_strlcpy(wpa_s
->pending_interface_name
, ifname
,
3643 sizeof(wpa_s
->pending_interface_name
));
3645 os_memset(&iface
, 0, sizeof(iface
));
3647 iface
.ifname
= wpa_s
->pending_interface_name
;
3648 iface
.driver
= wpa_s
->driver
->name
;
3649 iface
.driver_param
= wpa_s
->conf
->driver_param
;
3650 iface
.confname
= wpa_s
->confname
;
3651 p2pdev_wpa_s
= wpa_supplicant_add_iface(wpa_s
->global
, &iface
);
3652 if (!p2pdev_wpa_s
) {
3653 wpa_printf(MSG_DEBUG
, "P2P: Failed to add P2P Device interface");
3656 p2pdev_wpa_s
->parent
= wpa_s
;
3658 wpa_s
->pending_interface_name
[0] = '\0';
3663 static void wpas_presence_resp(void *ctx
, const u8
*src
, u8 status
,
3664 const u8
*noa
, size_t noa_len
)
3666 struct wpa_supplicant
*wpa_s
, *intf
= ctx
;
3669 for (wpa_s
= intf
->global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
3670 if (wpa_s
->waiting_presence_resp
)
3674 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: No group interface was waiting for presence response");
3677 wpa_s
->waiting_presence_resp
= 0;
3679 wpa_snprintf_hex(hex
, sizeof(hex
), noa
, noa_len
);
3680 wpa_msg(wpa_s
, MSG_INFO
, P2P_EVENT_PRESENCE_RESPONSE
"src=" MACSTR
3681 " status=%u noa=%s", MAC2STR(src
), status
, hex
);
3686 * wpas_p2p_init - Initialize P2P module for %wpa_supplicant
3687 * @global: Pointer to global data from wpa_supplicant_init()
3688 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
3689 * Returns: 0 on success, -1 on failure
3691 int wpas_p2p_init(struct wpa_global
*global
, struct wpa_supplicant
*wpa_s
)
3693 struct p2p_config p2p
;
3697 if (wpa_s
->conf
->p2p_disabled
)
3700 if (!(wpa_s
->drv_flags
& WPA_DRIVER_FLAGS_P2P_CAPABLE
))
3706 os_memset(&p2p
, 0, sizeof(p2p
));
3708 p2p
.debug_print
= wpas_p2p_debug_print
;
3709 p2p
.p2p_scan
= wpas_p2p_scan
;
3710 p2p
.send_action
= wpas_send_action
;
3711 p2p
.send_action_done
= wpas_send_action_done
;
3712 p2p
.go_neg_completed
= wpas_go_neg_completed
;
3713 p2p
.go_neg_req_rx
= wpas_go_neg_req_rx
;
3714 p2p
.dev_found
= wpas_dev_found
;
3715 p2p
.dev_lost
= wpas_dev_lost
;
3716 p2p
.find_stopped
= wpas_find_stopped
;
3717 p2p
.start_listen
= wpas_start_listen
;
3718 p2p
.stop_listen
= wpas_stop_listen
;
3719 p2p
.send_probe_resp
= wpas_send_probe_resp
;
3720 p2p
.sd_request
= wpas_sd_request
;
3721 p2p
.sd_response
= wpas_sd_response
;
3722 p2p
.prov_disc_req
= wpas_prov_disc_req
;
3723 p2p
.prov_disc_resp
= wpas_prov_disc_resp
;
3724 p2p
.prov_disc_fail
= wpas_prov_disc_fail
;
3725 p2p
.invitation_process
= wpas_invitation_process
;
3726 p2p
.invitation_received
= wpas_invitation_received
;
3727 p2p
.invitation_result
= wpas_invitation_result
;
3728 p2p
.get_noa
= wpas_get_noa
;
3729 p2p
.go_connected
= wpas_go_connected
;
3730 p2p
.presence_resp
= wpas_presence_resp
;
3731 p2p
.is_concurrent_session_active
= wpas_is_concurrent_session_active
;
3733 os_memcpy(wpa_s
->global
->p2p_dev_addr
, wpa_s
->own_addr
, ETH_ALEN
);
3734 os_memcpy(p2p
.dev_addr
, wpa_s
->global
->p2p_dev_addr
, ETH_ALEN
);
3735 p2p
.dev_name
= wpa_s
->conf
->device_name
;
3736 p2p
.manufacturer
= wpa_s
->conf
->manufacturer
;
3737 p2p
.model_name
= wpa_s
->conf
->model_name
;
3738 p2p
.model_number
= wpa_s
->conf
->model_number
;
3739 p2p
.serial_number
= wpa_s
->conf
->serial_number
;
3741 os_memcpy(p2p
.uuid
, wpa_s
->wps
->uuid
, 16);
3742 p2p
.config_methods
= wpa_s
->wps
->config_methods
;
3745 if (wpa_s
->conf
->p2p_listen_reg_class
&&
3746 wpa_s
->conf
->p2p_listen_channel
) {
3747 p2p
.reg_class
= wpa_s
->conf
->p2p_listen_reg_class
;
3748 p2p
.channel
= wpa_s
->conf
->p2p_listen_channel
;
3752 * Pick one of the social channels randomly as the listen
3755 os_get_random((u8
*) &r
, sizeof(r
));
3756 p2p
.channel
= 1 + (r
% 3) * 5;
3758 wpa_printf(MSG_DEBUG
, "P2P: Own listen channel: %d", p2p
.channel
);
3760 if (wpa_s
->conf
->p2p_oper_reg_class
&&
3761 wpa_s
->conf
->p2p_oper_channel
) {
3762 p2p
.op_reg_class
= wpa_s
->conf
->p2p_oper_reg_class
;
3763 p2p
.op_channel
= wpa_s
->conf
->p2p_oper_channel
;
3764 p2p
.cfg_op_channel
= 1;
3765 wpa_printf(MSG_DEBUG
, "P2P: Configured operating channel: "
3766 "%d:%d", p2p
.op_reg_class
, p2p
.op_channel
);
3769 p2p
.op_reg_class
= 81;
3771 * Use random operation channel from (1, 6, 11) if no other
3772 * preference is indicated.
3774 os_get_random((u8
*) &r
, sizeof(r
));
3775 p2p
.op_channel
= 1 + (r
% 3) * 5;
3776 p2p
.cfg_op_channel
= 0;
3777 wpa_printf(MSG_DEBUG
, "P2P: Random operating channel: "
3778 "%d:%d", p2p
.op_reg_class
, p2p
.op_channel
);
3781 if (wpa_s
->conf
->p2p_pref_chan
&& wpa_s
->conf
->num_p2p_pref_chan
) {
3782 p2p
.pref_chan
= wpa_s
->conf
->p2p_pref_chan
;
3783 p2p
.num_pref_chan
= wpa_s
->conf
->num_p2p_pref_chan
;
3786 if (wpa_s
->conf
->country
[0] && wpa_s
->conf
->country
[1]) {
3787 os_memcpy(p2p
.country
, wpa_s
->conf
->country
, 2);
3788 p2p
.country
[2] = 0x04;
3790 os_memcpy(p2p
.country
, "XX\x04", 3);
3792 if (wpas_p2p_setup_channels(wpa_s
, &p2p
.channels
, &p2p
.cli_channels
)) {
3793 wpa_printf(MSG_ERROR
, "P2P: Failed to configure supported "
3798 os_memcpy(p2p
.pri_dev_type
, wpa_s
->conf
->device_type
,
3801 p2p
.num_sec_dev_types
= wpa_s
->conf
->num_sec_device_types
;
3802 os_memcpy(p2p
.sec_dev_type
, wpa_s
->conf
->sec_device_type
,
3803 p2p
.num_sec_dev_types
* WPS_DEV_TYPE_LEN
);
3805 p2p
.concurrent_operations
= !!(wpa_s
->drv_flags
&
3806 WPA_DRIVER_FLAGS_P2P_CONCURRENT
);
3808 p2p
.max_peers
= 100;
3810 if (wpa_s
->conf
->p2p_ssid_postfix
) {
3811 p2p
.ssid_postfix_len
=
3812 os_strlen(wpa_s
->conf
->p2p_ssid_postfix
);
3813 if (p2p
.ssid_postfix_len
> sizeof(p2p
.ssid_postfix
))
3814 p2p
.ssid_postfix_len
= sizeof(p2p
.ssid_postfix
);
3815 os_memcpy(p2p
.ssid_postfix
, wpa_s
->conf
->p2p_ssid_postfix
,
3816 p2p
.ssid_postfix_len
);
3819 p2p
.p2p_intra_bss
= wpa_s
->conf
->p2p_intra_bss
;
3821 p2p
.max_listen
= wpa_s
->max_remain_on_chan
;
3823 global
->p2p
= p2p_init(&p2p
);
3824 if (global
->p2p
== NULL
)
3826 global
->p2p_init_wpa_s
= wpa_s
;
3828 for (i
= 0; i
< MAX_WPS_VENDOR_EXT
; i
++) {
3829 if (wpa_s
->conf
->wps_vendor_ext
[i
] == NULL
)
3831 p2p_add_wps_vendor_extension(
3832 global
->p2p
, wpa_s
->conf
->wps_vendor_ext
[i
]);
3835 p2p_set_no_go_freq(global
->p2p
, &wpa_s
->conf
->p2p_no_go_freq
);
3842 * wpas_p2p_deinit - Deinitialize per-interface P2P data
3843 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
3845 * This function deinitialize per-interface P2P data.
3847 void wpas_p2p_deinit(struct wpa_supplicant
*wpa_s
)
3849 if (wpa_s
->driver
&& wpa_s
->drv_priv
)
3850 wpa_drv_probe_req_report(wpa_s
, 0);
3852 if (wpa_s
->go_params
) {
3853 /* Clear any stored provisioning info */
3854 p2p_clear_provisioning_info(
3856 wpa_s
->go_params
->peer_device_addr
);
3859 os_free(wpa_s
->go_params
);
3860 wpa_s
->go_params
= NULL
;
3861 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
, wpa_s
, NULL
);
3862 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
3863 wpa_s
->p2p_long_listen
= 0;
3864 eloop_cancel_timeout(wpas_p2p_long_listen_timeout
, wpa_s
, NULL
);
3865 eloop_cancel_timeout(wpas_p2p_group_idle_timeout
, wpa_s
, NULL
);
3866 wpas_p2p_remove_pending_group_interface(wpa_s
);
3867 eloop_cancel_timeout(wpas_p2p_group_freq_conflict
, wpa_s
, NULL
);
3868 wpas_p2p_listen_work_done(wpa_s
);
3869 if (wpa_s
->p2p_send_action_work
) {
3870 os_free(wpa_s
->p2p_send_action_work
->ctx
);
3871 radio_work_done(wpa_s
->p2p_send_action_work
);
3872 wpa_s
->p2p_send_action_work
= NULL
;
3874 eloop_cancel_timeout(wpas_p2p_send_action_work_timeout
, wpa_s
, NULL
);
3876 wpabuf_free(wpa_s
->p2p_oob_dev_pw
);
3877 wpa_s
->p2p_oob_dev_pw
= NULL
;
3879 /* TODO: remove group interface from the driver if this wpa_s instance
3880 * is on top of a P2P group interface */
3885 * wpas_p2p_deinit_global - Deinitialize global P2P module
3886 * @global: Pointer to global data from wpa_supplicant_init()
3888 * This function deinitializes the global (per device) P2P module.
3890 void wpas_p2p_deinit_global(struct wpa_global
*global
)
3892 struct wpa_supplicant
*wpa_s
, *tmp
;
3894 wpa_s
= global
->ifaces
;
3896 wpas_p2p_service_flush(wpa_s
);
3898 if (global
->p2p
== NULL
)
3901 /* Remove remaining P2P group interfaces */
3902 while (wpa_s
&& wpa_s
->p2p_group_interface
!= NOT_P2P_GROUP_INTERFACE
)
3903 wpa_s
= wpa_s
->next
;
3905 tmp
= global
->ifaces
;
3908 tmp
->p2p_group_interface
== NOT_P2P_GROUP_INTERFACE
)) {
3913 /* Disconnect from the P2P group and deinit the interface */
3914 wpas_p2p_disconnect(tmp
);
3918 * Deinit GO data on any possibly remaining interface (if main
3919 * interface is used as GO).
3921 for (wpa_s
= global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
3922 if (wpa_s
->ap_iface
)
3923 wpas_p2p_group_deinit(wpa_s
);
3926 p2p_deinit(global
->p2p
);
3928 global
->p2p_init_wpa_s
= NULL
;
3932 static int wpas_p2p_create_iface(struct wpa_supplicant
*wpa_s
)
3934 if (!(wpa_s
->drv_flags
& WPA_DRIVER_FLAGS_DEDICATED_P2P_DEVICE
) &&
3935 wpa_s
->conf
->p2p_no_group_iface
)
3936 return 0; /* separate interface disabled per configuration */
3937 if (wpa_s
->drv_flags
&
3938 (WPA_DRIVER_FLAGS_P2P_DEDICATED_INTERFACE
|
3939 WPA_DRIVER_FLAGS_P2P_MGMT_AND_NON_P2P
))
3940 return 1; /* P2P group requires a new interface in every case
3942 if (!(wpa_s
->drv_flags
& WPA_DRIVER_FLAGS_P2P_CONCURRENT
))
3943 return 0; /* driver does not support concurrent operations */
3944 if (wpa_s
->global
->ifaces
->next
)
3945 return 1; /* more that one interface already in use */
3946 if (wpa_s
->wpa_state
>= WPA_AUTHENTICATING
)
3947 return 1; /* this interface is already in use */
3952 static int wpas_p2p_start_go_neg(struct wpa_supplicant
*wpa_s
,
3953 const u8
*peer_addr
,
3954 enum p2p_wps_method wps_method
,
3955 int go_intent
, const u8
*own_interface_addr
,
3956 unsigned int force_freq
, int persistent_group
,
3957 struct wpa_ssid
*ssid
, unsigned int pref_freq
)
3959 if (persistent_group
&& wpa_s
->conf
->persistent_reconnect
)
3960 persistent_group
= 2;
3963 * Increase GO config timeout if HT40 is used since it takes some time
3964 * to scan channels for coex purposes before the BSS can be started.
3966 p2p_set_config_timeout(wpa_s
->global
->p2p
,
3967 wpa_s
->p2p_go_ht40
? 255 : 100, 20);
3969 return p2p_connect(wpa_s
->global
->p2p
, peer_addr
, wps_method
,
3970 go_intent
, own_interface_addr
, force_freq
,
3971 persistent_group
, ssid
? ssid
->ssid
: NULL
,
3972 ssid
? ssid
->ssid_len
: 0,
3973 wpa_s
->p2p_pd_before_go_neg
, pref_freq
,
3974 wps_method
== WPS_NFC
? wpa_s
->p2p_oob_dev_pw_id
:
3979 static int wpas_p2p_auth_go_neg(struct wpa_supplicant
*wpa_s
,
3980 const u8
*peer_addr
,
3981 enum p2p_wps_method wps_method
,
3982 int go_intent
, const u8
*own_interface_addr
,
3983 unsigned int force_freq
, int persistent_group
,
3984 struct wpa_ssid
*ssid
, unsigned int pref_freq
)
3986 if (persistent_group
&& wpa_s
->conf
->persistent_reconnect
)
3987 persistent_group
= 2;
3989 return p2p_authorize(wpa_s
->global
->p2p
, peer_addr
, wps_method
,
3990 go_intent
, own_interface_addr
, force_freq
,
3991 persistent_group
, ssid
? ssid
->ssid
: NULL
,
3992 ssid
? ssid
->ssid_len
: 0, pref_freq
,
3993 wps_method
== WPS_NFC
? wpa_s
->p2p_oob_dev_pw_id
:
3998 static void wpas_p2p_check_join_scan_limit(struct wpa_supplicant
*wpa_s
)
4000 wpa_s
->p2p_join_scan_count
++;
4001 wpa_printf(MSG_DEBUG
, "P2P: Join scan attempt %d",
4002 wpa_s
->p2p_join_scan_count
);
4003 if (wpa_s
->p2p_join_scan_count
> P2P_MAX_JOIN_SCAN_ATTEMPTS
) {
4004 wpa_printf(MSG_DEBUG
, "P2P: Failed to find GO " MACSTR
4005 " for join operationg - stop join attempt",
4006 MAC2STR(wpa_s
->pending_join_iface_addr
));
4007 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
4008 if (wpa_s
->p2p_auto_pd
) {
4009 wpa_s
->p2p_auto_pd
= 0;
4010 wpa_msg_global(wpa_s
, MSG_INFO
,
4011 P2P_EVENT_PROV_DISC_FAILURE
4012 " p2p_dev_addr=" MACSTR
" status=N/A",
4013 MAC2STR(wpa_s
->pending_join_dev_addr
));
4016 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
4017 P2P_EVENT_GROUP_FORMATION_FAILURE
);
4022 static int wpas_check_freq_conflict(struct wpa_supplicant
*wpa_s
, int freq
)
4024 int *freqs
, res
, num
, i
;
4026 if (wpas_p2p_num_unused_channels(wpa_s
) > 0) {
4027 /* Multiple channels are supported and not all are in use */
4031 freqs
= os_calloc(wpa_s
->num_multichan_concurrent
, sizeof(int));
4035 num
= wpas_p2p_valid_oper_freqs(wpa_s
, freqs
,
4036 wpa_s
->num_multichan_concurrent
);
4042 for (i
= 0; i
< num
; i
++) {
4043 if (freqs
[i
] == freq
) {
4044 wpa_printf(MSG_DEBUG
, "P2P: Frequency %d MHz in use by another virtual interface and can be used",
4059 static int wpas_p2p_peer_go(struct wpa_supplicant
*wpa_s
,
4060 const u8
*peer_dev_addr
)
4062 struct wpa_bss
*bss
;
4065 bss
= wpa_bss_get_p2p_dev_addr(wpa_s
, peer_dev_addr
);
4068 if (bss
->last_update_idx
< wpa_s
->bss_update_idx
) {
4069 wpa_printf(MSG_DEBUG
, "P2P: Peer BSS entry not updated in the "
4074 updated
= os_reltime_before(&wpa_s
->p2p_auto_started
,
4076 wpa_printf(MSG_DEBUG
, "P2P: Current BSS entry for peer updated at "
4077 "%ld.%06ld (%supdated in last scan)",
4078 bss
->last_update
.sec
, bss
->last_update
.usec
,
4079 updated
? "": "not ");
4085 static void wpas_p2p_scan_res_join(struct wpa_supplicant
*wpa_s
,
4086 struct wpa_scan_results
*scan_res
)
4088 struct wpa_bss
*bss
= NULL
;
4090 u8 iface_addr
[ETH_ALEN
];
4092 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
4094 if (wpa_s
->global
->p2p_disabled
)
4097 wpa_printf(MSG_DEBUG
, "P2P: Scan results received (%d BSS) for %sjoin",
4098 scan_res
? (int) scan_res
->num
: -1,
4099 wpa_s
->p2p_auto_join
? "auto_" : "");
4102 wpas_p2p_scan_res_handler(wpa_s
, scan_res
);
4104 if (wpa_s
->p2p_auto_pd
) {
4105 int join
= wpas_p2p_peer_go(wpa_s
,
4106 wpa_s
->pending_join_dev_addr
);
4108 wpa_s
->auto_pd_scan_retry
< P2P_AUTO_PD_SCAN_ATTEMPTS
) {
4109 wpa_s
->auto_pd_scan_retry
++;
4110 bss
= wpa_bss_get_bssid_latest(
4111 wpa_s
, wpa_s
->pending_join_dev_addr
);
4114 wpa_printf(MSG_DEBUG
, "P2P: Scan retry %d for "
4115 "the peer " MACSTR
" at %d MHz",
4116 wpa_s
->auto_pd_scan_retry
,
4118 pending_join_dev_addr
),
4120 wpas_p2p_join_scan_req(wpa_s
, freq
, NULL
, 0);
4128 wpa_s
->p2p_auto_pd
= 0;
4129 wpa_s
->pending_pd_use
= join
? AUTO_PD_JOIN
: AUTO_PD_GO_NEG
;
4130 wpa_printf(MSG_DEBUG
, "P2P: Auto PD with " MACSTR
" join=%d",
4131 MAC2STR(wpa_s
->pending_join_dev_addr
), join
);
4132 if (p2p_prov_disc_req(wpa_s
->global
->p2p
,
4133 wpa_s
->pending_join_dev_addr
,
4134 wpa_s
->pending_pd_config_methods
, join
,
4135 0, wpa_s
->user_initiated_pd
) < 0) {
4136 wpa_s
->p2p_auto_pd
= 0;
4137 wpa_msg_global(wpa_s
, MSG_INFO
,
4138 P2P_EVENT_PROV_DISC_FAILURE
4139 " p2p_dev_addr=" MACSTR
" status=N/A",
4140 MAC2STR(wpa_s
->pending_join_dev_addr
));
4145 if (wpa_s
->p2p_auto_join
) {
4146 int join
= wpas_p2p_peer_go(wpa_s
,
4147 wpa_s
->pending_join_dev_addr
);
4149 wpa_printf(MSG_DEBUG
, "P2P: Peer was not found to be "
4150 "running a GO -> use GO Negotiation");
4151 wpas_p2p_connect(wpa_s
, wpa_s
->pending_join_dev_addr
,
4152 wpa_s
->p2p_pin
, wpa_s
->p2p_wps_method
,
4153 wpa_s
->p2p_persistent_group
, 0, 0, 0,
4154 wpa_s
->p2p_go_intent
,
4155 wpa_s
->p2p_connect_freq
,
4156 wpa_s
->p2p_persistent_id
,
4157 wpa_s
->p2p_pd_before_go_neg
,
4163 wpa_printf(MSG_DEBUG
, "P2P: Peer was found running GO%s -> "
4164 "try to join the group", join
? "" :
4167 wpa_s
->p2p_fallback_to_go_neg
= 1;
4170 freq
= p2p_get_oper_freq(wpa_s
->global
->p2p
,
4171 wpa_s
->pending_join_iface_addr
);
4173 p2p_get_interface_addr(wpa_s
->global
->p2p
,
4174 wpa_s
->pending_join_dev_addr
,
4176 os_memcmp(iface_addr
, wpa_s
->pending_join_dev_addr
, ETH_ALEN
) != 0)
4178 wpa_printf(MSG_DEBUG
, "P2P: Overwrite pending interface "
4179 "address for join from " MACSTR
" to " MACSTR
4180 " based on newly discovered P2P peer entry",
4181 MAC2STR(wpa_s
->pending_join_iface_addr
),
4182 MAC2STR(iface_addr
));
4183 os_memcpy(wpa_s
->pending_join_iface_addr
, iface_addr
,
4186 freq
= p2p_get_oper_freq(wpa_s
->global
->p2p
,
4187 wpa_s
->pending_join_iface_addr
);
4190 wpa_printf(MSG_DEBUG
, "P2P: Target GO operating frequency "
4191 "from P2P peer table: %d MHz", freq
);
4193 if (wpa_s
->p2p_join_ssid_len
) {
4194 wpa_printf(MSG_DEBUG
, "P2P: Trying to find target GO BSS entry based on BSSID "
4195 MACSTR
" and SSID %s",
4196 MAC2STR(wpa_s
->pending_join_iface_addr
),
4197 wpa_ssid_txt(wpa_s
->p2p_join_ssid
,
4198 wpa_s
->p2p_join_ssid_len
));
4199 bss
= wpa_bss_get(wpa_s
, wpa_s
->pending_join_iface_addr
,
4200 wpa_s
->p2p_join_ssid
,
4201 wpa_s
->p2p_join_ssid_len
);
4204 wpa_printf(MSG_DEBUG
, "P2P: Trying to find target GO BSS entry based on BSSID "
4205 MACSTR
, MAC2STR(wpa_s
->pending_join_iface_addr
));
4206 bss
= wpa_bss_get_bssid_latest(wpa_s
,
4207 wpa_s
->pending_join_iface_addr
);
4211 wpa_printf(MSG_DEBUG
, "P2P: Target GO operating frequency "
4212 "from BSS table: %d MHz (SSID %s)", freq
,
4213 wpa_ssid_txt(bss
->ssid
, bss
->ssid_len
));
4218 if (wpas_check_freq_conflict(wpa_s
, freq
) > 0) {
4219 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
4220 P2P_EVENT_GROUP_FORMATION_FAILURE
4221 "reason=FREQ_CONFLICT");
4225 wpa_printf(MSG_DEBUG
, "P2P: Send Provision Discovery Request "
4226 "prior to joining an existing group (GO " MACSTR
4228 MAC2STR(wpa_s
->pending_join_dev_addr
), freq
);
4229 wpa_s
->pending_pd_before_join
= 1;
4231 switch (wpa_s
->pending_join_wps_method
) {
4232 case WPS_PIN_DISPLAY
:
4233 method
= WPS_CONFIG_KEYPAD
;
4235 case WPS_PIN_KEYPAD
:
4236 method
= WPS_CONFIG_DISPLAY
;
4239 method
= WPS_CONFIG_PUSHBUTTON
;
4246 if ((p2p_get_provisioning_info(wpa_s
->global
->p2p
,
4247 wpa_s
->pending_join_dev_addr
) ==
4250 * We have already performed provision discovery for
4251 * joining the group. Proceed directly to join
4252 * operation without duplicated provision discovery. */
4253 wpa_printf(MSG_DEBUG
, "P2P: Provision discovery "
4254 "with " MACSTR
" already done - proceed to "
4256 MAC2STR(wpa_s
->pending_join_dev_addr
));
4257 wpa_s
->pending_pd_before_join
= 0;
4261 if (p2p_prov_disc_req(wpa_s
->global
->p2p
,
4262 wpa_s
->pending_join_dev_addr
, method
, 1,
4263 freq
, wpa_s
->user_initiated_pd
) < 0) {
4264 wpa_printf(MSG_DEBUG
, "P2P: Failed to send Provision "
4265 "Discovery Request before joining an "
4267 wpa_s
->pending_pd_before_join
= 0;
4273 wpa_printf(MSG_DEBUG
, "P2P: Failed to find BSS/GO - try again later");
4274 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
4275 eloop_register_timeout(1, 0, wpas_p2p_join_scan
, wpa_s
, NULL
);
4276 wpas_p2p_check_join_scan_limit(wpa_s
);
4280 /* Start join operation immediately */
4281 wpas_p2p_join_start(wpa_s
);
4285 static void wpas_p2p_join_scan_req(struct wpa_supplicant
*wpa_s
, int freq
,
4286 const u8
*ssid
, size_t ssid_len
)
4289 struct wpa_driver_scan_params params
;
4290 struct wpabuf
*wps_ie
, *ies
;
4292 int freqs
[2] = { 0, 0 };
4294 os_memset(¶ms
, 0, sizeof(params
));
4296 /* P2P Wildcard SSID */
4297 params
.num_ssids
= 1;
4298 if (ssid
&& ssid_len
) {
4299 params
.ssids
[0].ssid
= ssid
;
4300 params
.ssids
[0].ssid_len
= ssid_len
;
4301 os_memcpy(wpa_s
->p2p_join_ssid
, ssid
, ssid_len
);
4302 wpa_s
->p2p_join_ssid_len
= ssid_len
;
4304 params
.ssids
[0].ssid
= (u8
*) P2P_WILDCARD_SSID
;
4305 params
.ssids
[0].ssid_len
= P2P_WILDCARD_SSID_LEN
;
4306 wpa_s
->p2p_join_ssid_len
= 0;
4309 wpa_s
->wps
->dev
.p2p
= 1;
4310 wps_ie
= wps_build_probe_req_ie(DEV_PW_DEFAULT
, &wpa_s
->wps
->dev
,
4311 wpa_s
->wps
->uuid
, WPS_REQ_ENROLLEE
, 0,
4313 if (wps_ie
== NULL
) {
4314 wpas_p2p_scan_res_join(wpa_s
, NULL
);
4318 ielen
= p2p_scan_ie_buf_len(wpa_s
->global
->p2p
);
4319 ies
= wpabuf_alloc(wpabuf_len(wps_ie
) + ielen
);
4321 wpabuf_free(wps_ie
);
4322 wpas_p2p_scan_res_join(wpa_s
, NULL
);
4325 wpabuf_put_buf(ies
, wps_ie
);
4326 wpabuf_free(wps_ie
);
4328 p2p_scan_ie(wpa_s
->global
->p2p
, ies
, NULL
);
4330 params
.p2p_probe
= 1;
4331 params
.extra_ies
= wpabuf_head(ies
);
4332 params
.extra_ies_len
= wpabuf_len(ies
);
4337 * If freq is not provided, check the operating freq of the GO
4338 * and use a single channel scan on if possible.
4340 oper_freq
= p2p_get_oper_freq(wpa_s
->global
->p2p
,
4341 wpa_s
->pending_join_iface_addr
);
4347 params
.freqs
= freqs
;
4351 * Run a scan to update BSS table and start Provision Discovery once
4352 * the new scan results become available.
4354 ret
= wpa_drv_scan(wpa_s
, ¶ms
);
4356 os_get_reltime(&wpa_s
->scan_trigger_time
);
4357 wpa_s
->scan_res_handler
= wpas_p2p_scan_res_join
;
4358 wpa_s
->own_scan_requested
= 1;
4364 wpa_printf(MSG_DEBUG
, "P2P: Failed to start scan for join - "
4366 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
4367 eloop_register_timeout(1, 0, wpas_p2p_join_scan
, wpa_s
, NULL
);
4368 wpas_p2p_check_join_scan_limit(wpa_s
);
4373 static void wpas_p2p_join_scan(void *eloop_ctx
, void *timeout_ctx
)
4375 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
4376 wpas_p2p_join_scan_req(wpa_s
, 0, NULL
, 0);
4380 static int wpas_p2p_join(struct wpa_supplicant
*wpa_s
, const u8
*iface_addr
,
4381 const u8
*dev_addr
, enum p2p_wps_method wps_method
,
4382 int auto_join
, const u8
*ssid
, size_t ssid_len
)
4384 wpa_printf(MSG_DEBUG
, "P2P: Request to join existing group (iface "
4385 MACSTR
" dev " MACSTR
")%s",
4386 MAC2STR(iface_addr
), MAC2STR(dev_addr
),
4387 auto_join
? " (auto_join)" : "");
4388 if (ssid
&& ssid_len
) {
4389 wpa_printf(MSG_DEBUG
, "P2P: Group SSID specified: %s",
4390 wpa_ssid_txt(ssid
, ssid_len
));
4393 wpa_s
->p2p_auto_pd
= 0;
4394 wpa_s
->p2p_auto_join
= !!auto_join
;
4395 os_memcpy(wpa_s
->pending_join_iface_addr
, iface_addr
, ETH_ALEN
);
4396 os_memcpy(wpa_s
->pending_join_dev_addr
, dev_addr
, ETH_ALEN
);
4397 wpa_s
->pending_join_wps_method
= wps_method
;
4399 /* Make sure we are not running find during connection establishment */
4400 wpas_p2p_stop_find(wpa_s
);
4402 wpa_s
->p2p_join_scan_count
= 0;
4403 wpas_p2p_join_scan_req(wpa_s
, 0, ssid
, ssid_len
);
4408 static int wpas_p2p_join_start(struct wpa_supplicant
*wpa_s
)
4410 struct wpa_supplicant
*group
;
4411 struct p2p_go_neg_results res
;
4412 struct wpa_bss
*bss
;
4414 group
= wpas_p2p_get_group_iface(wpa_s
, 0, 0);
4417 if (group
!= wpa_s
) {
4418 os_memcpy(group
->p2p_pin
, wpa_s
->p2p_pin
,
4419 sizeof(group
->p2p_pin
));
4420 group
->p2p_wps_method
= wpa_s
->p2p_wps_method
;
4423 * Need to mark the current interface for p2p_group_formation
4424 * when a separate group interface is not used. This is needed
4425 * to allow p2p_cancel stop a pending p2p_connect-join.
4426 * wpas_p2p_init_group_interface() addresses this for the case
4427 * where a separate group interface is used.
4429 wpa_s
->global
->p2p_group_formation
= wpa_s
;
4432 group
->p2p_in_provisioning
= 1;
4433 group
->p2p_fallback_to_go_neg
= wpa_s
->p2p_fallback_to_go_neg
;
4435 os_memset(&res
, 0, sizeof(res
));
4436 os_memcpy(res
.peer_interface_addr
, wpa_s
->pending_join_iface_addr
,
4438 res
.wps_method
= wpa_s
->pending_join_wps_method
;
4439 bss
= wpa_bss_get_bssid_latest(wpa_s
, wpa_s
->pending_join_iface_addr
);
4441 res
.freq
= bss
->freq
;
4442 res
.ssid_len
= bss
->ssid_len
;
4443 os_memcpy(res
.ssid
, bss
->ssid
, bss
->ssid_len
);
4444 wpa_printf(MSG_DEBUG
, "P2P: Join target GO operating frequency "
4445 "from BSS table: %d MHz (SSID %s)", bss
->freq
,
4446 wpa_ssid_txt(bss
->ssid
, bss
->ssid_len
));
4449 if (wpa_s
->off_channel_freq
|| wpa_s
->roc_waiting_drv_freq
) {
4450 wpa_printf(MSG_DEBUG
, "P2P: Cancel remain-on-channel prior to "
4452 wpa_drv_cancel_remain_on_channel(wpa_s
);
4453 wpa_s
->off_channel_freq
= 0;
4454 wpa_s
->roc_waiting_drv_freq
= 0;
4456 wpas_start_wps_enrollee(group
, &res
);
4459 * Allow a longer timeout for join-a-running-group than normal 15
4460 * second group formation timeout since the GO may not have authorized
4461 * our connection yet.
4463 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
, wpa_s
, NULL
);
4464 eloop_register_timeout(60, 0, wpas_p2p_group_formation_timeout
,
4471 static int wpas_p2p_setup_freqs(struct wpa_supplicant
*wpa_s
, int freq
,
4472 int *force_freq
, int *pref_freq
, int go
)
4475 unsigned int freq_in_use
= 0, num
, i
;
4477 freqs
= os_calloc(wpa_s
->num_multichan_concurrent
, sizeof(int));
4481 num
= get_shared_radio_freqs(wpa_s
, freqs
,
4482 wpa_s
->num_multichan_concurrent
);
4483 wpa_printf(MSG_DEBUG
,
4484 "P2P: Setup freqs: freq=%d num_MCC=%d shared_freqs=%u",
4485 freq
, wpa_s
->num_multichan_concurrent
, num
);
4490 ret
= p2p_supported_freq(wpa_s
->global
->p2p
, freq
);
4492 ret
= p2p_supported_freq_cli(wpa_s
->global
->p2p
, freq
);
4494 wpa_printf(MSG_DEBUG
, "P2P: The forced channel "
4495 "(%u MHz) is not supported for P2P uses",
4501 for (i
= 0; i
< num
; i
++) {
4502 if (freqs
[i
] == freq
)
4506 if (num
== wpa_s
->num_multichan_concurrent
&& !freq_in_use
) {
4507 wpa_printf(MSG_DEBUG
, "P2P: Cannot start P2P group on %u MHz as there are no available channels",
4512 wpa_printf(MSG_DEBUG
, "P2P: Trying to force us to use the "
4513 "requested channel (%u MHz)", freq
);
4518 for (i
= 0; i
< num
; i
++) {
4519 if (!p2p_supported_freq(wpa_s
->global
->p2p
, freqs
[i
]))
4522 if (*pref_freq
== 0 && num
< wpa_s
->num_multichan_concurrent
) {
4523 wpa_printf(MSG_DEBUG
, "P2P: Try to prefer a frequency (%u MHz) we are already using",
4525 *pref_freq
= freqs
[i
];
4527 wpa_printf(MSG_DEBUG
, "P2P: Try to force us to use frequency (%u MHz) which is already in use",
4529 *force_freq
= freqs
[i
];
4535 if (num
< wpa_s
->num_multichan_concurrent
&& num
> 0) {
4536 wpa_printf(MSG_DEBUG
, "P2P: Current operating channels are not available for P2P. Try to use another channel");
4538 } else if (num
< wpa_s
->num_multichan_concurrent
) {
4539 wpa_printf(MSG_DEBUG
, "P2P: No current operating channels - try to use a new channel");
4542 wpa_printf(MSG_DEBUG
, "P2P: All channels are in use and none of them are P2P enabled. Cannot start P2P group");
4557 * wpas_p2p_connect - Request P2P Group Formation to be started
4558 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
4559 * @peer_addr: Address of the peer P2P Device
4560 * @pin: PIN to use during provisioning or %NULL to indicate PBC mode
4561 * @persistent_group: Whether to create a persistent group
4562 * @auto_join: Whether to select join vs. GO Negotiation automatically
4563 * @join: Whether to join an existing group (as a client) instead of starting
4564 * Group Owner negotiation; @peer_addr is BSSID in that case
4565 * @auth: Whether to only authorize the connection instead of doing that and
4566 * initiating Group Owner negotiation
4567 * @go_intent: GO Intent or -1 to use default
4568 * @freq: Frequency for the group or 0 for auto-selection
4569 * @persistent_id: Persistent group credentials to use for forcing GO
4570 * parameters or -1 to generate new values (SSID/passphrase)
4571 * @pd: Whether to send Provision Discovery prior to GO Negotiation as an
4572 * interoperability workaround when initiating group formation
4573 * @ht40: Start GO with 40 MHz channel width
4574 * @vht: Start GO with VHT support
4575 * Returns: 0 or new PIN (if pin was %NULL) on success, -1 on unspecified
4576 * failure, -2 on failure due to channel not currently available,
4577 * -3 if forced channel is not supported
4579 int wpas_p2p_connect(struct wpa_supplicant
*wpa_s
, const u8
*peer_addr
,
4580 const char *pin
, enum p2p_wps_method wps_method
,
4581 int persistent_group
, int auto_join
, int join
, int auth
,
4582 int go_intent
, int freq
, int persistent_id
, int pd
,
4585 int force_freq
= 0, pref_freq
= 0;
4587 enum wpa_driver_if_type iftype
;
4589 struct wpa_ssid
*ssid
= NULL
;
4591 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
4594 if (persistent_id
>= 0) {
4595 ssid
= wpa_config_get_network(wpa_s
->conf
, persistent_id
);
4596 if (ssid
== NULL
|| ssid
->disabled
!= 2 ||
4597 ssid
->mode
!= WPAS_MODE_P2P_GO
)
4601 os_free(wpa_s
->global
->add_psk
);
4602 wpa_s
->global
->add_psk
= NULL
;
4604 wpa_s
->global
->p2p_fail_on_wps_complete
= 0;
4607 go_intent
= wpa_s
->conf
->p2p_go_intent
;
4610 wpa_s
->p2p_long_listen
= 0;
4612 wpa_s
->p2p_wps_method
= wps_method
;
4613 wpa_s
->p2p_persistent_group
= !!persistent_group
;
4614 wpa_s
->p2p_persistent_id
= persistent_id
;
4615 wpa_s
->p2p_go_intent
= go_intent
;
4616 wpa_s
->p2p_connect_freq
= freq
;
4617 wpa_s
->p2p_fallback_to_go_neg
= 0;
4618 wpa_s
->p2p_pd_before_go_neg
= !!pd
;
4619 wpa_s
->p2p_go_ht40
= !!ht40
;
4620 wpa_s
->p2p_go_vht
= !!vht
;
4623 os_strlcpy(wpa_s
->p2p_pin
, pin
, sizeof(wpa_s
->p2p_pin
));
4624 else if (wps_method
== WPS_PIN_DISPLAY
) {
4625 ret
= wps_generate_pin();
4626 os_snprintf(wpa_s
->p2p_pin
, sizeof(wpa_s
->p2p_pin
), "%08d",
4628 wpa_printf(MSG_DEBUG
, "P2P: Randomly generated PIN: %s",
4631 wpa_s
->p2p_pin
[0] = '\0';
4633 if (join
|| auto_join
) {
4634 u8 iface_addr
[ETH_ALEN
], dev_addr
[ETH_ALEN
];
4636 wpa_printf(MSG_DEBUG
, "P2P: Authorize invitation to "
4637 "connect a running group from " MACSTR
,
4638 MAC2STR(peer_addr
));
4639 os_memcpy(wpa_s
->p2p_auth_invite
, peer_addr
, ETH_ALEN
);
4642 os_memcpy(dev_addr
, peer_addr
, ETH_ALEN
);
4643 if (p2p_get_interface_addr(wpa_s
->global
->p2p
, peer_addr
,
4645 os_memcpy(iface_addr
, peer_addr
, ETH_ALEN
);
4646 p2p_get_dev_addr(wpa_s
->global
->p2p
, peer_addr
,
4650 os_get_reltime(&wpa_s
->p2p_auto_started
);
4651 wpa_printf(MSG_DEBUG
, "P2P: Auto join started at "
4653 wpa_s
->p2p_auto_started
.sec
,
4654 wpa_s
->p2p_auto_started
.usec
);
4656 wpa_s
->user_initiated_pd
= 1;
4657 if (wpas_p2p_join(wpa_s
, iface_addr
, dev_addr
, wps_method
,
4658 auto_join
, NULL
, 0) < 0)
4663 res
= wpas_p2p_setup_freqs(wpa_s
, freq
, &force_freq
, &pref_freq
,
4667 wpas_p2p_set_own_freq_preference(wpa_s
,
4668 force_freq
? force_freq
: pref_freq
);
4670 wpa_s
->create_p2p_iface
= wpas_p2p_create_iface(wpa_s
);
4672 if (wpa_s
->create_p2p_iface
) {
4673 /* Prepare to add a new interface for the group */
4674 iftype
= WPA_IF_P2P_GROUP
;
4675 if (go_intent
== 15)
4676 iftype
= WPA_IF_P2P_GO
;
4677 if (wpas_p2p_add_group_interface(wpa_s
, iftype
) < 0) {
4678 wpa_printf(MSG_ERROR
, "P2P: Failed to allocate a new "
4679 "interface for the group");
4683 if_addr
= wpa_s
->pending_interface_addr
;
4685 if_addr
= wpa_s
->own_addr
;
4688 if (wpas_p2p_auth_go_neg(wpa_s
, peer_addr
, wps_method
,
4690 force_freq
, persistent_group
, ssid
,
4696 if (wpas_p2p_start_go_neg(wpa_s
, peer_addr
, wps_method
,
4697 go_intent
, if_addr
, force_freq
,
4698 persistent_group
, ssid
, pref_freq
) < 0) {
4699 if (wpa_s
->create_p2p_iface
)
4700 wpas_p2p_remove_pending_group_interface(wpa_s
);
4708 * wpas_p2p_remain_on_channel_cb - Indication of remain-on-channel start
4709 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
4710 * @freq: Frequency of the channel in MHz
4711 * @duration: Duration of the stay on the channel in milliseconds
4713 * This callback is called when the driver indicates that it has started the
4714 * requested remain-on-channel duration.
4716 void wpas_p2p_remain_on_channel_cb(struct wpa_supplicant
*wpa_s
,
4717 unsigned int freq
, unsigned int duration
)
4719 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
4721 if (wpa_s
->off_channel_freq
== wpa_s
->pending_listen_freq
) {
4722 p2p_listen_cb(wpa_s
->global
->p2p
, wpa_s
->pending_listen_freq
,
4723 wpa_s
->pending_listen_duration
);
4724 wpa_s
->pending_listen_freq
= 0;
4729 static int wpas_p2p_listen_start(struct wpa_supplicant
*wpa_s
,
4730 unsigned int timeout
)
4732 /* Limit maximum Listen state time based on driver limitation. */
4733 if (timeout
> wpa_s
->max_remain_on_chan
)
4734 timeout
= wpa_s
->max_remain_on_chan
;
4736 return p2p_listen(wpa_s
->global
->p2p
, timeout
);
4741 * wpas_p2p_cancel_remain_on_channel_cb - Remain-on-channel timeout
4742 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
4743 * @freq: Frequency of the channel in MHz
4745 * This callback is called when the driver indicates that a remain-on-channel
4746 * operation has been completed, i.e., the duration on the requested channel
4749 void wpas_p2p_cancel_remain_on_channel_cb(struct wpa_supplicant
*wpa_s
,
4752 wpa_printf(MSG_DEBUG
, "P2P: Cancel remain-on-channel callback "
4753 "(p2p_long_listen=%d ms pending_action_tx=%p)",
4754 wpa_s
->p2p_long_listen
, offchannel_pending_action_tx(wpa_s
));
4755 wpas_p2p_listen_work_done(wpa_s
);
4756 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
4758 if (p2p_listen_end(wpa_s
->global
->p2p
, freq
) > 0)
4759 return; /* P2P module started a new operation */
4760 if (offchannel_pending_action_tx(wpa_s
))
4762 if (wpa_s
->p2p_long_listen
> 0)
4763 wpa_s
->p2p_long_listen
-= wpa_s
->max_remain_on_chan
;
4764 if (wpa_s
->p2p_long_listen
> 0) {
4765 wpa_printf(MSG_DEBUG
, "P2P: Continuing long Listen state");
4766 wpas_p2p_listen_start(wpa_s
, wpa_s
->p2p_long_listen
);
4769 * When listen duration is over, stop listen & update p2p_state
4772 p2p_stop_listen(wpa_s
->global
->p2p
);
4778 * wpas_p2p_group_remove - Remove a P2P group
4779 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
4780 * @ifname: Network interface name of the group interface or "*" to remove all
4782 * Returns: 0 on success, -1 on failure
4784 * This function is used to remove a P2P group. This can be used to disconnect
4785 * from a group in which the local end is a P2P Client or to end a P2P Group in
4786 * case the local end is the Group Owner. If a virtual network interface was
4787 * created for this group, that interface will be removed. Otherwise, only the
4788 * configured P2P group network will be removed from the interface.
4790 int wpas_p2p_group_remove(struct wpa_supplicant
*wpa_s
, const char *ifname
)
4792 struct wpa_global
*global
= wpa_s
->global
;
4794 if (os_strcmp(ifname
, "*") == 0) {
4795 struct wpa_supplicant
*prev
;
4796 wpa_s
= global
->ifaces
;
4799 wpa_s
= wpa_s
->next
;
4800 if (prev
->p2p_group_interface
!=
4801 NOT_P2P_GROUP_INTERFACE
||
4802 (prev
->current_ssid
&&
4803 prev
->current_ssid
->p2p_group
))
4804 wpas_p2p_disconnect(prev
);
4809 for (wpa_s
= global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
4810 if (os_strcmp(wpa_s
->ifname
, ifname
) == 0)
4814 return wpas_p2p_disconnect(wpa_s
);
4818 static int wpas_p2p_select_go_freq(struct wpa_supplicant
*wpa_s
, int freq
)
4823 wpa_printf(MSG_DEBUG
, "P2P: Request to start GO on 2.4 GHz "
4825 if (wpa_s
->best_24_freq
> 0 &&
4826 p2p_supported_freq_go(wpa_s
->global
->p2p
,
4827 wpa_s
->best_24_freq
)) {
4828 freq
= wpa_s
->best_24_freq
;
4829 wpa_printf(MSG_DEBUG
, "P2P: Use best 2.4 GHz band "
4830 "channel: %d MHz", freq
);
4832 os_get_random((u8
*) &r
, sizeof(r
));
4833 freq
= 2412 + (r
% 3) * 25;
4834 wpa_printf(MSG_DEBUG
, "P2P: Use random 2.4 GHz band "
4835 "channel: %d MHz", freq
);
4840 wpa_printf(MSG_DEBUG
, "P2P: Request to start GO on 5 GHz "
4842 if (wpa_s
->best_5_freq
> 0 &&
4843 p2p_supported_freq_go(wpa_s
->global
->p2p
,
4844 wpa_s
->best_5_freq
)) {
4845 freq
= wpa_s
->best_5_freq
;
4846 wpa_printf(MSG_DEBUG
, "P2P: Use best 5 GHz band "
4847 "channel: %d MHz", freq
);
4849 os_get_random((u8
*) &r
, sizeof(r
));
4850 freq
= 5180 + (r
% 4) * 20;
4851 if (!p2p_supported_freq_go(wpa_s
->global
->p2p
, freq
)) {
4852 wpa_printf(MSG_DEBUG
, "P2P: Could not select "
4853 "5 GHz channel for P2P group");
4856 wpa_printf(MSG_DEBUG
, "P2P: Use random 5 GHz band "
4857 "channel: %d MHz", freq
);
4861 if (freq
> 0 && !p2p_supported_freq_go(wpa_s
->global
->p2p
, freq
)) {
4862 wpa_printf(MSG_DEBUG
, "P2P: The forced channel for GO "
4863 "(%u MHz) is not supported for P2P uses",
4872 static int wpas_p2p_init_go_params(struct wpa_supplicant
*wpa_s
,
4873 struct p2p_go_neg_results
*params
,
4874 int freq
, int ht40
, int vht
,
4875 const struct p2p_channels
*channels
)
4878 unsigned int pref_freq
;
4879 unsigned int num
, i
;
4881 os_memset(params
, 0, sizeof(*params
));
4882 params
->role_go
= 1;
4883 params
->ht40
= ht40
;
4886 if (!freq_included(channels
, freq
)) {
4887 wpa_printf(MSG_DEBUG
, "P2P: Forced GO freq %d MHz not "
4891 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on forced "
4892 "frequency %d MHz", freq
);
4893 params
->freq
= freq
;
4894 } else if (wpa_s
->conf
->p2p_oper_reg_class
== 81 &&
4895 wpa_s
->conf
->p2p_oper_channel
>= 1 &&
4896 wpa_s
->conf
->p2p_oper_channel
<= 11 &&
4897 freq_included(channels
,
4898 2407 + 5 * wpa_s
->conf
->p2p_oper_channel
)) {
4899 params
->freq
= 2407 + 5 * wpa_s
->conf
->p2p_oper_channel
;
4900 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on configured "
4901 "frequency %d MHz", params
->freq
);
4902 } else if ((wpa_s
->conf
->p2p_oper_reg_class
== 115 ||
4903 wpa_s
->conf
->p2p_oper_reg_class
== 116 ||
4904 wpa_s
->conf
->p2p_oper_reg_class
== 117 ||
4905 wpa_s
->conf
->p2p_oper_reg_class
== 124 ||
4906 wpa_s
->conf
->p2p_oper_reg_class
== 126 ||
4907 wpa_s
->conf
->p2p_oper_reg_class
== 127) &&
4908 freq_included(channels
,
4909 5000 + 5 * wpa_s
->conf
->p2p_oper_channel
)) {
4910 params
->freq
= 5000 + 5 * wpa_s
->conf
->p2p_oper_channel
;
4911 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on configured "
4912 "frequency %d MHz", params
->freq
);
4913 } else if (wpa_s
->conf
->p2p_oper_channel
== 0 &&
4914 wpa_s
->best_overall_freq
> 0 &&
4915 p2p_supported_freq_go(wpa_s
->global
->p2p
,
4916 wpa_s
->best_overall_freq
) &&
4917 freq_included(channels
, wpa_s
->best_overall_freq
)) {
4918 params
->freq
= wpa_s
->best_overall_freq
;
4919 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on best overall "
4920 "channel %d MHz", params
->freq
);
4921 } else if (wpa_s
->conf
->p2p_oper_channel
== 0 &&
4922 wpa_s
->best_24_freq
> 0 &&
4923 p2p_supported_freq_go(wpa_s
->global
->p2p
,
4924 wpa_s
->best_24_freq
) &&
4925 freq_included(channels
, wpa_s
->best_24_freq
)) {
4926 params
->freq
= wpa_s
->best_24_freq
;
4927 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on best 2.4 GHz "
4928 "channel %d MHz", params
->freq
);
4929 } else if (wpa_s
->conf
->p2p_oper_channel
== 0 &&
4930 wpa_s
->best_5_freq
> 0 &&
4931 p2p_supported_freq_go(wpa_s
->global
->p2p
,
4932 wpa_s
->best_5_freq
) &&
4933 freq_included(channels
, wpa_s
->best_5_freq
)) {
4934 params
->freq
= wpa_s
->best_5_freq
;
4935 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq based on best 5 GHz "
4936 "channel %d MHz", params
->freq
);
4937 } else if ((pref_freq
= p2p_get_pref_freq(wpa_s
->global
->p2p
,
4939 params
->freq
= pref_freq
;
4940 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq %d MHz from preferred "
4941 "channels", params
->freq
);
4944 for (chan
= 0; chan
< 11; chan
++) {
4945 params
->freq
= 2412 + chan
* 5;
4946 if (!wpas_p2p_disallowed_freq(wpa_s
->global
,
4948 freq_included(channels
, params
->freq
))
4952 wpa_printf(MSG_DEBUG
, "P2P: No 2.4 GHz channel "
4956 wpa_printf(MSG_DEBUG
, "P2P: Set GO freq %d MHz (no preference "
4957 "known)", params
->freq
);
4960 freqs
= os_calloc(wpa_s
->num_multichan_concurrent
, sizeof(int));
4964 res
= wpas_p2p_valid_oper_freqs(wpa_s
, freqs
,
4965 wpa_s
->num_multichan_concurrent
);
4972 for (i
= 0; i
< num
; i
++) {
4973 if (freq
&& freqs
[i
] == freq
)
4975 if (!freq
&& freq_included(channels
, freqs
[i
])) {
4976 wpa_printf(MSG_DEBUG
, "P2P: Force GO on a channel we are already using (%u MHz)",
4978 params
->freq
= freqs
[i
];
4984 if (wpas_p2p_num_unused_channels(wpa_s
) <= 0) {
4986 wpa_printf(MSG_DEBUG
, "P2P: Cannot force GO on freq (%u MHz) as all the channels are in use", freq
);
4988 wpa_printf(MSG_DEBUG
, "P2P: Cannot force GO on any of the channels we are already using");
4991 } else if (num
== 0) {
4992 wpa_printf(MSG_DEBUG
, "P2P: Use one of the free channels");
4994 wpa_printf(MSG_DEBUG
, "P2P: Cannot force GO on any of the channels we are already using. Use one of the free channels");
5003 static struct wpa_supplicant
*
5004 wpas_p2p_get_group_iface(struct wpa_supplicant
*wpa_s
, int addr_allocated
,
5007 struct wpa_supplicant
*group_wpa_s
;
5009 if (!wpas_p2p_create_iface(wpa_s
)) {
5010 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Use same interface for group "
5012 wpa_s
->p2p_first_connection_timeout
= 0;
5016 if (wpas_p2p_add_group_interface(wpa_s
, go
? WPA_IF_P2P_GO
:
5017 WPA_IF_P2P_CLIENT
) < 0) {
5018 wpa_msg_global(wpa_s
, MSG_ERROR
,
5019 "P2P: Failed to add group interface");
5022 group_wpa_s
= wpas_p2p_init_group_interface(wpa_s
, go
);
5023 if (group_wpa_s
== NULL
) {
5024 wpa_msg_global(wpa_s
, MSG_ERROR
,
5025 "P2P: Failed to initialize group interface");
5026 wpas_p2p_remove_pending_group_interface(wpa_s
);
5030 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Use separate group interface %s",
5031 group_wpa_s
->ifname
);
5032 group_wpa_s
->p2p_first_connection_timeout
= 0;
5038 * wpas_p2p_group_add - Add a new P2P group with local end as Group Owner
5039 * @wpa_s: Pointer to wpa_supplicant data from wpa_supplicant_add_iface()
5040 * @persistent_group: Whether to create a persistent group
5041 * @freq: Frequency for the group or 0 to indicate no hardcoding
5042 * @ht40: Start GO with 40 MHz channel width
5043 * @vht: Start GO with VHT support
5044 * Returns: 0 on success, -1 on failure
5046 * This function creates a new P2P group with the local end as the Group Owner,
5047 * i.e., without using Group Owner Negotiation.
5049 int wpas_p2p_group_add(struct wpa_supplicant
*wpa_s
, int persistent_group
,
5050 int freq
, int ht40
, int vht
)
5052 struct p2p_go_neg_results params
;
5054 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5057 os_free(wpa_s
->global
->add_psk
);
5058 wpa_s
->global
->add_psk
= NULL
;
5060 /* Make sure we are not running find during connection establishment */
5061 wpa_printf(MSG_DEBUG
, "P2P: Stop any on-going P2P FIND");
5062 wpas_p2p_stop_find_oper(wpa_s
);
5064 freq
= wpas_p2p_select_go_freq(wpa_s
, freq
);
5068 if (wpas_p2p_init_go_params(wpa_s
, ¶ms
, freq
, ht40
, vht
, NULL
))
5071 !p2p_supported_freq_go(wpa_s
->global
->p2p
, params
.freq
)) {
5072 wpa_printf(MSG_DEBUG
, "P2P: The selected channel for GO "
5073 "(%u MHz) is not supported for P2P uses",
5077 p2p_go_params(wpa_s
->global
->p2p
, ¶ms
);
5078 params
.persistent_group
= persistent_group
;
5080 wpa_s
= wpas_p2p_get_group_iface(wpa_s
, 0, 1);
5083 wpas_start_wps_go(wpa_s
, ¶ms
, 0);
5089 static int wpas_start_p2p_client(struct wpa_supplicant
*wpa_s
,
5090 struct wpa_ssid
*params
, int addr_allocated
)
5092 struct wpa_ssid
*ssid
;
5094 wpa_s
= wpas_p2p_get_group_iface(wpa_s
, addr_allocated
, 0);
5097 wpa_s
->p2p_last_4way_hs_fail
= NULL
;
5099 wpa_supplicant_ap_deinit(wpa_s
);
5101 ssid
= wpa_config_add_network(wpa_s
->conf
);
5104 wpa_config_set_network_defaults(ssid
);
5105 ssid
->temporary
= 1;
5106 ssid
->proto
= WPA_PROTO_RSN
;
5107 ssid
->pairwise_cipher
= WPA_CIPHER_CCMP
;
5108 ssid
->group_cipher
= WPA_CIPHER_CCMP
;
5109 ssid
->key_mgmt
= WPA_KEY_MGMT_PSK
;
5110 ssid
->ssid
= os_malloc(params
->ssid_len
);
5111 if (ssid
->ssid
== NULL
) {
5112 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
5115 os_memcpy(ssid
->ssid
, params
->ssid
, params
->ssid_len
);
5116 ssid
->ssid_len
= params
->ssid_len
;
5117 ssid
->p2p_group
= 1;
5118 ssid
->export_keys
= 1;
5119 if (params
->psk_set
) {
5120 os_memcpy(ssid
->psk
, params
->psk
, 32);
5123 if (params
->passphrase
)
5124 ssid
->passphrase
= os_strdup(params
->passphrase
);
5126 wpa_s
->show_group_started
= 1;
5128 wpa_supplicant_select_network(wpa_s
, ssid
);
5134 int wpas_p2p_group_add_persistent(struct wpa_supplicant
*wpa_s
,
5135 struct wpa_ssid
*ssid
, int addr_allocated
,
5136 int freq
, int ht40
, int vht
,
5137 const struct p2p_channels
*channels
,
5138 int connection_timeout
)
5140 struct p2p_go_neg_results params
;
5143 if (ssid
->disabled
!= 2 || ssid
->ssid
== NULL
)
5146 if (wpas_get_p2p_group(wpa_s
, ssid
->ssid
, ssid
->ssid_len
, &go
) &&
5147 go
== (ssid
->mode
== WPAS_MODE_P2P_GO
)) {
5148 wpa_printf(MSG_DEBUG
, "P2P: Requested persistent group is "
5153 os_free(wpa_s
->global
->add_psk
);
5154 wpa_s
->global
->add_psk
= NULL
;
5156 /* Make sure we are not running find during connection establishment */
5157 wpas_p2p_stop_find_oper(wpa_s
);
5159 wpa_s
->p2p_fallback_to_go_neg
= 0;
5161 if (ssid
->mode
== WPAS_MODE_INFRA
)
5162 return wpas_start_p2p_client(wpa_s
, ssid
, addr_allocated
);
5164 if (ssid
->mode
!= WPAS_MODE_P2P_GO
)
5167 freq
= wpas_p2p_select_go_freq(wpa_s
, freq
);
5171 if (wpas_p2p_init_go_params(wpa_s
, ¶ms
, freq
, ht40
, vht
, channels
))
5175 params
.psk_set
= ssid
->psk_set
;
5177 os_memcpy(params
.psk
, ssid
->psk
, sizeof(params
.psk
));
5178 if (ssid
->passphrase
) {
5179 if (os_strlen(ssid
->passphrase
) >= sizeof(params
.passphrase
)) {
5180 wpa_printf(MSG_ERROR
, "P2P: Invalid passphrase in "
5181 "persistent group");
5184 os_strlcpy(params
.passphrase
, ssid
->passphrase
,
5185 sizeof(params
.passphrase
));
5187 os_memcpy(params
.ssid
, ssid
->ssid
, ssid
->ssid_len
);
5188 params
.ssid_len
= ssid
->ssid_len
;
5189 params
.persistent_group
= 1;
5191 wpa_s
= wpas_p2p_get_group_iface(wpa_s
, addr_allocated
, 1);
5195 wpa_s
->p2p_first_connection_timeout
= connection_timeout
;
5196 wpas_start_wps_go(wpa_s
, ¶ms
, 0);
5202 static void wpas_p2p_ie_update(void *ctx
, struct wpabuf
*beacon_ies
,
5203 struct wpabuf
*proberesp_ies
)
5205 struct wpa_supplicant
*wpa_s
= ctx
;
5206 if (wpa_s
->ap_iface
) {
5207 struct hostapd_data
*hapd
= wpa_s
->ap_iface
->bss
[0];
5208 if (!(hapd
->conf
->p2p
& P2P_GROUP_OWNER
)) {
5209 wpabuf_free(beacon_ies
);
5210 wpabuf_free(proberesp_ies
);
5214 wpabuf_free(hapd
->p2p_beacon_ie
);
5215 hapd
->p2p_beacon_ie
= beacon_ies
;
5217 wpabuf_free(hapd
->p2p_probe_resp_ie
);
5218 hapd
->p2p_probe_resp_ie
= proberesp_ies
;
5220 wpabuf_free(beacon_ies
);
5221 wpabuf_free(proberesp_ies
);
5223 wpa_supplicant_ap_update_beacon(wpa_s
);
5227 static void wpas_p2p_idle_update(void *ctx
, int idle
)
5229 struct wpa_supplicant
*wpa_s
= ctx
;
5230 if (!wpa_s
->ap_iface
)
5232 wpa_printf(MSG_DEBUG
, "P2P: GO - group %sidle", idle
? "" : "not ");
5234 if (wpa_s
->global
->p2p_fail_on_wps_complete
&&
5235 wpa_s
->p2p_in_provisioning
) {
5236 wpas_p2p_grpform_fail_after_wps(wpa_s
);
5239 wpas_p2p_set_group_idle_timeout(wpa_s
);
5241 eloop_cancel_timeout(wpas_p2p_group_idle_timeout
, wpa_s
, NULL
);
5245 struct p2p_group
* wpas_p2p_group_init(struct wpa_supplicant
*wpa_s
,
5246 struct wpa_ssid
*ssid
)
5248 struct p2p_group
*group
;
5249 struct p2p_group_config
*cfg
;
5251 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5254 cfg
= os_zalloc(sizeof(*cfg
));
5258 if (ssid
->p2p_persistent_group
&& wpa_s
->conf
->persistent_reconnect
)
5259 cfg
->persistent_group
= 2;
5260 else if (ssid
->p2p_persistent_group
)
5261 cfg
->persistent_group
= 1;
5262 os_memcpy(cfg
->interface_addr
, wpa_s
->own_addr
, ETH_ALEN
);
5263 if (wpa_s
->max_stations
&&
5264 wpa_s
->max_stations
< wpa_s
->conf
->max_num_sta
)
5265 cfg
->max_clients
= wpa_s
->max_stations
;
5267 cfg
->max_clients
= wpa_s
->conf
->max_num_sta
;
5268 os_memcpy(cfg
->ssid
, ssid
->ssid
, ssid
->ssid_len
);
5269 cfg
->ssid_len
= ssid
->ssid_len
;
5270 cfg
->freq
= ssid
->frequency
;
5271 cfg
->cb_ctx
= wpa_s
;
5272 cfg
->ie_update
= wpas_p2p_ie_update
;
5273 cfg
->idle_update
= wpas_p2p_idle_update
;
5275 group
= p2p_group_init(wpa_s
->global
->p2p
, cfg
);
5278 if (ssid
->mode
!= WPAS_MODE_P2P_GROUP_FORMATION
)
5279 p2p_group_notif_formation_done(group
);
5280 wpa_s
->p2p_group
= group
;
5285 void wpas_p2p_wps_success(struct wpa_supplicant
*wpa_s
, const u8
*peer_addr
,
5288 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
5290 if (!wpa_s
->p2p_in_provisioning
) {
5291 wpa_printf(MSG_DEBUG
, "P2P: Ignore WPS success event - P2P "
5292 "provisioning not in progress");
5296 if (ssid
&& ssid
->mode
== WPAS_MODE_INFRA
) {
5297 u8 go_dev_addr
[ETH_ALEN
];
5298 os_memcpy(go_dev_addr
, wpa_s
->bssid
, ETH_ALEN
);
5299 wpas_p2p_persistent_group(wpa_s
, go_dev_addr
, ssid
->ssid
,
5301 /* Clear any stored provisioning info */
5302 p2p_clear_provisioning_info(wpa_s
->global
->p2p
, go_dev_addr
);
5305 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
, wpa_s
->parent
,
5307 wpa_s
->p2p_go_group_formation_completed
= 1;
5308 if (ssid
&& ssid
->mode
== WPAS_MODE_INFRA
) {
5310 * Use a separate timeout for initial data connection to
5311 * complete to allow the group to be removed automatically if
5312 * something goes wrong in this step before the P2P group idle
5313 * timeout mechanism is taken into use.
5315 wpa_dbg(wpa_s
, MSG_DEBUG
,
5316 "P2P: Re-start group formation timeout (%d seconds) as client for initial connection",
5317 P2P_MAX_INITIAL_CONN_WAIT
);
5318 eloop_register_timeout(P2P_MAX_INITIAL_CONN_WAIT
, 0,
5319 wpas_p2p_group_formation_timeout
,
5320 wpa_s
->parent
, NULL
);
5323 * Use a separate timeout for initial data connection to
5324 * complete to allow the group to be removed automatically if
5325 * the client does not complete data connection successfully.
5327 wpa_dbg(wpa_s
, MSG_DEBUG
,
5328 "P2P: Re-start group formation timeout (%d seconds) as GO for initial connection",
5329 P2P_MAX_INITIAL_CONN_WAIT_GO
);
5330 eloop_register_timeout(P2P_MAX_INITIAL_CONN_WAIT_GO
, 0,
5331 wpas_p2p_group_formation_timeout
,
5332 wpa_s
->parent
, NULL
);
5334 * Complete group formation on first successful data connection
5336 wpa_s
->p2p_go_group_formation_completed
= 0;
5338 if (wpa_s
->global
->p2p
)
5339 p2p_wps_success_cb(wpa_s
->global
->p2p
, peer_addr
);
5340 wpas_group_formation_completed(wpa_s
, 1);
5344 void wpas_p2p_wps_failed(struct wpa_supplicant
*wpa_s
,
5345 struct wps_event_fail
*fail
)
5347 if (!wpa_s
->p2p_in_provisioning
) {
5348 wpa_printf(MSG_DEBUG
, "P2P: Ignore WPS fail event - P2P "
5349 "provisioning not in progress");
5353 if (wpa_s
->go_params
) {
5354 p2p_clear_provisioning_info(
5356 wpa_s
->go_params
->peer_device_addr
);
5359 wpas_notify_p2p_wps_failed(wpa_s
, fail
);
5361 if (wpa_s
== wpa_s
->global
->p2p_group_formation
) {
5363 * Allow some time for the failed WPS negotiation exchange to
5364 * complete, but remove the group since group formation cannot
5365 * succeed after provisioning failure.
5367 wpa_printf(MSG_DEBUG
, "P2P: WPS step failed during group formation - reject connection from timeout");
5368 wpa_s
->global
->p2p_fail_on_wps_complete
= 1;
5369 eloop_deplete_timeout(0, 50000,
5370 wpas_p2p_group_formation_timeout
,
5371 wpa_s
->parent
, NULL
);
5376 int wpas_p2p_wps_eapol_cb(struct wpa_supplicant
*wpa_s
)
5378 if (!wpa_s
->global
->p2p_fail_on_wps_complete
||
5379 !wpa_s
->p2p_in_provisioning
)
5382 wpas_p2p_grpform_fail_after_wps(wpa_s
);
5388 int wpas_p2p_prov_disc(struct wpa_supplicant
*wpa_s
, const u8
*peer_addr
,
5389 const char *config_method
,
5390 enum wpas_p2p_prov_disc_use use
)
5394 wpa_s
->p2p_fallback_to_go_neg
= 0;
5395 wpa_s
->pending_pd_use
= NORMAL_PD
;
5396 if (os_strncmp(config_method
, "display", 7) == 0)
5397 config_methods
= WPS_CONFIG_DISPLAY
;
5398 else if (os_strncmp(config_method
, "keypad", 6) == 0)
5399 config_methods
= WPS_CONFIG_KEYPAD
;
5400 else if (os_strncmp(config_method
, "pbc", 3) == 0 ||
5401 os_strncmp(config_method
, "pushbutton", 10) == 0)
5402 config_methods
= WPS_CONFIG_PUSHBUTTON
;
5404 wpa_printf(MSG_DEBUG
, "P2P: Unknown config method");
5408 if (use
== WPAS_P2P_PD_AUTO
) {
5409 os_memcpy(wpa_s
->pending_join_dev_addr
, peer_addr
, ETH_ALEN
);
5410 wpa_s
->pending_pd_config_methods
= config_methods
;
5411 wpa_s
->p2p_auto_pd
= 1;
5412 wpa_s
->p2p_auto_join
= 0;
5413 wpa_s
->pending_pd_before_join
= 0;
5414 wpa_s
->auto_pd_scan_retry
= 0;
5415 wpas_p2p_stop_find(wpa_s
);
5416 wpa_s
->p2p_join_scan_count
= 0;
5417 os_get_reltime(&wpa_s
->p2p_auto_started
);
5418 wpa_printf(MSG_DEBUG
, "P2P: Auto PD started at %ld.%06ld",
5419 wpa_s
->p2p_auto_started
.sec
,
5420 wpa_s
->p2p_auto_started
.usec
);
5421 wpas_p2p_join_scan(wpa_s
, NULL
);
5425 if (wpa_s
->global
->p2p
== NULL
|| wpa_s
->global
->p2p_disabled
)
5428 return p2p_prov_disc_req(wpa_s
->global
->p2p
, peer_addr
,
5429 config_methods
, use
== WPAS_P2P_PD_FOR_JOIN
,
5434 int wpas_p2p_scan_result_text(const u8
*ies
, size_t ies_len
, char *buf
,
5437 return p2p_scan_result_text(ies
, ies_len
, buf
, end
);
5441 static void wpas_p2p_clear_pending_action_tx(struct wpa_supplicant
*wpa_s
)
5443 if (!offchannel_pending_action_tx(wpa_s
))
5446 wpa_printf(MSG_DEBUG
, "P2P: Drop pending Action TX due to new "
5447 "operation request");
5448 offchannel_clear_pending_action_tx(wpa_s
);
5452 int wpas_p2p_find(struct wpa_supplicant
*wpa_s
, unsigned int timeout
,
5453 enum p2p_discovery_type type
,
5454 unsigned int num_req_dev_types
, const u8
*req_dev_types
,
5455 const u8
*dev_id
, unsigned int search_delay
)
5457 wpas_p2p_clear_pending_action_tx(wpa_s
);
5458 wpa_s
->p2p_long_listen
= 0;
5460 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
||
5461 wpa_s
->p2p_in_provisioning
)
5464 wpa_supplicant_cancel_sched_scan(wpa_s
);
5466 return p2p_find(wpa_s
->global
->p2p
, timeout
, type
,
5467 num_req_dev_types
, req_dev_types
, dev_id
,
5472 static int wpas_p2p_stop_find_oper(struct wpa_supplicant
*wpa_s
)
5474 wpas_p2p_clear_pending_action_tx(wpa_s
);
5475 wpa_s
->p2p_long_listen
= 0;
5476 eloop_cancel_timeout(wpas_p2p_long_listen_timeout
, wpa_s
, NULL
);
5477 eloop_cancel_timeout(wpas_p2p_join_scan
, wpa_s
, NULL
);
5479 if (wpa_s
->global
->p2p
)
5480 p2p_stop_find(wpa_s
->global
->p2p
);
5486 void wpas_p2p_stop_find(struct wpa_supplicant
*wpa_s
)
5488 if (wpas_p2p_stop_find_oper(wpa_s
) > 0)
5490 wpas_p2p_remove_pending_group_interface(wpa_s
);
5494 static void wpas_p2p_long_listen_timeout(void *eloop_ctx
, void *timeout_ctx
)
5496 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
5497 wpa_s
->p2p_long_listen
= 0;
5501 int wpas_p2p_listen(struct wpa_supplicant
*wpa_s
, unsigned int timeout
)
5505 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5508 wpa_supplicant_cancel_sched_scan(wpa_s
);
5509 wpas_p2p_clear_pending_action_tx(wpa_s
);
5513 * This is a request for unlimited Listen state. However, at
5514 * least for now, this is mapped to a Listen state for one
5519 eloop_cancel_timeout(wpas_p2p_long_listen_timeout
, wpa_s
, NULL
);
5520 wpa_s
->p2p_long_listen
= 0;
5523 * Stop previous find/listen operation to avoid trying to request a new
5524 * remain-on-channel operation while the driver is still running the
5527 if (wpa_s
->global
->p2p
)
5528 p2p_stop_find(wpa_s
->global
->p2p
);
5530 res
= wpas_p2p_listen_start(wpa_s
, timeout
* 1000);
5531 if (res
== 0 && timeout
* 1000 > wpa_s
->max_remain_on_chan
) {
5532 wpa_s
->p2p_long_listen
= timeout
* 1000;
5533 eloop_register_timeout(timeout
, 0,
5534 wpas_p2p_long_listen_timeout
,
5542 int wpas_p2p_assoc_req_ie(struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
,
5543 u8
*buf
, size_t len
, int p2p_group
)
5545 struct wpabuf
*p2p_ie
;
5548 if (wpa_s
->global
->p2p_disabled
)
5550 if (wpa_s
->global
->p2p
== NULL
)
5555 p2p_ie
= wpa_bss_get_vendor_ie_multi(bss
, P2P_IE_VENDOR_TYPE
);
5556 ret
= p2p_assoc_req_ie(wpa_s
->global
->p2p
, bss
->bssid
, buf
, len
,
5558 wpabuf_free(p2p_ie
);
5564 int wpas_p2p_probe_req_rx(struct wpa_supplicant
*wpa_s
, const u8
*addr
,
5565 const u8
*dst
, const u8
*bssid
,
5566 const u8
*ie
, size_t ie_len
, int ssi_signal
)
5568 if (wpa_s
->global
->p2p_disabled
)
5570 if (wpa_s
->global
->p2p
== NULL
)
5573 switch (p2p_probe_req_rx(wpa_s
->global
->p2p
, addr
, dst
, bssid
,
5575 case P2P_PREQ_NOT_P2P
:
5576 wpas_notify_preq(wpa_s
, addr
, dst
, bssid
, ie
, ie_len
,
5579 case P2P_PREQ_MALFORMED
:
5580 case P2P_PREQ_NOT_LISTEN
:
5581 case P2P_PREQ_NOT_PROCESSED
:
5582 default: /* make gcc happy */
5584 case P2P_PREQ_PROCESSED
:
5590 void wpas_p2p_rx_action(struct wpa_supplicant
*wpa_s
, const u8
*da
,
5591 const u8
*sa
, const u8
*bssid
,
5592 u8 category
, const u8
*data
, size_t len
, int freq
)
5594 if (wpa_s
->global
->p2p_disabled
)
5596 if (wpa_s
->global
->p2p
== NULL
)
5599 p2p_rx_action(wpa_s
->global
->p2p
, da
, sa
, bssid
, category
, data
, len
,
5604 void wpas_p2p_scan_ie(struct wpa_supplicant
*wpa_s
, struct wpabuf
*ies
)
5606 if (wpa_s
->global
->p2p_disabled
)
5608 if (wpa_s
->global
->p2p
== NULL
)
5611 p2p_scan_ie(wpa_s
->global
->p2p
, ies
, NULL
);
5615 void wpas_p2p_group_deinit(struct wpa_supplicant
*wpa_s
)
5617 p2p_group_deinit(wpa_s
->p2p_group
);
5618 wpa_s
->p2p_group
= NULL
;
5620 wpa_s
->ap_configured_cb
= NULL
;
5621 wpa_s
->ap_configured_cb_ctx
= NULL
;
5622 wpa_s
->ap_configured_cb_data
= NULL
;
5623 wpa_s
->connect_without_scan
= NULL
;
5627 int wpas_p2p_reject(struct wpa_supplicant
*wpa_s
, const u8
*addr
)
5629 wpa_s
->p2p_long_listen
= 0;
5631 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5634 return p2p_reject(wpa_s
->global
->p2p
, addr
);
5638 /* Invite to reinvoke a persistent group */
5639 int wpas_p2p_invite(struct wpa_supplicant
*wpa_s
, const u8
*peer_addr
,
5640 struct wpa_ssid
*ssid
, const u8
*go_dev_addr
, int freq
,
5641 int ht40
, int vht
, int pref_freq
)
5643 enum p2p_invite_role role
;
5647 int no_pref_freq_given
= pref_freq
== 0;
5649 wpa_s
->global
->p2p_invite_group
= NULL
;
5651 os_memcpy(wpa_s
->p2p_auth_invite
, peer_addr
, ETH_ALEN
);
5653 os_memset(wpa_s
->p2p_auth_invite
, 0, ETH_ALEN
);
5655 wpa_s
->p2p_persistent_go_freq
= freq
;
5656 wpa_s
->p2p_go_ht40
= !!ht40
;
5657 if (ssid
->mode
== WPAS_MODE_P2P_GO
) {
5658 role
= P2P_INVITE_ROLE_GO
;
5659 if (peer_addr
== NULL
) {
5660 wpa_printf(MSG_DEBUG
, "P2P: Missing peer "
5661 "address in invitation command");
5664 if (wpas_p2p_create_iface(wpa_s
)) {
5665 if (wpas_p2p_add_group_interface(wpa_s
,
5666 WPA_IF_P2P_GO
) < 0) {
5667 wpa_printf(MSG_ERROR
, "P2P: Failed to "
5668 "allocate a new interface for the "
5672 bssid
= wpa_s
->pending_interface_addr
;
5674 bssid
= wpa_s
->own_addr
;
5676 role
= P2P_INVITE_ROLE_CLIENT
;
5677 peer_addr
= ssid
->bssid
;
5679 wpa_s
->pending_invite_ssid_id
= ssid
->id
;
5681 res
= wpas_p2p_setup_freqs(wpa_s
, freq
, &force_freq
, &pref_freq
,
5682 role
== P2P_INVITE_ROLE_GO
);
5686 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5689 if (wpa_s
->parent
->conf
->p2p_ignore_shared_freq
&&
5690 no_pref_freq_given
&& pref_freq
> 0 &&
5691 wpa_s
->num_multichan_concurrent
> 1 &&
5692 wpas_p2p_num_unused_channels(wpa_s
) > 0) {
5693 wpa_printf(MSG_DEBUG
, "P2P: Ignore own channel preference %d MHz for invitation due to p2p_ignore_shared_freq=1 configuration",
5698 return p2p_invite(wpa_s
->global
->p2p
, peer_addr
, role
, bssid
,
5699 ssid
->ssid
, ssid
->ssid_len
, force_freq
, go_dev_addr
,
5704 /* Invite to join an active group */
5705 int wpas_p2p_invite_group(struct wpa_supplicant
*wpa_s
, const char *ifname
,
5706 const u8
*peer_addr
, const u8
*go_dev_addr
)
5708 struct wpa_global
*global
= wpa_s
->global
;
5709 enum p2p_invite_role role
;
5711 struct wpa_ssid
*ssid
;
5713 int freq
= 0, force_freq
= 0, pref_freq
= 0;
5716 wpa_s
->p2p_persistent_go_freq
= 0;
5717 wpa_s
->p2p_go_ht40
= 0;
5718 wpa_s
->p2p_go_vht
= 0;
5720 for (wpa_s
= global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
5721 if (os_strcmp(wpa_s
->ifname
, ifname
) == 0)
5724 if (wpa_s
== NULL
) {
5725 wpa_printf(MSG_DEBUG
, "P2P: Interface '%s' not found", ifname
);
5729 ssid
= wpa_s
->current_ssid
;
5731 wpa_printf(MSG_DEBUG
, "P2P: No current SSID to use for "
5736 wpa_s
->global
->p2p_invite_group
= wpa_s
;
5737 persistent
= ssid
->p2p_persistent_group
&&
5738 wpas_p2p_get_persistent(wpa_s
->parent
, peer_addr
,
5739 ssid
->ssid
, ssid
->ssid_len
);
5741 if (ssid
->mode
== WPAS_MODE_P2P_GO
) {
5742 role
= P2P_INVITE_ROLE_ACTIVE_GO
;
5743 bssid
= wpa_s
->own_addr
;
5744 if (go_dev_addr
== NULL
)
5745 go_dev_addr
= wpa_s
->global
->p2p_dev_addr
;
5746 freq
= ssid
->frequency
;
5748 role
= P2P_INVITE_ROLE_CLIENT
;
5749 if (wpa_s
->wpa_state
< WPA_ASSOCIATED
) {
5750 wpa_printf(MSG_DEBUG
, "P2P: Not associated - cannot "
5751 "invite to current group");
5754 bssid
= wpa_s
->bssid
;
5755 if (go_dev_addr
== NULL
&&
5756 !is_zero_ether_addr(wpa_s
->go_dev_addr
))
5757 go_dev_addr
= wpa_s
->go_dev_addr
;
5758 freq
= wpa_s
->current_bss
? wpa_s
->current_bss
->freq
:
5759 (int) wpa_s
->assoc_freq
;
5761 wpa_s
->parent
->pending_invite_ssid_id
= -1;
5763 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5766 res
= wpas_p2p_setup_freqs(wpa_s
, freq
, &force_freq
, &pref_freq
,
5767 role
== P2P_INVITE_ROLE_ACTIVE_GO
);
5770 wpas_p2p_set_own_freq_preference(wpa_s
, force_freq
);
5772 return p2p_invite(wpa_s
->global
->p2p
, peer_addr
, role
, bssid
,
5773 ssid
->ssid
, ssid
->ssid_len
, force_freq
,
5774 go_dev_addr
, persistent
, pref_freq
);
5778 void wpas_p2p_completed(struct wpa_supplicant
*wpa_s
)
5780 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
5781 const char *ssid_txt
;
5782 u8 go_dev_addr
[ETH_ALEN
];
5783 int network_id
= -1;
5789 if (ssid
== NULL
|| ssid
->mode
!= WPAS_MODE_P2P_GROUP_FORMATION
) {
5790 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
5791 wpa_s
->parent
, NULL
);
5794 if (!wpa_s
->show_group_started
|| !ssid
)
5797 wpa_s
->show_group_started
= 0;
5799 ssid_txt
= wpa_ssid_txt(ssid
->ssid
, ssid
->ssid_len
);
5800 os_memset(go_dev_addr
, 0, ETH_ALEN
);
5801 if (ssid
->bssid_set
)
5802 os_memcpy(go_dev_addr
, ssid
->bssid
, ETH_ALEN
);
5803 persistent
= wpas_p2p_persistent_group(wpa_s
, go_dev_addr
, ssid
->ssid
,
5805 os_memcpy(wpa_s
->go_dev_addr
, go_dev_addr
, ETH_ALEN
);
5807 if (wpa_s
->global
->p2p_group_formation
== wpa_s
)
5808 wpa_s
->global
->p2p_group_formation
= NULL
;
5810 freq
= wpa_s
->current_bss
? wpa_s
->current_bss
->freq
:
5811 (int) wpa_s
->assoc_freq
;
5814 if (wpa_sm_get_p2p_ip_addr(wpa_s
->wpa
, ip
) == 0) {
5815 os_snprintf(ip_addr
, sizeof(ip_addr
), " ip_addr=%u.%u.%u.%u "
5816 "ip_mask=%u.%u.%u.%u go_ip_addr=%u.%u.%u.%u",
5817 ip
[0], ip
[1], ip
[2], ip
[3],
5818 ip
[4], ip
[5], ip
[6], ip
[7],
5819 ip
[8], ip
[9], ip
[10], ip
[11]);
5822 if (ssid
->passphrase
== NULL
&& ssid
->psk_set
) {
5824 wpa_snprintf_hex(psk
, sizeof(psk
), ssid
->psk
, 32);
5825 wpa_msg_global(wpa_s
->parent
, MSG_INFO
, P2P_EVENT_GROUP_STARTED
5826 "%s client ssid=\"%s\" freq=%d psk=%s "
5827 "go_dev_addr=" MACSTR
"%s%s",
5828 wpa_s
->ifname
, ssid_txt
, freq
, psk
,
5829 MAC2STR(go_dev_addr
),
5830 persistent
? " [PERSISTENT]" : "", ip_addr
);
5832 wpa_msg_global(wpa_s
->parent
, MSG_INFO
, P2P_EVENT_GROUP_STARTED
5833 "%s client ssid=\"%s\" freq=%d "
5834 "passphrase=\"%s\" go_dev_addr=" MACSTR
"%s%s",
5835 wpa_s
->ifname
, ssid_txt
, freq
,
5836 ssid
->passphrase
? ssid
->passphrase
: "",
5837 MAC2STR(go_dev_addr
),
5838 persistent
? " [PERSISTENT]" : "", ip_addr
);
5842 network_id
= wpas_p2p_store_persistent_group(wpa_s
->parent
,
5845 network_id
= ssid
->id
;
5846 wpas_notify_p2p_group_started(wpa_s
, ssid
, network_id
, 1);
5850 int wpas_p2p_presence_req(struct wpa_supplicant
*wpa_s
, u32 duration1
,
5851 u32 interval1
, u32 duration2
, u32 interval2
)
5855 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5858 if (wpa_s
->wpa_state
< WPA_ASSOCIATED
||
5859 wpa_s
->current_ssid
== NULL
||
5860 wpa_s
->current_ssid
->mode
!= WPAS_MODE_INFRA
)
5863 ret
= p2p_presence_req(wpa_s
->global
->p2p
, wpa_s
->bssid
,
5864 wpa_s
->own_addr
, wpa_s
->assoc_freq
,
5865 duration1
, interval1
, duration2
, interval2
);
5867 wpa_s
->waiting_presence_resp
= 1;
5873 int wpas_p2p_ext_listen(struct wpa_supplicant
*wpa_s
, unsigned int period
,
5874 unsigned int interval
)
5876 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5879 return p2p_ext_listen(wpa_s
->global
->p2p
, period
, interval
);
5883 static int wpas_p2p_is_client(struct wpa_supplicant
*wpa_s
)
5885 if (wpa_s
->current_ssid
== NULL
) {
5887 * current_ssid can be cleared when P2P client interface gets
5888 * disconnected, so assume this interface was used as P2P
5893 return wpa_s
->current_ssid
->p2p_group
&&
5894 wpa_s
->current_ssid
->mode
== WPAS_MODE_INFRA
;
5898 static void wpas_p2p_group_idle_timeout(void *eloop_ctx
, void *timeout_ctx
)
5900 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
5902 if (wpa_s
->conf
->p2p_group_idle
== 0 && !wpas_p2p_is_client(wpa_s
)) {
5903 wpa_printf(MSG_DEBUG
, "P2P: Ignore group idle timeout - "
5908 wpa_printf(MSG_DEBUG
, "P2P: Group idle timeout reached - terminate "
5910 wpas_p2p_group_delete(wpa_s
, P2P_GROUP_REMOVAL_IDLE_TIMEOUT
);
5914 static void wpas_p2p_set_group_idle_timeout(struct wpa_supplicant
*wpa_s
)
5918 if (eloop_cancel_timeout(wpas_p2p_group_idle_timeout
, wpa_s
, NULL
) > 0)
5919 wpa_printf(MSG_DEBUG
, "P2P: Cancelled P2P group idle timeout");
5921 if (wpa_s
->current_ssid
== NULL
|| !wpa_s
->current_ssid
->p2p_group
)
5924 timeout
= wpa_s
->conf
->p2p_group_idle
;
5925 if (wpa_s
->current_ssid
->mode
== WPAS_MODE_INFRA
&&
5926 (timeout
== 0 || timeout
> P2P_MAX_CLIENT_IDLE
))
5927 timeout
= P2P_MAX_CLIENT_IDLE
;
5933 if (wpa_s
->current_ssid
->mode
== WPAS_MODE_INFRA
)
5934 timeout
= 0; /* special client mode no-timeout */
5939 if (wpa_s
->p2p_in_provisioning
) {
5941 * Use the normal group formation timeout during the
5942 * provisioning phase to avoid terminating this process too
5943 * early due to group idle timeout.
5945 wpa_printf(MSG_DEBUG
, "P2P: Do not use P2P group idle timeout "
5946 "during provisioning");
5950 if (wpa_s
->show_group_started
) {
5952 * Use the normal group formation timeout between the end of
5953 * the provisioning phase and completion of 4-way handshake to
5954 * avoid terminating this process too early due to group idle
5957 wpa_printf(MSG_DEBUG
, "P2P: Do not use P2P group idle timeout "
5958 "while waiting for initial 4-way handshake to "
5963 wpa_printf(MSG_DEBUG
, "P2P: Set P2P group idle timeout to %u seconds",
5965 eloop_register_timeout(timeout
, 0, wpas_p2p_group_idle_timeout
,
5970 /* Returns 1 if the interface was removed */
5971 int wpas_p2p_deauth_notif(struct wpa_supplicant
*wpa_s
, const u8
*bssid
,
5972 u16 reason_code
, const u8
*ie
, size_t ie_len
,
5973 int locally_generated
)
5975 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
5978 if (!locally_generated
)
5979 p2p_deauth_notif(wpa_s
->global
->p2p
, bssid
, reason_code
, ie
,
5982 if (reason_code
== WLAN_REASON_DEAUTH_LEAVING
&& !locally_generated
&&
5983 wpa_s
->current_ssid
&&
5984 wpa_s
->current_ssid
->p2p_group
&&
5985 wpa_s
->current_ssid
->mode
== WPAS_MODE_INFRA
) {
5986 wpa_printf(MSG_DEBUG
, "P2P: GO indicated that the P2P Group "
5987 "session is ending");
5988 if (wpas_p2p_group_delete(wpa_s
,
5989 P2P_GROUP_REMOVAL_GO_ENDING_SESSION
)
5998 void wpas_p2p_disassoc_notif(struct wpa_supplicant
*wpa_s
, const u8
*bssid
,
5999 u16 reason_code
, const u8
*ie
, size_t ie_len
,
6000 int locally_generated
)
6002 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
6005 if (!locally_generated
)
6006 p2p_disassoc_notif(wpa_s
->global
->p2p
, bssid
, reason_code
, ie
,
6011 void wpas_p2p_update_config(struct wpa_supplicant
*wpa_s
)
6013 struct p2p_data
*p2p
= wpa_s
->global
->p2p
;
6018 if (!(wpa_s
->drv_flags
& WPA_DRIVER_FLAGS_P2P_CAPABLE
))
6021 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_DEVICE_NAME
)
6022 p2p_set_dev_name(p2p
, wpa_s
->conf
->device_name
);
6024 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_DEVICE_TYPE
)
6025 p2p_set_pri_dev_type(p2p
, wpa_s
->conf
->device_type
);
6028 (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_CONFIG_METHODS
))
6029 p2p_set_config_methods(p2p
, wpa_s
->wps
->config_methods
);
6031 if (wpa_s
->wps
&& (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_UUID
))
6032 p2p_set_uuid(p2p
, wpa_s
->wps
->uuid
);
6034 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_WPS_STRING
) {
6035 p2p_set_manufacturer(p2p
, wpa_s
->conf
->manufacturer
);
6036 p2p_set_model_name(p2p
, wpa_s
->conf
->model_name
);
6037 p2p_set_model_number(p2p
, wpa_s
->conf
->model_number
);
6038 p2p_set_serial_number(p2p
, wpa_s
->conf
->serial_number
);
6041 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_SEC_DEVICE_TYPE
)
6042 p2p_set_sec_dev_types(p2p
,
6043 (void *) wpa_s
->conf
->sec_device_type
,
6044 wpa_s
->conf
->num_sec_device_types
);
6046 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_VENDOR_EXTENSION
) {
6048 p2p_remove_wps_vendor_extensions(p2p
);
6049 for (i
= 0; i
< MAX_WPS_VENDOR_EXT
; i
++) {
6050 if (wpa_s
->conf
->wps_vendor_ext
[i
] == NULL
)
6052 p2p_add_wps_vendor_extension(
6053 p2p
, wpa_s
->conf
->wps_vendor_ext
[i
]);
6057 if ((wpa_s
->conf
->changed_parameters
& CFG_CHANGED_COUNTRY
) &&
6058 wpa_s
->conf
->country
[0] && wpa_s
->conf
->country
[1]) {
6060 country
[0] = wpa_s
->conf
->country
[0];
6061 country
[1] = wpa_s
->conf
->country
[1];
6063 p2p_set_country(p2p
, country
);
6066 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_P2P_SSID_POSTFIX
) {
6067 p2p_set_ssid_postfix(p2p
, (u8
*) wpa_s
->conf
->p2p_ssid_postfix
,
6068 wpa_s
->conf
->p2p_ssid_postfix
?
6069 os_strlen(wpa_s
->conf
->p2p_ssid_postfix
) :
6073 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_P2P_INTRA_BSS
)
6074 p2p_set_intra_bss_dist(p2p
, wpa_s
->conf
->p2p_intra_bss
);
6076 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_P2P_LISTEN_CHANNEL
) {
6077 u8 reg_class
, channel
;
6080 if (wpa_s
->conf
->p2p_listen_reg_class
&&
6081 wpa_s
->conf
->p2p_listen_channel
) {
6082 reg_class
= wpa_s
->conf
->p2p_listen_reg_class
;
6083 channel
= wpa_s
->conf
->p2p_listen_channel
;
6087 * Pick one of the social channels randomly as the
6090 os_get_random((u8
*) &r
, sizeof(r
));
6091 channel
= 1 + (r
% 3) * 5;
6093 ret
= p2p_set_listen_channel(p2p
, reg_class
, channel
);
6095 wpa_printf(MSG_ERROR
, "P2P: Own listen channel update "
6098 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_P2P_OPER_CHANNEL
) {
6099 u8 op_reg_class
, op_channel
, cfg_op_channel
;
6102 if (wpa_s
->conf
->p2p_oper_reg_class
&&
6103 wpa_s
->conf
->p2p_oper_channel
) {
6104 op_reg_class
= wpa_s
->conf
->p2p_oper_reg_class
;
6105 op_channel
= wpa_s
->conf
->p2p_oper_channel
;
6110 * Use random operation channel from (1, 6, 11)
6111 *if no other preference is indicated.
6113 os_get_random((u8
*) &r
, sizeof(r
));
6114 op_channel
= 1 + (r
% 3) * 5;
6117 ret
= p2p_set_oper_channel(p2p
, op_reg_class
, op_channel
,
6120 wpa_printf(MSG_ERROR
, "P2P: Own oper channel update "
6124 if (wpa_s
->conf
->changed_parameters
& CFG_CHANGED_P2P_PREF_CHAN
) {
6125 if (p2p_set_pref_chan(p2p
, wpa_s
->conf
->num_p2p_pref_chan
,
6126 wpa_s
->conf
->p2p_pref_chan
) < 0) {
6127 wpa_printf(MSG_ERROR
, "P2P: Preferred channel list "
6131 if (p2p_set_no_go_freq(p2p
, &wpa_s
->conf
->p2p_no_go_freq
) < 0) {
6132 wpa_printf(MSG_ERROR
, "P2P: No GO channel list "
6139 int wpas_p2p_set_noa(struct wpa_supplicant
*wpa_s
, u8 count
, int start
,
6142 if (!wpa_s
->ap_iface
)
6144 return hostapd_p2p_set_noa(wpa_s
->ap_iface
->bss
[0], count
, start
,
6149 int wpas_p2p_set_cross_connect(struct wpa_supplicant
*wpa_s
, int enabled
)
6151 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
6154 wpa_s
->global
->cross_connection
= enabled
;
6155 p2p_set_cross_connect(wpa_s
->global
->p2p
, enabled
);
6158 struct wpa_supplicant
*iface
;
6160 for (iface
= wpa_s
->global
->ifaces
; iface
; iface
= iface
->next
)
6162 if (iface
->cross_connect_enabled
== 0)
6165 iface
->cross_connect_enabled
= 0;
6166 iface
->cross_connect_in_use
= 0;
6167 wpa_msg_global(iface
->parent
, MSG_INFO
,
6168 P2P_EVENT_CROSS_CONNECT_DISABLE
"%s %s",
6170 iface
->cross_connect_uplink
);
6178 static void wpas_p2p_enable_cross_connect(struct wpa_supplicant
*uplink
)
6180 struct wpa_supplicant
*iface
;
6182 if (!uplink
->global
->cross_connection
)
6185 for (iface
= uplink
->global
->ifaces
; iface
; iface
= iface
->next
) {
6186 if (!iface
->cross_connect_enabled
)
6188 if (os_strcmp(uplink
->ifname
, iface
->cross_connect_uplink
) !=
6191 if (iface
->ap_iface
== NULL
)
6193 if (iface
->cross_connect_in_use
)
6196 iface
->cross_connect_in_use
= 1;
6197 wpa_msg_global(iface
->parent
, MSG_INFO
,
6198 P2P_EVENT_CROSS_CONNECT_ENABLE
"%s %s",
6199 iface
->ifname
, iface
->cross_connect_uplink
);
6204 static void wpas_p2p_disable_cross_connect(struct wpa_supplicant
*uplink
)
6206 struct wpa_supplicant
*iface
;
6208 for (iface
= uplink
->global
->ifaces
; iface
; iface
= iface
->next
) {
6209 if (!iface
->cross_connect_enabled
)
6211 if (os_strcmp(uplink
->ifname
, iface
->cross_connect_uplink
) !=
6214 if (!iface
->cross_connect_in_use
)
6217 wpa_msg_global(iface
->parent
, MSG_INFO
,
6218 P2P_EVENT_CROSS_CONNECT_DISABLE
"%s %s",
6219 iface
->ifname
, iface
->cross_connect_uplink
);
6220 iface
->cross_connect_in_use
= 0;
6225 void wpas_p2p_notif_connected(struct wpa_supplicant
*wpa_s
)
6227 if (wpa_s
->ap_iface
|| wpa_s
->current_ssid
== NULL
||
6228 wpa_s
->current_ssid
->mode
!= WPAS_MODE_INFRA
||
6229 wpa_s
->cross_connect_disallowed
)
6230 wpas_p2p_disable_cross_connect(wpa_s
);
6232 wpas_p2p_enable_cross_connect(wpa_s
);
6233 if (!wpa_s
->ap_iface
&&
6234 eloop_cancel_timeout(wpas_p2p_group_idle_timeout
, wpa_s
, NULL
) > 0)
6235 wpa_printf(MSG_DEBUG
, "P2P: Cancelled P2P group idle timeout");
6239 void wpas_p2p_notif_disconnected(struct wpa_supplicant
*wpa_s
)
6241 wpas_p2p_disable_cross_connect(wpa_s
);
6242 if (!wpa_s
->ap_iface
&&
6243 !eloop_is_timeout_registered(wpas_p2p_group_idle_timeout
,
6245 wpas_p2p_set_group_idle_timeout(wpa_s
);
6249 static void wpas_p2p_cross_connect_setup(struct wpa_supplicant
*wpa_s
)
6251 struct wpa_supplicant
*iface
;
6253 if (!wpa_s
->global
->cross_connection
)
6256 for (iface
= wpa_s
->global
->ifaces
; iface
; iface
= iface
->next
) {
6259 if (iface
->drv_flags
&
6260 WPA_DRIVER_FLAGS_P2P_DEDICATED_INTERFACE
)
6262 if (iface
->drv_flags
& WPA_DRIVER_FLAGS_P2P_CAPABLE
)
6265 wpa_s
->cross_connect_enabled
= 1;
6266 os_strlcpy(wpa_s
->cross_connect_uplink
, iface
->ifname
,
6267 sizeof(wpa_s
->cross_connect_uplink
));
6268 wpa_printf(MSG_DEBUG
, "P2P: Enable cross connection from "
6269 "%s to %s whenever uplink is available",
6270 wpa_s
->ifname
, wpa_s
->cross_connect_uplink
);
6272 if (iface
->ap_iface
|| iface
->current_ssid
== NULL
||
6273 iface
->current_ssid
->mode
!= WPAS_MODE_INFRA
||
6274 iface
->cross_connect_disallowed
||
6275 iface
->wpa_state
!= WPA_COMPLETED
)
6278 wpa_s
->cross_connect_in_use
= 1;
6279 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
6280 P2P_EVENT_CROSS_CONNECT_ENABLE
"%s %s",
6281 wpa_s
->ifname
, wpa_s
->cross_connect_uplink
);
6287 int wpas_p2p_notif_pbc_overlap(struct wpa_supplicant
*wpa_s
)
6289 if (wpa_s
->p2p_group_interface
!= P2P_GROUP_INTERFACE_CLIENT
&&
6290 !wpa_s
->p2p_in_provisioning
)
6291 return 0; /* not P2P client operation */
6293 wpa_printf(MSG_DEBUG
, "P2P: Terminate connection due to WPS PBC "
6295 if (wpa_s
!= wpa_s
->parent
)
6296 wpa_msg_ctrl(wpa_s
->parent
, MSG_INFO
, WPS_EVENT_OVERLAP
);
6297 wpas_p2p_group_formation_failed(wpa_s
);
6302 void wpas_p2p_update_channel_list(struct wpa_supplicant
*wpa_s
)
6304 struct p2p_channels chan
, cli_chan
;
6306 if (wpa_s
->global
== NULL
|| wpa_s
->global
->p2p
== NULL
)
6309 os_memset(&chan
, 0, sizeof(chan
));
6310 os_memset(&cli_chan
, 0, sizeof(cli_chan
));
6311 if (wpas_p2p_setup_channels(wpa_s
, &chan
, &cli_chan
)) {
6312 wpa_printf(MSG_ERROR
, "P2P: Failed to update supported "
6317 p2p_update_channel_list(wpa_s
->global
->p2p
, &chan
, &cli_chan
);
6321 static void wpas_p2p_scan_res_ignore(struct wpa_supplicant
*wpa_s
,
6322 struct wpa_scan_results
*scan_res
)
6324 wpa_printf(MSG_DEBUG
, "P2P: Ignore scan results");
6328 int wpas_p2p_cancel(struct wpa_supplicant
*wpa_s
)
6330 struct wpa_global
*global
= wpa_s
->global
;
6334 if (global
->p2p
== NULL
)
6337 wpa_printf(MSG_DEBUG
, "P2P: Request to cancel group formation");
6339 if (wpa_s
->pending_interface_name
[0] &&
6340 !is_zero_ether_addr(wpa_s
->pending_interface_addr
))
6343 peer
= p2p_get_go_neg_peer(global
->p2p
);
6345 wpa_printf(MSG_DEBUG
, "P2P: Unauthorize pending GO Neg peer "
6346 MACSTR
, MAC2STR(peer
));
6347 p2p_unauthorize(global
->p2p
, peer
);
6351 if (wpa_s
->scan_res_handler
== wpas_p2p_scan_res_join
) {
6352 wpa_printf(MSG_DEBUG
, "P2P: Stop pending scan for join");
6353 wpa_s
->scan_res_handler
= wpas_p2p_scan_res_ignore
;
6357 if (wpa_s
->pending_pd_before_join
) {
6358 wpa_printf(MSG_DEBUG
, "P2P: Stop pending PD before join");
6359 wpa_s
->pending_pd_before_join
= 0;
6363 wpas_p2p_stop_find(wpa_s
);
6365 for (wpa_s
= global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
6366 if (wpa_s
== global
->p2p_group_formation
&&
6367 (wpa_s
->p2p_in_provisioning
||
6368 wpa_s
->parent
->pending_interface_type
==
6369 WPA_IF_P2P_CLIENT
)) {
6370 wpa_printf(MSG_DEBUG
, "P2P: Interface %s in group "
6371 "formation found - cancelling",
6374 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
6375 wpa_s
->parent
, NULL
);
6376 if (wpa_s
->p2p_in_provisioning
) {
6377 wpas_group_formation_completed(wpa_s
, 0);
6380 wpas_p2p_group_delete(wpa_s
,
6381 P2P_GROUP_REMOVAL_REQUESTED
);
6387 wpa_printf(MSG_DEBUG
, "P2P: No ongoing group formation found");
6395 void wpas_p2p_interface_unavailable(struct wpa_supplicant
*wpa_s
)
6397 if (wpa_s
->current_ssid
== NULL
|| !wpa_s
->current_ssid
->p2p_group
)
6400 wpa_printf(MSG_DEBUG
, "P2P: Remove group due to driver resource not "
6401 "being available anymore");
6402 wpas_p2p_group_delete(wpa_s
, P2P_GROUP_REMOVAL_UNAVAILABLE
);
6406 void wpas_p2p_update_best_channels(struct wpa_supplicant
*wpa_s
,
6407 int freq_24
, int freq_5
, int freq_overall
)
6409 struct p2p_data
*p2p
= wpa_s
->global
->p2p
;
6412 p2p_set_best_channels(p2p
, freq_24
, freq_5
, freq_overall
);
6416 int wpas_p2p_unauthorize(struct wpa_supplicant
*wpa_s
, const char *addr
)
6419 struct p2p_data
*p2p
= wpa_s
->global
->p2p
;
6424 if (hwaddr_aton(addr
, peer
))
6427 return p2p_unauthorize(p2p
, peer
);
6432 * wpas_p2p_disconnect - Disconnect from a P2P Group
6433 * @wpa_s: Pointer to wpa_supplicant data
6434 * Returns: 0 on success, -1 on failure
6436 * This can be used to disconnect from a group in which the local end is a P2P
6437 * Client or to end a P2P Group in case the local end is the Group Owner. If a
6438 * virtual network interface was created for this group, that interface will be
6439 * removed. Otherwise, only the configured P2P group network will be removed
6440 * from the interface.
6442 int wpas_p2p_disconnect(struct wpa_supplicant
*wpa_s
)
6448 return wpas_p2p_group_delete(wpa_s
, P2P_GROUP_REMOVAL_REQUESTED
) < 0 ?
6453 int wpas_p2p_in_progress(struct wpa_supplicant
*wpa_s
)
6457 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
6460 ret
= p2p_in_progress(wpa_s
->global
->p2p
);
6463 * Check whether there is an ongoing WPS provisioning step (or
6464 * other parts of group formation) on another interface since
6465 * p2p_in_progress() does not report this to avoid issues for
6466 * scans during such provisioning step.
6468 if (wpa_s
->global
->p2p_group_formation
&&
6469 wpa_s
->global
->p2p_group_formation
!= wpa_s
) {
6470 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Another interface (%s) "
6471 "in group formation",
6472 wpa_s
->global
->p2p_group_formation
->ifname
);
6477 if (!ret
&& wpa_s
->global
->p2p_go_wait_client
.sec
) {
6478 struct os_reltime now
;
6479 os_get_reltime(&now
);
6480 if (os_reltime_expired(&now
, &wpa_s
->global
->p2p_go_wait_client
,
6481 P2P_MAX_INITIAL_CONN_WAIT_GO
)) {
6482 /* Wait for the first client has expired */
6483 wpa_s
->global
->p2p_go_wait_client
.sec
= 0;
6485 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Waiting for initial client connection during group formation");
6494 void wpas_p2p_network_removed(struct wpa_supplicant
*wpa_s
,
6495 struct wpa_ssid
*ssid
)
6497 if (wpa_s
->p2p_in_provisioning
&& ssid
->p2p_group
&&
6498 eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
6499 wpa_s
->parent
, NULL
) > 0) {
6501 * Remove the network by scheduling the group formation
6502 * timeout to happen immediately. The teardown code
6503 * needs to be scheduled to run asynch later so that we
6504 * don't delete data from under ourselves unexpectedly.
6505 * Calling wpas_p2p_group_formation_timeout directly
6506 * causes a series of crashes in WPS failure scenarios.
6508 wpa_printf(MSG_DEBUG
, "P2P: Canceled group formation due to "
6509 "P2P group network getting removed");
6510 eloop_register_timeout(0, 0, wpas_p2p_group_formation_timeout
,
6511 wpa_s
->parent
, NULL
);
6516 struct wpa_ssid
* wpas_p2p_get_persistent(struct wpa_supplicant
*wpa_s
,
6517 const u8
*addr
, const u8
*ssid
,
6523 for (s
= wpa_s
->conf
->ssid
; s
; s
= s
->next
) {
6524 if (s
->disabled
!= 2)
6527 (ssid_len
!= s
->ssid_len
||
6528 os_memcmp(ssid
, s
->ssid
, ssid_len
) != 0))
6531 if (s
->mode
== WPAS_MODE_P2P_GO
)
6535 if (os_memcmp(s
->bssid
, addr
, ETH_ALEN
) == 0)
6536 return s
; /* peer is GO in the persistent group */
6537 if (s
->mode
!= WPAS_MODE_P2P_GO
|| s
->p2p_client_list
== NULL
)
6539 for (i
= 0; i
< s
->num_p2p_clients
; i
++) {
6540 if (os_memcmp(s
->p2p_client_list
+ i
* ETH_ALEN
,
6541 addr
, ETH_ALEN
) == 0)
6542 return s
; /* peer is P2P client in persistent
6551 void wpas_p2p_notify_ap_sta_authorized(struct wpa_supplicant
*wpa_s
,
6554 if (eloop_cancel_timeout(wpas_p2p_group_formation_timeout
,
6555 wpa_s
->parent
, NULL
) > 0) {
6557 * This can happen if WPS provisioning step is not terminated
6558 * cleanly (e.g., P2P Client does not send WSC_Done). Since the
6559 * peer was able to connect, there is no need to time out group
6560 * formation after this, though. In addition, this is used with
6561 * the initial connection wait on the GO as a separate formation
6562 * timeout and as such, expected to be hit after the initial WPS
6563 * provisioning step.
6565 wpa_printf(MSG_DEBUG
, "P2P: Canceled P2P group formation timeout on data connection");
6567 if (!wpa_s
->p2p_go_group_formation_completed
) {
6568 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Marking group formation completed on GO on first data connection");
6569 wpa_s
->p2p_go_group_formation_completed
= 1;
6570 wpa_s
->global
->p2p_group_formation
= NULL
;
6571 wpa_s
->p2p_in_provisioning
= 0;
6573 wpa_s
->global
->p2p_go_wait_client
.sec
= 0;
6576 wpas_p2p_add_persistent_group_client(wpa_s
, addr
);
6580 static void wpas_p2p_fallback_to_go_neg(struct wpa_supplicant
*wpa_s
,
6583 struct wpa_supplicant
*group
= wpa_s
;
6584 if (wpa_s
->global
->p2p_group_formation
)
6585 group
= wpa_s
->global
->p2p_group_formation
;
6586 wpa_s
= wpa_s
->parent
;
6587 offchannel_send_action_done(wpa_s
);
6589 wpas_p2p_group_delete(group
, P2P_GROUP_REMOVAL_SILENT
);
6590 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Fall back to GO Negotiation");
6591 wpas_p2p_connect(wpa_s
, wpa_s
->pending_join_dev_addr
, wpa_s
->p2p_pin
,
6592 wpa_s
->p2p_wps_method
, wpa_s
->p2p_persistent_group
, 0,
6593 0, 0, wpa_s
->p2p_go_intent
, wpa_s
->p2p_connect_freq
,
6594 wpa_s
->p2p_persistent_id
,
6595 wpa_s
->p2p_pd_before_go_neg
,
6601 int wpas_p2p_scan_no_go_seen(struct wpa_supplicant
*wpa_s
)
6603 if (!wpa_s
->p2p_fallback_to_go_neg
||
6604 wpa_s
->p2p_in_provisioning
<= 5)
6607 if (wpas_p2p_peer_go(wpa_s
, wpa_s
->pending_join_dev_addr
) > 0)
6608 return 0; /* peer operating as a GO */
6610 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: GO not found for p2p_connect-auto - "
6611 "fallback to GO Negotiation");
6612 wpas_p2p_fallback_to_go_neg(wpa_s
, 1);
6618 unsigned int wpas_p2p_search_delay(struct wpa_supplicant
*wpa_s
)
6620 struct wpa_supplicant
*ifs
;
6622 if (wpa_s
->wpa_state
> WPA_SCANNING
) {
6623 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Use %u ms search delay due to "
6624 "concurrent operation",
6625 P2P_CONCURRENT_SEARCH_DELAY
);
6626 return P2P_CONCURRENT_SEARCH_DELAY
;
6629 dl_list_for_each(ifs
, &wpa_s
->radio
->ifaces
, struct wpa_supplicant
,
6631 if (ifs
!= wpa_s
&& ifs
->wpa_state
> WPA_SCANNING
) {
6632 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Use %u ms search "
6633 "delay due to concurrent operation on "
6635 P2P_CONCURRENT_SEARCH_DELAY
, ifs
->ifname
);
6636 return P2P_CONCURRENT_SEARCH_DELAY
;
6644 static int wpas_p2p_remove_psk_entry(struct wpa_supplicant
*wpa_s
,
6645 struct wpa_ssid
*s
, const u8
*addr
,
6648 struct psk_list_entry
*psk
, *tmp
;
6651 dl_list_for_each_safe(psk
, tmp
, &s
->psk_list
, struct psk_list_entry
,
6653 if ((iface_addr
&& !psk
->p2p
&&
6654 os_memcmp(addr
, psk
->addr
, ETH_ALEN
) == 0) ||
6655 (!iface_addr
&& psk
->p2p
&&
6656 os_memcmp(addr
, psk
->addr
, ETH_ALEN
) == 0)) {
6657 wpa_dbg(wpa_s
, MSG_DEBUG
,
6658 "P2P: Remove persistent group PSK list entry for "
6660 MAC2STR(psk
->addr
), psk
->p2p
);
6661 dl_list_del(&psk
->list
);
6671 void wpas_p2p_new_psk_cb(struct wpa_supplicant
*wpa_s
, const u8
*mac_addr
,
6672 const u8
*p2p_dev_addr
,
6673 const u8
*psk
, size_t psk_len
)
6675 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
6676 struct wpa_ssid
*persistent
;
6677 struct psk_list_entry
*p
;
6679 if (psk_len
!= sizeof(p
->psk
))
6683 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: New PSK for addr=" MACSTR
6684 " p2p_dev_addr=" MACSTR
,
6685 MAC2STR(mac_addr
), MAC2STR(p2p_dev_addr
));
6686 if (is_zero_ether_addr(p2p_dev_addr
))
6687 p2p_dev_addr
= NULL
;
6689 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: New PSK for addr=" MACSTR
,
6693 if (ssid
->mode
== WPAS_MODE_P2P_GROUP_FORMATION
) {
6694 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: new_psk_cb during group formation");
6695 /* To be added to persistent group once created */
6696 if (wpa_s
->global
->add_psk
== NULL
) {
6697 wpa_s
->global
->add_psk
= os_zalloc(sizeof(*p
));
6698 if (wpa_s
->global
->add_psk
== NULL
)
6701 p
= wpa_s
->global
->add_psk
;
6704 os_memcpy(p
->addr
, p2p_dev_addr
, ETH_ALEN
);
6707 os_memcpy(p
->addr
, mac_addr
, ETH_ALEN
);
6709 os_memcpy(p
->psk
, psk
, psk_len
);
6713 if (ssid
->mode
!= WPAS_MODE_P2P_GO
|| !ssid
->p2p_persistent_group
) {
6714 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Ignore new_psk_cb on not-persistent GO");
6718 persistent
= wpas_p2p_get_persistent(wpa_s
->parent
, NULL
, ssid
->ssid
,
6721 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Could not find persistent group information to store the new PSK");
6725 p
= os_zalloc(sizeof(*p
));
6730 os_memcpy(p
->addr
, p2p_dev_addr
, ETH_ALEN
);
6733 os_memcpy(p
->addr
, mac_addr
, ETH_ALEN
);
6735 os_memcpy(p
->psk
, psk
, psk_len
);
6737 if (dl_list_len(&persistent
->psk_list
) > P2P_MAX_STORED_CLIENTS
) {
6738 struct psk_list_entry
*last
;
6739 last
= dl_list_last(&persistent
->psk_list
,
6740 struct psk_list_entry
, list
);
6741 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Remove oldest PSK entry for "
6742 MACSTR
" (p2p=%u) to make room for a new one",
6743 MAC2STR(last
->addr
), last
->p2p
);
6744 dl_list_del(&last
->list
);
6748 wpas_p2p_remove_psk_entry(wpa_s
->parent
, persistent
,
6749 p2p_dev_addr
? p2p_dev_addr
: mac_addr
,
6750 p2p_dev_addr
== NULL
);
6752 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Add new PSK for p2p_dev_addr="
6753 MACSTR
, MAC2STR(p2p_dev_addr
));
6755 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Add new PSK for addr=" MACSTR
,
6758 dl_list_add(&persistent
->psk_list
, &p
->list
);
6760 #ifndef CONFIG_NO_CONFIG_WRITE
6761 if (wpa_s
->parent
->conf
->update_config
&&
6762 wpa_config_write(wpa_s
->parent
->confname
, wpa_s
->parent
->conf
))
6763 wpa_printf(MSG_DEBUG
, "P2P: Failed to update configuration");
6764 #endif /* CONFIG_NO_CONFIG_WRITE */
6768 static void wpas_p2p_remove_psk(struct wpa_supplicant
*wpa_s
,
6769 struct wpa_ssid
*s
, const u8
*addr
,
6774 res
= wpas_p2p_remove_psk_entry(wpa_s
, s
, addr
, iface_addr
);
6776 #ifndef CONFIG_NO_CONFIG_WRITE
6777 if (wpa_s
->conf
->update_config
&&
6778 wpa_config_write(wpa_s
->confname
, wpa_s
->conf
))
6779 wpa_dbg(wpa_s
, MSG_DEBUG
,
6780 "P2P: Failed to update configuration");
6781 #endif /* CONFIG_NO_CONFIG_WRITE */
6786 static void wpas_p2p_remove_client_go(struct wpa_supplicant
*wpa_s
,
6787 const u8
*peer
, int iface_addr
)
6789 struct hostapd_data
*hapd
;
6790 struct hostapd_wpa_psk
*psk
, *prev
, *rem
;
6791 struct sta_info
*sta
;
6793 if (wpa_s
->ap_iface
== NULL
|| wpa_s
->current_ssid
== NULL
||
6794 wpa_s
->current_ssid
->mode
!= WPAS_MODE_P2P_GO
)
6797 /* Remove per-station PSK entry */
6798 hapd
= wpa_s
->ap_iface
->bss
[0];
6800 psk
= hapd
->conf
->ssid
.wpa_psk
;
6802 if ((iface_addr
&& os_memcmp(peer
, psk
->addr
, ETH_ALEN
) == 0) ||
6804 os_memcmp(peer
, psk
->p2p_dev_addr
, ETH_ALEN
) == 0)) {
6805 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Remove operating group PSK entry for "
6806 MACSTR
" iface_addr=%d",
6807 MAC2STR(peer
), iface_addr
);
6809 prev
->next
= psk
->next
;
6811 hapd
->conf
->ssid
.wpa_psk
= psk
->next
;
6821 /* Disconnect from group */
6823 sta
= ap_get_sta(hapd
, peer
);
6825 sta
= ap_get_sta_p2p(hapd
, peer
);
6827 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Disconnect peer " MACSTR
6828 " (iface_addr=%d) from group",
6829 MAC2STR(peer
), iface_addr
);
6830 hostapd_drv_sta_deauth(hapd
, sta
->addr
,
6831 WLAN_REASON_DEAUTH_LEAVING
);
6832 ap_sta_deauthenticate(hapd
, sta
, WLAN_REASON_DEAUTH_LEAVING
);
6837 void wpas_p2p_remove_client(struct wpa_supplicant
*wpa_s
, const u8
*peer
,
6841 struct wpa_supplicant
*w
;
6843 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Remove client " MACSTR
, MAC2STR(peer
));
6845 /* Remove from any persistent group */
6846 for (s
= wpa_s
->parent
->conf
->ssid
; s
; s
= s
->next
) {
6847 if (s
->disabled
!= 2 || s
->mode
!= WPAS_MODE_P2P_GO
)
6850 wpas_remove_persistent_peer(wpa_s
, s
, peer
, 0);
6851 wpas_p2p_remove_psk(wpa_s
->parent
, s
, peer
, iface_addr
);
6854 /* Remove from any operating group */
6855 for (w
= wpa_s
->global
->ifaces
; w
; w
= w
->next
)
6856 wpas_p2p_remove_client_go(w
, peer
, iface_addr
);
6860 static void wpas_p2p_psk_failure_removal(void *eloop_ctx
, void *timeout_ctx
)
6862 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
6863 wpas_p2p_group_delete(wpa_s
, P2P_GROUP_REMOVAL_PSK_FAILURE
);
6867 static void wpas_p2p_group_freq_conflict(void *eloop_ctx
, void *timeout_ctx
)
6869 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
6871 wpa_printf(MSG_DEBUG
, "P2P: Frequency conflict - terminate group");
6872 wpas_p2p_group_delete(wpa_s
, P2P_GROUP_REMOVAL_FREQ_CONFLICT
);
6876 int wpas_p2p_handle_frequency_conflicts(struct wpa_supplicant
*wpa_s
, int freq
,
6877 struct wpa_ssid
*ssid
)
6879 struct wpa_supplicant
*iface
;
6881 for (iface
= wpa_s
->global
->ifaces
; iface
; iface
= iface
->next
) {
6882 if (!iface
->current_ssid
||
6883 iface
->current_ssid
->frequency
== freq
||
6884 (iface
->p2p_group_interface
== NOT_P2P_GROUP_INTERFACE
&&
6885 !iface
->current_ssid
->p2p_group
))
6888 /* Remove the connection with least priority */
6889 if (!wpas_is_p2p_prioritized(iface
)) {
6890 /* STA connection has priority over existing
6891 * P2P connection, so remove the interface. */
6892 wpa_printf(MSG_DEBUG
, "P2P: Removing P2P connection due to single channel concurrent mode frequency conflict");
6893 eloop_register_timeout(0, 0,
6894 wpas_p2p_group_freq_conflict
,
6896 /* If connection in progress is P2P connection, do not
6897 * proceed for the connection. */
6903 /* P2P connection has priority, disable the STA network
6905 wpa_supplicant_disable_network(wpa_s
->global
->ifaces
,
6907 wpa_msg(wpa_s
->global
->ifaces
, MSG_INFO
,
6908 WPA_EVENT_FREQ_CONFLICT
" id=%d", ssid
->id
);
6909 os_memset(wpa_s
->global
->ifaces
->pending_bssid
, 0,
6911 /* If P2P connection is in progress, continue
6924 int wpas_p2p_4way_hs_failed(struct wpa_supplicant
*wpa_s
)
6926 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
6928 if (ssid
== NULL
|| !ssid
->p2p_group
)
6931 if (wpa_s
->p2p_last_4way_hs_fail
&&
6932 wpa_s
->p2p_last_4way_hs_fail
== ssid
) {
6933 u8 go_dev_addr
[ETH_ALEN
];
6934 struct wpa_ssid
*persistent
;
6936 if (wpas_p2p_persistent_group(wpa_s
, go_dev_addr
,
6938 ssid
->ssid_len
) <= 0) {
6939 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Could not determine whether 4-way handshake failures were for a persistent group");
6943 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: Two 4-way handshake failures for a P2P group - go_dev_addr="
6944 MACSTR
, MAC2STR(go_dev_addr
));
6945 persistent
= wpas_p2p_get_persistent(wpa_s
->parent
, go_dev_addr
,
6948 if (persistent
== NULL
|| persistent
->mode
!= WPAS_MODE_INFRA
) {
6949 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: No matching persistent group stored");
6952 wpa_msg_global(wpa_s
->parent
, MSG_INFO
,
6953 P2P_EVENT_PERSISTENT_PSK_FAIL
"%d",
6956 wpa_s
->p2p_last_4way_hs_fail
= NULL
;
6958 * Remove the group from a timeout to avoid issues with caller
6959 * continuing to use the interface if this is on a P2P group
6962 eloop_register_timeout(0, 0, wpas_p2p_psk_failure_removal
,
6967 wpa_s
->p2p_last_4way_hs_fail
= ssid
;
6972 #ifdef CONFIG_WPS_NFC
6974 static struct wpabuf
* wpas_p2p_nfc_handover(int ndef
, struct wpabuf
*wsc
,
6986 wpa_printf(MSG_DEBUG
, "P2P: No p2p buffer for handover");
6990 ret
= wpabuf_alloc(2 + wpabuf_len(wsc
) + 2 + wpabuf_len(p2p
));
6997 wpabuf_put_be16(ret
, wpabuf_len(wsc
));
6998 wpabuf_put_buf(ret
, wsc
);
6999 wpabuf_put_be16(ret
, wpabuf_len(p2p
));
7000 wpabuf_put_buf(ret
, p2p
);
7004 wpa_hexdump_buf(MSG_DEBUG
,
7005 "P2P: Generated NFC connection handover message", ret
);
7009 tmp
= ndef_build_p2p(ret
);
7012 wpa_printf(MSG_DEBUG
, "P2P: Failed to NDEF encapsulate handover request");
7022 struct wpabuf
* wpas_p2p_nfc_handover_req(struct wpa_supplicant
*wpa_s
,
7025 struct wpabuf
*wsc
, *p2p
;
7027 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
) {
7028 wpa_printf(MSG_DEBUG
, "P2P: P2P disabled - cannot build handover request");
7032 if (wpa_s
->conf
->wps_nfc_dh_pubkey
== NULL
&&
7033 wps_nfc_gen_dh(&wpa_s
->conf
->wps_nfc_dh_pubkey
,
7034 &wpa_s
->conf
->wps_nfc_dh_privkey
) < 0) {
7035 wpa_dbg(wpa_s
, MSG_DEBUG
, "P2P: No DH key available for handover request");
7039 wsc
= wps_build_nfc_handover_req_p2p(wpa_s
->parent
->wps
,
7040 wpa_s
->conf
->wps_nfc_dh_pubkey
);
7041 p2p
= p2p_build_nfc_handover_req(wpa_s
->global
->p2p
);
7043 return wpas_p2p_nfc_handover(ndef
, wsc
, p2p
);
7047 struct wpabuf
* wpas_p2p_nfc_handover_sel(struct wpa_supplicant
*wpa_s
,
7050 struct wpabuf
*wsc
, *p2p
;
7052 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
7055 if (!tag
&& wpa_s
->conf
->wps_nfc_dh_pubkey
== NULL
&&
7056 wps_nfc_gen_dh(&wpa_s
->conf
->wps_nfc_dh_pubkey
,
7057 &wpa_s
->conf
->wps_nfc_dh_privkey
) < 0)
7060 wsc
= wps_build_nfc_handover_sel_p2p(wpa_s
->parent
->wps
,
7062 wpa_s
->conf
->wps_nfc_dev_pw_id
:
7063 DEV_PW_NFC_CONNECTION_HANDOVER
,
7064 wpa_s
->conf
->wps_nfc_dh_pubkey
,
7065 tag
? wpa_s
->conf
->wps_nfc_dev_pw
:
7067 p2p
= p2p_build_nfc_handover_sel(wpa_s
->global
->p2p
);
7069 return wpas_p2p_nfc_handover(ndef
, wsc
, p2p
);
7073 static int wpas_p2p_nfc_join_group(struct wpa_supplicant
*wpa_s
,
7074 struct p2p_nfc_params
*params
)
7076 wpa_printf(MSG_DEBUG
, "P2P: Initiate join-group based on NFC "
7077 "connection handover");
7078 return wpas_p2p_connect(wpa_s
, params
->peer
->p2p_device_addr
, NULL
,
7079 WPS_NFC
, 0, 0, 1, 0, wpa_s
->conf
->p2p_go_intent
,
7084 static int wpas_p2p_nfc_auth_join(struct wpa_supplicant
*wpa_s
,
7085 struct p2p_nfc_params
*params
)
7087 wpa_printf(MSG_DEBUG
, "P2P: Authorize join-group based on NFC "
7088 "connection handover");
7089 for (wpa_s
= wpa_s
->global
->ifaces
; wpa_s
; wpa_s
= wpa_s
->next
) {
7090 struct wpa_ssid
*ssid
= wpa_s
->current_ssid
;
7093 if (ssid
->mode
!= WPAS_MODE_P2P_GO
)
7095 if (wpa_s
->ap_iface
== NULL
)
7099 if (wpa_s
== NULL
) {
7100 wpa_printf(MSG_DEBUG
, "P2P: Could not find GO interface");
7104 if (wpa_s
->parent
->p2p_oob_dev_pw_id
!=
7105 DEV_PW_NFC_CONNECTION_HANDOVER
&&
7106 !wpa_s
->parent
->p2p_oob_dev_pw
) {
7107 wpa_printf(MSG_DEBUG
, "P2P: No NFC Dev Pw known");
7110 return wpas_ap_wps_add_nfc_pw(
7111 wpa_s
, wpa_s
->parent
->p2p_oob_dev_pw_id
,
7112 wpa_s
->parent
->p2p_oob_dev_pw
,
7113 wpa_s
->parent
->p2p_peer_oob_pk_hash_known
?
7114 wpa_s
->parent
->p2p_peer_oob_pubkey_hash
: NULL
);
7118 static int wpas_p2p_nfc_init_go_neg(struct wpa_supplicant
*wpa_s
,
7119 struct p2p_nfc_params
*params
)
7121 wpa_printf(MSG_DEBUG
, "P2P: Initiate GO Negotiation based on NFC "
7122 "connection handover");
7123 return wpas_p2p_connect(wpa_s
, params
->peer
->p2p_device_addr
, NULL
,
7124 WPS_NFC
, 0, 0, 0, 0, wpa_s
->conf
->p2p_go_intent
,
7129 static int wpas_p2p_nfc_resp_go_neg(struct wpa_supplicant
*wpa_s
,
7130 struct p2p_nfc_params
*params
)
7134 wpa_printf(MSG_DEBUG
, "P2P: Authorize GO Negotiation based on NFC "
7135 "connection handover");
7136 res
= wpas_p2p_connect(wpa_s
, params
->peer
->p2p_device_addr
, NULL
,
7137 WPS_NFC
, 0, 0, 0, 1, wpa_s
->conf
->p2p_go_intent
,
7142 res
= wpas_p2p_listen(wpa_s
, 60);
7144 p2p_unauthorize(wpa_s
->global
->p2p
,
7145 params
->peer
->p2p_device_addr
);
7152 static int wpas_p2p_nfc_connection_handover(struct wpa_supplicant
*wpa_s
,
7153 const struct wpabuf
*data
,
7156 const u8
*pos
, *end
;
7158 struct p2p_nfc_params params
;
7161 os_memset(¶ms
, 0, sizeof(params
));
7164 wpa_hexdump_buf(MSG_DEBUG
, "P2P: Received NFC tag payload", data
);
7166 pos
= wpabuf_head(data
);
7167 end
= pos
+ wpabuf_len(data
);
7169 if (end
- pos
< 2) {
7170 wpa_printf(MSG_DEBUG
, "P2P: Not enough data for Length of WSC "
7174 len
= WPA_GET_BE16(pos
);
7176 if (pos
+ len
> end
) {
7177 wpa_printf(MSG_DEBUG
, "P2P: Not enough data for WSC "
7181 params
.wsc_attr
= pos
;
7182 params
.wsc_len
= len
;
7185 if (end
- pos
< 2) {
7186 wpa_printf(MSG_DEBUG
, "P2P: Not enough data for Length of P2P "
7190 len
= WPA_GET_BE16(pos
);
7192 if (pos
+ len
> end
) {
7193 wpa_printf(MSG_DEBUG
, "P2P: Not enough data for P2P "
7197 params
.p2p_attr
= pos
;
7198 params
.p2p_len
= len
;
7201 wpa_hexdump(MSG_DEBUG
, "P2P: WSC attributes",
7202 params
.wsc_attr
, params
.wsc_len
);
7203 wpa_hexdump(MSG_DEBUG
, "P2P: P2P attributes",
7204 params
.p2p_attr
, params
.p2p_len
);
7206 wpa_hexdump(MSG_DEBUG
,
7207 "P2P: Ignored extra data after P2P attributes",
7211 res
= p2p_process_nfc_connection_handover(wpa_s
->global
->p2p
, ¶ms
);
7215 wpabuf_free(wpa_s
->p2p_oob_dev_pw
);
7216 wpa_s
->p2p_oob_dev_pw
= NULL
;
7218 if (params
.oob_dev_pw_len
< WPS_OOB_PUBKEY_HASH_LEN
+ 2) {
7219 wpa_printf(MSG_DEBUG
, "P2P: No peer OOB Dev Pw "
7224 id
= WPA_GET_BE16(params
.oob_dev_pw
+ WPS_OOB_PUBKEY_HASH_LEN
);
7225 wpa_printf(MSG_DEBUG
, "P2P: Peer OOB Dev Pw %u", id
);
7226 wpa_hexdump(MSG_DEBUG
, "P2P: Peer OOB Public Key hash",
7227 params
.oob_dev_pw
, WPS_OOB_PUBKEY_HASH_LEN
);
7228 os_memcpy(wpa_s
->p2p_peer_oob_pubkey_hash
,
7229 params
.oob_dev_pw
, WPS_OOB_PUBKEY_HASH_LEN
);
7230 wpa_s
->p2p_peer_oob_pk_hash_known
= 1;
7234 wpa_printf(MSG_DEBUG
, "P2P: Static handover - invalid "
7235 "peer OOB Device Password Id %u", id
);
7238 wpa_printf(MSG_DEBUG
, "P2P: Static handover - use peer OOB "
7239 "Device Password Id %u", id
);
7240 wpa_hexdump_key(MSG_DEBUG
, "P2P: Peer OOB Device Password",
7241 params
.oob_dev_pw
+ WPS_OOB_PUBKEY_HASH_LEN
+ 2,
7242 params
.oob_dev_pw_len
-
7243 WPS_OOB_PUBKEY_HASH_LEN
- 2);
7244 wpa_s
->p2p_oob_dev_pw_id
= id
;
7245 wpa_s
->p2p_oob_dev_pw
= wpabuf_alloc_copy(
7246 params
.oob_dev_pw
+ WPS_OOB_PUBKEY_HASH_LEN
+ 2,
7247 params
.oob_dev_pw_len
-
7248 WPS_OOB_PUBKEY_HASH_LEN
- 2);
7249 if (wpa_s
->p2p_oob_dev_pw
== NULL
)
7252 if (wpa_s
->conf
->wps_nfc_dh_pubkey
== NULL
&&
7253 wps_nfc_gen_dh(&wpa_s
->conf
->wps_nfc_dh_pubkey
,
7254 &wpa_s
->conf
->wps_nfc_dh_privkey
) < 0)
7257 wpa_printf(MSG_DEBUG
, "P2P: Using abbreviated WPS handshake "
7258 "without Device Password");
7259 wpa_s
->p2p_oob_dev_pw_id
= DEV_PW_NFC_CONNECTION_HANDOVER
;
7262 switch (params
.next_step
) {
7266 return wpas_p2p_nfc_join_group(wpa_s
, ¶ms
);
7268 return wpas_p2p_nfc_auth_join(wpa_s
, ¶ms
);
7270 return wpas_p2p_nfc_init_go_neg(wpa_s
, ¶ms
);
7272 /* TODO: use own OOB Dev Pw */
7273 return wpas_p2p_nfc_resp_go_neg(wpa_s
, ¶ms
);
7280 int wpas_p2p_nfc_tag_process(struct wpa_supplicant
*wpa_s
,
7281 const struct wpabuf
*data
)
7283 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
7286 return wpas_p2p_nfc_connection_handover(wpa_s
, data
, 1, 1);
7290 int wpas_p2p_nfc_report_handover(struct wpa_supplicant
*wpa_s
, int init
,
7291 const struct wpabuf
*req
,
7292 const struct wpabuf
*sel
)
7297 if (wpa_s
->global
->p2p_disabled
|| wpa_s
->global
->p2p
== NULL
)
7300 wpa_printf(MSG_DEBUG
, "NFC: P2P connection handover reported");
7302 wpa_hexdump_ascii(MSG_DEBUG
, "NFC: Req",
7303 wpabuf_head(req
), wpabuf_len(req
));
7304 wpa_hexdump_ascii(MSG_DEBUG
, "NFC: Sel",
7305 wpabuf_head(sel
), wpabuf_len(sel
));
7306 tmp
= ndef_parse_p2p(init
? sel
: req
);
7308 wpa_printf(MSG_DEBUG
, "P2P: Could not parse NDEF");
7312 ret
= wpas_p2p_nfc_connection_handover(wpa_s
, tmp
, init
, 0);
7319 int wpas_p2p_nfc_tag_enabled(struct wpa_supplicant
*wpa_s
, int enabled
)
7322 int go_intent
= wpa_s
->conf
->p2p_go_intent
;
7324 if (wpa_s
->global
->p2p
== NULL
)
7328 p2p_set_authorized_oob_dev_pw_id(wpa_s
->global
->p2p
, 0,
7330 if (wpa_s
->p2p_nfc_tag_enabled
)
7331 wpas_p2p_remove_pending_group_interface(wpa_s
);
7332 wpa_s
->p2p_nfc_tag_enabled
= 0;
7336 if (wpa_s
->global
->p2p_disabled
)
7339 if (wpa_s
->conf
->wps_nfc_dh_pubkey
== NULL
||
7340 wpa_s
->conf
->wps_nfc_dh_privkey
== NULL
||
7341 wpa_s
->conf
->wps_nfc_dev_pw
== NULL
||
7342 wpa_s
->conf
->wps_nfc_dev_pw_id
< 0x10) {
7343 wpa_printf(MSG_DEBUG
, "P2P: NFC password token not configured "
7344 "to allow static handover cases");
7348 wpa_s
->p2p_oob_dev_pw_id
= wpa_s
->conf
->wps_nfc_dev_pw_id
;
7349 wpabuf_free(wpa_s
->p2p_oob_dev_pw
);
7350 wpa_s
->p2p_oob_dev_pw
= wpabuf_dup(wpa_s
->conf
->wps_nfc_dev_pw
);
7351 if (wpa_s
->p2p_oob_dev_pw
== NULL
)
7353 wpa_s
->p2p_peer_oob_pk_hash_known
= 0;
7355 wpa_s
->create_p2p_iface
= wpas_p2p_create_iface(wpa_s
);
7357 if (wpa_s
->create_p2p_iface
) {
7358 enum wpa_driver_if_type iftype
;
7359 /* Prepare to add a new interface for the group */
7360 iftype
= WPA_IF_P2P_GROUP
;
7361 if (go_intent
== 15)
7362 iftype
= WPA_IF_P2P_GO
;
7363 if (wpas_p2p_add_group_interface(wpa_s
, iftype
) < 0) {
7364 wpa_printf(MSG_ERROR
, "P2P: Failed to allocate a new "
7365 "interface for the group");
7369 if_addr
= wpa_s
->pending_interface_addr
;
7371 if_addr
= wpa_s
->own_addr
;
7373 wpa_s
->p2p_nfc_tag_enabled
= enabled
;
7375 p2p_set_authorized_oob_dev_pw_id(
7376 wpa_s
->global
->p2p
, wpa_s
->conf
->wps_nfc_dev_pw_id
, go_intent
,
7382 #endif /* CONFIG_WPS_NFC */