2 * Interworking (IEEE 802.11u)
3 * Copyright (c) 2011-2013, Qualcomm Atheros, Inc.
4 * Copyright (c) 2011-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.
13 #include "common/ieee802_11_defs.h"
14 #include "common/gas.h"
15 #include "common/wpa_ctrl.h"
16 #include "utils/pcsc_funcs.h"
17 #include "utils/eloop.h"
18 #include "drivers/driver.h"
19 #include "eap_common/eap_defs.h"
20 #include "eap_peer/eap.h"
21 #include "eap_peer/eap_methods.h"
22 #include "eapol_supp/eapol_supp_sm.h"
23 #include "rsn_supp/wpa.h"
24 #include "wpa_supplicant_i.h"
26 #include "config_ssid.h"
31 #include "gas_query.h"
32 #include "hs20_supplicant.h"
33 #include "interworking.h"
36 #if defined(EAP_SIM) | defined(EAP_SIM_DYNAMIC)
37 #define INTERWORKING_3GPP
39 #if defined(EAP_AKA) | defined(EAP_AKA_DYNAMIC)
40 #define INTERWORKING_3GPP
42 #if defined(EAP_AKA_PRIME) | defined(EAP_AKA_PRIME_DYNAMIC)
43 #define INTERWORKING_3GPP
48 static void interworking_next_anqp_fetch(struct wpa_supplicant
*wpa_s
);
49 static struct wpa_cred
* interworking_credentials_available_realm(
50 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
52 static struct wpa_cred
* interworking_credentials_available_3gpp(
53 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
57 static int cred_prio_cmp(const struct wpa_cred
*a
, const struct wpa_cred
*b
)
59 if (a
->priority
> b
->priority
)
61 if (a
->priority
< b
->priority
)
63 if (a
->provisioning_sp
== NULL
|| b
->provisioning_sp
== NULL
||
64 os_strcmp(a
->provisioning_sp
, b
->provisioning_sp
) != 0)
66 if (a
->sp_priority
< b
->sp_priority
)
68 if (a
->sp_priority
> b
->sp_priority
)
74 static void interworking_reconnect(struct wpa_supplicant
*wpa_s
)
78 if (wpa_s
->wpa_state
>= WPA_AUTHENTICATING
) {
79 wpa_supplicant_cancel_sched_scan(wpa_s
);
80 wpa_s
->own_disconnect_req
= 1;
81 wpa_supplicant_deauthenticate(wpa_s
,
82 WLAN_REASON_DEAUTH_LEAVING
);
84 wpa_s
->disconnected
= 0;
85 wpa_s
->reassociate
= 1;
86 tried
= wpa_s
->interworking_fast_assoc_tried
;
87 wpa_s
->interworking_fast_assoc_tried
= 1;
89 if (!tried
&& wpa_supplicant_fast_associate(wpa_s
) >= 0)
92 wpa_s
->interworking_fast_assoc_tried
= 0;
93 wpa_supplicant_req_scan(wpa_s
, 0, 0);
97 static struct wpabuf
* anqp_build_req(u16 info_ids
[], size_t num_ids
,
104 buf
= gas_anqp_build_initial_req(0, 4 + num_ids
* 2 +
105 (extra
? wpabuf_len(extra
) : 0));
109 len_pos
= gas_anqp_add_element(buf
, ANQP_QUERY_LIST
);
110 for (i
= 0; i
< num_ids
; i
++)
111 wpabuf_put_le16(buf
, info_ids
[i
]);
112 gas_anqp_set_element_len(buf
, len_pos
);
114 wpabuf_put_buf(buf
, extra
);
116 gas_anqp_set_len(buf
);
122 static void interworking_anqp_resp_cb(void *ctx
, const u8
*dst
,
124 enum gas_query_result result
,
125 const struct wpabuf
*adv_proto
,
126 const struct wpabuf
*resp
,
129 struct wpa_supplicant
*wpa_s
= ctx
;
131 wpa_printf(MSG_DEBUG
, "ANQP: Response callback dst=" MACSTR
132 " dialog_token=%u result=%d status_code=%u",
133 MAC2STR(dst
), dialog_token
, result
, status_code
);
134 anqp_resp_cb(wpa_s
, dst
, dialog_token
, result
, adv_proto
, resp
,
136 interworking_next_anqp_fetch(wpa_s
);
140 static int cred_with_roaming_consortium(struct wpa_supplicant
*wpa_s
)
142 struct wpa_cred
*cred
;
144 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
145 if (cred
->roaming_consortium_len
)
147 if (cred
->required_roaming_consortium_len
)
154 static int cred_with_3gpp(struct wpa_supplicant
*wpa_s
)
156 struct wpa_cred
*cred
;
158 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
159 if (cred
->pcsc
|| cred
->imsi
)
166 static int cred_with_nai_realm(struct wpa_supplicant
*wpa_s
)
168 struct wpa_cred
*cred
;
170 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
171 if (cred
->pcsc
|| cred
->imsi
)
173 if (!cred
->eap_method
)
175 if (cred
->realm
&& cred
->roaming_consortium_len
== 0)
182 static int cred_with_domain(struct wpa_supplicant
*wpa_s
)
184 struct wpa_cred
*cred
;
186 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
187 if (cred
->domain
|| cred
->pcsc
|| cred
->imsi
||
188 cred
->roaming_partner
)
197 static int cred_with_min_backhaul(struct wpa_supplicant
*wpa_s
)
199 struct wpa_cred
*cred
;
201 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
202 if (cred
->min_dl_bandwidth_home
||
203 cred
->min_ul_bandwidth_home
||
204 cred
->min_dl_bandwidth_roaming
||
205 cred
->min_ul_bandwidth_roaming
)
212 static int cred_with_conn_capab(struct wpa_supplicant
*wpa_s
)
214 struct wpa_cred
*cred
;
216 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
217 if (cred
->num_req_conn_capab
)
223 #endif /* CONFIG_HS20 */
226 static int additional_roaming_consortiums(struct wpa_bss
*bss
)
229 ie
= wpa_bss_get_ie(bss
, WLAN_EID_ROAMING_CONSORTIUM
);
230 if (ie
== NULL
|| ie
[1] == 0)
232 return ie
[2]; /* Number of ANQP OIs */
236 static void interworking_continue_anqp(void *eloop_ctx
, void *sock_ctx
)
238 struct wpa_supplicant
*wpa_s
= eloop_ctx
;
239 interworking_next_anqp_fetch(wpa_s
);
243 static int interworking_anqp_send_req(struct wpa_supplicant
*wpa_s
,
250 size_t num_info_ids
= 0;
251 struct wpabuf
*extra
= NULL
;
252 int all
= wpa_s
->fetch_all_anqp
;
254 wpa_msg(wpa_s
, MSG_DEBUG
, "Interworking: ANQP Query Request to " MACSTR
,
255 MAC2STR(bss
->bssid
));
256 wpa_s
->interworking_gas_bss
= bss
;
258 info_ids
[num_info_ids
++] = ANQP_CAPABILITY_LIST
;
260 info_ids
[num_info_ids
++] = ANQP_VENUE_NAME
;
261 info_ids
[num_info_ids
++] = ANQP_NETWORK_AUTH_TYPE
;
263 if (all
|| (cred_with_roaming_consortium(wpa_s
) &&
264 additional_roaming_consortiums(bss
)))
265 info_ids
[num_info_ids
++] = ANQP_ROAMING_CONSORTIUM
;
267 info_ids
[num_info_ids
++] = ANQP_IP_ADDR_TYPE_AVAILABILITY
;
268 if (all
|| cred_with_nai_realm(wpa_s
))
269 info_ids
[num_info_ids
++] = ANQP_NAI_REALM
;
270 if (all
|| cred_with_3gpp(wpa_s
)) {
271 info_ids
[num_info_ids
++] = ANQP_3GPP_CELLULAR_NETWORK
;
272 wpa_supplicant_scard_init(wpa_s
, NULL
);
274 if (all
|| cred_with_domain(wpa_s
))
275 info_ids
[num_info_ids
++] = ANQP_DOMAIN_NAME
;
276 wpa_hexdump(MSG_DEBUG
, "Interworking: ANQP Query info",
277 (u8
*) info_ids
, num_info_ids
* 2);
280 if (wpa_bss_get_vendor_ie(bss
, HS20_IE_VENDOR_TYPE
)) {
283 extra
= wpabuf_alloc(100);
287 len_pos
= gas_anqp_add_element(extra
, ANQP_VENDOR_SPECIFIC
);
288 wpabuf_put_be24(extra
, OUI_WFA
);
289 wpabuf_put_u8(extra
, HS20_ANQP_OUI_TYPE
);
290 wpabuf_put_u8(extra
, HS20_STYPE_QUERY_LIST
);
291 wpabuf_put_u8(extra
, 0); /* Reserved */
292 wpabuf_put_u8(extra
, HS20_STYPE_CAPABILITY_LIST
);
295 HS20_STYPE_OPERATOR_FRIENDLY_NAME
);
296 if (all
|| cred_with_min_backhaul(wpa_s
))
297 wpabuf_put_u8(extra
, HS20_STYPE_WAN_METRICS
);
298 if (all
|| cred_with_conn_capab(wpa_s
))
299 wpabuf_put_u8(extra
, HS20_STYPE_CONNECTION_CAPABILITY
);
301 wpabuf_put_u8(extra
, HS20_STYPE_OPERATING_CLASS
);
303 wpabuf_put_u8(extra
, HS20_STYPE_OSU_PROVIDERS_LIST
);
304 gas_anqp_set_element_len(extra
, len_pos
);
306 #endif /* CONFIG_HS20 */
308 buf
= anqp_build_req(info_ids
, num_info_ids
, extra
);
313 res
= gas_query_req(wpa_s
->gas
, bss
->bssid
, bss
->freq
, buf
,
314 interworking_anqp_resp_cb
, wpa_s
);
316 wpa_msg(wpa_s
, MSG_DEBUG
, "ANQP: Failed to send Query Request");
319 eloop_register_timeout(0, 0, interworking_continue_anqp
, wpa_s
,
322 wpa_msg(wpa_s
, MSG_DEBUG
,
323 "ANQP: Query started with dialog token %u", res
);
329 struct nai_realm_eap
{
332 enum nai_realm_eap_auth_inner_non_eap inner_non_eap
;
334 u8 tunneled_cred_type
;
341 struct nai_realm_eap
*eap
;
345 static void nai_realm_free(struct nai_realm
*realms
, u16 count
)
351 for (i
= 0; i
< count
; i
++) {
352 os_free(realms
[i
].eap
);
353 os_free(realms
[i
].realm
);
359 static const u8
* nai_realm_parse_eap(struct nai_realm_eap
*e
, const u8
*pos
,
362 u8 elen
, auth_count
, a
;
366 wpa_printf(MSG_DEBUG
, "No room for EAP Method fixed fields");
371 if (elen
> end
- pos
|| elen
< 2) {
372 wpa_printf(MSG_DEBUG
, "No room for EAP Method subfield");
378 wpa_printf(MSG_DEBUG
, "EAP Method: len=%u method=%u auth_count=%u",
379 elen
, e
->method
, auth_count
);
381 for (a
= 0; a
< auth_count
; a
++) {
385 wpa_printf(MSG_DEBUG
,
386 "No room for Authentication Parameter subfield header");
392 if (len
> end
- pos
) {
393 wpa_printf(MSG_DEBUG
,
394 "No room for Authentication Parameter subfield");
399 case NAI_REALM_EAP_AUTH_NON_EAP_INNER_AUTH
:
402 e
->inner_non_eap
= *pos
;
403 if (e
->method
!= EAP_TYPE_TTLS
)
406 case NAI_REALM_INNER_NON_EAP_PAP
:
407 wpa_printf(MSG_DEBUG
, "EAP-TTLS/PAP");
409 case NAI_REALM_INNER_NON_EAP_CHAP
:
410 wpa_printf(MSG_DEBUG
, "EAP-TTLS/CHAP");
412 case NAI_REALM_INNER_NON_EAP_MSCHAP
:
413 wpa_printf(MSG_DEBUG
, "EAP-TTLS/MSCHAP");
415 case NAI_REALM_INNER_NON_EAP_MSCHAPV2
:
416 wpa_printf(MSG_DEBUG
, "EAP-TTLS/MSCHAPV2");
420 case NAI_REALM_EAP_AUTH_INNER_AUTH_EAP_METHOD
:
423 e
->inner_method
= *pos
;
424 wpa_printf(MSG_DEBUG
, "Inner EAP method: %u",
427 case NAI_REALM_EAP_AUTH_CRED_TYPE
:
431 wpa_printf(MSG_DEBUG
, "Credential Type: %u",
434 case NAI_REALM_EAP_AUTH_TUNNELED_CRED_TYPE
:
437 e
->tunneled_cred_type
= *pos
;
438 wpa_printf(MSG_DEBUG
, "Tunneled EAP Method Credential "
439 "Type: %u", e
->tunneled_cred_type
);
442 wpa_printf(MSG_DEBUG
, "Unsupported Authentication "
443 "Parameter: id=%u len=%u", id
, len
);
444 wpa_hexdump(MSG_DEBUG
, "Authentication Parameter "
456 static const u8
* nai_realm_parse_realm(struct nai_realm
*r
, const u8
*pos
,
464 wpa_printf(MSG_DEBUG
, "No room for NAI Realm Data "
469 len
= WPA_GET_LE16(pos
); /* NAI Realm Data field Length */
471 if (len
> end
- pos
|| len
< 3) {
472 wpa_printf(MSG_DEBUG
, "No room for NAI Realm Data "
474 len
, (unsigned int) (end
- pos
));
479 r
->encoding
= *pos
++;
481 if (realm_len
> f_end
- pos
) {
482 wpa_printf(MSG_DEBUG
, "No room for NAI Realm "
484 realm_len
, (unsigned int) (f_end
- pos
));
487 wpa_hexdump_ascii(MSG_DEBUG
, "NAI Realm", pos
, realm_len
);
488 r
->realm
= dup_binstr(pos
, realm_len
);
489 if (r
->realm
== NULL
)
493 if (f_end
- pos
< 1) {
494 wpa_printf(MSG_DEBUG
, "No room for EAP Method Count");
497 r
->eap_count
= *pos
++;
498 wpa_printf(MSG_DEBUG
, "EAP Count: %u", r
->eap_count
);
499 if (r
->eap_count
* 3 > f_end
- pos
) {
500 wpa_printf(MSG_DEBUG
, "No room for EAP Methods");
503 r
->eap
= os_calloc(r
->eap_count
, sizeof(struct nai_realm_eap
));
507 for (e
= 0; e
< r
->eap_count
; e
++) {
508 pos
= nai_realm_parse_eap(&r
->eap
[e
], pos
, f_end
);
517 static struct nai_realm
* nai_realm_parse(struct wpabuf
*anqp
, u16
*count
)
519 struct nai_realm
*realm
;
526 left
= wpabuf_len(anqp
);
530 pos
= wpabuf_head_u8(anqp
);
532 num
= WPA_GET_LE16(pos
);
533 wpa_printf(MSG_DEBUG
, "NAI Realm Count: %u", num
);
537 if (num
> left
/ 5) {
538 wpa_printf(MSG_DEBUG
, "Invalid NAI Realm Count %u - not "
539 "enough data (%u octets) for that many realms",
540 num
, (unsigned int) left
);
544 realm
= os_calloc(num
, sizeof(struct nai_realm
));
548 for (i
= 0; i
< num
; i
++) {
549 pos
= nai_realm_parse_realm(&realm
[i
], pos
, end
);
551 nai_realm_free(realm
, num
);
561 static int nai_realm_match(struct nai_realm
*realm
, const char *home_realm
)
563 char *tmp
, *pos
, *end
;
566 if (realm
->realm
== NULL
|| home_realm
== NULL
)
569 if (os_strchr(realm
->realm
, ';') == NULL
)
570 return os_strcasecmp(realm
->realm
, home_realm
) == 0;
572 tmp
= os_strdup(realm
->realm
);
578 end
= os_strchr(pos
, ';');
581 if (os_strcasecmp(pos
, home_realm
) == 0) {
596 static int nai_realm_cred_username(struct wpa_supplicant
*wpa_s
,
597 struct nai_realm_eap
*eap
)
599 if (eap_get_name(EAP_VENDOR_IETF
, eap
->method
) == NULL
) {
600 wpa_msg(wpa_s
, MSG_DEBUG
,
601 "nai-realm-cred-username: EAP method not supported: %d",
603 return 0; /* method not supported */
606 if (eap
->method
!= EAP_TYPE_TTLS
&& eap
->method
!= EAP_TYPE_PEAP
&&
607 eap
->method
!= EAP_TYPE_FAST
) {
608 /* Only tunneled methods with username/password supported */
609 wpa_msg(wpa_s
, MSG_DEBUG
,
610 "nai-realm-cred-username: Method: %d is not TTLS, PEAP, or FAST",
615 if (eap
->method
== EAP_TYPE_PEAP
|| eap
->method
== EAP_TYPE_FAST
) {
616 if (eap
->inner_method
&&
617 eap_get_name(EAP_VENDOR_IETF
, eap
->inner_method
) == NULL
) {
618 wpa_msg(wpa_s
, MSG_DEBUG
,
619 "nai-realm-cred-username: PEAP/FAST: Inner method not supported: %d",
623 if (!eap
->inner_method
&&
624 eap_get_name(EAP_VENDOR_IETF
, EAP_TYPE_MSCHAPV2
) == NULL
) {
625 wpa_msg(wpa_s
, MSG_DEBUG
,
626 "nai-realm-cred-username: MSCHAPv2 not supported");
631 if (eap
->method
== EAP_TYPE_TTLS
) {
632 if (eap
->inner_method
== 0 && eap
->inner_non_eap
== 0)
633 return 1; /* Assume TTLS/MSCHAPv2 is used */
634 if (eap
->inner_method
&&
635 eap_get_name(EAP_VENDOR_IETF
, eap
->inner_method
) == NULL
) {
636 wpa_msg(wpa_s
, MSG_DEBUG
,
637 "nai-realm-cred-username: TTLS, but inner not supported: %d",
641 if (eap
->inner_non_eap
&&
642 eap
->inner_non_eap
!= NAI_REALM_INNER_NON_EAP_PAP
&&
643 eap
->inner_non_eap
!= NAI_REALM_INNER_NON_EAP_CHAP
&&
644 eap
->inner_non_eap
!= NAI_REALM_INNER_NON_EAP_MSCHAP
&&
645 eap
->inner_non_eap
!= NAI_REALM_INNER_NON_EAP_MSCHAPV2
) {
646 wpa_msg(wpa_s
, MSG_DEBUG
,
647 "nai-realm-cred-username: TTLS, inner-non-eap not supported: %d",
653 if (eap
->inner_method
&&
654 eap
->inner_method
!= EAP_TYPE_GTC
&&
655 eap
->inner_method
!= EAP_TYPE_MSCHAPV2
) {
656 wpa_msg(wpa_s
, MSG_DEBUG
,
657 "nai-realm-cred-username: inner-method not GTC or MSCHAPv2: %d",
666 static int nai_realm_cred_cert(struct wpa_supplicant
*wpa_s
,
667 struct nai_realm_eap
*eap
)
669 if (eap_get_name(EAP_VENDOR_IETF
, eap
->method
) == NULL
) {
670 wpa_msg(wpa_s
, MSG_DEBUG
,
671 "nai-realm-cred-cert: Method not supported: %d",
673 return 0; /* method not supported */
676 if (eap
->method
!= EAP_TYPE_TLS
) {
677 /* Only EAP-TLS supported for credential authentication */
678 wpa_msg(wpa_s
, MSG_DEBUG
,
679 "nai-realm-cred-cert: Method not TLS: %d",
688 static struct nai_realm_eap
* nai_realm_find_eap(struct wpa_supplicant
*wpa_s
,
689 struct wpa_cred
*cred
,
690 struct nai_realm
*realm
)
694 if (cred
->username
== NULL
||
695 cred
->username
[0] == '\0' ||
696 ((cred
->password
== NULL
||
697 cred
->password
[0] == '\0') &&
698 (cred
->private_key
== NULL
||
699 cred
->private_key
[0] == '\0'))) {
700 wpa_msg(wpa_s
, MSG_DEBUG
,
701 "nai-realm-find-eap: incomplete cred info: username: %s password: %s private_key: %s",
702 cred
->username
? cred
->username
: "NULL",
703 cred
->password
? cred
->password
: "NULL",
704 cred
->private_key
? cred
->private_key
: "NULL");
708 for (e
= 0; e
< realm
->eap_count
; e
++) {
709 struct nai_realm_eap
*eap
= &realm
->eap
[e
];
710 if (cred
->password
&& cred
->password
[0] &&
711 nai_realm_cred_username(wpa_s
, eap
))
713 if (cred
->private_key
&& cred
->private_key
[0] &&
714 nai_realm_cred_cert(wpa_s
, eap
))
722 #ifdef INTERWORKING_3GPP
724 static int plmn_id_match(struct wpabuf
*anqp
, const char *imsi
, int mnc_len
)
726 u8 plmn
[3], plmn2
[3];
731 * See Annex A of 3GPP TS 24.234 v8.1.0 for description. The network
732 * operator is allowed to include only two digits of the MNC, so allow
733 * matches based on both two and three digit MNC assumptions. Since some
734 * SIM/USIM cards may not expose MNC length conveniently, we may be
735 * provided the default MNC length 3 here and as such, checking with MNC
736 * length 2 is justifiable even though 3GPP TS 24.234 does not mention
737 * that case. Anyway, MCC/MNC pair where both 2 and 3 digit MNC is used
738 * with otherwise matching values would not be good idea in general, so
739 * this should not result in selecting incorrect networks.
741 /* Match with 3 digit MNC */
742 plmn
[0] = (imsi
[0] - '0') | ((imsi
[1] - '0') << 4);
743 plmn
[1] = (imsi
[2] - '0') | ((imsi
[5] - '0') << 4);
744 plmn
[2] = (imsi
[3] - '0') | ((imsi
[4] - '0') << 4);
745 /* Match with 2 digit MNC */
746 plmn2
[0] = (imsi
[0] - '0') | ((imsi
[1] - '0') << 4);
747 plmn2
[1] = (imsi
[2] - '0') | 0xf0;
748 plmn2
[2] = (imsi
[3] - '0') | ((imsi
[4] - '0') << 4);
752 pos
= wpabuf_head_u8(anqp
);
753 end
= pos
+ wpabuf_len(anqp
);
757 wpa_printf(MSG_DEBUG
, "Unsupported GUD version 0x%x", *pos
);
762 if (udhl
> end
- pos
) {
763 wpa_printf(MSG_DEBUG
, "Invalid UDHL");
768 wpa_printf(MSG_DEBUG
, "Interworking: Matching against MCC/MNC alternatives: %02x:%02x:%02x or %02x:%02x:%02x (IMSI %s, MNC length %d)",
769 plmn
[0], plmn
[1], plmn
[2], plmn2
[0], plmn2
[1], plmn2
[2],
772 while (end
- pos
>= 2) {
781 if (iei
== 0 && len
> 0) {
784 wpa_hexdump(MSG_DEBUG
, "Interworking: PLMN List information element",
787 for (i
= 0; i
< num
; i
++) {
790 if (os_memcmp(pos
, plmn
, 3) == 0 ||
791 os_memcmp(pos
, plmn2
, 3) == 0)
792 return 1; /* Found matching PLMN */
796 wpa_hexdump(MSG_DEBUG
, "Interworking: Unrecognized 3GPP information element",
807 static int build_root_nai(char *nai
, size_t nai_len
, const char *imsi
,
808 size_t mnc_len
, char prefix
)
810 const char *sep
, *msin
;
812 size_t msin_len
, plmn_len
;
815 * TS 23.003, Clause 14 (3GPP to WLAN Interworking)
817 * <aka:0|sim:1><IMSI>@wlan.mnc<MNC>.mcc<MCC>.3gppnetwork.org
818 * <MNC> is zero-padded to three digits in case two-digit MNC is used
821 if (imsi
== NULL
|| os_strlen(imsi
) > 16) {
822 wpa_printf(MSG_DEBUG
, "No valid IMSI available");
825 sep
= os_strchr(imsi
, '-');
827 plmn_len
= sep
- imsi
;
829 } else if (mnc_len
&& os_strlen(imsi
) >= 3 + mnc_len
) {
830 plmn_len
= 3 + mnc_len
;
831 msin
= imsi
+ plmn_len
;
834 if (plmn_len
!= 5 && plmn_len
!= 6)
836 msin_len
= os_strlen(msin
);
842 os_memcpy(pos
, imsi
, plmn_len
);
844 os_memcpy(pos
, msin
, msin_len
);
846 pos
+= os_snprintf(pos
, end
- pos
, "@wlan.mnc");
856 os_snprintf(pos
, end
- pos
, ".mcc%c%c%c.3gppnetwork.org",
857 imsi
[0], imsi
[1], imsi
[2]);
863 static int set_root_nai(struct wpa_ssid
*ssid
, const char *imsi
, char prefix
)
866 if (build_root_nai(nai
, sizeof(nai
), imsi
, 0, prefix
) < 0)
868 return wpa_config_set_quoted(ssid
, "identity", nai
);
871 #endif /* INTERWORKING_3GPP */
874 static int already_connected(struct wpa_supplicant
*wpa_s
,
875 struct wpa_cred
*cred
, struct wpa_bss
*bss
)
877 struct wpa_ssid
*ssid
, *sel_ssid
;
878 struct wpa_bss
*selected
;
880 if (wpa_s
->wpa_state
< WPA_ASSOCIATED
|| wpa_s
->current_ssid
== NULL
)
883 ssid
= wpa_s
->current_ssid
;
884 if (ssid
->parent_cred
!= cred
)
887 if (ssid
->ssid_len
!= bss
->ssid_len
||
888 os_memcmp(ssid
->ssid
, bss
->ssid
, bss
->ssid_len
) != 0)
892 selected
= wpa_supplicant_pick_network(wpa_s
, &sel_ssid
);
893 if (selected
&& sel_ssid
&& sel_ssid
->priority
> ssid
->priority
)
894 return 0; /* higher priority network in scan results */
900 static void remove_duplicate_network(struct wpa_supplicant
*wpa_s
,
901 struct wpa_cred
*cred
,
904 struct wpa_ssid
*ssid
;
906 for (ssid
= wpa_s
->conf
->ssid
; ssid
; ssid
= ssid
->next
) {
907 if (ssid
->parent_cred
!= cred
)
909 if (ssid
->ssid_len
!= bss
->ssid_len
||
910 os_memcmp(ssid
->ssid
, bss
->ssid
, bss
->ssid_len
) != 0)
919 wpa_printf(MSG_DEBUG
, "Interworking: Remove duplicate network entry for the same credential");
921 if (ssid
== wpa_s
->current_ssid
) {
922 wpa_sm_set_config(wpa_s
->wpa
, NULL
);
923 eapol_sm_notify_config(wpa_s
->eapol
, NULL
, NULL
);
924 wpa_s
->own_disconnect_req
= 1;
925 wpa_supplicant_deauthenticate(wpa_s
,
926 WLAN_REASON_DEAUTH_LEAVING
);
929 wpas_notify_network_removed(wpa_s
, ssid
);
930 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
934 static int interworking_set_hs20_params(struct wpa_supplicant
*wpa_s
,
935 struct wpa_ssid
*ssid
)
937 const char *key_mgmt
= NULL
;
938 #ifdef CONFIG_IEEE80211R
940 struct wpa_driver_capa capa
;
942 res
= wpa_drv_get_capa(wpa_s
, &capa
);
943 if (res
== 0 && capa
.key_mgmt
& WPA_DRIVER_CAPA_KEY_MGMT_FT
) {
944 key_mgmt
= wpa_s
->conf
->pmf
!= NO_MGMT_FRAME_PROTECTION
?
945 "WPA-EAP WPA-EAP-SHA256 FT-EAP" :
948 #endif /* CONFIG_IEEE80211R */
951 key_mgmt
= wpa_s
->conf
->pmf
!= NO_MGMT_FRAME_PROTECTION
?
952 "WPA-EAP WPA-EAP-SHA256" : "WPA-EAP";
953 if (wpa_config_set(ssid
, "key_mgmt", key_mgmt
, 0) < 0 ||
954 wpa_config_set(ssid
, "proto", "RSN", 0) < 0 ||
955 wpa_config_set(ssid
, "pairwise", "CCMP", 0) < 0)
961 static int interworking_connect_3gpp(struct wpa_supplicant
*wpa_s
,
962 struct wpa_cred
*cred
,
963 struct wpa_bss
*bss
, int only_add
)
965 #ifdef INTERWORKING_3GPP
966 struct wpa_ssid
*ssid
;
971 if (bss
->anqp
== NULL
|| bss
->anqp
->anqp_3gpp
== NULL
)
974 wpa_msg(wpa_s
, MSG_DEBUG
, "Interworking: Connect with " MACSTR
975 " (3GPP)", MAC2STR(bss
->bssid
));
977 if (already_connected(wpa_s
, cred
, bss
)) {
978 wpa_msg(wpa_s
, MSG_INFO
, INTERWORKING_ALREADY_CONNECTED MACSTR
,
979 MAC2STR(bss
->bssid
));
980 return wpa_s
->current_ssid
->id
;
983 remove_duplicate_network(wpa_s
, cred
, bss
);
985 ssid
= wpa_config_add_network(wpa_s
->conf
);
988 ssid
->parent_cred
= cred
;
990 wpas_notify_network_added(wpa_s
, ssid
);
991 wpa_config_set_network_defaults(ssid
);
992 ssid
->priority
= cred
->priority
;
994 ssid
->ssid
= os_zalloc(bss
->ssid_len
+ 1);
995 if (ssid
->ssid
== NULL
)
997 os_memcpy(ssid
->ssid
, bss
->ssid
, bss
->ssid_len
);
998 ssid
->ssid_len
= bss
->ssid_len
;
999 ssid
->eap
.sim_num
= cred
->sim_num
;
1001 if (interworking_set_hs20_params(wpa_s
, ssid
) < 0)
1004 eap_type
= EAP_TYPE_SIM
;
1005 if (cred
->pcsc
&& wpa_s
->scard
&& scard_supports_umts(wpa_s
->scard
))
1006 eap_type
= EAP_TYPE_AKA
;
1007 if (cred
->eap_method
&& cred
->eap_method
[0].vendor
== EAP_VENDOR_IETF
) {
1008 if (cred
->eap_method
[0].method
== EAP_TYPE_SIM
||
1009 cred
->eap_method
[0].method
== EAP_TYPE_AKA
||
1010 cred
->eap_method
[0].method
== EAP_TYPE_AKA_PRIME
)
1011 eap_type
= cred
->eap_method
[0].method
;
1017 res
= wpa_config_set(ssid
, "eap", "SIM", 0);
1021 res
= wpa_config_set(ssid
, "eap", "AKA", 0);
1023 case EAP_TYPE_AKA_PRIME
:
1025 res
= wpa_config_set(ssid
, "eap", "AKA'", 0);
1032 wpa_msg(wpa_s
, MSG_DEBUG
,
1033 "Selected EAP method (%d) not supported", eap_type
);
1037 if (!cred
->pcsc
&& set_root_nai(ssid
, cred
->imsi
, prefix
) < 0) {
1038 wpa_msg(wpa_s
, MSG_DEBUG
, "Failed to set Root NAI");
1042 if (cred
->milenage
&& cred
->milenage
[0]) {
1043 if (wpa_config_set_quoted(ssid
, "password",
1044 cred
->milenage
) < 0)
1046 } else if (cred
->pcsc
) {
1047 if (wpa_config_set_quoted(ssid
, "pcsc", "") < 0)
1049 if (wpa_s
->conf
->pcsc_pin
&&
1050 wpa_config_set_quoted(ssid
, "pin", wpa_s
->conf
->pcsc_pin
)
1055 wpa_s
->next_ssid
= ssid
;
1056 wpa_config_update_prio_list(wpa_s
->conf
);
1058 interworking_reconnect(wpa_s
);
1063 wpas_notify_network_removed(wpa_s
, ssid
);
1064 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
1065 #endif /* INTERWORKING_3GPP */
1070 static int roaming_consortium_element_match(const u8
*ie
, const u8
*rc_id
,
1073 const u8
*pos
, *end
;
1080 end
= ie
+ 2 + ie
[1];
1082 /* Roaming Consortium element:
1083 * Number of ANQP OIs
1084 * OI #1 and #2 lengths
1085 * OI #1, [OI #2], [OI #3]
1091 pos
++; /* skip Number of ANQP OIs */
1093 if ((lens
& 0x0f) + (lens
>> 4) > end
- pos
)
1096 if ((lens
& 0x0f) == rc_len
&& os_memcmp(pos
, rc_id
, rc_len
) == 0)
1100 if ((lens
>> 4) == rc_len
&& os_memcmp(pos
, rc_id
, rc_len
) == 0)
1104 if (pos
< end
&& (size_t) (end
- pos
) == rc_len
&&
1105 os_memcmp(pos
, rc_id
, rc_len
) == 0)
1112 static int roaming_consortium_anqp_match(const struct wpabuf
*anqp
,
1113 const u8
*rc_id
, size_t rc_len
)
1115 const u8
*pos
, *end
;
1121 pos
= wpabuf_head(anqp
);
1122 end
= pos
+ wpabuf_len(anqp
);
1124 /* Set of <OI Length, OI> duples */
1127 if (len
> end
- pos
)
1129 if (len
== rc_len
&& os_memcmp(pos
, rc_id
, rc_len
) == 0)
1138 static int roaming_consortium_match(const u8
*ie
, const struct wpabuf
*anqp
,
1139 const u8
*rc_id
, size_t rc_len
)
1141 return roaming_consortium_element_match(ie
, rc_id
, rc_len
) ||
1142 roaming_consortium_anqp_match(anqp
, rc_id
, rc_len
);
1146 static int cred_no_required_oi_match(struct wpa_cred
*cred
, struct wpa_bss
*bss
)
1150 if (cred
->required_roaming_consortium_len
== 0)
1153 ie
= wpa_bss_get_ie(bss
, WLAN_EID_ROAMING_CONSORTIUM
);
1156 (bss
->anqp
== NULL
|| bss
->anqp
->roaming_consortium
== NULL
))
1159 return !roaming_consortium_match(ie
,
1161 bss
->anqp
->roaming_consortium
: NULL
,
1162 cred
->required_roaming_consortium
,
1163 cred
->required_roaming_consortium_len
);
1167 static int cred_excluded_ssid(struct wpa_cred
*cred
, struct wpa_bss
*bss
)
1171 if (!cred
->excluded_ssid
)
1174 for (i
= 0; i
< cred
->num_excluded_ssid
; i
++) {
1175 struct excluded_ssid
*e
= &cred
->excluded_ssid
[i
];
1176 if (bss
->ssid_len
== e
->ssid_len
&&
1177 os_memcmp(bss
->ssid
, e
->ssid
, e
->ssid_len
) == 0)
1185 static int cred_below_min_backhaul(struct wpa_supplicant
*wpa_s
,
1186 struct wpa_cred
*cred
, struct wpa_bss
*bss
)
1190 unsigned int dl_bandwidth
, ul_bandwidth
;
1192 u8 wan_info
, dl_load
, ul_load
;
1194 u32 ul_speed
, dl_speed
;
1196 if (!cred
->min_dl_bandwidth_home
&&
1197 !cred
->min_ul_bandwidth_home
&&
1198 !cred
->min_dl_bandwidth_roaming
&&
1199 !cred
->min_ul_bandwidth_roaming
)
1200 return 0; /* No bandwidth constraint specified */
1202 if (bss
->anqp
== NULL
|| bss
->anqp
->hs20_wan_metrics
== NULL
)
1203 return 0; /* No WAN Metrics known - ignore constraint */
1205 wan
= wpabuf_head(bss
->anqp
->hs20_wan_metrics
);
1207 if (wan_info
& BIT(3))
1208 return 1; /* WAN link at capacity */
1209 lmd
= WPA_GET_LE16(wan
+ 11);
1211 return 0; /* Downlink/Uplink Load was not measured */
1212 dl_speed
= WPA_GET_LE32(wan
+ 1);
1213 ul_speed
= WPA_GET_LE32(wan
+ 5);
1217 if (dl_speed
>= 0xffffff)
1218 dl_bandwidth
= dl_speed
/ 255 * (255 - dl_load
);
1220 dl_bandwidth
= dl_speed
* (255 - dl_load
) / 255;
1222 if (ul_speed
>= 0xffffff)
1223 ul_bandwidth
= ul_speed
/ 255 * (255 - ul_load
);
1225 ul_bandwidth
= ul_speed
* (255 - ul_load
) / 255;
1227 res
= interworking_home_sp_cred(wpa_s
, cred
, bss
->anqp
?
1228 bss
->anqp
->domain_name
: NULL
);
1230 if (cred
->min_dl_bandwidth_home
> dl_bandwidth
)
1232 if (cred
->min_ul_bandwidth_home
> ul_bandwidth
)
1235 if (cred
->min_dl_bandwidth_roaming
> dl_bandwidth
)
1237 if (cred
->min_ul_bandwidth_roaming
> ul_bandwidth
)
1240 #endif /* CONFIG_HS20 */
1246 static int cred_over_max_bss_load(struct wpa_supplicant
*wpa_s
,
1247 struct wpa_cred
*cred
, struct wpa_bss
*bss
)
1252 if (!cred
->max_bss_load
)
1253 return 0; /* No BSS Load constraint specified */
1255 ie
= wpa_bss_get_ie(bss
, WLAN_EID_BSS_LOAD
);
1256 if (ie
== NULL
|| ie
[1] < 3)
1257 return 0; /* No BSS Load advertised */
1259 res
= interworking_home_sp_cred(wpa_s
, cred
, bss
->anqp
?
1260 bss
->anqp
->domain_name
: NULL
);
1262 return 0; /* Not a home network */
1264 return ie
[4] > cred
->max_bss_load
;
1270 static int has_proto_match(const u8
*pos
, const u8
*end
, u8 proto
)
1272 while (end
- pos
>= 4) {
1273 if (pos
[0] == proto
&& pos
[3] == 1 /* Open */)
1282 static int has_proto_port_match(const u8
*pos
, const u8
*end
, u8 proto
,
1285 while (end
- pos
>= 4) {
1286 if (pos
[0] == proto
&& WPA_GET_LE16(&pos
[1]) == port
&&
1287 pos
[3] == 1 /* Open */)
1295 #endif /* CONFIG_HS20 */
1298 static int cred_conn_capab_missing(struct wpa_supplicant
*wpa_s
,
1299 struct wpa_cred
*cred
, struct wpa_bss
*bss
)
1303 const u8
*capab
, *end
;
1307 if (!cred
->num_req_conn_capab
)
1308 return 0; /* No connection capability constraint specified */
1310 if (bss
->anqp
== NULL
|| bss
->anqp
->hs20_connection_capability
== NULL
)
1311 return 0; /* No Connection Capability known - ignore constraint
1314 res
= interworking_home_sp_cred(wpa_s
, cred
, bss
->anqp
?
1315 bss
->anqp
->domain_name
: NULL
);
1317 return 0; /* No constraint in home network */
1319 capab
= wpabuf_head(bss
->anqp
->hs20_connection_capability
);
1320 end
= capab
+ wpabuf_len(bss
->anqp
->hs20_connection_capability
);
1322 for (i
= 0; i
< cred
->num_req_conn_capab
; i
++) {
1323 ports
= cred
->req_conn_capab_port
[i
];
1325 if (!has_proto_match(capab
, end
,
1326 cred
->req_conn_capab_proto
[i
]))
1329 for (j
= 0; ports
[j
] > -1; j
++) {
1330 if (!has_proto_port_match(
1332 cred
->req_conn_capab_proto
[i
],
1338 #endif /* CONFIG_HS20 */
1344 static struct wpa_cred
* interworking_credentials_available_roaming_consortium(
1345 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
1348 struct wpa_cred
*cred
, *selected
= NULL
;
1350 int is_excluded
= 0;
1352 ie
= wpa_bss_get_ie(bss
, WLAN_EID_ROAMING_CONSORTIUM
);
1355 (bss
->anqp
== NULL
|| bss
->anqp
->roaming_consortium
== NULL
))
1358 if (wpa_s
->conf
->cred
== NULL
)
1361 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
1362 if (cred
->roaming_consortium_len
== 0)
1365 if (!roaming_consortium_match(ie
,
1367 bss
->anqp
->roaming_consortium
:
1369 cred
->roaming_consortium
,
1370 cred
->roaming_consortium_len
))
1373 if (cred_no_required_oi_match(cred
, bss
))
1375 if (!ignore_bw
&& cred_below_min_backhaul(wpa_s
, cred
, bss
))
1377 if (!ignore_bw
&& cred_over_max_bss_load(wpa_s
, cred
, bss
))
1379 if (!ignore_bw
&& cred_conn_capab_missing(wpa_s
, cred
, bss
))
1381 if (cred_excluded_ssid(cred
, bss
)) {
1382 if (excluded
== NULL
)
1384 if (selected
== NULL
) {
1389 if (selected
== NULL
|| is_excluded
||
1390 cred_prio_cmp(selected
, cred
) < 0) {
1398 *excluded
= is_excluded
;
1404 static int interworking_set_eap_params(struct wpa_ssid
*ssid
,
1405 struct wpa_cred
*cred
, int ttls
)
1407 if (cred
->eap_method
) {
1408 ttls
= cred
->eap_method
->vendor
== EAP_VENDOR_IETF
&&
1409 cred
->eap_method
->method
== EAP_TYPE_TTLS
;
1411 os_free(ssid
->eap
.eap_methods
);
1412 ssid
->eap
.eap_methods
=
1413 os_malloc(sizeof(struct eap_method_type
) * 2);
1414 if (ssid
->eap
.eap_methods
== NULL
)
1416 os_memcpy(ssid
->eap
.eap_methods
, cred
->eap_method
,
1417 sizeof(*cred
->eap_method
));
1418 ssid
->eap
.eap_methods
[1].vendor
= EAP_VENDOR_IETF
;
1419 ssid
->eap
.eap_methods
[1].method
= EAP_TYPE_NONE
;
1422 if (ttls
&& cred
->username
&& cred
->username
[0]) {
1425 /* Use anonymous NAI in Phase 1 */
1426 pos
= os_strchr(cred
->username
, '@');
1428 size_t buflen
= 9 + os_strlen(pos
) + 1;
1429 anon
= os_malloc(buflen
);
1432 os_snprintf(anon
, buflen
, "anonymous%s", pos
);
1433 } else if (cred
->realm
) {
1434 size_t buflen
= 10 + os_strlen(cred
->realm
) + 1;
1435 anon
= os_malloc(buflen
);
1438 os_snprintf(anon
, buflen
, "anonymous@%s", cred
->realm
);
1440 anon
= os_strdup("anonymous");
1444 if (wpa_config_set_quoted(ssid
, "anonymous_identity", anon
) <
1452 if (!ttls
&& cred
->username
&& cred
->username
[0] && cred
->realm
&&
1453 !os_strchr(cred
->username
, '@')) {
1458 buflen
= os_strlen(cred
->username
) + 1 +
1459 os_strlen(cred
->realm
) + 1;
1461 id
= os_malloc(buflen
);
1464 os_snprintf(id
, buflen
, "%s@%s", cred
->username
, cred
->realm
);
1465 res
= wpa_config_set_quoted(ssid
, "identity", id
);
1469 } else if (cred
->username
&& cred
->username
[0] &&
1470 wpa_config_set_quoted(ssid
, "identity", cred
->username
) < 0)
1473 if (cred
->password
&& cred
->password
[0]) {
1474 if (cred
->ext_password
&&
1475 wpa_config_set(ssid
, "password", cred
->password
, 0) < 0)
1477 if (!cred
->ext_password
&&
1478 wpa_config_set_quoted(ssid
, "password", cred
->password
) <
1483 if (cred
->client_cert
&& cred
->client_cert
[0] &&
1484 wpa_config_set_quoted(ssid
, "client_cert", cred
->client_cert
) < 0)
1488 if (cred
->private_key
&&
1489 os_strncmp(cred
->private_key
, "keystore://", 11) == 0) {
1490 /* Use OpenSSL engine configuration for Android keystore */
1491 if (wpa_config_set_quoted(ssid
, "engine_id", "keystore") < 0 ||
1492 wpa_config_set_quoted(ssid
, "key_id",
1493 cred
->private_key
+ 11) < 0 ||
1494 wpa_config_set(ssid
, "engine", "1", 0) < 0)
1497 #endif /* ANDROID */
1498 if (cred
->private_key
&& cred
->private_key
[0] &&
1499 wpa_config_set_quoted(ssid
, "private_key", cred
->private_key
) < 0)
1502 if (cred
->private_key_passwd
&& cred
->private_key_passwd
[0] &&
1503 wpa_config_set_quoted(ssid
, "private_key_passwd",
1504 cred
->private_key_passwd
) < 0)
1508 os_free(ssid
->eap
.phase1
);
1509 ssid
->eap
.phase1
= os_strdup(cred
->phase1
);
1512 os_free(ssid
->eap
.phase2
);
1513 ssid
->eap
.phase2
= os_strdup(cred
->phase2
);
1516 if (cred
->ca_cert
&& cred
->ca_cert
[0] &&
1517 wpa_config_set_quoted(ssid
, "ca_cert", cred
->ca_cert
) < 0)
1520 if (cred
->domain_suffix_match
&& cred
->domain_suffix_match
[0] &&
1521 wpa_config_set_quoted(ssid
, "domain_suffix_match",
1522 cred
->domain_suffix_match
) < 0)
1525 ssid
->eap
.ocsp
= cred
->ocsp
;
1531 static int interworking_connect_roaming_consortium(
1532 struct wpa_supplicant
*wpa_s
, struct wpa_cred
*cred
,
1533 struct wpa_bss
*bss
, int only_add
)
1535 struct wpa_ssid
*ssid
;
1537 wpa_msg(wpa_s
, MSG_DEBUG
, "Interworking: Connect with " MACSTR
1538 " based on roaming consortium match", MAC2STR(bss
->bssid
));
1540 if (already_connected(wpa_s
, cred
, bss
)) {
1541 wpa_msg(wpa_s
, MSG_INFO
, INTERWORKING_ALREADY_CONNECTED MACSTR
,
1542 MAC2STR(bss
->bssid
));
1543 return wpa_s
->current_ssid
->id
;
1546 remove_duplicate_network(wpa_s
, cred
, bss
);
1548 ssid
= wpa_config_add_network(wpa_s
->conf
);
1551 ssid
->parent_cred
= cred
;
1552 wpas_notify_network_added(wpa_s
, ssid
);
1553 wpa_config_set_network_defaults(ssid
);
1554 ssid
->priority
= cred
->priority
;
1555 ssid
->temporary
= 1;
1556 ssid
->ssid
= os_zalloc(bss
->ssid_len
+ 1);
1557 if (ssid
->ssid
== NULL
)
1559 os_memcpy(ssid
->ssid
, bss
->ssid
, bss
->ssid_len
);
1560 ssid
->ssid_len
= bss
->ssid_len
;
1562 if (interworking_set_hs20_params(wpa_s
, ssid
) < 0)
1565 if (cred
->eap_method
== NULL
) {
1566 wpa_msg(wpa_s
, MSG_DEBUG
,
1567 "Interworking: No EAP method set for credential using roaming consortium");
1571 if (interworking_set_eap_params(
1573 cred
->eap_method
->vendor
== EAP_VENDOR_IETF
&&
1574 cred
->eap_method
->method
== EAP_TYPE_TTLS
) < 0)
1577 wpa_s
->next_ssid
= ssid
;
1578 wpa_config_update_prio_list(wpa_s
->conf
);
1580 interworking_reconnect(wpa_s
);
1585 wpas_notify_network_removed(wpa_s
, ssid
);
1586 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
1591 int interworking_connect(struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
,
1594 struct wpa_cred
*cred
, *cred_rc
, *cred_3gpp
;
1595 struct wpa_ssid
*ssid
;
1596 struct nai_realm
*realm
;
1597 struct nai_realm_eap
*eap
= NULL
;
1600 int excluded
= 0, *excl
= &excluded
;
1603 if (wpa_s
->conf
->cred
== NULL
|| bss
== NULL
)
1605 if (disallowed_bssid(wpa_s
, bss
->bssid
) ||
1606 disallowed_ssid(wpa_s
, bss
->ssid
, bss
->ssid_len
)) {
1607 wpa_msg(wpa_s
, MSG_DEBUG
,
1608 "Interworking: Reject connection to disallowed BSS "
1609 MACSTR
, MAC2STR(bss
->bssid
));
1613 wpa_printf(MSG_DEBUG
, "Interworking: Considering BSS " MACSTR
1615 MAC2STR(bss
->bssid
));
1617 if (!wpa_bss_get_ie(bss
, WLAN_EID_RSN
)) {
1619 * We currently support only HS 2.0 networks and those are
1620 * required to use WPA2-Enterprise.
1622 wpa_msg(wpa_s
, MSG_DEBUG
,
1623 "Interworking: Network does not use RSN");
1627 cred_rc
= interworking_credentials_available_roaming_consortium(
1628 wpa_s
, bss
, 0, excl
);
1630 wpa_msg(wpa_s
, MSG_DEBUG
,
1631 "Interworking: Highest roaming consortium matching credential priority %d sp_priority %d",
1632 cred_rc
->priority
, cred_rc
->sp_priority
);
1633 if (excl
&& !(*excl
))
1637 cred
= interworking_credentials_available_realm(wpa_s
, bss
, 0, excl
);
1639 wpa_msg(wpa_s
, MSG_DEBUG
,
1640 "Interworking: Highest NAI Realm list matching credential priority %d sp_priority %d",
1641 cred
->priority
, cred
->sp_priority
);
1642 if (excl
&& !(*excl
))
1646 cred_3gpp
= interworking_credentials_available_3gpp(wpa_s
, bss
, 0,
1649 wpa_msg(wpa_s
, MSG_DEBUG
,
1650 "Interworking: Highest 3GPP matching credential priority %d sp_priority %d",
1651 cred_3gpp
->priority
, cred_3gpp
->sp_priority
);
1652 if (excl
&& !(*excl
))
1656 if (!cred_rc
&& !cred
&& !cred_3gpp
) {
1657 wpa_msg(wpa_s
, MSG_DEBUG
,
1658 "Interworking: No full credential matches - consider options without BW(etc.) limits");
1659 cred_rc
= interworking_credentials_available_roaming_consortium(
1660 wpa_s
, bss
, 1, excl
);
1662 wpa_msg(wpa_s
, MSG_DEBUG
,
1663 "Interworking: Highest roaming consortium matching credential priority %d sp_priority %d (ignore BW)",
1664 cred_rc
->priority
, cred_rc
->sp_priority
);
1665 if (excl
&& !(*excl
))
1669 cred
= interworking_credentials_available_realm(wpa_s
, bss
, 1,
1672 wpa_msg(wpa_s
, MSG_DEBUG
,
1673 "Interworking: Highest NAI Realm list matching credential priority %d sp_priority %d (ignore BW)",
1674 cred
->priority
, cred
->sp_priority
);
1675 if (excl
&& !(*excl
))
1679 cred_3gpp
= interworking_credentials_available_3gpp(wpa_s
, bss
,
1682 wpa_msg(wpa_s
, MSG_DEBUG
,
1683 "Interworking: Highest 3GPP matching credential priority %d sp_priority %d (ignore BW)",
1684 cred_3gpp
->priority
, cred_3gpp
->sp_priority
);
1685 if (excl
&& !(*excl
))
1691 (cred
== NULL
|| cred_prio_cmp(cred_rc
, cred
) >= 0) &&
1692 (cred_3gpp
== NULL
|| cred_prio_cmp(cred_rc
, cred_3gpp
) >= 0))
1693 return interworking_connect_roaming_consortium(wpa_s
, cred_rc
,
1697 (cred
== NULL
|| cred_prio_cmp(cred_3gpp
, cred
) >= 0)) {
1698 return interworking_connect_3gpp(wpa_s
, cred_3gpp
, bss
,
1703 wpa_msg(wpa_s
, MSG_DEBUG
,
1704 "Interworking: No matching credentials found for "
1705 MACSTR
, MAC2STR(bss
->bssid
));
1709 realm
= nai_realm_parse(bss
->anqp
? bss
->anqp
->nai_realm
: NULL
,
1711 if (realm
== NULL
) {
1712 wpa_msg(wpa_s
, MSG_DEBUG
,
1713 "Interworking: Could not parse NAI Realm list from "
1714 MACSTR
, MAC2STR(bss
->bssid
));
1718 for (i
= 0; i
< count
; i
++) {
1719 if (!nai_realm_match(&realm
[i
], cred
->realm
))
1721 eap
= nai_realm_find_eap(wpa_s
, cred
, &realm
[i
]);
1727 wpa_msg(wpa_s
, MSG_DEBUG
,
1728 "Interworking: No matching credentials and EAP method found for "
1729 MACSTR
, MAC2STR(bss
->bssid
));
1730 nai_realm_free(realm
, count
);
1734 wpa_msg(wpa_s
, MSG_DEBUG
, "Interworking: Connect with " MACSTR
,
1735 MAC2STR(bss
->bssid
));
1737 if (already_connected(wpa_s
, cred
, bss
)) {
1738 wpa_msg(wpa_s
, MSG_INFO
, INTERWORKING_ALREADY_CONNECTED MACSTR
,
1739 MAC2STR(bss
->bssid
));
1740 nai_realm_free(realm
, count
);
1744 remove_duplicate_network(wpa_s
, cred
, bss
);
1746 ssid
= wpa_config_add_network(wpa_s
->conf
);
1748 nai_realm_free(realm
, count
);
1751 ssid
->parent_cred
= cred
;
1752 wpas_notify_network_added(wpa_s
, ssid
);
1753 wpa_config_set_network_defaults(ssid
);
1754 ssid
->priority
= cred
->priority
;
1755 ssid
->temporary
= 1;
1756 ssid
->ssid
= os_zalloc(bss
->ssid_len
+ 1);
1757 if (ssid
->ssid
== NULL
)
1759 os_memcpy(ssid
->ssid
, bss
->ssid
, bss
->ssid_len
);
1760 ssid
->ssid_len
= bss
->ssid_len
;
1762 if (interworking_set_hs20_params(wpa_s
, ssid
) < 0)
1765 if (wpa_config_set(ssid
, "eap", eap_get_name(EAP_VENDOR_IETF
,
1766 eap
->method
), 0) < 0)
1769 switch (eap
->method
) {
1771 if (eap
->inner_method
) {
1772 os_snprintf(buf
, sizeof(buf
), "\"autheap=%s\"",
1773 eap_get_name(EAP_VENDOR_IETF
,
1774 eap
->inner_method
));
1775 if (wpa_config_set(ssid
, "phase2", buf
, 0) < 0)
1779 switch (eap
->inner_non_eap
) {
1780 case NAI_REALM_INNER_NON_EAP_PAP
:
1781 if (wpa_config_set(ssid
, "phase2", "\"auth=PAP\"", 0) <
1785 case NAI_REALM_INNER_NON_EAP_CHAP
:
1786 if (wpa_config_set(ssid
, "phase2", "\"auth=CHAP\"", 0)
1790 case NAI_REALM_INNER_NON_EAP_MSCHAP
:
1791 if (wpa_config_set(ssid
, "phase2", "\"auth=MSCHAP\"",
1795 case NAI_REALM_INNER_NON_EAP_MSCHAPV2
:
1796 if (wpa_config_set(ssid
, "phase2", "\"auth=MSCHAPV2\"",
1801 /* EAP params were not set - assume TTLS/MSCHAPv2 */
1802 if (wpa_config_set(ssid
, "phase2", "\"auth=MSCHAPV2\"",
1810 if (wpa_config_set(ssid
, "phase1", "\"fast_provisioning=2\"",
1813 if (wpa_config_set(ssid
, "pac_file",
1814 "\"blob://pac_interworking\"", 0) < 0)
1816 name
= eap_get_name(EAP_VENDOR_IETF
,
1817 eap
->inner_method
? eap
->inner_method
:
1821 os_snprintf(buf
, sizeof(buf
), "\"auth=%s\"", name
);
1822 if (wpa_config_set(ssid
, "phase2", buf
, 0) < 0)
1829 if (interworking_set_eap_params(ssid
, cred
,
1830 eap
->method
== EAP_TYPE_TTLS
) < 0)
1833 nai_realm_free(realm
, count
);
1835 wpa_s
->next_ssid
= ssid
;
1836 wpa_config_update_prio_list(wpa_s
->conf
);
1838 interworking_reconnect(wpa_s
);
1843 wpas_notify_network_removed(wpa_s
, ssid
);
1844 wpa_config_remove_network(wpa_s
->conf
, ssid
->id
);
1845 nai_realm_free(realm
, count
);
1851 static int interworking_pcsc_read_imsi(struct wpa_supplicant
*wpa_s
)
1855 if (wpa_s
->imsi
[0] && wpa_s
->mnc_len
)
1858 len
= sizeof(wpa_s
->imsi
) - 1;
1859 if (scard_get_imsi(wpa_s
->scard
, wpa_s
->imsi
, &len
)) {
1860 scard_deinit(wpa_s
->scard
);
1861 wpa_s
->scard
= NULL
;
1862 wpa_msg(wpa_s
, MSG_ERROR
, "Could not read IMSI");
1865 wpa_s
->imsi
[len
] = '\0';
1866 wpa_s
->mnc_len
= scard_get_mnc_len(wpa_s
->scard
);
1867 wpa_printf(MSG_DEBUG
, "SCARD: IMSI %s (MNC length %d)",
1868 wpa_s
->imsi
, wpa_s
->mnc_len
);
1872 #endif /* PCSC_FUNCS */
1875 static struct wpa_cred
* interworking_credentials_available_3gpp(
1876 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
1879 struct wpa_cred
*selected
= NULL
;
1880 #ifdef INTERWORKING_3GPP
1881 struct wpa_cred
*cred
;
1883 int is_excluded
= 0;
1885 if (bss
->anqp
== NULL
|| bss
->anqp
->anqp_3gpp
== NULL
) {
1886 wpa_msg(wpa_s
, MSG_DEBUG
,
1887 "interworking-avail-3gpp: not avail, anqp: %p anqp_3gpp: %p",
1888 bss
->anqp
, bss
->anqp
? bss
->anqp
->anqp_3gpp
: NULL
);
1892 #ifdef CONFIG_EAP_PROXY
1893 if (!wpa_s
->imsi
[0]) {
1895 wpa_msg(wpa_s
, MSG_DEBUG
,
1896 "Interworking: IMSI not available - try to read again through eap_proxy");
1897 wpa_s
->mnc_len
= eapol_sm_get_eap_proxy_imsi(wpa_s
->eapol
,
1900 if (wpa_s
->mnc_len
> 0) {
1901 wpa_s
->imsi
[len
] = '\0';
1902 wpa_msg(wpa_s
, MSG_DEBUG
,
1903 "eap_proxy: IMSI %s (MNC length %d)",
1904 wpa_s
->imsi
, wpa_s
->mnc_len
);
1906 wpa_msg(wpa_s
, MSG_DEBUG
,
1907 "eap_proxy: IMSI not available");
1910 #endif /* CONFIG_EAP_PROXY */
1912 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
1920 if (cred
->pcsc
&& wpa_s
->scard
) {
1921 if (interworking_pcsc_read_imsi(wpa_s
) < 0)
1924 mnc_len
= wpa_s
->mnc_len
;
1927 #endif /* PCSC_FUNCS */
1928 #ifdef CONFIG_EAP_PROXY
1929 if (cred
->pcsc
&& wpa_s
->mnc_len
> 0 && wpa_s
->imsi
[0]) {
1931 mnc_len
= wpa_s
->mnc_len
;
1934 #endif /* CONFIG_EAP_PROXY */
1936 if (cred
->imsi
== NULL
|| !cred
->imsi
[0] ||
1937 (!wpa_s
->conf
->external_sim
&&
1938 (cred
->milenage
== NULL
|| !cred
->milenage
[0])))
1941 sep
= os_strchr(cred
->imsi
, '-');
1943 (sep
- cred
->imsi
!= 5 && sep
- cred
->imsi
!= 6))
1945 mnc_len
= sep
- cred
->imsi
- 3;
1946 os_memcpy(imsi_buf
, cred
->imsi
, 3 + mnc_len
);
1948 msin_len
= os_strlen(cred
->imsi
);
1949 if (3 + mnc_len
+ msin_len
>= sizeof(imsi_buf
) - 1)
1950 msin_len
= sizeof(imsi_buf
) - 3 - mnc_len
- 1;
1951 os_memcpy(&imsi_buf
[3 + mnc_len
], sep
, msin_len
);
1952 imsi_buf
[3 + mnc_len
+ msin_len
] = '\0';
1955 #if defined(PCSC_FUNCS) || defined(CONFIG_EAP_PROXY)
1957 #endif /* PCSC_FUNCS || CONFIG_EAP_PROXY */
1958 wpa_msg(wpa_s
, MSG_DEBUG
,
1959 "Interworking: Parsing 3GPP info from " MACSTR
,
1960 MAC2STR(bss
->bssid
));
1961 ret
= plmn_id_match(bss
->anqp
->anqp_3gpp
, imsi
, mnc_len
);
1962 wpa_msg(wpa_s
, MSG_DEBUG
, "PLMN match %sfound",
1965 if (cred_no_required_oi_match(cred
, bss
))
1968 cred_below_min_backhaul(wpa_s
, cred
, bss
))
1971 cred_over_max_bss_load(wpa_s
, cred
, bss
))
1974 cred_conn_capab_missing(wpa_s
, cred
, bss
))
1976 if (cred_excluded_ssid(cred
, bss
)) {
1977 if (excluded
== NULL
)
1979 if (selected
== NULL
) {
1984 if (selected
== NULL
|| is_excluded
||
1985 cred_prio_cmp(selected
, cred
) < 0) {
1994 *excluded
= is_excluded
;
1995 #endif /* INTERWORKING_3GPP */
2000 static struct wpa_cred
* interworking_credentials_available_realm(
2001 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
2004 struct wpa_cred
*cred
, *selected
= NULL
;
2005 struct nai_realm
*realm
;
2007 int is_excluded
= 0;
2009 if (bss
->anqp
== NULL
|| bss
->anqp
->nai_realm
== NULL
)
2012 if (wpa_s
->conf
->cred
== NULL
)
2015 wpa_msg(wpa_s
, MSG_DEBUG
, "Interworking: Parsing NAI Realm list from "
2016 MACSTR
, MAC2STR(bss
->bssid
));
2017 realm
= nai_realm_parse(bss
->anqp
->nai_realm
, &count
);
2018 if (realm
== NULL
) {
2019 wpa_msg(wpa_s
, MSG_DEBUG
,
2020 "Interworking: Could not parse NAI Realm list from "
2021 MACSTR
, MAC2STR(bss
->bssid
));
2025 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
2026 if (cred
->realm
== NULL
)
2029 for (i
= 0; i
< count
; i
++) {
2030 if (!nai_realm_match(&realm
[i
], cred
->realm
))
2032 if (nai_realm_find_eap(wpa_s
, cred
, &realm
[i
])) {
2033 if (cred_no_required_oi_match(cred
, bss
))
2036 cred_below_min_backhaul(wpa_s
, cred
, bss
))
2039 cred_over_max_bss_load(wpa_s
, cred
, bss
))
2042 cred_conn_capab_missing(wpa_s
, cred
, bss
))
2044 if (cred_excluded_ssid(cred
, bss
)) {
2045 if (excluded
== NULL
)
2047 if (selected
== NULL
) {
2052 if (selected
== NULL
|| is_excluded
||
2053 cred_prio_cmp(selected
, cred
) < 0)
2061 wpa_msg(wpa_s
, MSG_DEBUG
,
2062 "Interworking: realm-find-eap returned false");
2067 nai_realm_free(realm
, count
);
2070 *excluded
= is_excluded
;
2076 static struct wpa_cred
* interworking_credentials_available_helper(
2077 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int ignore_bw
,
2080 struct wpa_cred
*cred
, *cred2
;
2081 int excluded1
, excluded2
= 0;
2083 if (disallowed_bssid(wpa_s
, bss
->bssid
) ||
2084 disallowed_ssid(wpa_s
, bss
->ssid
, bss
->ssid_len
)) {
2085 wpa_printf(MSG_DEBUG
, "Interworking: Ignore disallowed BSS "
2086 MACSTR
, MAC2STR(bss
->bssid
));
2090 cred
= interworking_credentials_available_realm(wpa_s
, bss
, ignore_bw
,
2092 cred2
= interworking_credentials_available_3gpp(wpa_s
, bss
, ignore_bw
,
2094 if (cred
&& cred2
&&
2095 (cred_prio_cmp(cred2
, cred
) >= 0 || (!excluded2
&& excluded1
))) {
2097 excluded1
= excluded2
;
2101 excluded1
= excluded2
;
2104 cred2
= interworking_credentials_available_roaming_consortium(
2105 wpa_s
, bss
, ignore_bw
, &excluded2
);
2106 if (cred
&& cred2
&&
2107 (cred_prio_cmp(cred2
, cred
) >= 0 || (!excluded2
&& excluded1
))) {
2109 excluded1
= excluded2
;
2113 excluded1
= excluded2
;
2117 *excluded
= excluded1
;
2122 static struct wpa_cred
* interworking_credentials_available(
2123 struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
, int *excluded
)
2125 struct wpa_cred
*cred
;
2129 cred
= interworking_credentials_available_helper(wpa_s
, bss
, 0,
2133 return interworking_credentials_available_helper(wpa_s
, bss
, 1,
2138 int domain_name_list_contains(struct wpabuf
*domain_names
,
2139 const char *domain
, int exact_match
)
2141 const u8
*pos
, *end
;
2144 len
= os_strlen(domain
);
2145 pos
= wpabuf_head(domain_names
);
2146 end
= pos
+ wpabuf_len(domain_names
);
2148 while (end
- pos
> 1) {
2152 if (elen
> end
- pos
)
2155 wpa_hexdump_ascii(MSG_DEBUG
, "Interworking: AP domain name",
2158 os_strncasecmp(domain
, (const char *) pos
, len
) == 0)
2160 if (!exact_match
&& elen
> len
&& pos
[elen
- len
- 1] == '.') {
2161 const char *ap
= (const char *) pos
;
2162 int offset
= elen
- len
;
2164 if (os_strncasecmp(domain
, ap
+ offset
, len
) == 0)
2175 int interworking_home_sp_cred(struct wpa_supplicant
*wpa_s
,
2176 struct wpa_cred
*cred
,
2177 struct wpabuf
*domain_names
)
2181 #ifdef INTERWORKING_3GPP
2182 char nai
[100], *realm
;
2189 else if (cred
->pcsc
&& wpa_s
->scard
) {
2190 if (interworking_pcsc_read_imsi(wpa_s
) < 0)
2193 mnc_len
= wpa_s
->mnc_len
;
2195 #endif /* PCSC_FUNCS */
2196 #ifdef CONFIG_EAP_PROXY
2197 else if (cred
->pcsc
&& wpa_s
->mnc_len
> 0 && wpa_s
->imsi
[0]) {
2199 mnc_len
= wpa_s
->mnc_len
;
2201 #endif /* CONFIG_EAP_PROXY */
2203 imsi
&& build_root_nai(nai
, sizeof(nai
), imsi
, mnc_len
, 0) == 0) {
2204 realm
= os_strchr(nai
, '@');
2207 wpa_msg(wpa_s
, MSG_DEBUG
,
2208 "Interworking: Search for match with SIM/USIM domain %s",
2211 domain_name_list_contains(domain_names
, realm
, 1))
2216 #endif /* INTERWORKING_3GPP */
2218 if (domain_names
== NULL
|| cred
->domain
== NULL
)
2221 for (i
= 0; i
< cred
->num_domain
; i
++) {
2222 wpa_msg(wpa_s
, MSG_DEBUG
,
2223 "Interworking: Search for match with home SP FQDN %s",
2225 if (domain_name_list_contains(domain_names
, cred
->domain
[i
], 1))
2233 static int interworking_home_sp(struct wpa_supplicant
*wpa_s
,
2234 struct wpabuf
*domain_names
)
2236 struct wpa_cred
*cred
;
2238 if (domain_names
== NULL
|| wpa_s
->conf
->cred
== NULL
)
2241 for (cred
= wpa_s
->conf
->cred
; cred
; cred
= cred
->next
) {
2242 int res
= interworking_home_sp_cred(wpa_s
, cred
, domain_names
);
2251 static int interworking_find_network_match(struct wpa_supplicant
*wpa_s
)
2253 struct wpa_bss
*bss
;
2254 struct wpa_ssid
*ssid
;
2256 dl_list_for_each(bss
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2257 for (ssid
= wpa_s
->conf
->ssid
; ssid
; ssid
= ssid
->next
) {
2258 if (wpas_network_disabled(wpa_s
, ssid
) ||
2259 ssid
->mode
!= WPAS_MODE_INFRA
)
2261 if (ssid
->ssid_len
!= bss
->ssid_len
||
2262 os_memcmp(ssid
->ssid
, bss
->ssid
, ssid
->ssid_len
) !=
2266 * TODO: Consider more accurate matching of security
2267 * configuration similarly to what is done in events.c
2277 static int roaming_partner_match(struct wpa_supplicant
*wpa_s
,
2278 struct roaming_partner
*partner
,
2279 struct wpabuf
*domain_names
)
2281 wpa_printf(MSG_DEBUG
, "Interworking: Comparing roaming_partner info fqdn='%s' exact_match=%d priority=%u country='%s'",
2282 partner
->fqdn
, partner
->exact_match
, partner
->priority
,
2284 wpa_hexdump_ascii(MSG_DEBUG
, "Interworking: Domain names",
2285 wpabuf_head(domain_names
),
2286 wpabuf_len(domain_names
));
2287 if (!domain_name_list_contains(domain_names
, partner
->fqdn
,
2288 partner
->exact_match
))
2290 /* TODO: match Country */
2295 static u8
roaming_prio(struct wpa_supplicant
*wpa_s
, struct wpa_cred
*cred
,
2296 struct wpa_bss
*bss
)
2300 if (bss
->anqp
== NULL
|| bss
->anqp
->domain_name
== NULL
) {
2301 wpa_printf(MSG_DEBUG
, "Interworking: No ANQP domain name info -> use default roaming partner priority 128");
2302 return 128; /* cannot check preference with domain name */
2305 if (interworking_home_sp_cred(wpa_s
, cred
, bss
->anqp
->domain_name
) > 0)
2307 wpa_printf(MSG_DEBUG
, "Interworking: Determined to be home SP -> use maximum preference 0 as roaming partner priority");
2308 return 0; /* max preference for home SP network */
2311 for (i
= 0; i
< cred
->num_roaming_partner
; i
++) {
2312 if (roaming_partner_match(wpa_s
, &cred
->roaming_partner
[i
],
2313 bss
->anqp
->domain_name
)) {
2314 wpa_printf(MSG_DEBUG
, "Interworking: Roaming partner preference match - priority %u",
2315 cred
->roaming_partner
[i
].priority
);
2316 return cred
->roaming_partner
[i
].priority
;
2320 wpa_printf(MSG_DEBUG
, "Interworking: No roaming partner preference match - use default roaming partner priority 128");
2325 static struct wpa_bss
* pick_best_roaming_partner(struct wpa_supplicant
*wpa_s
,
2326 struct wpa_bss
*selected
,
2327 struct wpa_cred
*cred
)
2329 struct wpa_bss
*bss
;
2331 struct wpa_cred
*cred2
;
2334 * Check if any other BSS is operated by a more preferred roaming
2338 best_prio
= roaming_prio(wpa_s
, cred
, selected
);
2339 wpa_printf(MSG_DEBUG
, "Interworking: roaming_prio=%u for selected BSS "
2340 MACSTR
" (cred=%d)", best_prio
, MAC2STR(selected
->bssid
),
2343 dl_list_for_each(bss
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2344 if (bss
== selected
)
2346 cred2
= interworking_credentials_available(wpa_s
, bss
, NULL
);
2349 if (!wpa_bss_get_ie(bss
, WLAN_EID_RSN
))
2351 prio
= roaming_prio(wpa_s
, cred2
, bss
);
2352 wpa_printf(MSG_DEBUG
, "Interworking: roaming_prio=%u for BSS "
2353 MACSTR
" (cred=%d)", prio
, MAC2STR(bss
->bssid
),
2355 if (prio
< best_prio
) {
2356 int bh1
, bh2
, load1
, load2
, conn1
, conn2
;
2357 bh1
= cred_below_min_backhaul(wpa_s
, cred
, selected
);
2358 load1
= cred_over_max_bss_load(wpa_s
, cred
, selected
);
2359 conn1
= cred_conn_capab_missing(wpa_s
, cred
, selected
);
2360 bh2
= cred_below_min_backhaul(wpa_s
, cred2
, bss
);
2361 load2
= cred_over_max_bss_load(wpa_s
, cred2
, bss
);
2362 conn2
= cred_conn_capab_missing(wpa_s
, cred2
, bss
);
2363 wpa_printf(MSG_DEBUG
, "Interworking: old: %d %d %d new: %d %d %d",
2364 bh1
, load1
, conn1
, bh2
, load2
, conn2
);
2365 if (bh1
|| load1
|| conn1
|| !(bh2
|| load2
|| conn2
)) {
2366 wpa_printf(MSG_DEBUG
, "Interworking: Better roaming partner " MACSTR
" selected", MAC2STR(bss
->bssid
));
2377 static void interworking_select_network(struct wpa_supplicant
*wpa_s
)
2379 struct wpa_bss
*bss
, *selected
= NULL
, *selected_home
= NULL
;
2380 struct wpa_bss
*selected2
= NULL
, *selected2_home
= NULL
;
2381 unsigned int count
= 0;
2384 struct wpa_cred
*cred
, *selected_cred
= NULL
;
2385 struct wpa_cred
*selected_home_cred
= NULL
;
2386 struct wpa_cred
*selected2_cred
= NULL
;
2387 struct wpa_cred
*selected2_home_cred
= NULL
;
2389 wpa_s
->network_select
= 0;
2391 wpa_printf(MSG_DEBUG
, "Interworking: Select network (auto_select=%d)",
2392 wpa_s
->auto_select
);
2393 dl_list_for_each(bss
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2395 int bh
, bss_load
, conn_capab
;
2396 cred
= interworking_credentials_available(wpa_s
, bss
,
2401 if (!wpa_bss_get_ie(bss
, WLAN_EID_RSN
)) {
2403 * We currently support only HS 2.0 networks and those
2404 * are required to use WPA2-Enterprise.
2406 wpa_msg(wpa_s
, MSG_DEBUG
,
2407 "Interworking: Credential match with " MACSTR
2408 " but network does not use RSN",
2409 MAC2STR(bss
->bssid
));
2414 res
= interworking_home_sp(wpa_s
, bss
->anqp
?
2415 bss
->anqp
->domain_name
: NULL
);
2422 bh
= cred_below_min_backhaul(wpa_s
, cred
, bss
);
2423 bss_load
= cred_over_max_bss_load(wpa_s
, cred
, bss
);
2424 conn_capab
= cred_conn_capab_missing(wpa_s
, cred
, bss
);
2425 wpa_msg(wpa_s
, MSG_INFO
, "%s" MACSTR
" type=%s%s%s%s id=%d priority=%d sp_priority=%d",
2426 excluded
? INTERWORKING_BLACKLISTED
: INTERWORKING_AP
,
2427 MAC2STR(bss
->bssid
), type
,
2428 bh
? " below_min_backhaul=1" : "",
2429 bss_load
? " over_max_bss_load=1" : "",
2430 conn_capab
? " conn_capab_missing=1" : "",
2431 cred
->id
, cred
->priority
, cred
->sp_priority
);
2434 if (wpa_s
->auto_select
||
2435 (wpa_s
->conf
->auto_interworking
&&
2436 wpa_s
->auto_network_select
)) {
2437 if (bh
|| bss_load
|| conn_capab
) {
2438 if (selected2_cred
== NULL
||
2439 cred_prio_cmp(cred
, selected2_cred
) > 0) {
2440 wpa_printf(MSG_DEBUG
, "Interworking: Mark as selected2");
2442 selected2_cred
= cred
;
2445 (selected2_home_cred
== NULL
||
2446 cred_prio_cmp(cred
, selected2_home_cred
) >
2448 wpa_printf(MSG_DEBUG
, "Interworking: Mark as selected2_home");
2449 selected2_home
= bss
;
2450 selected2_home_cred
= cred
;
2453 if (selected_cred
== NULL
||
2454 cred_prio_cmp(cred
, selected_cred
) > 0) {
2455 wpa_printf(MSG_DEBUG
, "Interworking: Mark as selected");
2457 selected_cred
= cred
;
2460 (selected_home_cred
== NULL
||
2461 cred_prio_cmp(cred
, selected_home_cred
) >
2463 wpa_printf(MSG_DEBUG
, "Interworking: Mark as selected_home");
2464 selected_home
= bss
;
2465 selected_home_cred
= cred
;
2471 if (selected_home
&& selected_home
!= selected
&&
2472 selected_home_cred
&&
2473 (selected_cred
== NULL
||
2474 cred_prio_cmp(selected_home_cred
, selected_cred
) >= 0)) {
2475 /* Prefer network operated by the Home SP */
2476 wpa_printf(MSG_DEBUG
, "Interworking: Overrided selected with selected_home");
2477 selected
= selected_home
;
2478 selected_cred
= selected_home_cred
;
2482 if (selected2_home
) {
2483 wpa_printf(MSG_DEBUG
, "Interworking: Use home BSS with BW limit mismatch since no other network could be selected");
2484 selected
= selected2_home
;
2485 selected_cred
= selected2_home_cred
;
2486 } else if (selected2
) {
2487 wpa_printf(MSG_DEBUG
, "Interworking: Use visited BSS with BW limit mismatch since no other network could be selected");
2488 selected
= selected2
;
2489 selected_cred
= selected2_cred
;
2495 * No matching network was found based on configured
2496 * credentials. Check whether any of the enabled network blocks
2497 * have matching APs.
2499 if (interworking_find_network_match(wpa_s
)) {
2500 wpa_msg(wpa_s
, MSG_DEBUG
,
2501 "Interworking: Possible BSS match for enabled network configurations");
2502 if (wpa_s
->auto_select
) {
2503 interworking_reconnect(wpa_s
);
2508 if (wpa_s
->auto_network_select
) {
2509 wpa_msg(wpa_s
, MSG_DEBUG
,
2510 "Interworking: Continue scanning after ANQP fetch");
2511 wpa_supplicant_req_scan(wpa_s
, wpa_s
->scan_interval
,
2516 wpa_msg(wpa_s
, MSG_INFO
, INTERWORKING_NO_MATCH
"No network "
2517 "with matching credentials found");
2518 if (wpa_s
->wpa_state
== WPA_SCANNING
)
2519 wpa_supplicant_set_state(wpa_s
, WPA_DISCONNECTED
);
2523 wpa_printf(MSG_DEBUG
, "Interworking: Selected " MACSTR
,
2524 MAC2STR(selected
->bssid
));
2525 selected
= pick_best_roaming_partner(wpa_s
, selected
,
2527 wpa_printf(MSG_DEBUG
, "Interworking: Selected " MACSTR
2528 " (after best roaming partner selection)",
2529 MAC2STR(selected
->bssid
));
2530 wpa_msg(wpa_s
, MSG_INFO
, INTERWORKING_SELECTED MACSTR
,
2531 MAC2STR(selected
->bssid
));
2532 interworking_connect(wpa_s
, selected
, 0);
2533 } else if (wpa_s
->wpa_state
== WPA_SCANNING
)
2534 wpa_supplicant_set_state(wpa_s
, WPA_DISCONNECTED
);
2538 static struct wpa_bss_anqp
*
2539 interworking_match_anqp_info(struct wpa_supplicant
*wpa_s
, struct wpa_bss
*bss
)
2541 struct wpa_bss
*other
;
2543 if (is_zero_ether_addr(bss
->hessid
))
2544 return NULL
; /* Cannot be in the same homegenous ESS */
2546 dl_list_for_each(other
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2549 if (other
->anqp
== NULL
)
2551 if (other
->anqp
->roaming_consortium
== NULL
&&
2552 other
->anqp
->nai_realm
== NULL
&&
2553 other
->anqp
->anqp_3gpp
== NULL
&&
2554 other
->anqp
->domain_name
== NULL
)
2556 if (!(other
->flags
& WPA_BSS_ANQP_FETCH_TRIED
))
2558 if (os_memcmp(bss
->hessid
, other
->hessid
, ETH_ALEN
) != 0)
2560 if (bss
->ssid_len
!= other
->ssid_len
||
2561 os_memcmp(bss
->ssid
, other
->ssid
, bss
->ssid_len
) != 0)
2564 wpa_msg(wpa_s
, MSG_DEBUG
,
2565 "Interworking: Share ANQP data with already fetched BSSID "
2566 MACSTR
" and " MACSTR
,
2567 MAC2STR(other
->bssid
), MAC2STR(bss
->bssid
));
2568 other
->anqp
->users
++;
2576 static void interworking_next_anqp_fetch(struct wpa_supplicant
*wpa_s
)
2578 struct wpa_bss
*bss
;
2582 wpa_printf(MSG_DEBUG
, "Interworking: next_anqp_fetch - "
2583 "fetch_anqp_in_progress=%d fetch_osu_icon_in_progress=%d",
2584 wpa_s
->fetch_anqp_in_progress
,
2585 wpa_s
->fetch_osu_icon_in_progress
);
2587 if (eloop_terminated() || !wpa_s
->fetch_anqp_in_progress
) {
2588 wpa_printf(MSG_DEBUG
, "Interworking: Stop next-ANQP-fetch");
2593 if (wpa_s
->fetch_osu_icon_in_progress
) {
2594 wpa_printf(MSG_DEBUG
, "Interworking: Next icon (in progress)");
2595 hs20_next_osu_icon(wpa_s
);
2598 #endif /* CONFIG_HS20 */
2600 dl_list_for_each(bss
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2601 if (!(bss
->caps
& IEEE80211_CAP_ESS
))
2603 ie
= wpa_bss_get_ie(bss
, WLAN_EID_EXT_CAPAB
);
2604 if (ie
== NULL
|| ie
[1] < 4 || !(ie
[5] & 0x80))
2605 continue; /* AP does not support Interworking */
2606 if (disallowed_bssid(wpa_s
, bss
->bssid
) ||
2607 disallowed_ssid(wpa_s
, bss
->ssid
, bss
->ssid_len
))
2608 continue; /* Disallowed BSS */
2610 if (!(bss
->flags
& WPA_BSS_ANQP_FETCH_TRIED
)) {
2611 if (bss
->anqp
== NULL
) {
2612 bss
->anqp
= interworking_match_anqp_info(wpa_s
,
2615 /* Shared data already fetched */
2618 bss
->anqp
= wpa_bss_anqp_alloc();
2619 if (bss
->anqp
== NULL
)
2623 bss
->flags
|= WPA_BSS_ANQP_FETCH_TRIED
;
2624 wpa_msg(wpa_s
, MSG_INFO
, "Starting ANQP fetch for "
2625 MACSTR
, MAC2STR(bss
->bssid
));
2626 interworking_anqp_send_req(wpa_s
, bss
);
2633 if (wpa_s
->fetch_osu_info
) {
2634 if (wpa_s
->num_prov_found
== 0 &&
2635 wpa_s
->fetch_osu_waiting_scan
&&
2636 wpa_s
->num_osu_scans
< 3) {
2637 wpa_printf(MSG_DEBUG
, "HS 2.0: No OSU providers seen - try to scan again");
2638 hs20_start_osu_scan(wpa_s
);
2641 wpa_printf(MSG_DEBUG
, "Interworking: Next icon");
2642 hs20_osu_icon_fetch(wpa_s
);
2645 #endif /* CONFIG_HS20 */
2646 wpa_msg(wpa_s
, MSG_INFO
, "ANQP fetch completed");
2647 wpa_s
->fetch_anqp_in_progress
= 0;
2648 if (wpa_s
->network_select
)
2649 interworking_select_network(wpa_s
);
2654 void interworking_start_fetch_anqp(struct wpa_supplicant
*wpa_s
)
2656 struct wpa_bss
*bss
;
2658 dl_list_for_each(bss
, &wpa_s
->bss
, struct wpa_bss
, list
)
2659 bss
->flags
&= ~WPA_BSS_ANQP_FETCH_TRIED
;
2661 wpa_s
->fetch_anqp_in_progress
= 1;
2664 * Start actual ANQP operation from eloop call to make sure the loop
2665 * does not end up using excessive recursion.
2667 eloop_register_timeout(0, 0, interworking_continue_anqp
, wpa_s
, NULL
);
2671 int interworking_fetch_anqp(struct wpa_supplicant
*wpa_s
)
2673 if (wpa_s
->fetch_anqp_in_progress
|| wpa_s
->network_select
)
2676 wpa_s
->network_select
= 0;
2677 wpa_s
->fetch_all_anqp
= 1;
2678 wpa_s
->fetch_osu_info
= 0;
2680 interworking_start_fetch_anqp(wpa_s
);
2686 void interworking_stop_fetch_anqp(struct wpa_supplicant
*wpa_s
)
2688 if (!wpa_s
->fetch_anqp_in_progress
)
2691 wpa_s
->fetch_anqp_in_progress
= 0;
2695 int anqp_send_req(struct wpa_supplicant
*wpa_s
, const u8
*dst
,
2696 u16 info_ids
[], size_t num_ids
, u32 subtypes
,
2700 struct wpabuf
*extra_buf
= NULL
;
2703 struct wpa_bss
*bss
;
2706 bss
= wpa_bss_get_bssid(wpa_s
, dst
);
2708 wpa_printf(MSG_WARNING
,
2709 "ANQP: Cannot send query to unknown BSS "
2710 MACSTR
, MAC2STR(dst
));
2714 wpa_bss_anqp_unshare_alloc(bss
);
2717 wpa_msg(wpa_s
, MSG_DEBUG
,
2718 "ANQP: Query Request to " MACSTR
" for %u id(s)",
2719 MAC2STR(dst
), (unsigned int) num_ids
);
2722 if (subtypes
!= 0) {
2723 extra_buf
= wpabuf_alloc(100);
2724 if (extra_buf
== NULL
)
2726 hs20_put_anqp_req(subtypes
, NULL
, 0, extra_buf
);
2728 #endif /* CONFIG_HS20 */
2734 mbo
= mbo_build_anqp_buf(wpa_s
, bss
, mbo_subtypes
);
2736 if (wpabuf_resize(&extra_buf
, wpabuf_len(mbo
))) {
2737 wpabuf_free(extra_buf
);
2740 wpabuf_put_buf(extra_buf
, mbo
);
2744 #endif /* CONFIG_MBO */
2746 buf
= anqp_build_req(info_ids
, num_ids
, extra_buf
);
2747 wpabuf_free(extra_buf
);
2751 res
= gas_query_req(wpa_s
->gas
, dst
, freq
, buf
, anqp_resp_cb
, wpa_s
);
2753 wpa_msg(wpa_s
, MSG_DEBUG
, "ANQP: Failed to send Query Request");
2757 wpa_msg(wpa_s
, MSG_DEBUG
,
2758 "ANQP: Query started with dialog token %u", res
);
2765 static void anqp_add_extra(struct wpa_supplicant
*wpa_s
,
2766 struct wpa_bss_anqp
*anqp
, u16 info_id
,
2767 const u8
*data
, size_t slen
)
2769 struct wpa_bss_anqp_elem
*tmp
, *elem
= NULL
;
2774 dl_list_for_each(tmp
, &anqp
->anqp_elems
, struct wpa_bss_anqp_elem
,
2776 if (tmp
->infoid
== info_id
) {
2783 elem
= os_zalloc(sizeof(*elem
));
2786 elem
->infoid
= info_id
;
2787 dl_list_add(&anqp
->anqp_elems
, &elem
->list
);
2789 wpabuf_free(elem
->payload
);
2792 elem
->payload
= wpabuf_alloc_copy(data
, slen
);
2793 if (!elem
->payload
) {
2794 dl_list_del(&elem
->list
);
2800 static void interworking_parse_rx_anqp_resp(struct wpa_supplicant
*wpa_s
,
2801 struct wpa_bss
*bss
, const u8
*sa
,
2803 const u8
*data
, size_t slen
,
2806 const u8
*pos
= data
;
2807 struct wpa_bss_anqp
*anqp
= NULL
;
2810 #endif /* CONFIG_HS20 */
2816 case ANQP_CAPABILITY_LIST
:
2817 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2818 " ANQP Capability list", MAC2STR(sa
));
2819 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: Capability list",
2822 wpabuf_free(anqp
->capability_list
);
2823 anqp
->capability_list
= wpabuf_alloc_copy(pos
, slen
);
2826 case ANQP_VENUE_NAME
:
2827 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2828 " Venue Name", MAC2STR(sa
));
2829 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: Venue Name", pos
, slen
);
2831 wpabuf_free(anqp
->venue_name
);
2832 anqp
->venue_name
= wpabuf_alloc_copy(pos
, slen
);
2835 case ANQP_NETWORK_AUTH_TYPE
:
2836 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2837 " Network Authentication Type information",
2839 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: Network Authentication "
2842 wpabuf_free(anqp
->network_auth_type
);
2843 anqp
->network_auth_type
= wpabuf_alloc_copy(pos
, slen
);
2846 case ANQP_ROAMING_CONSORTIUM
:
2847 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2848 " Roaming Consortium list", MAC2STR(sa
));
2849 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: Roaming Consortium",
2852 wpabuf_free(anqp
->roaming_consortium
);
2853 anqp
->roaming_consortium
= wpabuf_alloc_copy(pos
, slen
);
2856 case ANQP_IP_ADDR_TYPE_AVAILABILITY
:
2857 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2858 " IP Address Type Availability information",
2860 wpa_hexdump(MSG_MSGDUMP
, "ANQP: IP Address Availability",
2863 wpabuf_free(anqp
->ip_addr_type_availability
);
2864 anqp
->ip_addr_type_availability
=
2865 wpabuf_alloc_copy(pos
, slen
);
2868 case ANQP_NAI_REALM
:
2869 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2870 " NAI Realm list", MAC2STR(sa
));
2871 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: NAI Realm", pos
, slen
);
2873 wpabuf_free(anqp
->nai_realm
);
2874 anqp
->nai_realm
= wpabuf_alloc_copy(pos
, slen
);
2877 case ANQP_3GPP_CELLULAR_NETWORK
:
2878 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2879 " 3GPP Cellular Network information", MAC2STR(sa
));
2880 wpa_hexdump_ascii(MSG_DEBUG
, "ANQP: 3GPP Cellular Network",
2883 wpabuf_free(anqp
->anqp_3gpp
);
2884 anqp
->anqp_3gpp
= wpabuf_alloc_copy(pos
, slen
);
2887 case ANQP_DOMAIN_NAME
:
2888 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2889 " Domain Name list", MAC2STR(sa
));
2890 wpa_hexdump_ascii(MSG_MSGDUMP
, "ANQP: Domain Name", pos
, slen
);
2892 wpabuf_free(anqp
->domain_name
);
2893 anqp
->domain_name
= wpabuf_alloc_copy(pos
, slen
);
2897 case ANQP_FILS_REALM_INFO
:
2898 wpa_msg(wpa_s
, MSG_INFO
, RX_ANQP MACSTR
2899 " FILS Realm Information", MAC2STR(sa
));
2900 wpa_hexdump_ascii(MSG_MSGDUMP
, "ANQP: FILS Realm Information",
2903 wpabuf_free(anqp
->fils_realm_info
);
2904 anqp
->fils_realm_info
= wpabuf_alloc_copy(pos
, slen
);
2907 #endif /* CONFIG_FILS */
2908 case ANQP_VENDOR_SPECIFIC
:
2912 switch (WPA_GET_BE24(pos
)) {
2924 case HS20_ANQP_OUI_TYPE
:
2925 hs20_parse_rx_hs20_anqp_resp(wpa_s
, bss
, sa
,
2930 wpa_msg(wpa_s
, MSG_DEBUG
,
2931 "HS20: Unsupported ANQP vendor type %u",
2936 #endif /* CONFIG_HS20 */
2938 wpa_msg(wpa_s
, MSG_DEBUG
,
2939 "Interworking: Unsupported vendor-specific ANQP OUI %06x",
2945 wpa_msg(wpa_s
, MSG_DEBUG
,
2946 "Interworking: Unsupported ANQP Info ID %u", info_id
);
2947 anqp_add_extra(wpa_s
, anqp
, info_id
, data
, slen
);
2953 void anqp_resp_cb(void *ctx
, const u8
*dst
, u8 dialog_token
,
2954 enum gas_query_result result
,
2955 const struct wpabuf
*adv_proto
,
2956 const struct wpabuf
*resp
, u16 status_code
)
2958 struct wpa_supplicant
*wpa_s
= ctx
;
2963 struct wpa_bss
*bss
= NULL
, *tmp
;
2964 const char *anqp_result
= "SUCCESS";
2966 wpa_printf(MSG_DEBUG
, "Interworking: anqp_resp_cb dst=" MACSTR
2967 " dialog_token=%u result=%d status_code=%u",
2968 MAC2STR(dst
), dialog_token
, result
, status_code
);
2969 if (result
!= GAS_QUERY_SUCCESS
) {
2971 if (wpa_s
->fetch_osu_icon_in_progress
)
2972 hs20_icon_fetch_failed(wpa_s
);
2973 #endif /* CONFIG_HS20 */
2974 anqp_result
= "FAILURE";
2978 pos
= wpabuf_head(adv_proto
);
2979 if (wpabuf_len(adv_proto
) < 4 || pos
[0] != WLAN_EID_ADV_PROTO
||
2980 pos
[1] < 2 || pos
[3] != ACCESS_NETWORK_QUERY_PROTOCOL
) {
2981 wpa_msg(wpa_s
, MSG_DEBUG
,
2982 "ANQP: Unexpected Advertisement Protocol in response");
2984 if (wpa_s
->fetch_osu_icon_in_progress
)
2985 hs20_icon_fetch_failed(wpa_s
);
2986 #endif /* CONFIG_HS20 */
2987 anqp_result
= "INVALID_FRAME";
2992 * If possible, select the BSS entry based on which BSS entry was used
2993 * for the request. This can help in cases where multiple BSS entries
2994 * may exist for the same AP.
2996 dl_list_for_each_reverse(tmp
, &wpa_s
->bss
, struct wpa_bss
, list
) {
2997 if (tmp
== wpa_s
->interworking_gas_bss
&&
2998 os_memcmp(tmp
->bssid
, dst
, ETH_ALEN
) == 0) {
3004 bss
= wpa_bss_get_bssid(wpa_s
, dst
);
3006 pos
= wpabuf_head(resp
);
3007 end
= pos
+ wpabuf_len(resp
);
3010 unsigned int left
= end
- pos
;
3013 wpa_msg(wpa_s
, MSG_DEBUG
, "ANQP: Invalid element");
3014 anqp_result
= "INVALID_FRAME";
3015 goto out_parse_done
;
3017 info_id
= WPA_GET_LE16(pos
);
3019 slen
= WPA_GET_LE16(pos
);
3023 wpa_msg(wpa_s
, MSG_DEBUG
,
3024 "ANQP: Invalid element length for Info ID %u",
3026 anqp_result
= "INVALID_FRAME";
3027 goto out_parse_done
;
3029 interworking_parse_rx_anqp_resp(wpa_s
, bss
, dst
, info_id
, pos
,
3030 slen
, dialog_token
);
3036 hs20_notify_parse_done(wpa_s
);
3037 #endif /* CONFIG_HS20 */
3039 wpa_msg(wpa_s
, MSG_INFO
, ANQP_QUERY_DONE
"addr=" MACSTR
" result=%s",
3040 MAC2STR(dst
), anqp_result
);
3044 static void interworking_scan_res_handler(struct wpa_supplicant
*wpa_s
,
3045 struct wpa_scan_results
*scan_res
)
3047 wpa_msg(wpa_s
, MSG_DEBUG
,
3048 "Interworking: Scan results available - start ANQP fetch");
3049 interworking_start_fetch_anqp(wpa_s
);
3053 int interworking_select(struct wpa_supplicant
*wpa_s
, int auto_select
,
3056 interworking_stop_fetch_anqp(wpa_s
);
3057 wpa_s
->network_select
= 1;
3058 wpa_s
->auto_network_select
= 0;
3059 wpa_s
->auto_select
= !!auto_select
;
3060 wpa_s
->fetch_all_anqp
= 0;
3061 wpa_s
->fetch_osu_info
= 0;
3062 wpa_msg(wpa_s
, MSG_DEBUG
,
3063 "Interworking: Start scan for network selection");
3064 wpa_s
->scan_res_handler
= interworking_scan_res_handler
;
3065 wpa_s
->normal_scans
= 0;
3066 wpa_s
->scan_req
= MANUAL_SCAN_REQ
;
3067 os_free(wpa_s
->manual_scan_freqs
);
3068 wpa_s
->manual_scan_freqs
= freqs
;
3069 wpa_s
->after_wps
= 0;
3070 wpa_s
->known_wps_freq
= 0;
3071 wpa_supplicant_req_scan(wpa_s
, 0, 0);
3077 static void gas_resp_cb(void *ctx
, const u8
*addr
, u8 dialog_token
,
3078 enum gas_query_result result
,
3079 const struct wpabuf
*adv_proto
,
3080 const struct wpabuf
*resp
, u16 status_code
)
3082 struct wpa_supplicant
*wpa_s
= ctx
;
3085 wpa_msg(wpa_s
, MSG_INFO
, GAS_RESPONSE_INFO
"addr=" MACSTR
3086 " dialog_token=%d status_code=%d resp_len=%d",
3087 MAC2STR(addr
), dialog_token
, status_code
,
3088 resp
? (int) wpabuf_len(resp
) : -1);
3092 n
= wpabuf_dup(resp
);
3095 wpabuf_free(wpa_s
->prev_gas_resp
);
3096 wpa_s
->prev_gas_resp
= wpa_s
->last_gas_resp
;
3097 os_memcpy(wpa_s
->prev_gas_addr
, wpa_s
->last_gas_addr
, ETH_ALEN
);
3098 wpa_s
->prev_gas_dialog_token
= wpa_s
->last_gas_dialog_token
;
3099 wpa_s
->last_gas_resp
= n
;
3100 os_memcpy(wpa_s
->last_gas_addr
, addr
, ETH_ALEN
);
3101 wpa_s
->last_gas_dialog_token
= dialog_token
;
3105 int gas_send_request(struct wpa_supplicant
*wpa_s
, const u8
*dst
,
3106 const struct wpabuf
*adv_proto
,
3107 const struct wpabuf
*query
)
3112 struct wpa_bss
*bss
;
3115 u8 query_resp_len_limit
= 0;
3117 freq
= wpa_s
->assoc_freq
;
3118 bss
= wpa_bss_get_bssid(wpa_s
, dst
);
3124 wpa_msg(wpa_s
, MSG_DEBUG
, "GAS request to " MACSTR
" (freq %d MHz)",
3125 MAC2STR(dst
), freq
);
3126 wpa_hexdump_buf(MSG_DEBUG
, "Advertisement Protocol ID", adv_proto
);
3127 wpa_hexdump_buf(MSG_DEBUG
, "GAS Query", query
);
3129 len
= 3 + wpabuf_len(adv_proto
) + 2;
3131 len
+= wpabuf_len(query
);
3132 buf
= gas_build_initial_req(0, len
);
3136 /* Advertisement Protocol IE */
3137 wpabuf_put_u8(buf
, WLAN_EID_ADV_PROTO
);
3138 wpabuf_put_u8(buf
, 1 + wpabuf_len(adv_proto
)); /* Length */
3139 wpabuf_put_u8(buf
, query_resp_len_limit
& 0x7f);
3140 wpabuf_put_buf(buf
, adv_proto
);
3144 wpabuf_put_le16(buf
, wpabuf_len(query
));
3145 wpabuf_put_buf(buf
, query
);
3147 wpabuf_put_le16(buf
, 0);
3149 res
= gas_query_req(wpa_s
->gas
, dst
, freq
, buf
, gas_resp_cb
, wpa_s
);
3151 wpa_msg(wpa_s
, MSG_DEBUG
, "GAS: Failed to send Query Request");
3155 wpa_msg(wpa_s
, MSG_DEBUG
,
3156 "GAS: Query started with dialog token %u", res
);