]> git.ipfire.org Git - thirdparty/hostap.git/blobdiff - src/wps/wps_enrollee.c
WPS: Enable WSC 2.0 support unconditionally
[thirdparty/hostap.git] / src / wps / wps_enrollee.c
index 7b86ff7ac3bf9fa07faa090d471a1b6a491b1a51..d072582feb2a4bc76726b830b7e2353f8ac88882 100644 (file)
@@ -130,10 +130,8 @@ static struct wpabuf * wps_build_m1(struct wps_data *wps)
                 * workaround.
                 */
                config_methods &= ~WPS_CONFIG_PUSHBUTTON;
-#ifdef CONFIG_WPS2
                config_methods &= ~(WPS_CONFIG_VIRT_PUSHBUTTON |
                                    WPS_CONFIG_PHY_PUSHBUTTON);
-#endif /* CONFIG_WPS2 */
        }
 
        if (wps_build_version(msg) ||
@@ -243,54 +241,53 @@ static int wps_build_cred_ssid(struct wps_data *wps, struct wpabuf *msg)
 
 static int wps_build_cred_auth_type(struct wps_data *wps, struct wpabuf *msg)
 {
-       u16 auth_type = wps->wps->auth_types;
-
-       /* Select the best authentication type */
-       if (auth_type & WPS_AUTH_WPA2PSK)
-               auth_type = WPS_AUTH_WPA2PSK;
-       else if (auth_type & WPS_AUTH_WPAPSK)
-               auth_type = WPS_AUTH_WPAPSK;
-       else if (auth_type & WPS_AUTH_OPEN)
-               auth_type = WPS_AUTH_OPEN;
-       else if (auth_type & WPS_AUTH_SHARED)
-               auth_type = WPS_AUTH_SHARED;
-
-       wpa_printf(MSG_DEBUG, "WPS:  * Authentication Type (0x%x)", auth_type);
+       wpa_printf(MSG_DEBUG, "WPS:  * Authentication Type (0x%x)",
+                  wps->wps->ap_auth_type);
        wpabuf_put_be16(msg, ATTR_AUTH_TYPE);
        wpabuf_put_be16(msg, 2);
-       wpabuf_put_be16(msg, auth_type);
+       wpabuf_put_be16(msg, wps->wps->ap_auth_type);
        return 0;
 }
 
 
 static int wps_build_cred_encr_type(struct wps_data *wps, struct wpabuf *msg)
 {
-       u16 encr_type = wps->wps->encr_types;
-
-       /* Select the best encryption type */
-       if (wps->wps->auth_types & (WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK)) {
-               if (encr_type & WPS_ENCR_AES)
-                       encr_type = WPS_ENCR_AES;
-               else if (encr_type & WPS_ENCR_TKIP)
-                       encr_type = WPS_ENCR_TKIP;
-       } else {
-               if (encr_type & WPS_ENCR_WEP)
-                       encr_type = WPS_ENCR_WEP;
-               else if (encr_type & WPS_ENCR_NONE)
-                       encr_type = WPS_ENCR_NONE;
-       }
-
-       wpa_printf(MSG_DEBUG, "WPS:  * Encryption Type (0x%x)", encr_type);
+       wpa_printf(MSG_DEBUG, "WPS:  * Encryption Type (0x%x)",
+                  wps->wps->ap_encr_type);
        wpabuf_put_be16(msg, ATTR_ENCR_TYPE);
        wpabuf_put_be16(msg, 2);
-       wpabuf_put_be16(msg, encr_type);
+       wpabuf_put_be16(msg, wps->wps->ap_encr_type);
        return 0;
 }
 
 
 static int wps_build_cred_network_key(struct wps_data *wps, struct wpabuf *msg)
 {
-       wpa_printf(MSG_DEBUG, "WPS:  * Network Key");
+       if ((wps->wps->ap_auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) &&
+           wps->wps->network_key_len == 0) {
+               char hex[65];
+               u8 psk[32];
+               /* Generate a random per-device PSK */
+               if (random_get_bytes(psk, sizeof(psk)) < 0)
+                       return -1;
+               wpa_hexdump_key(MSG_DEBUG, "WPS: Generated per-device PSK",
+                               psk, sizeof(psk));
+               wpa_printf(MSG_DEBUG, "WPS:  * Network Key (len=%u)",
+                          (unsigned int) wps->new_psk_len * 2);
+               wpa_snprintf_hex(hex, sizeof(hex), psk, sizeof(psk));
+               wpabuf_put_be16(msg, ATTR_NETWORK_KEY);
+               wpabuf_put_be16(msg, sizeof(psk) * 2);
+               wpabuf_put_data(msg, hex, sizeof(psk) * 2);
+               if (wps->wps->registrar) {
+                       wps_cb_new_psk(wps->wps->registrar,
+                                      wps->peer_dev.mac_addr,
+                                      wps->p2p_dev_addr, psk, sizeof(psk));
+               }
+               return 0;
+       }
+
+       wpa_printf(MSG_DEBUG, "WPS:  * Network Key (len=%u)",
+                  (unsigned int) wps->wps->network_key_len);
        wpabuf_put_be16(msg, ATTR_NETWORK_KEY);
        wpabuf_put_be16(msg, wps->wps->network_key_len);
        wpabuf_put_data(msg, wps->wps->network_key, wps->wps->network_key_len);
@@ -310,6 +307,9 @@ static int wps_build_cred_mac_addr(struct wps_data *wps, struct wpabuf *msg)
 
 static int wps_build_ap_settings(struct wps_data *wps, struct wpabuf *plain)
 {
+       const u8 *start, *end;
+       int ret;
+
        if (wps->wps->ap_settings) {
                wpa_printf(MSG_DEBUG, "WPS:  * AP Settings (pre-configured)");
                wpabuf_put_data(plain, wps->wps->ap_settings,
@@ -317,11 +317,19 @@ static int wps_build_ap_settings(struct wps_data *wps, struct wpabuf *plain)
                return 0;
        }
 
-       return wps_build_cred_ssid(wps, plain) ||
+       wpa_printf(MSG_DEBUG, "WPS:  * AP Settings based on current configuration");
+       start = wpabuf_put(plain, 0);
+       ret = wps_build_cred_ssid(wps, plain) ||
                wps_build_cred_mac_addr(wps, plain) ||
                wps_build_cred_auth_type(wps, plain) ||
                wps_build_cred_encr_type(wps, plain) ||
                wps_build_cred_network_key(wps, plain);
+       end = wpabuf_put(plain, 0);
+
+       wpa_hexdump_key(MSG_DEBUG, "WPS: Plaintext AP Settings",
+                       start, end - start);
+
+       return ret;
 }
 
 
@@ -514,6 +522,24 @@ static int wps_process_pubkey(struct wps_data *wps, const u8 *pk,
                return -1;
        }
 
+       if (wps->peer_pubkey_hash_set) {
+               u8 hash[WPS_HASH_LEN];
+               sha256_vector(1, &pk, &pk_len, hash);
+               if (os_memcmp(hash, wps->peer_pubkey_hash,
+                             WPS_OOB_PUBKEY_HASH_LEN) != 0) {
+                       wpa_printf(MSG_ERROR, "WPS: Public Key hash mismatch");
+                       wpa_hexdump(MSG_DEBUG, "WPS: Received public key",
+                                   pk, pk_len);
+                       wpa_hexdump(MSG_DEBUG, "WPS: Calculated public key "
+                                   "hash", hash, WPS_OOB_PUBKEY_HASH_LEN);
+                       wpa_hexdump(MSG_DEBUG, "WPS: Expected public key hash",
+                                   wps->peer_pubkey_hash,
+                                   WPS_OOB_PUBKEY_HASH_LEN);
+                       wps->config_error = WPS_CFG_PUBLIC_KEY_HASH_MISMATCH;
+                       return -1;
+               }
+       }
+
        wpabuf_free(wps->dh_pubkey_r);
        wps->dh_pubkey_r = wpabuf_alloc_copy(pk, pk_len);
        if (wps->dh_pubkey_r == NULL)
@@ -670,7 +696,6 @@ static int wps_process_cred_e(struct wps_data *wps, const u8 *cred,
 #endif /* CONFIG_WPS_STRICT */
        }
 
-#ifdef CONFIG_WPS2
        if (!(wps->cred.encr_type &
              (WPS_ENCR_NONE | WPS_ENCR_TKIP | WPS_ENCR_AES))) {
                if (wps->cred.encr_type & WPS_ENCR_WEP) {
@@ -684,7 +709,6 @@ static int wps_process_cred_e(struct wps_data *wps, const u8 *cred,
                           "invalid encr_type 0x%x", wps->cred.encr_type);
                return -1;
        }
-#endif /* CONFIG_WPS2 */
 
        if (wps->wps->cred_cb) {
                wps->cred.cred_attr = cred - 4;
@@ -771,7 +795,6 @@ static int wps_process_ap_settings_e(struct wps_data *wps,
 #endif /* CONFIG_WPS_STRICT */
        }
 
-#ifdef CONFIG_WPS2
        if (!(cred.encr_type & (WPS_ENCR_NONE | WPS_ENCR_TKIP | WPS_ENCR_AES)))
        {
                if (cred.encr_type & WPS_ENCR_WEP) {
@@ -785,7 +808,6 @@ static int wps_process_ap_settings_e(struct wps_data *wps,
                           "invalid encr_type 0x%x", cred.encr_type);
                return -1;
        }
-#endif /* CONFIG_WPS2 */
 
 #ifdef CONFIG_WPS_STRICT
        if (wps2) {
@@ -802,7 +824,6 @@ static int wps_process_ap_settings_e(struct wps_data *wps,
        }
 #endif /* CONFIG_WPS_STRICT */
 
-#ifdef CONFIG_WPS2
        if ((cred.encr_type & (WPS_ENCR_TKIP | WPS_ENCR_AES)) == WPS_ENCR_TKIP)
        {
                wpa_printf(MSG_DEBUG, "WPS: Upgrade encr_type TKIP -> "
@@ -816,7 +837,6 @@ static int wps_process_ap_settings_e(struct wps_data *wps,
                           "WPAPSK+WPA2PSK");
                cred.auth_type |= WPS_AUTH_WPA2PSK;
        }
-#endif /* CONFIG_WPS2 */
 
        if (wps->wps->cred_cb) {
                cred.cred_attr = wpabuf_head(attrs);
@@ -929,6 +949,38 @@ static enum wps_process_res wps_process_m2(struct wps_data *wps,
                return WPS_CONTINUE;
        }
 
+#ifdef CONFIG_WPS_NFC
+       if (wps->peer_pubkey_hash_set) {
+               struct wpabuf *decrypted;
+               struct wps_parse_attr eattr;
+
+               decrypted = wps_decrypt_encr_settings(wps, attr->encr_settings,
+                                                     attr->encr_settings_len);
+               if (decrypted == NULL) {
+                       wpa_printf(MSG_DEBUG, "WPS: Failed to decrypt "
+                                  "Encrypted Settings attribute");
+                       wps->state = SEND_WSC_NACK;
+                       return WPS_CONTINUE;
+               }
+
+               wpa_printf(MSG_DEBUG, "WPS: Processing decrypted Encrypted "
+                          "Settings attribute");
+               if (wps_parse_msg(decrypted, &eattr) < 0 ||
+                   wps_process_key_wrap_auth(wps, decrypted,
+                                             eattr.key_wrap_auth) ||
+                   wps_process_creds(wps, eattr.cred, eattr.cred_len,
+                                     eattr.num_cred, attr->version2 != NULL)) {
+                       wpabuf_free(decrypted);
+                       wps->state = SEND_WSC_NACK;
+                       return WPS_CONTINUE;
+               }
+               wpabuf_free(decrypted);
+
+               wps->state = WPS_MSG_DONE;
+               return WPS_CONTINUE;
+       }
+#endif /* CONFIG_WPS_NFC */
+
        wps->state = SEND_M3;
        return WPS_CONTINUE;
 }