xref: /freebsd/contrib/wpa/src/rsn_supp/wpa_ft.c (revision 0f454b93f8502e85e8d2b26a383e40b5dc50cd27)
1 /*
2  * WPA Supplicant - IEEE 802.11r - Fast BSS Transition
3  * Copyright (c) 2006-2007, Jouni Malinen <j@w1.fi>
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License version 2 as
7  * published by the Free Software Foundation.
8  *
9  * Alternatively, this software may be distributed under the terms of BSD
10  * license.
11  *
12  * See README and COPYING for more details.
13  */
14 
15 #include "includes.h"
16 
17 #include "common.h"
18 #include "wpa.h"
19 #include "wpa_i.h"
20 #include "wpa_ie.h"
21 #include "aes_wrap.h"
22 #include "ieee802_11_defs.h"
23 
24 #ifdef CONFIG_IEEE80211R
25 
26 int wpa_derive_ptk_ft(struct wpa_sm *sm, const unsigned char *src_addr,
27 		      const struct wpa_eapol_key *key,
28 		      struct wpa_ptk *ptk)
29 {
30 	u8 pmk_r1_name[WPA_PMK_NAME_LEN];
31 	u8 ptk_name[WPA_PMK_NAME_LEN];
32 	const u8 *anonce = key->key_nonce;
33 
34 	if (sm->xxkey_len == 0) {
35 		wpa_printf(MSG_DEBUG, "FT: XXKey not available for key "
36 			   "derivation");
37 		return -1;
38 	}
39 
40 	wpa_derive_pmk_r0(sm->xxkey, sm->xxkey_len, sm->ssid,
41 			  sm->ssid_len, sm->mobility_domain,
42 			  sm->r0kh_id, sm->r0kh_id_len, sm->own_addr,
43 			  sm->pmk_r0, sm->pmk_r0_name);
44 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R0", sm->pmk_r0, PMK_LEN);
45 	wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name",
46 		    sm->pmk_r0_name, WPA_PMK_NAME_LEN);
47 	wpa_derive_pmk_r1(sm->pmk_r0, sm->pmk_r0_name, sm->r1kh_id,
48 			  sm->own_addr, sm->pmk_r1, pmk_r1_name);
49 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", sm->pmk_r1, PMK_LEN);
50 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", pmk_r1_name, WPA_PMK_NAME_LEN);
51 	wpa_pmk_r1_to_ptk(sm->pmk_r1, sm->snonce, anonce, sm->own_addr,
52 			  sm->bssid, pmk_r1_name,
53 			  (u8 *) ptk, sizeof(*ptk), ptk_name);
54 	wpa_hexdump_key(MSG_DEBUG, "FT: PTK", (u8 *) ptk, sizeof(*ptk));
55 	wpa_hexdump(MSG_DEBUG, "FT: PTKName", ptk_name, WPA_PMK_NAME_LEN);
56 
57 	return 0;
58 }
59 
60 
61 /**
62  * wpa_sm_set_ft_params - Set FT (IEEE 802.11r) parameters
63  * @sm: Pointer to WPA state machine data from wpa_sm_init()
64  * @mobility_domain: Mobility domain identifier (2 octets)
65  * @r0kh_id: PMK-R0 key holder identity (1-48 octets)
66  * @r0kh_id_len: R0KH-ID length (1-48)
67  * @r1kh_id: PMK-R1 key holder identity (16 octets)
68  * Returns: 0 on success, -1 on failure
69  */
70 int wpa_sm_set_ft_params(struct wpa_sm *sm, const u8 *mobility_domain,
71 			 const u8 *r0kh_id, size_t r0kh_id_len,
72 			 const u8 *r1kh_id)
73 {
74 	if (sm && mobility_domain) {
75 		wpa_hexdump(MSG_DEBUG, "FT: Mobility domain",
76 			    mobility_domain, MOBILITY_DOMAIN_ID_LEN);
77 		os_memcpy(sm->mobility_domain, mobility_domain,
78 			  MOBILITY_DOMAIN_ID_LEN);
79 	} else if (sm)
80 		os_memset(sm->mobility_domain, 0, MOBILITY_DOMAIN_ID_LEN);
81 
82 	if (sm && r0kh_id) {
83 		if (r0kh_id_len > FT_R0KH_ID_MAX_LEN)
84 			return -1;
85 		wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID", r0kh_id, r0kh_id_len);
86 		os_memcpy(sm->r0kh_id, r0kh_id, r0kh_id_len);
87 		sm->r0kh_id_len = r0kh_id_len;
88 	} else if (sm) {
89 		/* FIX: When should R0KH-ID be cleared? We need to keep the
90 		 * old R0KH-ID in order to be able to use this during FT. */
91 		/*
92 		 * os_memset(sm->r0kh_id, 0, FT_R0KH_ID_LEN);
93 		 * sm->r0kh_id_len = 0;
94 		 */
95 	}
96 
97 	if (sm && r1kh_id) {
98 		wpa_hexdump(MSG_DEBUG, "FT: R1KH-ID", r1kh_id, FT_R1KH_ID_LEN);
99 		os_memcpy(sm->r1kh_id, r1kh_id, FT_R1KH_ID_LEN);
100 	} else if (sm)
101 		os_memset(sm->r1kh_id, 0, FT_R1KH_ID_LEN);
102 
103 	return 0;
104 }
105 
106 
107 /**
108  * wpa_ft_gen_req_ies - Generate FT (IEEE 802.11r) IEs for Auth Request
109  * @sm: Pointer to WPA state machine data from wpa_sm_init()
110  * @len: Buffer for returning the length of the IEs
111  * @anonce: ANonce or %NULL if not yet available
112  * @pmk_name: PMKR0Name or PMKR1Name to be added into the RSN IE PMKID List
113  * @kck: 128-bit KCK for MIC or %NULL if no MIC is used
114  * @target_ap: Target AP address
115  * Returns: Pointer to buffer with IEs or %NULL on failure
116  *
117  * Caller is responsible for freeing the returned buffer with os_free();
118  */
119 static u8 * wpa_ft_gen_req_ies(struct wpa_sm *sm, size_t *len,
120 			       const u8 *anonce, const u8 *pmk_name,
121 			       const u8 *kck, const u8 *target_ap)
122 {
123 	size_t buf_len;
124 	u8 *buf, *pos, *ftie_len, *ftie_pos;
125 	struct rsn_mdie *mdie;
126 	struct rsn_ftie *ftie;
127 	struct rsn_ie_hdr *rsnie;
128 	u16 capab;
129 
130 	sm->ft_completed = 0;
131 
132 	buf_len = 2 + sizeof(struct rsn_mdie) + 2 + sizeof(struct rsn_ftie) +
133 		2 + sm->r0kh_id_len + 100;
134 	buf = os_zalloc(buf_len);
135 	if (buf == NULL)
136 		return NULL;
137 	pos = buf;
138 
139 	/* RSNIE[PMKR0Name] */
140 	rsnie = (struct rsn_ie_hdr *) pos;
141 	rsnie->elem_id = WLAN_EID_RSN;
142 	WPA_PUT_LE16(rsnie->version, RSN_VERSION);
143 	pos = (u8 *) (rsnie + 1);
144 
145 	/* Group Suite Selector */
146 	if (sm->group_cipher == WPA_CIPHER_CCMP)
147 		RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_CCMP);
148 	else if (sm->group_cipher == WPA_CIPHER_TKIP)
149 		RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_TKIP);
150 	else {
151 		wpa_printf(MSG_WARNING, "FT: Invalid group cipher (%d)",
152 			   sm->group_cipher);
153 		os_free(buf);
154 		return NULL;
155 	}
156 	pos += RSN_SELECTOR_LEN;
157 
158 	/* Pairwise Suite Count */
159 	WPA_PUT_LE16(pos, 1);
160 	pos += 2;
161 
162 	/* Pairwise Suite List */
163 	if (sm->pairwise_cipher == WPA_CIPHER_CCMP)
164 		RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_CCMP);
165 	else if (sm->pairwise_cipher == WPA_CIPHER_TKIP)
166 		RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_TKIP);
167 	else {
168 		wpa_printf(MSG_WARNING, "FT: Invalid pairwise cipher (%d)",
169 			   sm->pairwise_cipher);
170 		os_free(buf);
171 		return NULL;
172 	}
173 	pos += RSN_SELECTOR_LEN;
174 
175 	/* Authenticated Key Management Suite Count */
176 	WPA_PUT_LE16(pos, 1);
177 	pos += 2;
178 
179 	/* Authenticated Key Management Suite List */
180 	if (sm->key_mgmt == WPA_KEY_MGMT_FT_IEEE8021X)
181 		RSN_SELECTOR_PUT(pos, RSN_AUTH_KEY_MGMT_FT_802_1X);
182 	else if (sm->key_mgmt == WPA_KEY_MGMT_FT_PSK)
183 		RSN_SELECTOR_PUT(pos, RSN_AUTH_KEY_MGMT_FT_PSK);
184 	else {
185 		wpa_printf(MSG_WARNING, "FT: Invalid key management type (%d)",
186 			   sm->key_mgmt);
187 		os_free(buf);
188 		return NULL;
189 	}
190 	pos += RSN_SELECTOR_LEN;
191 
192 	/* RSN Capabilities */
193 	capab = 0;
194 #ifdef CONFIG_IEEE80211W
195 	if (sm->mgmt_group_cipher == WPA_CIPHER_AES_128_CMAC)
196 		capab |= WPA_CAPABILITY_MFPC;
197 #endif /* CONFIG_IEEE80211W */
198 	WPA_PUT_LE16(pos, capab);
199 	pos += 2;
200 
201 	/* PMKID Count */
202 	WPA_PUT_LE16(pos, 1);
203 	pos += 2;
204 
205 	/* PMKID List [PMKR0Name/PMKR1Name] */
206 	os_memcpy(pos, pmk_name, WPA_PMK_NAME_LEN);
207 	pos += WPA_PMK_NAME_LEN;
208 
209 #ifdef CONFIG_IEEE80211W
210 	if (sm->mgmt_group_cipher == WPA_CIPHER_AES_128_CMAC) {
211 		/* Management Group Cipher Suite */
212 		RSN_SELECTOR_PUT(pos, RSN_CIPHER_SUITE_AES_128_CMAC);
213 		pos += RSN_SELECTOR_LEN;
214 	}
215 #endif /* CONFIG_IEEE80211W */
216 
217 	rsnie->len = (pos - (u8 *) rsnie) - 2;
218 
219 	/* MDIE */
220 	*pos++ = WLAN_EID_MOBILITY_DOMAIN;
221 	*pos++ = sizeof(*mdie);
222 	mdie = (struct rsn_mdie *) pos;
223 	pos += sizeof(*mdie);
224 	os_memcpy(mdie->mobility_domain, sm->mobility_domain,
225 		  MOBILITY_DOMAIN_ID_LEN);
226 	mdie->ft_capab = 0; /* FIX: copy from the target AP's MDIE */
227 
228 	/* FTIE[SNonce, R0KH-ID] */
229 	ftie_pos = pos;
230 	*pos++ = WLAN_EID_FAST_BSS_TRANSITION;
231 	ftie_len = pos++;
232 	ftie = (struct rsn_ftie *) pos;
233 	pos += sizeof(*ftie);
234 	os_memcpy(ftie->snonce, sm->snonce, WPA_NONCE_LEN);
235 	if (anonce)
236 		os_memcpy(ftie->anonce, anonce, WPA_NONCE_LEN);
237 	/* R0KH-ID sub-element */
238 	*pos++ = FTIE_SUBELEM_R0KH_ID;
239 	*pos++ = sm->r0kh_id_len;
240 	os_memcpy(pos, sm->r0kh_id, sm->r0kh_id_len);
241 	pos += sm->r0kh_id_len;
242 	*ftie_len = pos - ftie_len - 1;
243 
244 	if (kck) {
245 		/*
246 		 * IEEE Std 802.11r-2008, 11A.8.4
247 		 * MIC shall be calculated over:
248 		 * non-AP STA MAC address
249 		 * Target AP MAC address
250 		 * Transaction seq number (5 for ReassocReq, 3 otherwise)
251 		 * RSN IE
252 		 * MDIE
253 		 * FTIE (with MIC field set to 0)
254 		 * RIC-Request (if present)
255 		 */
256 		ftie->mic_control[1] = 3; /* Information element count */
257 		if (wpa_ft_mic(kck, sm->own_addr, target_ap, 5,
258 			       ((u8 *) mdie) - 2, 2 + sizeof(*mdie),
259 			       ftie_pos, 2 + *ftie_len,
260 			       (u8 *) rsnie, 2 + rsnie->len, NULL, 0,
261 			       ftie->mic) < 0) {
262 			wpa_printf(MSG_INFO, "FT: Failed to calculate MIC");
263 			os_free(buf);
264 			return NULL;
265 		}
266 	}
267 
268 	*len = pos - buf;
269 
270 	return buf;
271 }
272 
273 
274 struct wpa_ft_ies {
275 	const u8 *mdie;
276 	size_t mdie_len;
277 	const u8 *ftie;
278 	size_t ftie_len;
279 	const u8 *r1kh_id;
280 	const u8 *gtk;
281 	size_t gtk_len;
282 	const u8 *r0kh_id;
283 	size_t r0kh_id_len;
284 	const u8 *rsn;
285 	size_t rsn_len;
286 	const u8 *rsn_pmkid;
287 	const u8 *tie;
288 	size_t tie_len;
289 	const u8 *igtk;
290 	size_t igtk_len;
291 };
292 
293 
294 static int wpa_ft_parse_ftie(const u8 *ie, size_t ie_len,
295 			     struct wpa_ft_ies *parse)
296 {
297 	const u8 *end, *pos;
298 
299 	parse->ftie = ie;
300 	parse->ftie_len = ie_len;
301 
302 	pos = ie + sizeof(struct rsn_ftie);
303 	end = ie + ie_len;
304 
305 	while (pos + 2 <= end && pos + 2 + pos[1] <= end) {
306 		switch (pos[0]) {
307 		case FTIE_SUBELEM_R1KH_ID:
308 			if (pos[1] != FT_R1KH_ID_LEN) {
309 				wpa_printf(MSG_DEBUG, "FT: Invalid R1KH-ID "
310 					   "length in FTIE: %d", pos[1]);
311 				return -1;
312 			}
313 			parse->r1kh_id = pos + 2;
314 			break;
315 		case FTIE_SUBELEM_GTK:
316 			parse->gtk = pos + 2;
317 			parse->gtk_len = pos[1];
318 			break;
319 		case FTIE_SUBELEM_R0KH_ID:
320 			if (pos[1] < 1 || pos[1] > FT_R0KH_ID_MAX_LEN) {
321 				wpa_printf(MSG_DEBUG, "FT: Invalid R0KH-ID "
322 					   "length in FTIE: %d", pos[1]);
323 				return -1;
324 			}
325 			parse->r0kh_id = pos + 2;
326 			parse->r0kh_id_len = pos[1];
327 			break;
328 #ifdef CONFIG_IEEE80211W
329 		case FTIE_SUBELEM_IGTK:
330 			parse->igtk = pos + 2;
331 			parse->igtk_len = pos[1];
332 			break;
333 #endif /* CONFIG_IEEE80211W */
334 		}
335 
336 		pos += 2 + pos[1];
337 	}
338 
339 	return 0;
340 }
341 
342 
343 static int wpa_ft_parse_ies(const u8 *ies, size_t ies_len,
344 			    struct wpa_ft_ies *parse)
345 {
346 	const u8 *end, *pos;
347 	struct wpa_ie_data data;
348 	int ret;
349 
350 	os_memset(parse, 0, sizeof(*parse));
351 	if (ies == NULL)
352 		return 0;
353 
354 	pos = ies;
355 	end = ies + ies_len;
356 	while (pos + 2 <= end && pos + 2 + pos[1] <= end) {
357 		switch (pos[0]) {
358 		case WLAN_EID_RSN:
359 			parse->rsn = pos + 2;
360 			parse->rsn_len = pos[1];
361 			ret = wpa_parse_wpa_ie_rsn(parse->rsn - 2,
362 						   parse->rsn_len + 2,
363 						   &data);
364 			if (ret < 0) {
365 				wpa_printf(MSG_DEBUG, "FT: Failed to parse "
366 					   "RSN IE: %d", ret);
367 				return -1;
368 			}
369 			if (data.num_pmkid == 1 && data.pmkid)
370 				parse->rsn_pmkid = data.pmkid;
371 			break;
372 		case WLAN_EID_MOBILITY_DOMAIN:
373 			parse->mdie = pos + 2;
374 			parse->mdie_len = pos[1];
375 			break;
376 		case WLAN_EID_FAST_BSS_TRANSITION:
377 			if (wpa_ft_parse_ftie(pos + 2, pos[1], parse) < 0)
378 				return -1;
379 			break;
380 		case WLAN_EID_TIMEOUT_INTERVAL:
381 			parse->tie = pos + 2;
382 			parse->tie_len = pos[1];
383 			break;
384 		}
385 
386 		pos += 2 + pos[1];
387 	}
388 
389 	return 0;
390 }
391 
392 
393 static int wpa_ft_install_ptk(struct wpa_sm *sm, const u8 *bssid)
394 {
395 	int keylen;
396 	wpa_alg alg;
397 	u8 null_rsc[6] = { 0, 0, 0, 0, 0, 0 };
398 
399 	wpa_printf(MSG_DEBUG, "FT: Installing PTK to the driver.");
400 
401 	switch (sm->pairwise_cipher) {
402 	case WPA_CIPHER_CCMP:
403 		alg = WPA_ALG_CCMP;
404 		keylen = 16;
405 		break;
406 	case WPA_CIPHER_TKIP:
407 		alg = WPA_ALG_TKIP;
408 		keylen = 32;
409 		break;
410 	default:
411 		wpa_printf(MSG_WARNING, "FT: Unsupported pairwise cipher %d",
412 			   sm->pairwise_cipher);
413 		return -1;
414 	}
415 
416 	if (wpa_sm_set_key(sm, alg, bssid, 0, 1, null_rsc,
417 			   sizeof(null_rsc), (u8 *) sm->ptk.tk1, keylen) < 0) {
418 		wpa_printf(MSG_WARNING, "FT: Failed to set PTK to the driver");
419 		return -1;
420 	}
421 
422 	return 0;
423 }
424 
425 
426 /**
427  * wpa_ft_prepare_auth_request - Generate over-the-air auth request
428  * @sm: Pointer to WPA state machine data from wpa_sm_init()
429  * Returns: 0 on success, -1 on failure
430  */
431 int wpa_ft_prepare_auth_request(struct wpa_sm *sm)
432 {
433 	u8 *ft_ies;
434 	size_t ft_ies_len;
435 
436 	/* Generate a new SNonce */
437 	if (os_get_random(sm->snonce, WPA_NONCE_LEN)) {
438 		wpa_printf(MSG_INFO, "FT: Failed to generate a new SNonce");
439 		return -1;
440 	}
441 
442 	ft_ies = wpa_ft_gen_req_ies(sm, &ft_ies_len, NULL, sm->pmk_r0_name,
443 				    NULL, sm->bssid);
444 	if (ft_ies) {
445 		wpa_sm_update_ft_ies(sm, sm->mobility_domain,
446 				     ft_ies, ft_ies_len);
447 		os_free(ft_ies);
448 	}
449 
450 	return 0;
451 }
452 
453 
454 int wpa_ft_process_response(struct wpa_sm *sm, const u8 *ies, size_t ies_len,
455 			    int ft_action, const u8 *target_ap)
456 {
457 	u8 *ft_ies;
458 	size_t ft_ies_len;
459 	struct wpa_ft_ies parse;
460 	struct rsn_mdie *mdie;
461 	struct rsn_ftie *ftie;
462 	u8 ptk_name[WPA_PMK_NAME_LEN];
463 	int ret;
464 	const u8 *bssid;
465 
466 	wpa_hexdump(MSG_DEBUG, "FT: Response IEs", ies, ies_len);
467 
468 	if (ft_action) {
469 		if (!sm->over_the_ds_in_progress) {
470 			wpa_printf(MSG_DEBUG, "FT: No over-the-DS in progress "
471 				   "- drop FT Action Response");
472 			return -1;
473 		}
474 
475 		if (os_memcmp(target_ap, sm->target_ap, ETH_ALEN) != 0) {
476 			wpa_printf(MSG_DEBUG, "FT: No over-the-DS in progress "
477 				   "with this Target AP - drop FT Action "
478 				   "Response");
479 			return -1;
480 		}
481 	}
482 
483 	if (sm->key_mgmt != WPA_KEY_MGMT_FT_IEEE8021X &&
484 	    sm->key_mgmt != WPA_KEY_MGMT_FT_PSK) {
485 		wpa_printf(MSG_DEBUG, "FT: Reject FT IEs since FT is not "
486 			   "enabled for this connection");
487 		return -1;
488 	}
489 
490 	if (wpa_ft_parse_ies(ies, ies_len, &parse) < 0) {
491 		wpa_printf(MSG_DEBUG, "FT: Failed to parse IEs");
492 		return -1;
493 	}
494 
495 	mdie = (struct rsn_mdie *) parse.mdie;
496 	if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
497 	    os_memcmp(mdie->mobility_domain, sm->mobility_domain,
498 		      MOBILITY_DOMAIN_ID_LEN) != 0) {
499 		wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
500 		return -1;
501 	}
502 
503 	ftie = (struct rsn_ftie *) parse.ftie;
504 	if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
505 		wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
506 		return -1;
507 	}
508 
509 	if (parse.r0kh_id == NULL) {
510 		wpa_printf(MSG_DEBUG, "FT: No R0KH-ID subelem in FTIE");
511 		return -1;
512 	}
513 
514 	if (parse.r0kh_id_len != sm->r0kh_id_len ||
515 	    os_memcmp(parse.r0kh_id, sm->r0kh_id, parse.r0kh_id_len) != 0) {
516 		wpa_printf(MSG_DEBUG, "FT: R0KH-ID in FTIE did not match with "
517 			   "the current R0KH-ID");
518 		wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID in FTIE",
519 			    parse.r0kh_id, parse.r0kh_id_len);
520 		wpa_hexdump(MSG_DEBUG, "FT: The current R0KH-ID",
521 			    sm->r0kh_id, sm->r0kh_id_len);
522 		return -1;
523 	}
524 
525 	if (parse.r1kh_id == NULL) {
526 		wpa_printf(MSG_DEBUG, "FT: No R1KH-ID subelem in FTIE");
527 		return -1;
528 	}
529 
530 	if (parse.rsn_pmkid == NULL ||
531 	    os_memcmp(parse.rsn_pmkid, sm->pmk_r0_name, WPA_PMK_NAME_LEN)) {
532 		wpa_printf(MSG_DEBUG, "FT: No matching PMKR0Name (PMKID) in "
533 			   "RSNIE");
534 		return -1;
535 	}
536 
537 	os_memcpy(sm->r1kh_id, parse.r1kh_id, FT_R1KH_ID_LEN);
538 	wpa_hexdump(MSG_DEBUG, "FT: R1KH-ID", sm->r1kh_id, FT_R1KH_ID_LEN);
539 	wpa_hexdump(MSG_DEBUG, "FT: SNonce", sm->snonce, WPA_NONCE_LEN);
540 	wpa_hexdump(MSG_DEBUG, "FT: ANonce", ftie->anonce, WPA_NONCE_LEN);
541 	wpa_derive_pmk_r1(sm->pmk_r0, sm->pmk_r0_name, sm->r1kh_id,
542 			  sm->own_addr, sm->pmk_r1, sm->pmk_r1_name);
543 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", sm->pmk_r1, PMK_LEN);
544 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name",
545 		    sm->pmk_r1_name, WPA_PMK_NAME_LEN);
546 
547 	bssid = target_ap;
548 	wpa_pmk_r1_to_ptk(sm->pmk_r1, sm->snonce, ftie->anonce, sm->own_addr,
549 			  bssid, sm->pmk_r1_name,
550 			  (u8 *) &sm->ptk, sizeof(sm->ptk), ptk_name);
551 	wpa_hexdump_key(MSG_DEBUG, "FT: PTK",
552 			(u8 *) &sm->ptk, sizeof(sm->ptk));
553 	wpa_hexdump(MSG_DEBUG, "FT: PTKName", ptk_name, WPA_PMK_NAME_LEN);
554 
555 	ft_ies = wpa_ft_gen_req_ies(sm, &ft_ies_len, ftie->anonce,
556 				    sm->pmk_r1_name, sm->ptk.kck, bssid);
557 	if (ft_ies) {
558 		wpa_sm_update_ft_ies(sm, sm->mobility_domain,
559 				     ft_ies, ft_ies_len);
560 		os_free(ft_ies);
561 	}
562 
563 	ret = wpa_ft_install_ptk(sm, bssid);
564 
565 	if (ret == 0) {
566 		sm->ft_completed = 1;
567 		if (ft_action) {
568 			/* TODO: trigger re-association to the Target AP;
569 			 * MLME is now doing this automatically, but it should
570 			 * really be done only if we get here successfully. */
571 			os_memcpy(sm->bssid, target_ap, ETH_ALEN);
572 		}
573 	}
574 
575 	return ret;
576 }
577 
578 
579 int wpa_ft_is_completed(struct wpa_sm *sm)
580 {
581 	if (sm == NULL)
582 		return 0;
583 
584 	if (sm->key_mgmt != WPA_KEY_MGMT_FT_IEEE8021X &&
585 	    sm->key_mgmt != WPA_KEY_MGMT_FT_PSK)
586 		return 0;
587 
588 	return sm->ft_completed;
589 }
590 
591 
592 static int wpa_ft_process_gtk_subelem(struct wpa_sm *sm, const u8 *gtk_elem,
593 				      size_t gtk_elem_len)
594 {
595 	u8 gtk[32];
596 	int keyidx;
597 	wpa_alg alg;
598 	size_t gtk_len, keylen, rsc_len;
599 
600 	if (gtk_elem == NULL) {
601 		wpa_printf(MSG_DEBUG, "FT: No GTK included in FTIE");
602 		return 0;
603 	}
604 
605 	wpa_hexdump_key(MSG_DEBUG, "FT: Received GTK in Reassoc Resp",
606 			gtk_elem, gtk_elem_len);
607 
608 	if (gtk_elem_len < 10 + 24 || (gtk_elem_len - 10) % 8 ||
609 	    gtk_elem_len - 18 > sizeof(gtk)) {
610 		wpa_printf(MSG_DEBUG, "FT: Invalid GTK sub-elem "
611 			   "length %lu", (unsigned long) gtk_elem_len);
612 		return -1;
613 	}
614 	gtk_len = gtk_elem_len - 18;
615 	if (aes_unwrap(sm->ptk.kek, gtk_len / 8, gtk_elem + 10, gtk)) {
616 		wpa_printf(MSG_WARNING, "FT: AES unwrap failed - could not "
617 			   "decrypt GTK");
618 		return -1;
619 	}
620 
621 	switch (sm->group_cipher) {
622 	case WPA_CIPHER_CCMP:
623 		keylen = 16;
624 		rsc_len = 6;
625 		alg = WPA_ALG_CCMP;
626 		break;
627 	case WPA_CIPHER_TKIP:
628 		keylen = 32;
629 		rsc_len = 6;
630 		alg = WPA_ALG_TKIP;
631 		break;
632 	case WPA_CIPHER_WEP104:
633 		keylen = 13;
634 		rsc_len = 0;
635 		alg = WPA_ALG_WEP;
636 		break;
637 	case WPA_CIPHER_WEP40:
638 		keylen = 5;
639 		rsc_len = 0;
640 		alg = WPA_ALG_WEP;
641 		break;
642 	default:
643 		wpa_printf(MSG_WARNING, "WPA: Unsupported Group Cipher %d",
644 			   sm->group_cipher);
645 		return -1;
646 	}
647 
648 	if (gtk_len < keylen) {
649 		wpa_printf(MSG_DEBUG, "FT: Too short GTK in FTIE");
650 		return -1;
651 	}
652 
653 	/* Key Info[1] | Key Length[1] | RSC[8] | Key[5..32]. */
654 
655 	keyidx = gtk_elem[0] & 0x03;
656 
657 	if (gtk_elem[1] != keylen) {
658 		wpa_printf(MSG_DEBUG, "FT: GTK length mismatch: received %d "
659 			   "negotiated %lu",
660 			   gtk_elem[1], (unsigned long) keylen);
661 		return -1;
662 	}
663 
664 	wpa_hexdump_key(MSG_DEBUG, "FT: GTK from Reassoc Resp", gtk, keylen);
665 	if (wpa_sm_set_key(sm, alg, (u8 *) "\xff\xff\xff\xff\xff\xff",
666 			   keyidx, 0, gtk_elem + 2, rsc_len, gtk, keylen) <
667 	    0) {
668 		wpa_printf(MSG_WARNING, "WPA: Failed to set GTK to the "
669 			   "driver.");
670 		return -1;
671 	}
672 
673 	return 0;
674 }
675 
676 
677 #ifdef CONFIG_IEEE80211W
678 static int wpa_ft_process_igtk_subelem(struct wpa_sm *sm, const u8 *igtk_elem,
679 				       size_t igtk_elem_len)
680 {
681 	u8 igtk[WPA_IGTK_LEN];
682 	u16 keyidx;
683 
684 	if (sm->mgmt_group_cipher != WPA_CIPHER_AES_128_CMAC)
685 		return 0;
686 
687 	if (igtk_elem == NULL) {
688 		wpa_printf(MSG_DEBUG, "FT: No IGTK included in FTIE");
689 		return 0;
690 	}
691 
692 	wpa_hexdump_key(MSG_DEBUG, "FT: Received IGTK in Reassoc Resp",
693 			igtk_elem, igtk_elem_len);
694 
695 	if (igtk_elem_len != 2 + 6 + 1 + WPA_IGTK_LEN + 8) {
696 		wpa_printf(MSG_DEBUG, "FT: Invalid IGTK sub-elem "
697 			   "length %lu", (unsigned long) igtk_elem_len);
698 		return -1;
699 	}
700 	if (igtk_elem[8] != WPA_IGTK_LEN) {
701 		wpa_printf(MSG_DEBUG, "FT: Invalid IGTK sub-elem Key Length "
702 			   "%d", igtk_elem[8]);
703 		return -1;
704 	}
705 
706 	if (aes_unwrap(sm->ptk.kek, WPA_IGTK_LEN / 8, igtk_elem + 9, igtk)) {
707 		wpa_printf(MSG_WARNING, "FT: AES unwrap failed - could not "
708 			   "decrypt IGTK");
709 		return -1;
710 	}
711 
712 	/* KeyID[2] | IPN[6] | Key Length[1] | Key[16+8] */
713 
714 	keyidx = WPA_GET_LE16(igtk_elem);
715 
716 	wpa_hexdump_key(MSG_DEBUG, "FT: IGTK from Reassoc Resp", igtk,
717 			WPA_IGTK_LEN);
718 	if (wpa_sm_set_key(sm, WPA_ALG_IGTK, (u8 *) "\xff\xff\xff\xff\xff\xff",
719 			   keyidx, 0, igtk_elem + 2, 6, igtk, WPA_IGTK_LEN) <
720 	    0) {
721 		wpa_printf(MSG_WARNING, "WPA: Failed to set IGTK to the "
722 			   "driver.");
723 		return -1;
724 	}
725 
726 	return 0;
727 }
728 #endif /* CONFIG_IEEE80211W */
729 
730 
731 int wpa_ft_validate_reassoc_resp(struct wpa_sm *sm, const u8 *ies,
732 				 size_t ies_len, const u8 *src_addr)
733 {
734 	struct wpa_ft_ies parse;
735 	struct rsn_mdie *mdie;
736 	struct rsn_ftie *ftie;
737 	size_t count;
738 	u8 mic[16];
739 
740 	wpa_hexdump(MSG_DEBUG, "FT: Response IEs", ies, ies_len);
741 
742 	if (sm->key_mgmt != WPA_KEY_MGMT_FT_IEEE8021X &&
743 	    sm->key_mgmt != WPA_KEY_MGMT_FT_PSK) {
744 		wpa_printf(MSG_DEBUG, "FT: Reject FT IEs since FT is not "
745 			   "enabled for this connection");
746 		return -1;
747 	}
748 
749 	if (wpa_ft_parse_ies(ies, ies_len, &parse) < 0) {
750 		wpa_printf(MSG_DEBUG, "FT: Failed to parse IEs");
751 		return -1;
752 	}
753 
754 	mdie = (struct rsn_mdie *) parse.mdie;
755 	if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
756 	    os_memcmp(mdie->mobility_domain, sm->mobility_domain,
757 		      MOBILITY_DOMAIN_ID_LEN) != 0) {
758 		wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
759 		return -1;
760 	}
761 
762 	ftie = (struct rsn_ftie *) parse.ftie;
763 	if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
764 		wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
765 		return -1;
766 	}
767 
768 	if (parse.r0kh_id == NULL) {
769 		wpa_printf(MSG_DEBUG, "FT: No R0KH-ID subelem in FTIE");
770 		return -1;
771 	}
772 
773 	if (parse.r0kh_id_len != sm->r0kh_id_len ||
774 	    os_memcmp(parse.r0kh_id, sm->r0kh_id, parse.r0kh_id_len) != 0) {
775 		wpa_printf(MSG_DEBUG, "FT: R0KH-ID in FTIE did not match with "
776 			   "the current R0KH-ID");
777 		wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID in FTIE",
778 			    parse.r0kh_id, parse.r0kh_id_len);
779 		wpa_hexdump(MSG_DEBUG, "FT: The current R0KH-ID",
780 			    sm->r0kh_id, sm->r0kh_id_len);
781 		return -1;
782 	}
783 
784 	if (parse.r1kh_id == NULL) {
785 		wpa_printf(MSG_DEBUG, "FT: No R1KH-ID subelem in FTIE");
786 		return -1;
787 	}
788 
789 	if (os_memcmp(parse.r1kh_id, sm->r1kh_id, FT_R1KH_ID_LEN) != 0) {
790 		wpa_printf(MSG_DEBUG, "FT: Unknown R1KH-ID used in "
791 			   "ReassocResp");
792 		return -1;
793 	}
794 
795 	if (parse.rsn_pmkid == NULL ||
796 	    os_memcmp(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN)) {
797 		wpa_printf(MSG_DEBUG, "FT: No matching PMKR1Name (PMKID) in "
798 			   "RSNIE (pmkid=%d)", !!parse.rsn_pmkid);
799 		return -1;
800 	}
801 
802 	count = 3;
803 	if (parse.tie)
804 		count++;
805 
806 	if (ftie->mic_control[1] != count) {
807 		wpa_printf(MSG_DEBUG, "FT: Unexpected IE count in FTIE (%d)",
808 			   ftie->mic_control[1]);
809 		return -1;
810 	}
811 
812 	if (wpa_ft_mic(sm->ptk.kck, sm->own_addr, src_addr, 6,
813 		       parse.mdie - 2, parse.mdie_len + 2,
814 		       parse.ftie - 2, parse.ftie_len + 2,
815 		       parse.rsn - 2, parse.rsn_len + 2, NULL, 0,
816 		       mic) < 0) {
817 		wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC");
818 		return -1;
819 	}
820 
821 	if (os_memcmp(mic, ftie->mic, 16) != 0) {
822 		wpa_printf(MSG_DEBUG, "FT: Invalid MIC in FTIE");
823 		wpa_hexdump(MSG_MSGDUMP, "FT: Received MIC", ftie->mic, 16);
824 		wpa_hexdump(MSG_MSGDUMP, "FT: Calculated MIC", mic, 16);
825 		return -1;
826 	}
827 
828 	if (wpa_ft_process_gtk_subelem(sm, parse.gtk, parse.gtk_len) < 0)
829 		return -1;
830 
831 #ifdef CONFIG_IEEE80211W
832 	if (wpa_ft_process_igtk_subelem(sm, parse.igtk, parse.igtk_len) < 0)
833 		return -1;
834 #endif /* CONFIG_IEEE80211W */
835 
836 	return 0;
837 }
838 
839 
840 /**
841  * wpa_ft_start_over_ds - Generate over-the-DS auth request
842  * @sm: Pointer to WPA state machine data from wpa_sm_init()
843  * Returns: 0 on success, -1 on failure
844  */
845 int wpa_ft_start_over_ds(struct wpa_sm *sm, const u8 *target_ap)
846 {
847 	u8 *ft_ies;
848 	size_t ft_ies_len;
849 
850 	wpa_printf(MSG_DEBUG, "FT: Request over-the-DS with " MACSTR,
851 		   MAC2STR(target_ap));
852 
853 	/* Generate a new SNonce */
854 	if (os_get_random(sm->snonce, WPA_NONCE_LEN)) {
855 		wpa_printf(MSG_INFO, "FT: Failed to generate a new SNonce");
856 		return -1;
857 	}
858 
859 	ft_ies = wpa_ft_gen_req_ies(sm, &ft_ies_len, NULL, sm->pmk_r0_name,
860 				    NULL, target_ap);
861 	if (ft_ies) {
862 		sm->over_the_ds_in_progress = 1;
863 		os_memcpy(sm->target_ap, target_ap, ETH_ALEN);
864 		wpa_sm_send_ft_action(sm, 1, target_ap, ft_ies, ft_ies_len);
865 		os_free(ft_ies);
866 	}
867 
868 	return 0;
869 }
870 
871 #endif /* CONFIG_IEEE80211R */
872