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