Disconnect hostapd from building in base
[dragonfly.git] / contrib / hostapd / src / wps / wps_enrollee.c
CommitLineData
a875087d
JL
1/*
2 * Wi-Fi Protected Setup - Enrollee
3 * Copyright (c) 2008, Jouni Malinen <j@w1.fi>
4 *
4781064b
JM
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
a875087d
JL
7 */
8
9#include "includes.h"
10
11#include "common.h"
4781064b
JM
12#include "crypto/crypto.h"
13#include "crypto/sha256.h"
14#include "crypto/random.h"
a875087d
JL
15#include "wps_i.h"
16#include "wps_dev_attr.h"
17
18
a875087d
JL
19static int wps_build_wps_state(struct wps_data *wps, struct wpabuf *msg)
20{
21 u8 state;
22 if (wps->wps->ap)
23 state = wps->wps->wps_state;
24 else
25 state = WPS_STATE_NOT_CONFIGURED;
26 wpa_printf(MSG_DEBUG, "WPS: * Wi-Fi Protected Setup State (%d)",
27 state);
28 wpabuf_put_be16(msg, ATTR_WPS_STATE);
29 wpabuf_put_be16(msg, 1);
30 wpabuf_put_u8(msg, state);
31 return 0;
32}
33
34
35static int wps_build_e_hash(struct wps_data *wps, struct wpabuf *msg)
36{
37 u8 *hash;
38 const u8 *addr[4];
39 size_t len[4];
40
4781064b 41 if (random_get_bytes(wps->snonce, 2 * WPS_SECRET_NONCE_LEN) < 0)
a875087d
JL
42 return -1;
43 wpa_hexdump(MSG_DEBUG, "WPS: E-S1", wps->snonce, WPS_SECRET_NONCE_LEN);
44 wpa_hexdump(MSG_DEBUG, "WPS: E-S2",
45 wps->snonce + WPS_SECRET_NONCE_LEN, WPS_SECRET_NONCE_LEN);
46
47 if (wps->dh_pubkey_e == NULL || wps->dh_pubkey_r == NULL) {
48 wpa_printf(MSG_DEBUG, "WPS: DH public keys not available for "
49 "E-Hash derivation");
50 return -1;
51 }
52
53 wpa_printf(MSG_DEBUG, "WPS: * E-Hash1");
54 wpabuf_put_be16(msg, ATTR_E_HASH1);
55 wpabuf_put_be16(msg, SHA256_MAC_LEN);
56 hash = wpabuf_put(msg, SHA256_MAC_LEN);
57 /* E-Hash1 = HMAC_AuthKey(E-S1 || PSK1 || PK_E || PK_R) */
58 addr[0] = wps->snonce;
59 len[0] = WPS_SECRET_NONCE_LEN;
60 addr[1] = wps->psk1;
61 len[1] = WPS_PSK_LEN;
62 addr[2] = wpabuf_head(wps->dh_pubkey_e);
63 len[2] = wpabuf_len(wps->dh_pubkey_e);
64 addr[3] = wpabuf_head(wps->dh_pubkey_r);
65 len[3] = wpabuf_len(wps->dh_pubkey_r);
66 hmac_sha256_vector(wps->authkey, WPS_AUTHKEY_LEN, 4, addr, len, hash);
67 wpa_hexdump(MSG_DEBUG, "WPS: E-Hash1", hash, SHA256_MAC_LEN);
68
69 wpa_printf(MSG_DEBUG, "WPS: * E-Hash2");
70 wpabuf_put_be16(msg, ATTR_E_HASH2);
71 wpabuf_put_be16(msg, SHA256_MAC_LEN);
72 hash = wpabuf_put(msg, SHA256_MAC_LEN);
73 /* E-Hash2 = HMAC_AuthKey(E-S2 || PSK2 || PK_E || PK_R) */
74 addr[0] = wps->snonce + WPS_SECRET_NONCE_LEN;
75 addr[1] = wps->psk2;
76 hmac_sha256_vector(wps->authkey, WPS_AUTHKEY_LEN, 4, addr, len, hash);
77 wpa_hexdump(MSG_DEBUG, "WPS: E-Hash2", hash, SHA256_MAC_LEN);
78
79 return 0;
80}
81
82
83static int wps_build_e_snonce1(struct wps_data *wps, struct wpabuf *msg)
84{
85 wpa_printf(MSG_DEBUG, "WPS: * E-SNonce1");
86 wpabuf_put_be16(msg, ATTR_E_SNONCE1);
87 wpabuf_put_be16(msg, WPS_SECRET_NONCE_LEN);
88 wpabuf_put_data(msg, wps->snonce, WPS_SECRET_NONCE_LEN);
89 return 0;
90}
91
92
93static int wps_build_e_snonce2(struct wps_data *wps, struct wpabuf *msg)
94{
95 wpa_printf(MSG_DEBUG, "WPS: * E-SNonce2");
96 wpabuf_put_be16(msg, ATTR_E_SNONCE2);
97 wpabuf_put_be16(msg, WPS_SECRET_NONCE_LEN);
98 wpabuf_put_data(msg, wps->snonce + WPS_SECRET_NONCE_LEN,
99 WPS_SECRET_NONCE_LEN);
100 return 0;
101}
102
103
104static struct wpabuf * wps_build_m1(struct wps_data *wps)
105{
106 struct wpabuf *msg;
4781064b 107 u16 config_methods;
a875087d 108
4781064b 109 if (random_get_bytes(wps->nonce_e, WPS_NONCE_LEN) < 0)
a875087d
JL
110 return NULL;
111 wpa_hexdump(MSG_DEBUG, "WPS: Enrollee Nonce",
112 wps->nonce_e, WPS_NONCE_LEN);
113
114 wpa_printf(MSG_DEBUG, "WPS: Building Message M1");
115 msg = wpabuf_alloc(1000);
116 if (msg == NULL)
117 return NULL;
118
4781064b
JM
119 config_methods = wps->wps->config_methods;
120 if (wps->wps->ap && !wps->pbc_in_m1 &&
121 (wps->dev_password_len != 0 ||
122 (config_methods & WPS_CONFIG_DISPLAY))) {
123 /*
124 * These are the methods that the AP supports as an Enrollee
125 * for adding external Registrars, so remove PushButton.
126 *
127 * As a workaround for Windows 7 mechanism for probing WPS
128 * capabilities from M1, leave PushButton option if no PIN
129 * method is available or if WPS configuration enables PBC
130 * workaround.
131 */
132 config_methods &= ~WPS_CONFIG_PUSHBUTTON;
133#ifdef CONFIG_WPS2
134 config_methods &= ~(WPS_CONFIG_VIRT_PUSHBUTTON |
135 WPS_CONFIG_PHY_PUSHBUTTON);
136#endif /* CONFIG_WPS2 */
137 }
a875087d
JL
138
139 if (wps_build_version(msg) ||
140 wps_build_msg_type(msg, WPS_M1) ||
141 wps_build_uuid_e(msg, wps->uuid_e) ||
4781064b 142 wps_build_mac_addr(msg, wps->mac_addr_e) ||
a875087d
JL
143 wps_build_enrollee_nonce(wps, msg) ||
144 wps_build_public_key(wps, msg) ||
145 wps_build_auth_type_flags(wps, msg) ||
146 wps_build_encr_type_flags(wps, msg) ||
147 wps_build_conn_type_flags(wps, msg) ||
4781064b 148 wps_build_config_methods(msg, config_methods) ||
a875087d
JL
149 wps_build_wps_state(wps, msg) ||
150 wps_build_device_attrs(&wps->wps->dev, msg) ||
4781064b
JM
151 wps_build_rf_bands(&wps->wps->dev, msg,
152 wps->wps->rf_band_cb(wps->wps->cb_ctx)) ||
a875087d
JL
153 wps_build_assoc_state(wps, msg) ||
154 wps_build_dev_password_id(msg, wps->dev_pw_id) ||
155 wps_build_config_error(msg, WPS_CFG_NO_ERROR) ||
4781064b
JM
156 wps_build_os_version(&wps->wps->dev, msg) ||
157 wps_build_wfa_ext(msg, 0, NULL, 0) ||
158 wps_build_vendor_ext_m1(&wps->wps->dev, msg)) {
a875087d
JL
159 wpabuf_free(msg);
160 return NULL;
161 }
162
163 wps->state = RECV_M2;
164 return msg;
165}
166
167
168static struct wpabuf * wps_build_m3(struct wps_data *wps)
169{
170 struct wpabuf *msg;
171
172 wpa_printf(MSG_DEBUG, "WPS: Building Message M3");
173
174 if (wps->dev_password == NULL) {
175 wpa_printf(MSG_DEBUG, "WPS: No Device Password available");
176 return NULL;
177 }
178 wps_derive_psk(wps, wps->dev_password, wps->dev_password_len);
179
180 msg = wpabuf_alloc(1000);
181 if (msg == NULL)
182 return NULL;
183
184 if (wps_build_version(msg) ||
185 wps_build_msg_type(msg, WPS_M3) ||
186 wps_build_registrar_nonce(wps, msg) ||
187 wps_build_e_hash(wps, msg) ||
4781064b 188 wps_build_wfa_ext(msg, 0, NULL, 0) ||
a875087d
JL
189 wps_build_authenticator(wps, msg)) {
190 wpabuf_free(msg);
191 return NULL;
192 }
193
194 wps->state = RECV_M4;
195 return msg;
196}
197
198
199static struct wpabuf * wps_build_m5(struct wps_data *wps)
200{
201 struct wpabuf *msg, *plain;
202
203 wpa_printf(MSG_DEBUG, "WPS: Building Message M5");
204
205 plain = wpabuf_alloc(200);
206 if (plain == NULL)
207 return NULL;
208
209 msg = wpabuf_alloc(1000);
210 if (msg == NULL) {
211 wpabuf_free(plain);
212 return NULL;
213 }
214
215 if (wps_build_version(msg) ||
216 wps_build_msg_type(msg, WPS_M5) ||
217 wps_build_registrar_nonce(wps, msg) ||
218 wps_build_e_snonce1(wps, plain) ||
219 wps_build_key_wrap_auth(wps, plain) ||
220 wps_build_encr_settings(wps, msg, plain) ||
4781064b 221 wps_build_wfa_ext(msg, 0, NULL, 0) ||
a875087d
JL
222 wps_build_authenticator(wps, msg)) {
223 wpabuf_free(plain);
224 wpabuf_free(msg);
225 return NULL;
226 }
227 wpabuf_free(plain);
228
229 wps->state = RECV_M6;
230 return msg;
231}
232
233
234static int wps_build_cred_ssid(struct wps_data *wps, struct wpabuf *msg)
235{
236 wpa_printf(MSG_DEBUG, "WPS: * SSID");
237 wpabuf_put_be16(msg, ATTR_SSID);
238 wpabuf_put_be16(msg, wps->wps->ssid_len);
239 wpabuf_put_data(msg, wps->wps->ssid, wps->wps->ssid_len);
240 return 0;
241}
242
243
244static int wps_build_cred_auth_type(struct wps_data *wps, struct wpabuf *msg)
245{
4781064b
JM
246 u16 auth_type = wps->wps->auth_types;
247
248 /* Select the best authentication type */
249 if (auth_type & WPS_AUTH_WPA2PSK)
250 auth_type = WPS_AUTH_WPA2PSK;
251 else if (auth_type & WPS_AUTH_WPAPSK)
252 auth_type = WPS_AUTH_WPAPSK;
253 else if (auth_type & WPS_AUTH_OPEN)
254 auth_type = WPS_AUTH_OPEN;
255 else if (auth_type & WPS_AUTH_SHARED)
256 auth_type = WPS_AUTH_SHARED;
257
258 wpa_printf(MSG_DEBUG, "WPS: * Authentication Type (0x%x)", auth_type);
a875087d
JL
259 wpabuf_put_be16(msg, ATTR_AUTH_TYPE);
260 wpabuf_put_be16(msg, 2);
4781064b 261 wpabuf_put_be16(msg, auth_type);
a875087d
JL
262 return 0;
263}
264
265
266static int wps_build_cred_encr_type(struct wps_data *wps, struct wpabuf *msg)
267{
4781064b
JM
268 u16 encr_type = wps->wps->encr_types;
269
270 /* Select the best encryption type */
271 if (wps->wps->auth_types & (WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK)) {
272 if (encr_type & WPS_ENCR_AES)
273 encr_type = WPS_ENCR_AES;
274 else if (encr_type & WPS_ENCR_TKIP)
275 encr_type = WPS_ENCR_TKIP;
276 } else {
277 if (encr_type & WPS_ENCR_WEP)
278 encr_type = WPS_ENCR_WEP;
279 else if (encr_type & WPS_ENCR_NONE)
280 encr_type = WPS_ENCR_NONE;
281 }
282
283 wpa_printf(MSG_DEBUG, "WPS: * Encryption Type (0x%x)", encr_type);
a875087d
JL
284 wpabuf_put_be16(msg, ATTR_ENCR_TYPE);
285 wpabuf_put_be16(msg, 2);
4781064b 286 wpabuf_put_be16(msg, encr_type);
a875087d
JL
287 return 0;
288}
289
290
291static int wps_build_cred_network_key(struct wps_data *wps, struct wpabuf *msg)
292{
293 wpa_printf(MSG_DEBUG, "WPS: * Network Key");
294 wpabuf_put_be16(msg, ATTR_NETWORK_KEY);
295 wpabuf_put_be16(msg, wps->wps->network_key_len);
296 wpabuf_put_data(msg, wps->wps->network_key, wps->wps->network_key_len);
297 return 0;
298}
299
300
301static int wps_build_cred_mac_addr(struct wps_data *wps, struct wpabuf *msg)
302{
303 wpa_printf(MSG_DEBUG, "WPS: * MAC Address (AP BSSID)");
304 wpabuf_put_be16(msg, ATTR_MAC_ADDR);
305 wpabuf_put_be16(msg, ETH_ALEN);
306 wpabuf_put_data(msg, wps->wps->dev.mac_addr, ETH_ALEN);
307 return 0;
308}
309
310
311static int wps_build_ap_settings(struct wps_data *wps, struct wpabuf *plain)
312{
313 if (wps->wps->ap_settings) {
314 wpa_printf(MSG_DEBUG, "WPS: * AP Settings (pre-configured)");
315 wpabuf_put_data(plain, wps->wps->ap_settings,
316 wps->wps->ap_settings_len);
317 return 0;
318 }
319
320 return wps_build_cred_ssid(wps, plain) ||
321 wps_build_cred_mac_addr(wps, plain) ||
322 wps_build_cred_auth_type(wps, plain) ||
323 wps_build_cred_encr_type(wps, plain) ||
324 wps_build_cred_network_key(wps, plain);
325}
326
327
328static struct wpabuf * wps_build_m7(struct wps_data *wps)
329{
330 struct wpabuf *msg, *plain;
331
332 wpa_printf(MSG_DEBUG, "WPS: Building Message M7");
333
334 plain = wpabuf_alloc(500 + wps->wps->ap_settings_len);
335 if (plain == NULL)
336 return NULL;
337
338 msg = wpabuf_alloc(1000 + wps->wps->ap_settings_len);
339 if (msg == NULL) {
340 wpabuf_free(plain);
341 return NULL;
342 }
343
344 if (wps_build_version(msg) ||
345 wps_build_msg_type(msg, WPS_M7) ||
346 wps_build_registrar_nonce(wps, msg) ||
347 wps_build_e_snonce2(wps, plain) ||
348 (wps->wps->ap && wps_build_ap_settings(wps, plain)) ||
349 wps_build_key_wrap_auth(wps, plain) ||
350 wps_build_encr_settings(wps, msg, plain) ||
4781064b 351 wps_build_wfa_ext(msg, 0, NULL, 0) ||
a875087d
JL
352 wps_build_authenticator(wps, msg)) {
353 wpabuf_free(plain);
354 wpabuf_free(msg);
355 return NULL;
356 }
357 wpabuf_free(plain);
358
4781064b
JM
359 if (wps->wps->ap && wps->wps->registrar) {
360 /*
361 * If the Registrar is only learning our current configuration,
362 * it may not continue protocol run to successful completion.
363 * Store information here to make sure it remains available.
364 */
365 wps_device_store(wps->wps->registrar, &wps->peer_dev,
366 wps->uuid_r);
367 }
368
a875087d
JL
369 wps->state = RECV_M8;
370 return msg;
371}
372
373
374static struct wpabuf * wps_build_wsc_done(struct wps_data *wps)
375{
376 struct wpabuf *msg;
377
378 wpa_printf(MSG_DEBUG, "WPS: Building Message WSC_Done");
379
380 msg = wpabuf_alloc(1000);
381 if (msg == NULL)
382 return NULL;
383
384 if (wps_build_version(msg) ||
385 wps_build_msg_type(msg, WPS_WSC_DONE) ||
386 wps_build_enrollee_nonce(wps, msg) ||
4781064b
JM
387 wps_build_registrar_nonce(wps, msg) ||
388 wps_build_wfa_ext(msg, 0, NULL, 0)) {
a875087d
JL
389 wpabuf_free(msg);
390 return NULL;
391 }
392
393 if (wps->wps->ap)
394 wps->state = RECV_ACK;
395 else {
4781064b 396 wps_success_event(wps->wps, wps->peer_dev.mac_addr);
a875087d
JL
397 wps->state = WPS_FINISHED;
398 }
399 return msg;
400}
401
402
a875087d
JL
403struct wpabuf * wps_enrollee_get_msg(struct wps_data *wps,
404 enum wsc_op_code *op_code)
405{
406 struct wpabuf *msg;
407
408 switch (wps->state) {
409 case SEND_M1:
410 msg = wps_build_m1(wps);
411 *op_code = WSC_MSG;
412 break;
413 case SEND_M3:
414 msg = wps_build_m3(wps);
415 *op_code = WSC_MSG;
416 break;
417 case SEND_M5:
418 msg = wps_build_m5(wps);
419 *op_code = WSC_MSG;
420 break;
421 case SEND_M7:
422 msg = wps_build_m7(wps);
423 *op_code = WSC_MSG;
424 break;
425 case RECEIVED_M2D:
426 if (wps->wps->ap) {
427 msg = wps_build_wsc_nack(wps);
428 *op_code = WSC_NACK;
429 break;
430 }
431 msg = wps_build_wsc_ack(wps);
432 *op_code = WSC_ACK;
433 if (msg) {
434 /* Another M2/M2D may be received */
435 wps->state = RECV_M2;
436 }
437 break;
438 case SEND_WSC_NACK:
439 msg = wps_build_wsc_nack(wps);
440 *op_code = WSC_NACK;
441 break;
442 case WPS_MSG_DONE:
443 msg = wps_build_wsc_done(wps);
444 *op_code = WSC_Done;
445 break;
446 default:
447 wpa_printf(MSG_DEBUG, "WPS: Unsupported state %d for building "
448 "a message", wps->state);
449 msg = NULL;
450 break;
451 }
452
453 if (*op_code == WSC_MSG && msg) {
454 /* Save a copy of the last message for Authenticator derivation
455 */
456 wpabuf_free(wps->last_msg);
457 wps->last_msg = wpabuf_dup(msg);
458 }
459
460 return msg;
461}
462
463
464static int wps_process_registrar_nonce(struct wps_data *wps, const u8 *r_nonce)
465{
466 if (r_nonce == NULL) {
467 wpa_printf(MSG_DEBUG, "WPS: No Registrar Nonce received");
468 return -1;
469 }
470
471 os_memcpy(wps->nonce_r, r_nonce, WPS_NONCE_LEN);
472 wpa_hexdump(MSG_DEBUG, "WPS: Registrar Nonce",
473 wps->nonce_r, WPS_NONCE_LEN);
474
475 return 0;
476}
477
478
479static int wps_process_enrollee_nonce(struct wps_data *wps, const u8 *e_nonce)
480{
481 if (e_nonce == NULL) {
482 wpa_printf(MSG_DEBUG, "WPS: No Enrollee Nonce received");
483 return -1;
484 }
485
486 if (os_memcmp(wps->nonce_e, e_nonce, WPS_NONCE_LEN) != 0) {
487 wpa_printf(MSG_DEBUG, "WPS: Invalid Enrollee Nonce received");
488 return -1;
489 }
490
491 return 0;
492}
493
494
495static int wps_process_uuid_r(struct wps_data *wps, const u8 *uuid_r)
496{
497 if (uuid_r == NULL) {
498 wpa_printf(MSG_DEBUG, "WPS: No UUID-R received");
499 return -1;
500 }
501
502 os_memcpy(wps->uuid_r, uuid_r, WPS_UUID_LEN);
503 wpa_hexdump(MSG_DEBUG, "WPS: UUID-R", wps->uuid_r, WPS_UUID_LEN);
504
505 return 0;
506}
507
508
509static int wps_process_pubkey(struct wps_data *wps, const u8 *pk,
510 size_t pk_len)
511{
512 if (pk == NULL || pk_len == 0) {
513 wpa_printf(MSG_DEBUG, "WPS: No Public Key received");
514 return -1;
515 }
516
4781064b
JM
517 if (wps->peer_pubkey_hash_set) {
518 u8 hash[WPS_HASH_LEN];
519 sha256_vector(1, &pk, &pk_len, hash);
520 if (os_memcmp(hash, wps->peer_pubkey_hash,
521 WPS_OOB_PUBKEY_HASH_LEN) != 0) {
522 wpa_printf(MSG_ERROR, "WPS: Public Key hash mismatch");
523 wpa_hexdump(MSG_DEBUG, "WPS: Received public key",
524 pk, pk_len);
525 wpa_hexdump(MSG_DEBUG, "WPS: Calculated public key "
526 "hash", hash, WPS_OOB_PUBKEY_HASH_LEN);
527 wpa_hexdump(MSG_DEBUG, "WPS: Expected public key hash",
528 wps->peer_pubkey_hash,
529 WPS_OOB_PUBKEY_HASH_LEN);
530 wps->config_error = WPS_CFG_PUBLIC_KEY_HASH_MISMATCH;
531 return -1;
532 }
533 }
534
a875087d
JL
535 wpabuf_free(wps->dh_pubkey_r);
536 wps->dh_pubkey_r = wpabuf_alloc_copy(pk, pk_len);
537 if (wps->dh_pubkey_r == NULL)
538 return -1;
539
540 if (wps_derive_keys(wps) < 0)
541 return -1;
542
543 return 0;
544}
545
546
547static int wps_process_r_hash1(struct wps_data *wps, const u8 *r_hash1)
548{
549 if (r_hash1 == NULL) {
550 wpa_printf(MSG_DEBUG, "WPS: No R-Hash1 received");
551 return -1;
552 }
553
554 os_memcpy(wps->peer_hash1, r_hash1, WPS_HASH_LEN);
555 wpa_hexdump(MSG_DEBUG, "WPS: R-Hash1", wps->peer_hash1, WPS_HASH_LEN);
556
557 return 0;
558}
559
560
561static int wps_process_r_hash2(struct wps_data *wps, const u8 *r_hash2)
562{
563 if (r_hash2 == NULL) {
564 wpa_printf(MSG_DEBUG, "WPS: No R-Hash2 received");
565 return -1;
566 }
567
568 os_memcpy(wps->peer_hash2, r_hash2, WPS_HASH_LEN);
569 wpa_hexdump(MSG_DEBUG, "WPS: R-Hash2", wps->peer_hash2, WPS_HASH_LEN);
570
571 return 0;
572}
573
574
575static int wps_process_r_snonce1(struct wps_data *wps, const u8 *r_snonce1)
576{
577 u8 hash[SHA256_MAC_LEN];
578 const u8 *addr[4];
579 size_t len[4];
580
581 if (r_snonce1 == NULL) {
582 wpa_printf(MSG_DEBUG, "WPS: No R-SNonce1 received");
583 return -1;
584 }
585
586 wpa_hexdump_key(MSG_DEBUG, "WPS: R-SNonce1", r_snonce1,
587 WPS_SECRET_NONCE_LEN);
588
589 /* R-Hash1 = HMAC_AuthKey(R-S1 || PSK1 || PK_E || PK_R) */
590 addr[0] = r_snonce1;
591 len[0] = WPS_SECRET_NONCE_LEN;
592 addr[1] = wps->psk1;
593 len[1] = WPS_PSK_LEN;
594 addr[2] = wpabuf_head(wps->dh_pubkey_e);
595 len[2] = wpabuf_len(wps->dh_pubkey_e);
596 addr[3] = wpabuf_head(wps->dh_pubkey_r);
597 len[3] = wpabuf_len(wps->dh_pubkey_r);
598 hmac_sha256_vector(wps->authkey, WPS_AUTHKEY_LEN, 4, addr, len, hash);
599
600 if (os_memcmp(wps->peer_hash1, hash, WPS_HASH_LEN) != 0) {
601 wpa_printf(MSG_DEBUG, "WPS: R-Hash1 derived from R-S1 does "
602 "not match with the pre-committed value");
603 wps->config_error = WPS_CFG_DEV_PASSWORD_AUTH_FAILURE;
4781064b 604 wps_pwd_auth_fail_event(wps->wps, 1, 1, wps->peer_dev.mac_addr);
a875087d
JL
605 return -1;
606 }
607
608 wpa_printf(MSG_DEBUG, "WPS: Registrar proved knowledge of the first "
609 "half of the device password");
610
611 return 0;
612}
613
614
615static int wps_process_r_snonce2(struct wps_data *wps, const u8 *r_snonce2)
616{
617 u8 hash[SHA256_MAC_LEN];
618 const u8 *addr[4];
619 size_t len[4];
620
621 if (r_snonce2 == NULL) {
622 wpa_printf(MSG_DEBUG, "WPS: No R-SNonce2 received");
623 return -1;
624 }
625
626 wpa_hexdump_key(MSG_DEBUG, "WPS: R-SNonce2", r_snonce2,
627 WPS_SECRET_NONCE_LEN);
628
629 /* R-Hash2 = HMAC_AuthKey(R-S2 || PSK2 || PK_E || PK_R) */
630 addr[0] = r_snonce2;
631 len[0] = WPS_SECRET_NONCE_LEN;
632 addr[1] = wps->psk2;
633 len[1] = WPS_PSK_LEN;
634 addr[2] = wpabuf_head(wps->dh_pubkey_e);
635 len[2] = wpabuf_len(wps->dh_pubkey_e);
636 addr[3] = wpabuf_head(wps->dh_pubkey_r);
637 len[3] = wpabuf_len(wps->dh_pubkey_r);
638 hmac_sha256_vector(wps->authkey, WPS_AUTHKEY_LEN, 4, addr, len, hash);
639
640 if (os_memcmp(wps->peer_hash2, hash, WPS_HASH_LEN) != 0) {
641 wpa_printf(MSG_DEBUG, "WPS: R-Hash2 derived from R-S2 does "
642 "not match with the pre-committed value");
643 wps->config_error = WPS_CFG_DEV_PASSWORD_AUTH_FAILURE;
4781064b 644 wps_pwd_auth_fail_event(wps->wps, 1, 2, wps->peer_dev.mac_addr);
a875087d
JL
645 return -1;
646 }
647
648 wpa_printf(MSG_DEBUG, "WPS: Registrar proved knowledge of the second "
649 "half of the device password");
650
651 return 0;
652}
653
654
655static int wps_process_cred_e(struct wps_data *wps, const u8 *cred,
4781064b 656 size_t cred_len, int wps2)
a875087d
JL
657{
658 struct wps_parse_attr attr;
659 struct wpabuf msg;
4781064b 660 int ret = 0;
a875087d
JL
661
662 wpa_printf(MSG_DEBUG, "WPS: Received Credential");
663 os_memset(&wps->cred, 0, sizeof(wps->cred));
664 wpabuf_set(&msg, cred, cred_len);
665 if (wps_parse_msg(&msg, &attr) < 0 ||
666 wps_process_cred(&attr, &wps->cred))
667 return -1;
668
669 if (os_memcmp(wps->cred.mac_addr, wps->wps->dev.mac_addr, ETH_ALEN) !=
670 0) {
671 wpa_printf(MSG_DEBUG, "WPS: MAC Address in the Credential ("
672 MACSTR ") does not match with own address (" MACSTR
673 ")", MAC2STR(wps->cred.mac_addr),
674 MAC2STR(wps->wps->dev.mac_addr));
675 /*
676 * In theory, this could be consider fatal error, but there are
677 * number of deployed implementations using other address here
678 * due to unclarity in the specification. For interoperability
679 * reasons, allow this to be processed since we do not really
680 * use the MAC Address information for anything.
681 */
4781064b
JM
682#ifdef CONFIG_WPS_STRICT
683 if (wps2) {
684 wpa_printf(MSG_INFO, "WPS: Do not accept incorrect "
685 "MAC Address in AP Settings");
686 return -1;
687 }
688#endif /* CONFIG_WPS_STRICT */
689 }
690
691#ifdef CONFIG_WPS2
692 if (!(wps->cred.encr_type &
693 (WPS_ENCR_NONE | WPS_ENCR_TKIP | WPS_ENCR_AES))) {
694 if (wps->cred.encr_type & WPS_ENCR_WEP) {
695 wpa_printf(MSG_INFO, "WPS: Reject Credential "
696 "due to WEP configuration");
697 wps->error_indication = WPS_EI_SECURITY_WEP_PROHIBITED;
698 return -2;
699 }
700
701 wpa_printf(MSG_INFO, "WPS: Reject Credential due to "
702 "invalid encr_type 0x%x", wps->cred.encr_type);
703 return -1;
a875087d 704 }
4781064b 705#endif /* CONFIG_WPS2 */
a875087d
JL
706
707 if (wps->wps->cred_cb) {
708 wps->cred.cred_attr = cred - 4;
709 wps->cred.cred_attr_len = cred_len + 4;
4781064b 710 ret = wps->wps->cred_cb(wps->wps->cb_ctx, &wps->cred);
a875087d
JL
711 wps->cred.cred_attr = NULL;
712 wps->cred.cred_attr_len = 0;
713 }
714
4781064b 715 return ret;
a875087d
JL
716}
717
718
719static int wps_process_creds(struct wps_data *wps, const u8 *cred[],
4781064b 720 size_t cred_len[], size_t num_cred, int wps2)
a875087d
JL
721{
722 size_t i;
4781064b 723 int ok = 0;
a875087d
JL
724
725 if (wps->wps->ap)
726 return 0;
727
728 if (num_cred == 0) {
729 wpa_printf(MSG_DEBUG, "WPS: No Credential attributes "
730 "received");
731 return -1;
732 }
733
734 for (i = 0; i < num_cred; i++) {
4781064b
JM
735 int res;
736 res = wps_process_cred_e(wps, cred[i], cred_len[i], wps2);
737 if (res == 0)
738 ok++;
739 else if (res == -2)
740 wpa_printf(MSG_DEBUG, "WPS: WEP credential skipped");
741 else
a875087d
JL
742 return -1;
743 }
744
4781064b
JM
745 if (ok == 0) {
746 wpa_printf(MSG_DEBUG, "WPS: No valid Credential attribute "
747 "received");
748 return -1;
749 }
750
a875087d
JL
751 return 0;
752}
753
754
755static int wps_process_ap_settings_e(struct wps_data *wps,
756 struct wps_parse_attr *attr,
4781064b 757 struct wpabuf *attrs, int wps2)
a875087d
JL
758{
759 struct wps_credential cred;
760
761 if (!wps->wps->ap)
762 return 0;
763
764 if (wps_process_ap_settings(attr, &cred) < 0)
765 return -1;
766
767 wpa_printf(MSG_INFO, "WPS: Received new AP configuration from "
768 "Registrar");
769
770 if (os_memcmp(cred.mac_addr, wps->wps->dev.mac_addr, ETH_ALEN) !=
771 0) {
772 wpa_printf(MSG_DEBUG, "WPS: MAC Address in the AP Settings ("
773 MACSTR ") does not match with own address (" MACSTR
774 ")", MAC2STR(cred.mac_addr),
775 MAC2STR(wps->wps->dev.mac_addr));
776 /*
777 * In theory, this could be consider fatal error, but there are
778 * number of deployed implementations using other address here
779 * due to unclarity in the specification. For interoperability
780 * reasons, allow this to be processed since we do not really
781 * use the MAC Address information for anything.
782 */
4781064b
JM
783#ifdef CONFIG_WPS_STRICT
784 if (wps2) {
785 wpa_printf(MSG_INFO, "WPS: Do not accept incorrect "
786 "MAC Address in AP Settings");
787 return -1;
788 }
789#endif /* CONFIG_WPS_STRICT */
a875087d
JL
790 }
791
4781064b
JM
792#ifdef CONFIG_WPS2
793 if (!(cred.encr_type & (WPS_ENCR_NONE | WPS_ENCR_TKIP | WPS_ENCR_AES)))
794 {
795 if (cred.encr_type & WPS_ENCR_WEP) {
796 wpa_printf(MSG_INFO, "WPS: Reject new AP settings "
797 "due to WEP configuration");
798 wps->error_indication = WPS_EI_SECURITY_WEP_PROHIBITED;
799 return -1;
800 }
801
802 wpa_printf(MSG_INFO, "WPS: Reject new AP settings due to "
803 "invalid encr_type 0x%x", cred.encr_type);
804 return -1;
805 }
806#endif /* CONFIG_WPS2 */
807
808#ifdef CONFIG_WPS_STRICT
809 if (wps2) {
810 if ((cred.encr_type & (WPS_ENCR_TKIP | WPS_ENCR_AES)) ==
811 WPS_ENCR_TKIP ||
812 (cred.auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) ==
813 WPS_AUTH_WPAPSK) {
814 wpa_printf(MSG_INFO, "WPS-STRICT: Invalid WSC 2.0 "
815 "AP Settings: WPA-Personal/TKIP only");
816 wps->error_indication =
817 WPS_EI_SECURITY_TKIP_ONLY_PROHIBITED;
818 return -1;
819 }
820 }
821#endif /* CONFIG_WPS_STRICT */
822
823#ifdef CONFIG_WPS2
824 if ((cred.encr_type & (WPS_ENCR_TKIP | WPS_ENCR_AES)) == WPS_ENCR_TKIP)
825 {
826 wpa_printf(MSG_DEBUG, "WPS: Upgrade encr_type TKIP -> "
827 "TKIP+AES");
828 cred.encr_type |= WPS_ENCR_AES;
829 }
830
831 if ((cred.auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) ==
832 WPS_AUTH_WPAPSK) {
833 wpa_printf(MSG_DEBUG, "WPS: Upgrade auth_type WPAPSK -> "
834 "WPAPSK+WPA2PSK");
835 cred.auth_type |= WPS_AUTH_WPA2PSK;
836 }
837#endif /* CONFIG_WPS2 */
838
a875087d
JL
839 if (wps->wps->cred_cb) {
840 cred.cred_attr = wpabuf_head(attrs);
841 cred.cred_attr_len = wpabuf_len(attrs);
842 wps->wps->cred_cb(wps->wps->cb_ctx, &cred);
843 }
844
845 return 0;
846}
847
848
4781064b
JM
849static int wps_process_dev_pw_id(struct wps_data *wps, const u8 *dev_pw_id)
850{
851 u16 id;
852
853 if (dev_pw_id == NULL) {
854 wpa_printf(MSG_DEBUG, "WPS: Device Password ID");
855 return -1;
856 }
857
858 id = WPA_GET_BE16(dev_pw_id);
859 if (wps->dev_pw_id == id) {
860 wpa_printf(MSG_DEBUG, "WPS: Device Password ID %u", id);
861 return 0;
862 }
863
864#ifdef CONFIG_P2P
865 if ((id == DEV_PW_DEFAULT &&
866 wps->dev_pw_id == DEV_PW_REGISTRAR_SPECIFIED) ||
867 (id == DEV_PW_REGISTRAR_SPECIFIED &&
868 wps->dev_pw_id == DEV_PW_DEFAULT)) {
869 /*
870 * Common P2P use cases indicate whether the PIN is from the
871 * client or GO using Device Password Id in M1/M2 in a way that
872 * does not look fully compliant with WSC specification. Anyway,
873 * this is deployed and needs to be allowed, so ignore changes
874 * between Registrar-Specified and Default PIN.
875 */
876 wpa_printf(MSG_DEBUG, "WPS: Allow PIN Device Password ID "
877 "change");
878 return 0;
879 }
880#endif /* CONFIG_P2P */
881
882 wpa_printf(MSG_DEBUG, "WPS: Registrar trying to change Device Password "
883 "ID from %u to %u", wps->dev_pw_id, id);
884
885 if (wps->dev_pw_id == DEV_PW_PUSHBUTTON && id == DEV_PW_DEFAULT) {
886 wpa_printf(MSG_DEBUG,
887 "WPS: Workaround - ignore PBC-to-PIN change");
888 return 0;
889 }
890
891 if (wps->alt_dev_password && wps->alt_dev_pw_id == id) {
892 wpa_printf(MSG_DEBUG, "WPS: Found a matching Device Password");
893 os_free(wps->dev_password);
894 wps->dev_pw_id = wps->alt_dev_pw_id;
895 wps->dev_password = wps->alt_dev_password;
896 wps->dev_password_len = wps->alt_dev_password_len;
897 wps->alt_dev_password = NULL;
898 wps->alt_dev_password_len = 0;
899 return 0;
900 }
901
902 return -1;
903}
904
905
a875087d
JL
906static enum wps_process_res wps_process_m2(struct wps_data *wps,
907 const struct wpabuf *msg,
908 struct wps_parse_attr *attr)
909{
910 wpa_printf(MSG_DEBUG, "WPS: Received M2");
911
912 if (wps->state != RECV_M2) {
913 wpa_printf(MSG_DEBUG, "WPS: Unexpected state (%d) for "
914 "receiving M2", wps->state);
915 wps->state = SEND_WSC_NACK;
916 return WPS_CONTINUE;
917 }
918
919 if (wps_process_registrar_nonce(wps, attr->registrar_nonce) ||
920 wps_process_enrollee_nonce(wps, attr->enrollee_nonce) ||
921 wps_process_uuid_r(wps, attr->uuid_r) ||
4781064b 922 wps_process_dev_pw_id(wps, attr->dev_password_id)) {
a875087d
JL
923 wps->state = SEND_WSC_NACK;
924 return WPS_CONTINUE;
925 }
926
4781064b
JM
927 /*
928 * Stop here on an AP as an Enrollee if AP Setup is locked unless the
929 * special locked mode is used to allow protocol run up to M7 in order
930 * to support external Registrars that only learn the current AP
931 * configuration without changing it.
932 */
933 if (wps->wps->ap &&
934 ((wps->wps->ap_setup_locked && wps->wps->ap_setup_locked != 2) ||
935 wps->dev_password == NULL)) {
a875087d
JL
936 wpa_printf(MSG_DEBUG, "WPS: AP Setup is locked - refuse "
937 "registration of a new Registrar");
938 wps->config_error = WPS_CFG_SETUP_LOCKED;
939 wps->state = SEND_WSC_NACK;
940 return WPS_CONTINUE;
941 }
942
4781064b
JM
943 if (wps_process_pubkey(wps, attr->public_key, attr->public_key_len) ||
944 wps_process_authenticator(wps, attr->authenticator, msg) ||
945 wps_process_device_attrs(&wps->peer_dev, attr)) {
946 wps->state = SEND_WSC_NACK;
947 return WPS_CONTINUE;
948 }
949
950#ifdef CONFIG_WPS_NFC
951 if (wps->peer_pubkey_hash_set) {
952 struct wpabuf *decrypted;
953 struct wps_parse_attr eattr;
954
955 decrypted = wps_decrypt_encr_settings(wps, attr->encr_settings,
956 attr->encr_settings_len);
957 if (decrypted == NULL) {
958 wpa_printf(MSG_DEBUG, "WPS: Failed to decrypt "
959 "Encrypted Settings attribute");
960 wps->state = SEND_WSC_NACK;
961 return WPS_CONTINUE;
962 }
963
964 wpa_printf(MSG_DEBUG, "WPS: Processing decrypted Encrypted "
965 "Settings attribute");
966 if (wps_parse_msg(decrypted, &eattr) < 0 ||
967 wps_process_key_wrap_auth(wps, decrypted,
968 eattr.key_wrap_auth) ||
969 wps_process_creds(wps, eattr.cred, eattr.cred_len,
970 eattr.num_cred, attr->version2 != NULL)) {
971 wpabuf_free(decrypted);
972 wps->state = SEND_WSC_NACK;
973 return WPS_CONTINUE;
974 }
975 wpabuf_free(decrypted);
976
977 wps->state = WPS_MSG_DONE;
978 return WPS_CONTINUE;
979 }
980#endif /* CONFIG_WPS_NFC */
981
a875087d
JL
982 wps->state = SEND_M3;
983 return WPS_CONTINUE;
984}
985
986
987static enum wps_process_res wps_process_m2d(struct wps_data *wps,
988 struct wps_parse_attr *attr)
989{
990 wpa_printf(MSG_DEBUG, "WPS: Received M2D");
991
992 if (wps->state != RECV_M2) {
993 wpa_printf(MSG_DEBUG, "WPS: Unexpected state (%d) for "
994 "receiving M2D", wps->state);
995 wps->state = SEND_WSC_NACK;
996 return WPS_CONTINUE;
997 }
998
999 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Manufacturer",
1000 attr->manufacturer, attr->manufacturer_len);
1001 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Model Name",
1002 attr->model_name, attr->model_name_len);
1003 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Model Number",
1004 attr->model_number, attr->model_number_len);
1005 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Serial Number",
1006 attr->serial_number, attr->serial_number_len);
1007 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Device Name",
1008 attr->dev_name, attr->dev_name_len);
1009
1010 if (wps->wps->event_cb) {
1011 union wps_event_data data;
1012 struct wps_event_m2d *m2d = &data.m2d;
1013 os_memset(&data, 0, sizeof(data));
1014 if (attr->config_methods)
1015 m2d->config_methods =
1016 WPA_GET_BE16(attr->config_methods);
1017 m2d->manufacturer = attr->manufacturer;
1018 m2d->manufacturer_len = attr->manufacturer_len;
1019 m2d->model_name = attr->model_name;
1020 m2d->model_name_len = attr->model_name_len;
1021 m2d->model_number = attr->model_number;
1022 m2d->model_number_len = attr->model_number_len;
1023 m2d->serial_number = attr->serial_number;
1024 m2d->serial_number_len = attr->serial_number_len;
1025 m2d->dev_name = attr->dev_name;
1026 m2d->dev_name_len = attr->dev_name_len;
1027 m2d->primary_dev_type = attr->primary_dev_type;
1028 if (attr->config_error)
1029 m2d->config_error =
1030 WPA_GET_BE16(attr->config_error);
1031 if (attr->dev_password_id)
1032 m2d->dev_password_id =
1033 WPA_GET_BE16(attr->dev_password_id);
1034 wps->wps->event_cb(wps->wps->cb_ctx, WPS_EV_M2D, &data);
1035 }
1036
1037 wps->state = RECEIVED_M2D;
1038 return WPS_CONTINUE;
1039}
1040
1041
1042static enum wps_process_res wps_process_m4(struct wps_data *wps,
1043 const struct wpabuf *msg,
1044 struct wps_parse_attr *attr)
1045{
1046 struct wpabuf *decrypted;
1047 struct wps_parse_attr eattr;
1048
1049 wpa_printf(MSG_DEBUG, "WPS: Received M4");
1050
1051 if (wps->state != RECV_M4) {
1052 wpa_printf(MSG_DEBUG, "WPS: Unexpected state (%d) for "
1053 "receiving M4", wps->state);
1054 wps->state = SEND_WSC_NACK;
1055 return WPS_CONTINUE;
1056 }
1057
1058 if (wps_process_enrollee_nonce(wps, attr->enrollee_nonce) ||
1059 wps_process_authenticator(wps, attr->authenticator, msg) ||
1060 wps_process_r_hash1(wps, attr->r_hash1) ||
1061 wps_process_r_hash2(wps, attr->r_hash2)) {
1062 wps->state = SEND_WSC_NACK;
1063 return WPS_CONTINUE;
1064 }
1065
1066 decrypted = wps_decrypt_encr_settings(wps, attr->encr_settings,
1067 attr->encr_settings_len);
1068 if (decrypted == NULL) {
1069 wpa_printf(MSG_DEBUG, "WPS: Failed to decrypted Encrypted "
1070 "Settings attribute");
1071 wps->state = SEND_WSC_NACK;
1072 return WPS_CONTINUE;
1073 }
1074
4781064b
JM
1075 if (wps_validate_m4_encr(decrypted, attr->version2 != NULL) < 0) {
1076 wpabuf_free(decrypted);
1077 wps->state = SEND_WSC_NACK;
1078 return WPS_CONTINUE;
1079 }
1080
a875087d
JL
1081 wpa_printf(MSG_DEBUG, "WPS: Processing decrypted Encrypted Settings "
1082 "attribute");
1083 if (wps_parse_msg(decrypted, &eattr) < 0 ||
1084 wps_process_key_wrap_auth(wps, decrypted, eattr.key_wrap_auth) ||
1085 wps_process_r_snonce1(wps, eattr.r_snonce1)) {
1086 wpabuf_free(decrypted);
1087 wps->state = SEND_WSC_NACK;
1088 return WPS_CONTINUE;
1089 }
1090 wpabuf_free(decrypted);
1091
1092 wps->state = SEND_M5;
1093 return WPS_CONTINUE;
1094}
1095
1096
1097static enum wps_process_res wps_process_m6(struct wps_data *wps,
1098 const struct wpabuf *msg,
1099 struct wps_parse_attr *attr)
1100{
1101 struct wpabuf *decrypted;
1102 struct wps_parse_attr eattr;
1103
1104 wpa_printf(MSG_DEBUG, "WPS: Received M6");
1105
1106 if (wps->state != RECV_M6) {
1107 wpa_printf(MSG_DEBUG, "WPS: Unexpected state (%d) for "
1108 "receiving M6", wps->state);
1109 wps->state = SEND_WSC_NACK;
1110 return WPS_CONTINUE;
1111 }
1112
1113 if (wps_process_enrollee_nonce(wps, attr->enrollee_nonce) ||
1114 wps_process_authenticator(wps, attr->authenticator, msg)) {
1115 wps->state = SEND_WSC_NACK;
1116 return WPS_CONTINUE;
1117 }
1118
1119 decrypted = wps_decrypt_encr_settings(wps, attr->encr_settings,
1120 attr->encr_settings_len);
1121 if (decrypted == NULL) {
1122 wpa_printf(MSG_DEBUG, "WPS: Failed to decrypted Encrypted "
1123 "Settings attribute");
1124 wps->state = SEND_WSC_NACK;
1125 return WPS_CONTINUE;
1126 }
1127
4781064b
JM
1128 if (wps_validate_m6_encr(decrypted, attr->version2 != NULL) < 0) {
1129 wpabuf_free(decrypted);
1130 wps->state = SEND_WSC_NACK;
1131 return WPS_CONTINUE;
1132 }
1133
a875087d
JL
1134 wpa_printf(MSG_DEBUG, "WPS: Processing decrypted Encrypted Settings "
1135 "attribute");
1136 if (wps_parse_msg(decrypted, &eattr) < 0 ||
1137 wps_process_key_wrap_auth(wps, decrypted, eattr.key_wrap_auth) ||
1138 wps_process_r_snonce2(wps, eattr.r_snonce2)) {
1139 wpabuf_free(decrypted);
1140 wps->state = SEND_WSC_NACK;
1141 return WPS_CONTINUE;
1142 }
1143 wpabuf_free(decrypted);
1144
4781064b
JM
1145 if (wps->wps->ap)
1146 wps->wps->event_cb(wps->wps->cb_ctx, WPS_EV_AP_PIN_SUCCESS,
1147 NULL);
1148
a875087d
JL
1149 wps->state = SEND_M7;
1150 return WPS_CONTINUE;
1151}
1152
1153
1154static enum wps_process_res wps_process_m8(struct wps_data *wps,
1155 const struct wpabuf *msg,
1156 struct wps_parse_attr *attr)
1157{
1158 struct wpabuf *decrypted;
1159 struct wps_parse_attr eattr;
1160
1161 wpa_printf(MSG_DEBUG, "WPS: Received M8");
1162
1163 if (wps->state != RECV_M8) {
1164 wpa_printf(MSG_DEBUG, "WPS: Unexpected state (%d) for "
1165 "receiving M8", wps->state);
1166 wps->state = SEND_WSC_NACK;
1167 return WPS_CONTINUE;
1168 }
1169
1170 if (wps_process_enrollee_nonce(wps, attr->enrollee_nonce) ||
1171 wps_process_authenticator(wps, attr->authenticator, msg)) {
1172 wps->state = SEND_WSC_NACK;
1173 return WPS_CONTINUE;
1174 }
1175
4781064b
JM
1176 if (wps->wps->ap && wps->wps->ap_setup_locked) {
1177 /*
1178 * Stop here if special ap_setup_locked == 2 mode allowed the
1179 * protocol to continue beyond M2. This allows ER to learn the
1180 * current AP settings without changing them.
1181 */
1182 wpa_printf(MSG_DEBUG, "WPS: AP Setup is locked - refuse "
1183 "registration of a new Registrar");
1184 wps->config_error = WPS_CFG_SETUP_LOCKED;
1185 wps->state = SEND_WSC_NACK;
1186 return WPS_CONTINUE;
1187 }
1188
a875087d
JL
1189 decrypted = wps_decrypt_encr_settings(wps, attr->encr_settings,
1190 attr->encr_settings_len);
1191 if (decrypted == NULL) {
1192 wpa_printf(MSG_DEBUG, "WPS: Failed to decrypted Encrypted "
1193 "Settings attribute");
1194 wps->state = SEND_WSC_NACK;
1195 return WPS_CONTINUE;
1196 }
1197
4781064b
JM
1198 if (wps_validate_m8_encr(decrypted, wps->wps->ap,
1199 attr->version2 != NULL) < 0) {
1200 wpabuf_free(decrypted);
1201 wps->state = SEND_WSC_NACK;
1202 return WPS_CONTINUE;
1203 }
1204
a875087d
JL
1205 wpa_printf(MSG_DEBUG, "WPS: Processing decrypted Encrypted Settings "
1206 "attribute");
1207 if (wps_parse_msg(decrypted, &eattr) < 0 ||
1208 wps_process_key_wrap_auth(wps, decrypted, eattr.key_wrap_auth) ||
1209 wps_process_creds(wps, eattr.cred, eattr.cred_len,
4781064b
JM
1210 eattr.num_cred, attr->version2 != NULL) ||
1211 wps_process_ap_settings_e(wps, &eattr, decrypted,
1212 attr->version2 != NULL)) {
a875087d
JL
1213 wpabuf_free(decrypted);
1214 wps->state = SEND_WSC_NACK;
1215 return WPS_CONTINUE;
1216 }
1217 wpabuf_free(decrypted);
1218
1219 wps->state = WPS_MSG_DONE;
1220 return WPS_CONTINUE;
1221}
1222
1223
1224static enum wps_process_res wps_process_wsc_msg(struct wps_data *wps,
1225 const struct wpabuf *msg)
1226{
1227 struct wps_parse_attr attr;
1228 enum wps_process_res ret = WPS_CONTINUE;
1229
1230 wpa_printf(MSG_DEBUG, "WPS: Received WSC_MSG");
1231
1232 if (wps_parse_msg(msg, &attr) < 0)
1233 return WPS_FAILURE;
1234
a875087d 1235 if (attr.enrollee_nonce == NULL ||
4781064b 1236 os_memcmp(wps->nonce_e, attr.enrollee_nonce, WPS_NONCE_LEN) != 0) {
a875087d
JL
1237 wpa_printf(MSG_DEBUG, "WPS: Mismatch in enrollee nonce");
1238 return WPS_FAILURE;
1239 }
1240
1241 if (attr.msg_type == NULL) {
1242 wpa_printf(MSG_DEBUG, "WPS: No Message Type attribute");
4781064b
JM
1243 wps->state = SEND_WSC_NACK;
1244 return WPS_CONTINUE;
a875087d
JL
1245 }
1246
1247 switch (*attr.msg_type) {
1248 case WPS_M2:
4781064b
JM
1249 if (wps_validate_m2(msg) < 0)
1250 return WPS_FAILURE;
a875087d
JL
1251 ret = wps_process_m2(wps, msg, &attr);
1252 break;
1253 case WPS_M2D:
4781064b
JM
1254 if (wps_validate_m2d(msg) < 0)
1255 return WPS_FAILURE;
a875087d
JL
1256 ret = wps_process_m2d(wps, &attr);
1257 break;
1258 case WPS_M4:
4781064b
JM
1259 if (wps_validate_m4(msg) < 0)
1260 return WPS_FAILURE;
a875087d
JL
1261 ret = wps_process_m4(wps, msg, &attr);
1262 if (ret == WPS_FAILURE || wps->state == SEND_WSC_NACK)
4781064b
JM
1263 wps_fail_event(wps->wps, WPS_M4, wps->config_error,
1264 wps->error_indication,
1265 wps->peer_dev.mac_addr);
a875087d
JL
1266 break;
1267 case WPS_M6:
4781064b
JM
1268 if (wps_validate_m6(msg) < 0)
1269 return WPS_FAILURE;
a875087d
JL
1270 ret = wps_process_m6(wps, msg, &attr);
1271 if (ret == WPS_FAILURE || wps->state == SEND_WSC_NACK)
4781064b
JM
1272 wps_fail_event(wps->wps, WPS_M6, wps->config_error,
1273 wps->error_indication,
1274 wps->peer_dev.mac_addr);
a875087d
JL
1275 break;
1276 case WPS_M8:
4781064b
JM
1277 if (wps_validate_m8(msg) < 0)
1278 return WPS_FAILURE;
a875087d
JL
1279 ret = wps_process_m8(wps, msg, &attr);
1280 if (ret == WPS_FAILURE || wps->state == SEND_WSC_NACK)
4781064b
JM
1281 wps_fail_event(wps->wps, WPS_M8, wps->config_error,
1282 wps->error_indication,
1283 wps->peer_dev.mac_addr);
a875087d
JL
1284 break;
1285 default:
1286 wpa_printf(MSG_DEBUG, "WPS: Unsupported Message Type %d",
1287 *attr.msg_type);
1288 return WPS_FAILURE;
1289 }
1290
1291 /*
1292 * Save a copy of the last message for Authenticator derivation if we
1293 * are continuing. However, skip M2D since it is not authenticated and
1294 * neither is the ACK/NACK response frame. This allows the possibly
1295 * following M2 to be processed correctly by using the previously sent
1296 * M1 in Authenticator derivation.
1297 */
1298 if (ret == WPS_CONTINUE && *attr.msg_type != WPS_M2D) {
1299 /* Save a copy of the last message for Authenticator derivation
1300 */
1301 wpabuf_free(wps->last_msg);
1302 wps->last_msg = wpabuf_dup(msg);
1303 }
1304
1305 return ret;
1306}
1307
1308
1309static enum wps_process_res wps_process_wsc_ack(struct wps_data *wps,
1310 const struct wpabuf *msg)
1311{
1312 struct wps_parse_attr attr;
1313
1314 wpa_printf(MSG_DEBUG, "WPS: Received WSC_ACK");
1315
1316 if (wps_parse_msg(msg, &attr) < 0)
1317 return WPS_FAILURE;
1318
a875087d
JL
1319 if (attr.msg_type == NULL) {
1320 wpa_printf(MSG_DEBUG, "WPS: No Message Type attribute");
1321 return WPS_FAILURE;
1322 }
1323
1324 if (*attr.msg_type != WPS_WSC_ACK) {
1325 wpa_printf(MSG_DEBUG, "WPS: Invalid Message Type %d",
1326 *attr.msg_type);
1327 return WPS_FAILURE;
1328 }
1329
1330 if (attr.registrar_nonce == NULL ||
4781064b 1331 os_memcmp(wps->nonce_r, attr.registrar_nonce, WPS_NONCE_LEN) != 0)
a875087d
JL
1332 {
1333 wpa_printf(MSG_DEBUG, "WPS: Mismatch in registrar nonce");
1334 return WPS_FAILURE;
1335 }
1336
1337 if (attr.enrollee_nonce == NULL ||
4781064b 1338 os_memcmp(wps->nonce_e, attr.enrollee_nonce, WPS_NONCE_LEN) != 0) {
a875087d
JL
1339 wpa_printf(MSG_DEBUG, "WPS: Mismatch in enrollee nonce");
1340 return WPS_FAILURE;
1341 }
1342
1343 if (wps->state == RECV_ACK && wps->wps->ap) {
1344 wpa_printf(MSG_DEBUG, "WPS: External Registrar registration "
1345 "completed successfully");
4781064b 1346 wps_success_event(wps->wps, wps->peer_dev.mac_addr);
a875087d
JL
1347 wps->state = WPS_FINISHED;
1348 return WPS_DONE;
1349 }
1350
1351 return WPS_FAILURE;
1352}
1353
1354
1355static enum wps_process_res wps_process_wsc_nack(struct wps_data *wps,
1356 const struct wpabuf *msg)
1357{
1358 struct wps_parse_attr attr;
4781064b 1359 u16 config_error;
a875087d
JL
1360
1361 wpa_printf(MSG_DEBUG, "WPS: Received WSC_NACK");
1362
1363 if (wps_parse_msg(msg, &attr) < 0)
1364 return WPS_FAILURE;
1365
a875087d
JL
1366 if (attr.msg_type == NULL) {
1367 wpa_printf(MSG_DEBUG, "WPS: No Message Type attribute");
1368 return WPS_FAILURE;
1369 }
1370
1371 if (*attr.msg_type != WPS_WSC_NACK) {
1372 wpa_printf(MSG_DEBUG, "WPS: Invalid Message Type %d",
1373 *attr.msg_type);
1374 return WPS_FAILURE;
1375 }
1376
1377 if (attr.registrar_nonce == NULL ||
4781064b 1378 os_memcmp(wps->nonce_r, attr.registrar_nonce, WPS_NONCE_LEN) != 0)
a875087d
JL
1379 {
1380 wpa_printf(MSG_DEBUG, "WPS: Mismatch in registrar nonce");
1381 wpa_hexdump(MSG_DEBUG, "WPS: Received Registrar Nonce",
1382 attr.registrar_nonce, WPS_NONCE_LEN);
1383 wpa_hexdump(MSG_DEBUG, "WPS: Expected Registrar Nonce",
1384 wps->nonce_r, WPS_NONCE_LEN);
1385 return WPS_FAILURE;
1386 }
1387
1388 if (attr.enrollee_nonce == NULL ||
4781064b 1389 os_memcmp(wps->nonce_e, attr.enrollee_nonce, WPS_NONCE_LEN) != 0) {
a875087d
JL
1390 wpa_printf(MSG_DEBUG, "WPS: Mismatch in enrollee nonce");
1391 wpa_hexdump(MSG_DEBUG, "WPS: Received Enrollee Nonce",
1392 attr.enrollee_nonce, WPS_NONCE_LEN);
1393 wpa_hexdump(MSG_DEBUG, "WPS: Expected Enrollee Nonce",
1394 wps->nonce_e, WPS_NONCE_LEN);
1395 return WPS_FAILURE;
1396 }
1397
1398 if (attr.config_error == NULL) {
1399 wpa_printf(MSG_DEBUG, "WPS: No Configuration Error attribute "
1400 "in WSC_NACK");
1401 return WPS_FAILURE;
1402 }
1403
4781064b 1404 config_error = WPA_GET_BE16(attr.config_error);
a875087d 1405 wpa_printf(MSG_DEBUG, "WPS: Registrar terminated negotiation with "
4781064b 1406 "Configuration Error %d", config_error);
a875087d
JL
1407
1408 switch (wps->state) {
1409 case RECV_M4:
4781064b
JM
1410 wps_fail_event(wps->wps, WPS_M3, config_error,
1411 wps->error_indication, wps->peer_dev.mac_addr);
a875087d
JL
1412 break;
1413 case RECV_M6:
4781064b
JM
1414 wps_fail_event(wps->wps, WPS_M5, config_error,
1415 wps->error_indication, wps->peer_dev.mac_addr);
a875087d
JL
1416 break;
1417 case RECV_M8:
4781064b
JM
1418 wps_fail_event(wps->wps, WPS_M7, config_error,
1419 wps->error_indication, wps->peer_dev.mac_addr);
a875087d
JL
1420 break;
1421 default:
1422 break;
1423 }
1424
1425 /* Followed by NACK if Enrollee is Supplicant or EAP-Failure if
1426 * Enrollee is Authenticator */
1427 wps->state = SEND_WSC_NACK;
1428
1429 return WPS_FAILURE;
1430}
1431
1432
1433enum wps_process_res wps_enrollee_process_msg(struct wps_data *wps,
1434 enum wsc_op_code op_code,
1435 const struct wpabuf *msg)
1436{
1437
1438 wpa_printf(MSG_DEBUG, "WPS: Processing received message (len=%lu "
1439 "op_code=%d)",
1440 (unsigned long) wpabuf_len(msg), op_code);
1441
1442 if (op_code == WSC_UPnP) {
1443 /* Determine the OpCode based on message type attribute */
1444 struct wps_parse_attr attr;
1445 if (wps_parse_msg(msg, &attr) == 0 && attr.msg_type) {
1446 if (*attr.msg_type == WPS_WSC_ACK)
1447 op_code = WSC_ACK;
1448 else if (*attr.msg_type == WPS_WSC_NACK)
1449 op_code = WSC_NACK;
1450 }
1451 }
1452
1453 switch (op_code) {
1454 case WSC_MSG:
1455 case WSC_UPnP:
1456 return wps_process_wsc_msg(wps, msg);
1457 case WSC_ACK:
4781064b
JM
1458 if (wps_validate_wsc_ack(msg) < 0)
1459 return WPS_FAILURE;
a875087d
JL
1460 return wps_process_wsc_ack(wps, msg);
1461 case WSC_NACK:
4781064b
JM
1462 if (wps_validate_wsc_nack(msg) < 0)
1463 return WPS_FAILURE;
a875087d
JL
1464 return wps_process_wsc_nack(wps, msg);
1465 default:
1466 wpa_printf(MSG_DEBUG, "WPS: Unsupported op_code %d", op_code);
1467 return WPS_FAILURE;
1468 }
1469}