• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * hostapd - IEEE 802.11r - Fast BSS Transition
3  * Copyright (c) 2004-2018, 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 "utils/includes.h"
10 
11 #include "utils/common.h"
12 #include "utils/eloop.h"
13 #include "utils/list.h"
14 #include "common/ieee802_11_defs.h"
15 #include "common/ieee802_11_common.h"
16 #include "common/ocv.h"
17 #include "drivers/driver.h"
18 #include "crypto/aes.h"
19 #include "crypto/aes_siv.h"
20 #include "crypto/aes_wrap.h"
21 #include "crypto/sha384.h"
22 #include "crypto/random.h"
23 #include "ap_config.h"
24 #include "ieee802_11.h"
25 #include "wmm.h"
26 #include "wpa_auth.h"
27 #include "wpa_auth_i.h"
28 #include "pmksa_cache_auth.h"
29 
30 
31 #ifdef CONFIG_IEEE80211R_AP
32 
33 const unsigned int ftRRBseqTimeout = 10;
34 const unsigned int ftRRBmaxQueueLen = 100;
35 
36 
37 static int wpa_ft_send_rrb_auth_resp(struct wpa_state_machine *sm,
38 				     const u8 *current_ap, const u8 *sta_addr,
39 				     u16 status, const u8 *resp_ies,
40 				     size_t resp_ies_len);
41 static void ft_finish_pull(struct wpa_state_machine *sm);
42 static void wpa_ft_expire_pull(void *eloop_ctx, void *timeout_ctx);
43 static void wpa_ft_rrb_seq_timeout(void *eloop_ctx, void *timeout_ctx);
44 
45 struct tlv_list {
46 	u16 type;
47 	size_t len;
48 	const u8 *data;
49 };
50 
51 
52 /**
53  * wpa_ft_rrb_decrypt - Decrypt FT RRB message
54  * @key: AES-SIV key for AEAD
55  * @key_len: Length of key in octets
56  * @enc: Pointer to encrypted TLVs
57  * @enc_len: Length of encrypted TLVs in octets
58  * @auth: Pointer to authenticated TLVs
59  * @auth_len: Length of authenticated TLVs in octets
60  * @src_addr: MAC address of the frame sender
61  * @type: Vendor-specific subtype of the RRB frame (FT_PACKET_*)
62  * @plain: Pointer to return the pointer to the allocated plaintext buffer;
63  *	needs to be freed by the caller if not NULL;
64  *	will only be returned on success
65  * @plain_len: Pointer to return the length of the allocated plaintext buffer
66  *	in octets
67  * Returns: 0 on success, -1 on error
68  */
wpa_ft_rrb_decrypt(const u8 * key,const size_t key_len,const u8 * enc,size_t enc_len,const u8 * auth,const size_t auth_len,const u8 * src_addr,u8 type,u8 ** plain,size_t * plain_size)69 static int wpa_ft_rrb_decrypt(const u8 *key, const size_t key_len,
70 			      const u8 *enc, size_t enc_len,
71 			      const u8 *auth, const size_t auth_len,
72 			      const u8 *src_addr, u8 type,
73 			      u8 **plain, size_t *plain_size)
74 {
75 	const u8 *ad[3] = { src_addr, auth, &type };
76 	size_t ad_len[3] = { ETH_ALEN, auth_len, sizeof(type) };
77 
78 	wpa_printf(MSG_DEBUG, "FT(RRB): src_addr=" MACSTR " type=%u",
79 		   MAC2STR(src_addr), type);
80 	wpa_hexdump_key(MSG_DEBUG, "FT(RRB): decrypt using key", key, key_len);
81 	wpa_hexdump(MSG_DEBUG, "FT(RRB): encrypted TLVs", enc, enc_len);
82 	wpa_hexdump(MSG_DEBUG, "FT(RRB): authenticated TLVs", auth, auth_len);
83 
84 	if (!key) { /* skip decryption */
85 		*plain = os_memdup(enc, enc_len);
86 		if (enc_len > 0 && !*plain)
87 			goto err;
88 
89 		*plain_size = enc_len;
90 
91 		return 0;
92 	}
93 
94 	*plain = NULL;
95 
96 	/* SIV overhead */
97 	if (enc_len < AES_BLOCK_SIZE)
98 		goto err;
99 
100 	*plain = os_zalloc(enc_len - AES_BLOCK_SIZE);
101 	if (!*plain)
102 		goto err;
103 
104 	if (aes_siv_decrypt(key, key_len, enc, enc_len, 3, ad, ad_len,
105 			    *plain) < 0) {
106 		if (enc_len < AES_BLOCK_SIZE + 2)
107 			goto err;
108 
109 		/* Try to work around Ethernet devices that add extra
110 		 * two octet padding even if the frame is longer than
111 		 * the minimum Ethernet frame. */
112 		enc_len -= 2;
113 		if (aes_siv_decrypt(key, key_len, enc, enc_len, 3, ad, ad_len,
114 				    *plain) < 0)
115 			goto err;
116 	}
117 
118 	*plain_size = enc_len - AES_BLOCK_SIZE;
119 	wpa_hexdump_key(MSG_DEBUG, "FT(RRB): decrypted TLVs",
120 			*plain, *plain_size);
121 	return 0;
122 err:
123 	os_free(*plain);
124 	*plain = NULL;
125 	*plain_size = 0;
126 
127 	wpa_printf(MSG_ERROR, "FT(RRB): Failed to decrypt");
128 
129 	return -1;
130 }
131 
132 
133 /* get first tlv record in packet matching type
134  * @data (decrypted) packet
135  * @return 0 on success else -1
136  */
wpa_ft_rrb_get_tlv(const u8 * plain,size_t plain_len,u16 type,size_t * tlv_len,const u8 ** tlv_data)137 static int wpa_ft_rrb_get_tlv(const u8 *plain, size_t plain_len,
138 			      u16 type, size_t *tlv_len, const u8 **tlv_data)
139 {
140 	const struct ft_rrb_tlv *f;
141 	size_t left;
142 	le16 type16;
143 	size_t len;
144 
145 	left = plain_len;
146 	type16 = host_to_le16(type);
147 
148 	while (left >= sizeof(*f)) {
149 		f = (const struct ft_rrb_tlv *) plain;
150 
151 		left -= sizeof(*f);
152 		plain += sizeof(*f);
153 		len = le_to_host16(f->len);
154 
155 		if (left < len) {
156 			wpa_printf(MSG_DEBUG, "FT: RRB message truncated");
157 			break;
158 		}
159 
160 		if (f->type == type16) {
161 			*tlv_len = len;
162 			*tlv_data = plain;
163 			return 0;
164 		}
165 
166 		left -= len;
167 		plain += len;
168 	}
169 
170 	return -1;
171 }
172 
173 
wpa_ft_rrb_dump(const u8 * plain,const size_t plain_len)174 static void wpa_ft_rrb_dump(const u8 *plain, const size_t plain_len)
175 {
176 	const struct ft_rrb_tlv *f;
177 	size_t left;
178 	size_t len;
179 
180 	left = plain_len;
181 
182 	wpa_printf(MSG_DEBUG, "FT: RRB dump message");
183 	while (left >= sizeof(*f)) {
184 		f = (const struct ft_rrb_tlv *) plain;
185 
186 		left -= sizeof(*f);
187 		plain += sizeof(*f);
188 		len = le_to_host16(f->len);
189 
190 		wpa_printf(MSG_DEBUG, "FT: RRB TLV type = %d, len = %zu",
191 			   le_to_host16(f->type), len);
192 
193 		if (left < len) {
194 			wpa_printf(MSG_DEBUG,
195 				   "FT: RRB message truncated: left %zu bytes, need %zu",
196 				   left, len);
197 			break;
198 		}
199 
200 		wpa_hexdump(MSG_DEBUG, "FT: RRB TLV data", plain, len);
201 
202 		left -= len;
203 		plain += len;
204 	}
205 
206 	if (left > 0)
207 		wpa_hexdump(MSG_DEBUG, "FT: RRB TLV padding", plain, left);
208 
209 	wpa_printf(MSG_DEBUG, "FT: RRB dump message end");
210 }
211 
212 
cmp_int(const void * a,const void * b)213 static int cmp_int(const void *a, const void *b)
214 {
215 	int x, y;
216 
217 	x = *((int *) a);
218 	y = *((int *) b);
219 	return x - y;
220 }
221 
222 
wpa_ft_rrb_get_tlv_vlan(const u8 * plain,const size_t plain_len,struct vlan_description * vlan)223 static int wpa_ft_rrb_get_tlv_vlan(const u8 *plain, const size_t plain_len,
224 				   struct vlan_description *vlan)
225 {
226 	struct ft_rrb_tlv *f;
227 	size_t left;
228 	size_t len;
229 	int taggedidx;
230 	int vlan_id;
231 	int type;
232 
233 	left = plain_len;
234 	taggedidx = 0;
235 	os_memset(vlan, 0, sizeof(*vlan));
236 
237 	while (left >= sizeof(*f)) {
238 		f = (struct ft_rrb_tlv *) plain;
239 
240 		left -= sizeof(*f);
241 		plain += sizeof(*f);
242 
243 		len = le_to_host16(f->len);
244 		type = le_to_host16(f->type);
245 
246 		if (left < len) {
247 			wpa_printf(MSG_DEBUG, "FT: RRB message truncated");
248 			return -1;
249 		}
250 
251 		if (type != FT_RRB_VLAN_UNTAGGED && type != FT_RRB_VLAN_TAGGED)
252 			goto skip;
253 
254 		if (type == FT_RRB_VLAN_UNTAGGED && len != sizeof(le16)) {
255 			wpa_printf(MSG_DEBUG,
256 				   "FT: RRB VLAN_UNTAGGED invalid length");
257 			return -1;
258 		}
259 
260 		if (type == FT_RRB_VLAN_TAGGED && len % sizeof(le16) != 0) {
261 			wpa_printf(MSG_DEBUG,
262 				   "FT: RRB VLAN_TAGGED invalid length");
263 			return -1;
264 		}
265 
266 		while (len >= sizeof(le16)) {
267 			vlan_id = WPA_GET_LE16(plain);
268 			plain += sizeof(le16);
269 			left -= sizeof(le16);
270 			len -= sizeof(le16);
271 
272 			if (vlan_id <= 0 || vlan_id > MAX_VLAN_ID) {
273 				wpa_printf(MSG_DEBUG,
274 					   "FT: RRB VLAN ID invalid %d",
275 					   vlan_id);
276 				continue;
277 			}
278 
279 			if (type == FT_RRB_VLAN_UNTAGGED)
280 				vlan->untagged = vlan_id;
281 
282 			if (type == FT_RRB_VLAN_TAGGED &&
283 			    taggedidx < MAX_NUM_TAGGED_VLAN) {
284 				vlan->tagged[taggedidx] = vlan_id;
285 				taggedidx++;
286 			} else if (type == FT_RRB_VLAN_TAGGED) {
287 				wpa_printf(MSG_DEBUG, "FT: RRB too many VLANs");
288 			}
289 		}
290 
291 	skip:
292 		left -= len;
293 		plain += len;
294 	}
295 
296 	if (taggedidx)
297 		qsort(vlan->tagged, taggedidx, sizeof(int), cmp_int);
298 
299 	vlan->notempty = vlan->untagged || vlan->tagged[0];
300 
301 	return 0;
302 }
303 
304 
wpa_ft_tlv_len(const struct tlv_list * tlvs)305 static size_t wpa_ft_tlv_len(const struct tlv_list *tlvs)
306 {
307 	size_t tlv_len = 0;
308 	int i;
309 
310 	if (!tlvs)
311 		return 0;
312 
313 	for (i = 0; tlvs[i].type != FT_RRB_LAST_EMPTY; i++) {
314 		tlv_len += sizeof(struct ft_rrb_tlv);
315 		tlv_len += tlvs[i].len;
316 	}
317 
318 	return tlv_len;
319 }
320 
321 
wpa_ft_tlv_lin(const struct tlv_list * tlvs,u8 * start,u8 * endpos)322 static size_t wpa_ft_tlv_lin(const struct tlv_list *tlvs, u8 *start,
323 			     u8 *endpos)
324 {
325 	int i;
326 	size_t tlv_len;
327 	struct ft_rrb_tlv *hdr;
328 	u8 *pos;
329 
330 	if (!tlvs)
331 		return 0;
332 
333 	tlv_len = 0;
334 	pos = start;
335 	for (i = 0; tlvs[i].type != FT_RRB_LAST_EMPTY; i++) {
336 		if (tlv_len + sizeof(*hdr) > (size_t) (endpos - start))
337 			return tlv_len;
338 		tlv_len += sizeof(*hdr);
339 		hdr = (struct ft_rrb_tlv *) pos;
340 		hdr->type = host_to_le16(tlvs[i].type);
341 		hdr->len = host_to_le16(tlvs[i].len);
342 		pos = start + tlv_len;
343 
344 		if (tlv_len + tlvs[i].len > (size_t) (endpos - start))
345 			return tlv_len;
346 		if (tlvs[i].len == 0)
347 			continue;
348 		tlv_len += tlvs[i].len;
349 		os_memcpy(pos, tlvs[i].data, tlvs[i].len);
350 		pos = start + tlv_len;
351 	}
352 
353 	return tlv_len;
354 }
355 
356 
wpa_ft_vlan_len(const struct vlan_description * vlan)357 static size_t wpa_ft_vlan_len(const struct vlan_description *vlan)
358 {
359 	size_t tlv_len = 0;
360 	int i;
361 
362 	if (!vlan || !vlan->notempty)
363 		return 0;
364 
365 	if (vlan->untagged) {
366 		tlv_len += sizeof(struct ft_rrb_tlv);
367 		tlv_len += sizeof(le16);
368 	}
369 	if (vlan->tagged[0])
370 		tlv_len += sizeof(struct ft_rrb_tlv);
371 	for (i = 0; i < MAX_NUM_TAGGED_VLAN && vlan->tagged[i]; i++)
372 		tlv_len += sizeof(le16);
373 
374 	return tlv_len;
375 }
376 
377 
wpa_ft_vlan_lin(const struct vlan_description * vlan,u8 * start,u8 * endpos)378 static size_t wpa_ft_vlan_lin(const struct vlan_description *vlan,
379 			      u8 *start, u8 *endpos)
380 {
381 	size_t tlv_len;
382 	int i, len;
383 	struct ft_rrb_tlv *hdr;
384 	u8 *pos = start;
385 
386 	if (!vlan || !vlan->notempty)
387 		return 0;
388 
389 	tlv_len = 0;
390 	if (vlan->untagged) {
391 		tlv_len += sizeof(*hdr);
392 		if (start + tlv_len > endpos)
393 			return tlv_len;
394 		hdr = (struct ft_rrb_tlv *) pos;
395 		hdr->type = host_to_le16(FT_RRB_VLAN_UNTAGGED);
396 		hdr->len = host_to_le16(sizeof(le16));
397 		pos = start + tlv_len;
398 
399 		tlv_len += sizeof(le16);
400 		if (start + tlv_len > endpos)
401 			return tlv_len;
402 		WPA_PUT_LE16(pos, vlan->untagged);
403 		pos = start + tlv_len;
404 	}
405 
406 	if (!vlan->tagged[0])
407 		return tlv_len;
408 
409 	tlv_len += sizeof(*hdr);
410 	if (start + tlv_len > endpos)
411 		return tlv_len;
412 	hdr = (struct ft_rrb_tlv *) pos;
413 	hdr->type = host_to_le16(FT_RRB_VLAN_TAGGED);
414 	len = 0; /* len is computed below */
415 	pos = start + tlv_len;
416 
417 	for (i = 0; i < MAX_NUM_TAGGED_VLAN && vlan->tagged[i]; i++) {
418 		tlv_len += sizeof(le16);
419 		if (start + tlv_len > endpos)
420 			break;
421 		len += sizeof(le16);
422 		WPA_PUT_LE16(pos, vlan->tagged[i]);
423 		pos = start + tlv_len;
424 	}
425 
426 	hdr->len = host_to_le16(len);
427 
428 	return tlv_len;
429 }
430 
431 
wpa_ft_rrb_lin(const struct tlv_list * tlvs1,const struct tlv_list * tlvs2,const struct vlan_description * vlan,u8 ** plain,size_t * plain_len)432 static int wpa_ft_rrb_lin(const struct tlv_list *tlvs1,
433 			  const struct tlv_list *tlvs2,
434 			  const struct vlan_description *vlan,
435 			  u8 **plain, size_t *plain_len)
436 {
437 	u8 *pos, *endpos;
438 	size_t tlv_len;
439 
440 	tlv_len = wpa_ft_tlv_len(tlvs1);
441 	tlv_len += wpa_ft_tlv_len(tlvs2);
442 	tlv_len += wpa_ft_vlan_len(vlan);
443 
444 	*plain_len = tlv_len;
445 	*plain = os_zalloc(tlv_len);
446 	if (!*plain) {
447 		wpa_printf(MSG_ERROR, "FT: Failed to allocate plaintext");
448 		goto err;
449 	}
450 
451 	pos = *plain;
452 	endpos = *plain + tlv_len;
453 	pos += wpa_ft_tlv_lin(tlvs1, pos, endpos);
454 	pos += wpa_ft_tlv_lin(tlvs2, pos, endpos);
455 	pos += wpa_ft_vlan_lin(vlan, pos, endpos);
456 
457 	/* sanity check */
458 	if (pos != endpos) {
459 		wpa_printf(MSG_ERROR, "FT: Length error building RRB");
460 		goto err;
461 	}
462 
463 	return 0;
464 
465 err:
466 	os_free(*plain);
467 	*plain = NULL;
468 	*plain_len = 0;
469 	return -1;
470 }
471 
472 
wpa_ft_rrb_encrypt(const u8 * key,const size_t key_len,const u8 * plain,const size_t plain_len,const u8 * auth,const size_t auth_len,const u8 * src_addr,u8 type,u8 * enc)473 static int wpa_ft_rrb_encrypt(const u8 *key, const size_t key_len,
474 			      const u8 *plain, const size_t plain_len,
475 			      const u8 *auth, const size_t auth_len,
476 			      const u8 *src_addr, u8 type, u8 *enc)
477 {
478 	const u8 *ad[3] = { src_addr, auth, &type };
479 	size_t ad_len[3] = { ETH_ALEN, auth_len, sizeof(type) };
480 
481 	wpa_printf(MSG_DEBUG, "FT(RRB): src_addr=" MACSTR " type=%u",
482 		   MAC2STR(src_addr), type);
483 	wpa_hexdump_key(MSG_DEBUG, "FT(RRB): plaintext message",
484 			plain, plain_len);
485 	wpa_hexdump_key(MSG_DEBUG, "FT(RRB): encrypt using key", key, key_len);
486 	wpa_hexdump(MSG_DEBUG, "FT(RRB): authenticated TLVs", auth, auth_len);
487 
488 	if (!key) {
489 		/* encryption not needed, return plaintext as packet */
490 		os_memcpy(enc, plain, plain_len);
491 	} else if (aes_siv_encrypt(key, key_len, plain, plain_len,
492 				   3, ad, ad_len, enc) < 0) {
493 		wpa_printf(MSG_ERROR, "FT: Failed to encrypt RRB-OUI message");
494 		return -1;
495 	}
496 	wpa_hexdump(MSG_DEBUG, "FT(RRB): encrypted TLVs",
497 		    enc, plain_len + AES_BLOCK_SIZE);
498 
499 	return 0;
500 }
501 
502 
503 /**
504  * wpa_ft_rrb_build - Build and encrypt an FT RRB message
505  * @key: AES-SIV key for AEAD
506  * @key_len: Length of key in octets
507  * @tlvs_enc0: First set of to-be-encrypted TLVs
508  * @tlvs_enc1: Second set of to-be-encrypted TLVs
509  * @tlvs_auth: Set of to-be-authenticated TLVs
510  * @src_addr: MAC address of the frame sender
511  * @type: Vendor-specific subtype of the RRB frame (FT_PACKET_*)
512  * @packet Pointer to return the pointer to the allocated packet buffer;
513  *         needs to be freed by the caller if not null;
514  *         will only be returned on success
515  * @packet_len: Pointer to return the length of the allocated buffer in octets
516  * Returns: 0 on success, -1 on error
517  */
wpa_ft_rrb_build(const u8 * key,const size_t key_len,const struct tlv_list * tlvs_enc0,const struct tlv_list * tlvs_enc1,const struct tlv_list * tlvs_auth,const struct vlan_description * vlan,const u8 * src_addr,u8 type,u8 ** packet,size_t * packet_len)518 static int wpa_ft_rrb_build(const u8 *key, const size_t key_len,
519 			    const struct tlv_list *tlvs_enc0,
520 			    const struct tlv_list *tlvs_enc1,
521 			    const struct tlv_list *tlvs_auth,
522 			    const struct vlan_description *vlan,
523 			    const u8 *src_addr, u8 type,
524 			    u8 **packet, size_t *packet_len)
525 {
526 	u8 *plain = NULL, *auth = NULL, *pos, *tmp;
527 	size_t plain_len = 0, auth_len = 0;
528 	int ret = -1;
529 	size_t pad_len = 0;
530 
531 	*packet = NULL;
532 	if (wpa_ft_rrb_lin(tlvs_enc0, tlvs_enc1, vlan, &plain, &plain_len) < 0)
533 		goto out;
534 
535 	if (wpa_ft_rrb_lin(tlvs_auth, NULL, NULL, &auth, &auth_len) < 0)
536 		goto out;
537 
538 	*packet_len = sizeof(u16) + auth_len + plain_len;
539 	if (key)
540 		*packet_len += AES_BLOCK_SIZE;
541 #define RRB_MIN_MSG_LEN 64
542 	if (*packet_len < RRB_MIN_MSG_LEN) {
543 		pad_len = RRB_MIN_MSG_LEN - *packet_len;
544 		if (pad_len < sizeof(struct ft_rrb_tlv))
545 			pad_len = sizeof(struct ft_rrb_tlv);
546 		wpa_printf(MSG_DEBUG,
547 			   "FT: Pad message to minimum Ethernet frame length (%d --> %d)",
548 			   (int) *packet_len, (int) (*packet_len + pad_len));
549 		*packet_len += pad_len;
550 		tmp = os_realloc(auth, auth_len + pad_len);
551 		if (!tmp)
552 			goto out;
553 		auth = tmp;
554 		pos = auth + auth_len;
555 		WPA_PUT_LE16(pos, FT_RRB_LAST_EMPTY);
556 		pos += 2;
557 		WPA_PUT_LE16(pos, pad_len - sizeof(struct ft_rrb_tlv));
558 		pos += 2;
559 		os_memset(pos, 0, pad_len - sizeof(struct ft_rrb_tlv));
560 		auth_len += pad_len;
561 
562 	}
563 	*packet = os_zalloc(*packet_len);
564 	if (!*packet)
565 		goto out;
566 
567 	pos = *packet;
568 	WPA_PUT_LE16(pos, auth_len);
569 	pos += 2;
570 	os_memcpy(pos, auth, auth_len);
571 	pos += auth_len;
572 	if (wpa_ft_rrb_encrypt(key, key_len, plain, plain_len, auth,
573 			       auth_len, src_addr, type, pos) < 0)
574 		goto out;
575 	wpa_hexdump(MSG_MSGDUMP, "FT: RRB frame payload", *packet, *packet_len);
576 
577 	ret = 0;
578 
579 out:
580 	bin_clear_free(plain, plain_len);
581 	os_free(auth);
582 
583 	if (ret) {
584 		wpa_printf(MSG_ERROR, "FT: Failed to build RRB-OUI message");
585 		os_free(*packet);
586 		*packet = NULL;
587 		*packet_len = 0;
588 	}
589 
590 	return ret;
591 }
592 
593 
594 #define RRB_GET_SRC(srcfield, type, field, txt, checklength) do { \
595 	if (wpa_ft_rrb_get_tlv(srcfield, srcfield##_len, type, \
596 				&f_##field##_len, &f_##field) < 0 || \
597 	    (checklength > 0 && ((size_t) checklength) != f_##field##_len)) { \
598 		wpa_printf(MSG_INFO, "FT: Missing required " #field \
599 			   " in %s from " MACSTR, txt, MAC2STR(src_addr)); \
600 		wpa_ft_rrb_dump(srcfield, srcfield##_len); \
601 		goto out; \
602 	} \
603 } while (0)
604 
605 #define RRB_GET(type, field, txt, checklength) \
606 	RRB_GET_SRC(plain, type, field, txt, checklength)
607 #define RRB_GET_AUTH(type, field, txt, checklength) \
608 	RRB_GET_SRC(auth, type, field, txt, checklength)
609 
610 #define RRB_GET_OPTIONAL_SRC(srcfield, type, field, txt, checklength) do { \
611 	if (wpa_ft_rrb_get_tlv(srcfield, srcfield##_len, type, \
612 				&f_##field##_len, &f_##field) < 0 || \
613 	    (checklength > 0 && ((size_t) checklength) != f_##field##_len)) { \
614 		wpa_printf(MSG_DEBUG, "FT: Missing optional " #field \
615 			   " in %s from " MACSTR, txt, MAC2STR(src_addr)); \
616 		f_##field##_len = 0; \
617 		f_##field = NULL; \
618 	} \
619 } while (0)
620 
621 #define RRB_GET_OPTIONAL(type, field, txt, checklength) \
622 	RRB_GET_OPTIONAL_SRC(plain, type, field, txt, checklength)
623 #define RRB_GET_OPTIONAL_AUTH(type, field, txt, checklength) \
624 	RRB_GET_OPTIONAL_SRC(auth, type, field, txt, checklength)
625 
wpa_ft_rrb_send(struct wpa_authenticator * wpa_auth,const u8 * dst,const u8 * data,size_t data_len)626 static int wpa_ft_rrb_send(struct wpa_authenticator *wpa_auth, const u8 *dst,
627 			   const u8 *data, size_t data_len)
628 {
629 	if (wpa_auth->cb->send_ether == NULL)
630 		return -1;
631 	wpa_printf(MSG_DEBUG, "FT: RRB send to " MACSTR, MAC2STR(dst));
632 	return wpa_auth->cb->send_ether(wpa_auth->cb_ctx, dst, ETH_P_RRB,
633 					data, data_len);
634 }
635 
636 
wpa_ft_rrb_oui_send(struct wpa_authenticator * wpa_auth,const u8 * dst,u8 oui_suffix,const u8 * data,size_t data_len)637 static int wpa_ft_rrb_oui_send(struct wpa_authenticator *wpa_auth,
638 			       const u8 *dst, u8 oui_suffix,
639 			       const u8 *data, size_t data_len)
640 {
641 	if (!wpa_auth->cb->send_oui)
642 		return -1;
643 	wpa_printf(MSG_DEBUG, "FT: RRB-OUI type %u send to " MACSTR " (len=%u)",
644 		   oui_suffix, MAC2STR(dst), (unsigned int) data_len);
645 	return wpa_auth->cb->send_oui(wpa_auth->cb_ctx, dst, oui_suffix, data,
646 				      data_len);
647 }
648 
649 
wpa_ft_action_send(struct wpa_authenticator * wpa_auth,const u8 * dst,const u8 * data,size_t data_len)650 static int wpa_ft_action_send(struct wpa_authenticator *wpa_auth,
651 			      const u8 *dst, const u8 *data, size_t data_len)
652 {
653 	if (wpa_auth->cb->send_ft_action == NULL)
654 		return -1;
655 	return wpa_auth->cb->send_ft_action(wpa_auth->cb_ctx, dst,
656 					    data, data_len);
657 }
658 
659 
wpa_ft_get_psk(struct wpa_authenticator * wpa_auth,const u8 * addr,const u8 * p2p_dev_addr,const u8 * prev_psk)660 static const u8 * wpa_ft_get_psk(struct wpa_authenticator *wpa_auth,
661 				 const u8 *addr, const u8 *p2p_dev_addr,
662 				 const u8 *prev_psk)
663 {
664 	if (wpa_auth->cb->get_psk == NULL)
665 		return NULL;
666 	return wpa_auth->cb->get_psk(wpa_auth->cb_ctx, addr, p2p_dev_addr,
667 				     prev_psk, NULL, NULL);
668 }
669 
670 
671 static struct wpa_state_machine *
wpa_ft_add_sta(struct wpa_authenticator * wpa_auth,const u8 * sta_addr)672 wpa_ft_add_sta(struct wpa_authenticator *wpa_auth, const u8 *sta_addr)
673 {
674 	if (wpa_auth->cb->add_sta == NULL)
675 		return NULL;
676 	return wpa_auth->cb->add_sta(wpa_auth->cb_ctx, sta_addr);
677 }
678 
679 
wpa_ft_set_vlan(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,struct vlan_description * vlan)680 static int wpa_ft_set_vlan(struct wpa_authenticator *wpa_auth,
681 			   const u8 *sta_addr, struct vlan_description *vlan)
682 {
683 	if (!wpa_auth->cb->set_vlan)
684 		return -1;
685 	return wpa_auth->cb->set_vlan(wpa_auth->cb_ctx, sta_addr, vlan);
686 }
687 
688 
wpa_ft_get_vlan(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,struct vlan_description * vlan)689 static int wpa_ft_get_vlan(struct wpa_authenticator *wpa_auth,
690 			   const u8 *sta_addr, struct vlan_description *vlan)
691 {
692 	if (!wpa_auth->cb->get_vlan)
693 		return -1;
694 	return wpa_auth->cb->get_vlan(wpa_auth->cb_ctx, sta_addr, vlan);
695 }
696 
697 
698 static int
wpa_ft_set_identity(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,const u8 * identity,size_t identity_len)699 wpa_ft_set_identity(struct wpa_authenticator *wpa_auth, const u8 *sta_addr,
700 		    const u8 *identity, size_t identity_len)
701 {
702 	if (!wpa_auth->cb->set_identity)
703 		return -1;
704 	return wpa_auth->cb->set_identity(wpa_auth->cb_ctx, sta_addr, identity,
705 					  identity_len);
706 }
707 
708 
709 static size_t
wpa_ft_get_identity(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,const u8 ** buf)710 wpa_ft_get_identity(struct wpa_authenticator *wpa_auth, const u8 *sta_addr,
711 		    const u8 **buf)
712 {
713 	*buf = NULL;
714 	if (!wpa_auth->cb->get_identity)
715 		return 0;
716 	return wpa_auth->cb->get_identity(wpa_auth->cb_ctx, sta_addr, buf);
717 }
718 
719 
720 static int
wpa_ft_set_radius_cui(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,const u8 * radius_cui,size_t radius_cui_len)721 wpa_ft_set_radius_cui(struct wpa_authenticator *wpa_auth, const u8 *sta_addr,
722 		      const u8 *radius_cui, size_t radius_cui_len)
723 {
724 	if (!wpa_auth->cb->set_radius_cui)
725 		return -1;
726 	return wpa_auth->cb->set_radius_cui(wpa_auth->cb_ctx, sta_addr,
727 					    radius_cui, radius_cui_len);
728 }
729 
730 
731 static size_t
wpa_ft_get_radius_cui(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,const u8 ** buf)732 wpa_ft_get_radius_cui(struct wpa_authenticator *wpa_auth, const u8 *sta_addr,
733 		      const u8 **buf)
734 {
735 	*buf = NULL;
736 	if (!wpa_auth->cb->get_radius_cui)
737 		return 0;
738 	return wpa_auth->cb->get_radius_cui(wpa_auth->cb_ctx, sta_addr, buf);
739 }
740 
741 
742 static void
wpa_ft_set_session_timeout(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,int session_timeout)743 wpa_ft_set_session_timeout(struct wpa_authenticator *wpa_auth,
744 			    const u8 *sta_addr, int session_timeout)
745 {
746 	if (!wpa_auth->cb->set_session_timeout)
747 		return;
748 	wpa_auth->cb->set_session_timeout(wpa_auth->cb_ctx, sta_addr,
749 					  session_timeout);
750 }
751 
752 
753 static int
wpa_ft_get_session_timeout(struct wpa_authenticator * wpa_auth,const u8 * sta_addr)754 wpa_ft_get_session_timeout(struct wpa_authenticator *wpa_auth,
755 			    const u8 *sta_addr)
756 {
757 	if (!wpa_auth->cb->get_session_timeout)
758 		return 0;
759 	return wpa_auth->cb->get_session_timeout(wpa_auth->cb_ctx, sta_addr);
760 }
761 
762 
wpa_ft_add_tspec(struct wpa_authenticator * wpa_auth,const u8 * sta_addr,u8 * tspec_ie,size_t tspec_ielen)763 static int wpa_ft_add_tspec(struct wpa_authenticator *wpa_auth,
764 			    const u8 *sta_addr,
765 			    u8 *tspec_ie, size_t tspec_ielen)
766 {
767 	if (wpa_auth->cb->add_tspec == NULL) {
768 		wpa_printf(MSG_DEBUG, "FT: add_tspec is not initialized");
769 		return -1;
770 	}
771 	return wpa_auth->cb->add_tspec(wpa_auth->cb_ctx, sta_addr, tspec_ie,
772 				       tspec_ielen);
773 }
774 
775 
776 #ifdef CONFIG_OCV
wpa_channel_info(struct wpa_authenticator * wpa_auth,struct wpa_channel_info * ci)777 static int wpa_channel_info(struct wpa_authenticator *wpa_auth,
778 			       struct wpa_channel_info *ci)
779 {
780 	if (!wpa_auth->cb->channel_info)
781 		return -1;
782 	return wpa_auth->cb->channel_info(wpa_auth->cb_ctx, ci);
783 }
784 #endif /* CONFIG_OCV */
785 
786 
wpa_write_mdie(struct wpa_auth_config * conf,u8 * buf,size_t len)787 int wpa_write_mdie(struct wpa_auth_config *conf, u8 *buf, size_t len)
788 {
789 	u8 *pos = buf;
790 	u8 capab;
791 	if (len < 2 + sizeof(struct rsn_mdie))
792 		return -1;
793 
794 	*pos++ = WLAN_EID_MOBILITY_DOMAIN;
795 	*pos++ = MOBILITY_DOMAIN_ID_LEN + 1;
796 	os_memcpy(pos, conf->mobility_domain, MOBILITY_DOMAIN_ID_LEN);
797 	pos += MOBILITY_DOMAIN_ID_LEN;
798 	capab = 0;
799 	if (conf->ft_over_ds)
800 		capab |= RSN_FT_CAPAB_FT_OVER_DS;
801 	*pos++ = capab;
802 
803 	return pos - buf;
804 }
805 
806 
wpa_write_ftie(struct wpa_auth_config * conf,int use_sha384,const u8 * r0kh_id,size_t r0kh_id_len,const u8 * anonce,const u8 * snonce,u8 * buf,size_t len,const u8 * subelem,size_t subelem_len,int rsnxe_used)807 int wpa_write_ftie(struct wpa_auth_config *conf, int use_sha384,
808 		   const u8 *r0kh_id, size_t r0kh_id_len,
809 		   const u8 *anonce, const u8 *snonce,
810 		   u8 *buf, size_t len, const u8 *subelem,
811 		   size_t subelem_len, int rsnxe_used)
812 {
813 	u8 *pos = buf, *ielen;
814 	size_t hdrlen = use_sha384 ? sizeof(struct rsn_ftie_sha384) :
815 		sizeof(struct rsn_ftie);
816 
817 	if (len < 2 + hdrlen + 2 + FT_R1KH_ID_LEN + 2 + r0kh_id_len +
818 	    subelem_len)
819 		return -1;
820 
821 	*pos++ = WLAN_EID_FAST_BSS_TRANSITION;
822 	ielen = pos++;
823 
824 	if (use_sha384) {
825 		struct rsn_ftie_sha384 *hdr = (struct rsn_ftie_sha384 *) pos;
826 
827 		os_memset(hdr, 0, sizeof(*hdr));
828 		pos += sizeof(*hdr);
829 		WPA_PUT_LE16(hdr->mic_control, !!rsnxe_used);
830 		if (anonce)
831 			os_memcpy(hdr->anonce, anonce, WPA_NONCE_LEN);
832 		if (snonce)
833 			os_memcpy(hdr->snonce, snonce, WPA_NONCE_LEN);
834 	} else {
835 		struct rsn_ftie *hdr = (struct rsn_ftie *) pos;
836 
837 		os_memset(hdr, 0, sizeof(*hdr));
838 		pos += sizeof(*hdr);
839 		WPA_PUT_LE16(hdr->mic_control, !!rsnxe_used);
840 		if (anonce)
841 			os_memcpy(hdr->anonce, anonce, WPA_NONCE_LEN);
842 		if (snonce)
843 			os_memcpy(hdr->snonce, snonce, WPA_NONCE_LEN);
844 	}
845 
846 	/* Optional Parameters */
847 	*pos++ = FTIE_SUBELEM_R1KH_ID;
848 	*pos++ = FT_R1KH_ID_LEN;
849 	os_memcpy(pos, conf->r1_key_holder, FT_R1KH_ID_LEN);
850 	pos += FT_R1KH_ID_LEN;
851 
852 	if (r0kh_id) {
853 		*pos++ = FTIE_SUBELEM_R0KH_ID;
854 		*pos++ = r0kh_id_len;
855 		os_memcpy(pos, r0kh_id, r0kh_id_len);
856 		pos += r0kh_id_len;
857 	}
858 
859 	if (subelem) {
860 		os_memcpy(pos, subelem, subelem_len);
861 		pos += subelem_len;
862 	}
863 
864 	*ielen = pos - buf - 2;
865 
866 	return pos - buf;
867 }
868 
869 
870 /* A packet to be handled after seq response */
871 struct ft_remote_item {
872 	struct dl_list list;
873 
874 	u8 nonce[FT_RRB_NONCE_LEN];
875 	struct os_reltime nonce_ts;
876 
877 	u8 src_addr[ETH_ALEN];
878 	u8 *enc;
879 	size_t enc_len;
880 	u8 *auth;
881 	size_t auth_len;
882 	int (*cb)(struct wpa_authenticator *wpa_auth,
883 		  const u8 *src_addr,
884 		  const u8 *enc, size_t enc_len,
885 		  const u8 *auth, size_t auth_len,
886 		  int no_defer);
887 };
888 
889 
wpa_ft_rrb_seq_free(struct ft_remote_item * item)890 static void wpa_ft_rrb_seq_free(struct ft_remote_item *item)
891 {
892 	eloop_cancel_timeout(wpa_ft_rrb_seq_timeout, ELOOP_ALL_CTX, item);
893 	dl_list_del(&item->list);
894 	bin_clear_free(item->enc, item->enc_len);
895 	os_free(item->auth);
896 	os_free(item);
897 }
898 
899 
wpa_ft_rrb_seq_flush(struct wpa_authenticator * wpa_auth,struct ft_remote_seq * rkh_seq,int cb)900 static void wpa_ft_rrb_seq_flush(struct wpa_authenticator *wpa_auth,
901 				 struct ft_remote_seq *rkh_seq, int cb)
902 {
903 	struct ft_remote_item *item, *n;
904 
905 	dl_list_for_each_safe(item, n, &rkh_seq->rx.queue,
906 			      struct ft_remote_item, list) {
907 		if (cb && item->cb)
908 			item->cb(wpa_auth, item->src_addr, item->enc,
909 				 item->enc_len, item->auth, item->auth_len, 1);
910 		wpa_ft_rrb_seq_free(item);
911 	}
912 }
913 
914 
wpa_ft_rrb_seq_timeout(void * eloop_ctx,void * timeout_ctx)915 static void wpa_ft_rrb_seq_timeout(void *eloop_ctx, void *timeout_ctx)
916 {
917 	struct ft_remote_item *item = timeout_ctx;
918 
919 	wpa_ft_rrb_seq_free(item);
920 }
921 
922 
923 static int
wpa_ft_rrb_seq_req(struct wpa_authenticator * wpa_auth,struct ft_remote_seq * rkh_seq,const u8 * src_addr,const u8 * f_r0kh_id,size_t f_r0kh_id_len,const u8 * f_r1kh_id,const u8 * key,size_t key_len,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int (* cb)(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer))924 wpa_ft_rrb_seq_req(struct wpa_authenticator *wpa_auth,
925 		   struct ft_remote_seq *rkh_seq, const u8 *src_addr,
926 		   const u8 *f_r0kh_id, size_t f_r0kh_id_len,
927 		   const u8 *f_r1kh_id, const u8 *key, size_t key_len,
928 		   const u8 *enc, size_t enc_len,
929 		   const u8 *auth, size_t auth_len,
930 		   int (*cb)(struct wpa_authenticator *wpa_auth,
931 			     const u8 *src_addr,
932 			     const u8 *enc, size_t enc_len,
933 			     const u8 *auth, size_t auth_len,
934 			     int no_defer))
935 {
936 	struct ft_remote_item *item = NULL;
937 	u8 *packet = NULL;
938 	size_t packet_len;
939 	struct tlv_list seq_req_auth[] = {
940 		{ .type = FT_RRB_NONCE, .len = FT_RRB_NONCE_LEN,
941 		  .data = NULL /* to be filled: item->nonce */ },
942 		{ .type = FT_RRB_R0KH_ID, .len = f_r0kh_id_len,
943 		  .data = f_r0kh_id },
944 		{ .type = FT_RRB_R1KH_ID, .len = FT_R1KH_ID_LEN,
945 		  .data = f_r1kh_id },
946 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
947 	};
948 
949 	if (dl_list_len(&rkh_seq->rx.queue) >= ftRRBmaxQueueLen) {
950 		wpa_printf(MSG_DEBUG, "FT: Sequence number queue too long");
951 		goto err;
952 	}
953 
954 	wpa_printf(MSG_DEBUG, "FT: Send sequence number request from " MACSTR
955 		   " to " MACSTR,
956 		   MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
957 	item = os_zalloc(sizeof(*item));
958 	if (!item)
959 		goto err;
960 
961 	os_memcpy(item->src_addr, src_addr, ETH_ALEN);
962 	item->cb = cb;
963 
964 	if (random_get_bytes(item->nonce, FT_RRB_NONCE_LEN) < 0) {
965 		wpa_printf(MSG_DEBUG, "FT: Seq num nonce: out of random bytes");
966 		goto err;
967 	}
968 
969 	if (os_get_reltime(&item->nonce_ts) < 0)
970 		goto err;
971 
972 	if (enc && enc_len > 0) {
973 		item->enc = os_memdup(enc, enc_len);
974 		item->enc_len = enc_len;
975 		if (!item->enc)
976 			goto err;
977 	}
978 
979 	if (auth && auth_len > 0) {
980 		item->auth = os_memdup(auth, auth_len);
981 		item->auth_len = auth_len;
982 		if (!item->auth)
983 			goto err;
984 	}
985 
986 	eloop_register_timeout(ftRRBseqTimeout, 0, wpa_ft_rrb_seq_timeout,
987 			       wpa_auth, item);
988 
989 	seq_req_auth[0].data = item->nonce;
990 
991 	if (wpa_ft_rrb_build(key, key_len, NULL, NULL, seq_req_auth, NULL,
992 			     wpa_auth->addr, FT_PACKET_R0KH_R1KH_SEQ_REQ,
993 			     &packet, &packet_len) < 0) {
994 		item = NULL; /* some other seq resp might still accept this */
995 		goto err;
996 	}
997 
998 	dl_list_add(&rkh_seq->rx.queue, &item->list);
999 
1000 	wpa_ft_rrb_oui_send(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_SEQ_REQ,
1001 			    packet, packet_len);
1002 
1003 	os_free(packet);
1004 
1005 	return 0;
1006 err:
1007 	wpa_printf(MSG_DEBUG, "FT: Failed to send sequence number request");
1008 	if (item) {
1009 		os_free(item->auth);
1010 		bin_clear_free(item->enc, item->enc_len);
1011 		os_free(item);
1012 	}
1013 
1014 	return -1;
1015 }
1016 
1017 
1018 #define FT_RRB_SEQ_OK    0
1019 #define FT_RRB_SEQ_DROP  1
1020 #define FT_RRB_SEQ_DEFER 2
1021 
1022 static int
wpa_ft_rrb_seq_chk(struct ft_remote_seq * rkh_seq,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,const char * msgtype,int no_defer)1023 wpa_ft_rrb_seq_chk(struct ft_remote_seq *rkh_seq, const u8 *src_addr,
1024 		   const u8 *enc, size_t enc_len,
1025 		   const u8 *auth, size_t auth_len,
1026 		   const char *msgtype, int no_defer)
1027 {
1028 	const u8 *f_seq;
1029 	size_t f_seq_len;
1030 	const struct ft_rrb_seq *msg_both;
1031 	u32 msg_seq, msg_off, rkh_off;
1032 	struct os_reltime now;
1033 	unsigned int i;
1034 
1035 	RRB_GET_AUTH(FT_RRB_SEQ, seq, msgtype, sizeof(*msg_both));
1036 	wpa_hexdump(MSG_DEBUG, "FT: sequence number", f_seq, f_seq_len);
1037 	msg_both = (const struct ft_rrb_seq *) f_seq;
1038 
1039 	if (rkh_seq->rx.num_last == 0) {
1040 		/* first packet from remote */
1041 		goto defer;
1042 	}
1043 
1044 	if (le_to_host32(msg_both->dom) != rkh_seq->rx.dom) {
1045 		/* remote might have rebooted */
1046 		goto defer;
1047 	}
1048 
1049 	if (os_get_reltime(&now) == 0) {
1050 		u32 msg_ts_now_remote, msg_ts_off;
1051 		struct os_reltime now_remote;
1052 
1053 		os_reltime_sub(&now, &rkh_seq->rx.time_offset, &now_remote);
1054 		msg_ts_now_remote = now_remote.sec;
1055 		msg_ts_off = le_to_host32(msg_both->ts) -
1056 			(msg_ts_now_remote - ftRRBseqTimeout);
1057 		if (msg_ts_off > 2 * ftRRBseqTimeout)
1058 			goto defer;
1059 	}
1060 
1061 	msg_seq = le_to_host32(msg_both->seq);
1062 	rkh_off = rkh_seq->rx.last[rkh_seq->rx.offsetidx];
1063 	msg_off = msg_seq - rkh_off;
1064 	if (msg_off > 0xC0000000)
1065 		goto out; /* too old message, drop it */
1066 
1067 	if (msg_off <= 0x40000000) {
1068 		for (i = 0; i < rkh_seq->rx.num_last; i++) {
1069 			if (rkh_seq->rx.last[i] == msg_seq)
1070 				goto out; /* duplicate message, drop it */
1071 		}
1072 
1073 		return FT_RRB_SEQ_OK;
1074 	}
1075 
1076 defer:
1077 	if (no_defer)
1078 		goto out;
1079 
1080 	wpa_printf(MSG_DEBUG, "FT: Possibly invalid sequence number in %s from "
1081 		   MACSTR, msgtype, MAC2STR(src_addr));
1082 
1083 	return FT_RRB_SEQ_DEFER;
1084 out:
1085 	wpa_printf(MSG_DEBUG, "FT: Invalid sequence number in %s from " MACSTR,
1086 		   msgtype, MAC2STR(src_addr));
1087 
1088 	return FT_RRB_SEQ_DROP;
1089 }
1090 
1091 
1092 static void
wpa_ft_rrb_seq_accept(struct wpa_authenticator * wpa_auth,struct ft_remote_seq * rkh_seq,const u8 * src_addr,const u8 * auth,size_t auth_len,const char * msgtype)1093 wpa_ft_rrb_seq_accept(struct wpa_authenticator *wpa_auth,
1094 		      struct ft_remote_seq *rkh_seq, const u8 *src_addr,
1095 		      const u8 *auth, size_t auth_len,
1096 		      const char *msgtype)
1097 {
1098 	const u8 *f_seq;
1099 	size_t f_seq_len;
1100 	const struct ft_rrb_seq *msg_both;
1101 	u32 msg_seq, msg_off, min_off, rkh_off;
1102 	int minidx = 0;
1103 	unsigned int i;
1104 
1105 	RRB_GET_AUTH(FT_RRB_SEQ, seq, msgtype, sizeof(*msg_both));
1106 	msg_both = (const struct ft_rrb_seq *) f_seq;
1107 
1108 	msg_seq = le_to_host32(msg_both->seq);
1109 
1110 	if (rkh_seq->rx.num_last < FT_REMOTE_SEQ_BACKLOG) {
1111 		rkh_seq->rx.last[rkh_seq->rx.num_last] = msg_seq;
1112 		rkh_seq->rx.num_last++;
1113 		return;
1114 	}
1115 
1116 	rkh_off = rkh_seq->rx.last[rkh_seq->rx.offsetidx];
1117 	for (i = 0; i < rkh_seq->rx.num_last; i++) {
1118 		msg_off = rkh_seq->rx.last[i] - rkh_off;
1119 		min_off = rkh_seq->rx.last[minidx] - rkh_off;
1120 		if (msg_off < min_off && i != rkh_seq->rx.offsetidx)
1121 			minidx = i;
1122 	}
1123 	rkh_seq->rx.last[rkh_seq->rx.offsetidx] = msg_seq;
1124 	rkh_seq->rx.offsetidx = minidx;
1125 
1126 	return;
1127 out:
1128 	/* RRB_GET_AUTH should never fail here as
1129 	 * wpa_ft_rrb_seq_chk() verified FT_RRB_SEQ presence. */
1130 	wpa_printf(MSG_ERROR, "FT: %s() failed", __func__);
1131 }
1132 
1133 
wpa_ft_new_seq(struct ft_remote_seq * rkh_seq,struct ft_rrb_seq * f_seq)1134 static int wpa_ft_new_seq(struct ft_remote_seq *rkh_seq,
1135 			  struct ft_rrb_seq *f_seq)
1136 {
1137 	struct os_reltime now;
1138 
1139 	if (os_get_reltime(&now) < 0)
1140 		return -1;
1141 
1142 	if (!rkh_seq->tx.dom) {
1143 		if (random_get_bytes((u8 *) &rkh_seq->tx.seq,
1144 				     sizeof(rkh_seq->tx.seq))) {
1145 			wpa_printf(MSG_ERROR,
1146 				   "FT: Failed to get random data for sequence number initialization");
1147 			rkh_seq->tx.seq = now.usec;
1148 		}
1149 		if (random_get_bytes((u8 *) &rkh_seq->tx.dom,
1150 				     sizeof(rkh_seq->tx.dom))) {
1151 			wpa_printf(MSG_ERROR,
1152 				   "FT: Failed to get random data for sequence number initialization");
1153 			rkh_seq->tx.dom = now.usec;
1154 		}
1155 		rkh_seq->tx.dom |= 1;
1156 	}
1157 
1158 	f_seq->dom = host_to_le32(rkh_seq->tx.dom);
1159 	f_seq->seq = host_to_le32(rkh_seq->tx.seq);
1160 	f_seq->ts = host_to_le32(now.sec);
1161 
1162 	rkh_seq->tx.seq++;
1163 
1164 	return 0;
1165 }
1166 
1167 
1168 struct wpa_ft_pmk_r0_sa {
1169 	struct dl_list list;
1170 	u8 pmk_r0[PMK_LEN_MAX];
1171 	size_t pmk_r0_len;
1172 	u8 pmk_r0_name[WPA_PMK_NAME_LEN];
1173 	u8 spa[ETH_ALEN];
1174 	int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */
1175 	struct vlan_description *vlan;
1176 	os_time_t expiration; /* 0 for no expiration */
1177 	u8 *identity;
1178 	size_t identity_len;
1179 	u8 *radius_cui;
1180 	size_t radius_cui_len;
1181 	os_time_t session_timeout; /* 0 for no expiration */
1182 	/* TODO: radius_class, EAP type */
1183 	int pmk_r1_pushed;
1184 };
1185 
1186 struct wpa_ft_pmk_r1_sa {
1187 	struct dl_list list;
1188 	u8 pmk_r1[PMK_LEN_MAX];
1189 	size_t pmk_r1_len;
1190 	u8 pmk_r1_name[WPA_PMK_NAME_LEN];
1191 	u8 spa[ETH_ALEN];
1192 	int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */
1193 	struct vlan_description *vlan;
1194 	u8 *identity;
1195 	size_t identity_len;
1196 	u8 *radius_cui;
1197 	size_t radius_cui_len;
1198 	os_time_t session_timeout; /* 0 for no expiration */
1199 	/* TODO: radius_class, EAP type */
1200 };
1201 
1202 struct wpa_ft_pmk_cache {
1203 	struct dl_list pmk_r0; /* struct wpa_ft_pmk_r0_sa */
1204 	struct dl_list pmk_r1; /* struct wpa_ft_pmk_r1_sa */
1205 };
1206 
1207 
1208 static void wpa_ft_expire_pmk_r0(void *eloop_ctx, void *timeout_ctx);
1209 static void wpa_ft_expire_pmk_r1(void *eloop_ctx, void *timeout_ctx);
1210 
1211 
wpa_ft_free_pmk_r0(struct wpa_ft_pmk_r0_sa * r0)1212 static void wpa_ft_free_pmk_r0(struct wpa_ft_pmk_r0_sa *r0)
1213 {
1214 	if (!r0)
1215 		return;
1216 
1217 	dl_list_del(&r0->list);
1218 	eloop_cancel_timeout(wpa_ft_expire_pmk_r0, r0, NULL);
1219 
1220 	os_memset(r0->pmk_r0, 0, PMK_LEN_MAX);
1221 	os_free(r0->vlan);
1222 	os_free(r0->identity);
1223 	os_free(r0->radius_cui);
1224 	os_free(r0);
1225 }
1226 
1227 
wpa_ft_expire_pmk_r0(void * eloop_ctx,void * timeout_ctx)1228 static void wpa_ft_expire_pmk_r0(void *eloop_ctx, void *timeout_ctx)
1229 {
1230 	struct wpa_ft_pmk_r0_sa *r0 = eloop_ctx;
1231 	struct os_reltime now;
1232 	int expires_in;
1233 	int session_timeout;
1234 
1235 	os_get_reltime(&now);
1236 
1237 	if (!r0)
1238 		return;
1239 
1240 	expires_in = r0->expiration - now.sec;
1241 	session_timeout = r0->session_timeout - now.sec;
1242 	/* conditions to remove from cache:
1243 	 * a) r0->expiration is set and hit
1244 	 * -or-
1245 	 * b) r0->session_timeout is set and hit
1246 	 */
1247 	if ((!r0->expiration || expires_in > 0) &&
1248 	    (!r0->session_timeout || session_timeout > 0)) {
1249 		wpa_printf(MSG_ERROR,
1250 			   "FT: %s() called for non-expired entry %p",
1251 			   __func__, r0);
1252 		eloop_cancel_timeout(wpa_ft_expire_pmk_r0, r0, NULL);
1253 		if (r0->expiration && expires_in > 0)
1254 			eloop_register_timeout(expires_in + 1, 0,
1255 					       wpa_ft_expire_pmk_r0, r0, NULL);
1256 		if (r0->session_timeout && session_timeout > 0)
1257 			eloop_register_timeout(session_timeout + 1, 0,
1258 					       wpa_ft_expire_pmk_r0, r0, NULL);
1259 		return;
1260 	}
1261 
1262 	wpa_ft_free_pmk_r0(r0);
1263 }
1264 
1265 
wpa_ft_free_pmk_r1(struct wpa_ft_pmk_r1_sa * r1)1266 static void wpa_ft_free_pmk_r1(struct wpa_ft_pmk_r1_sa *r1)
1267 {
1268 	if (!r1)
1269 		return;
1270 
1271 	dl_list_del(&r1->list);
1272 	eloop_cancel_timeout(wpa_ft_expire_pmk_r1, r1, NULL);
1273 
1274 	os_memset(r1->pmk_r1, 0, PMK_LEN_MAX);
1275 	os_free(r1->vlan);
1276 	os_free(r1->identity);
1277 	os_free(r1->radius_cui);
1278 	os_free(r1);
1279 }
1280 
1281 
wpa_ft_expire_pmk_r1(void * eloop_ctx,void * timeout_ctx)1282 static void wpa_ft_expire_pmk_r1(void *eloop_ctx, void *timeout_ctx)
1283 {
1284 	struct wpa_ft_pmk_r1_sa *r1 = eloop_ctx;
1285 
1286 	wpa_ft_free_pmk_r1(r1);
1287 }
1288 
1289 
wpa_ft_pmk_cache_init(void)1290 struct wpa_ft_pmk_cache * wpa_ft_pmk_cache_init(void)
1291 {
1292 	struct wpa_ft_pmk_cache *cache;
1293 
1294 	cache = os_zalloc(sizeof(*cache));
1295 	if (cache) {
1296 		dl_list_init(&cache->pmk_r0);
1297 		dl_list_init(&cache->pmk_r1);
1298 	}
1299 
1300 	return cache;
1301 }
1302 
1303 
wpa_ft_pmk_cache_deinit(struct wpa_ft_pmk_cache * cache)1304 void wpa_ft_pmk_cache_deinit(struct wpa_ft_pmk_cache *cache)
1305 {
1306 	struct wpa_ft_pmk_r0_sa *r0, *r0prev;
1307 	struct wpa_ft_pmk_r1_sa *r1, *r1prev;
1308 
1309 	dl_list_for_each_safe(r0, r0prev, &cache->pmk_r0,
1310 			      struct wpa_ft_pmk_r0_sa, list)
1311 		wpa_ft_free_pmk_r0(r0);
1312 
1313 	dl_list_for_each_safe(r1, r1prev, &cache->pmk_r1,
1314 			      struct wpa_ft_pmk_r1_sa, list)
1315 		wpa_ft_free_pmk_r1(r1);
1316 
1317 	os_free(cache);
1318 }
1319 
1320 
wpa_ft_store_pmk_r0(struct wpa_authenticator * wpa_auth,const u8 * spa,const u8 * pmk_r0,size_t pmk_r0_len,const u8 * pmk_r0_name,int pairwise,const struct vlan_description * vlan,int expires_in,int session_timeout,const u8 * identity,size_t identity_len,const u8 * radius_cui,size_t radius_cui_len)1321 static int wpa_ft_store_pmk_r0(struct wpa_authenticator *wpa_auth,
1322 			       const u8 *spa, const u8 *pmk_r0,
1323 			       size_t pmk_r0_len,
1324 			       const u8 *pmk_r0_name, int pairwise,
1325 			       const struct vlan_description *vlan,
1326 			       int expires_in, int session_timeout,
1327 			       const u8 *identity, size_t identity_len,
1328 			       const u8 *radius_cui, size_t radius_cui_len)
1329 {
1330 	struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1331 	struct wpa_ft_pmk_r0_sa *r0;
1332 	struct os_reltime now;
1333 
1334 	/* TODO: add limit on number of entries in cache */
1335 	os_get_reltime(&now);
1336 
1337 	r0 = os_zalloc(sizeof(*r0));
1338 	if (r0 == NULL)
1339 		return -1;
1340 
1341 	os_memcpy(r0->pmk_r0, pmk_r0, pmk_r0_len);
1342 	r0->pmk_r0_len = pmk_r0_len;
1343 	os_memcpy(r0->pmk_r0_name, pmk_r0_name, WPA_PMK_NAME_LEN);
1344 	os_memcpy(r0->spa, spa, ETH_ALEN);
1345 	r0->pairwise = pairwise;
1346 	if (expires_in > 0)
1347 		r0->expiration = now.sec + expires_in;
1348 	if (vlan && vlan->notempty) {
1349 		r0->vlan = os_zalloc(sizeof(*vlan));
1350 		if (!r0->vlan) {
1351 			bin_clear_free(r0, sizeof(*r0));
1352 			return -1;
1353 		}
1354 		*r0->vlan = *vlan;
1355 	}
1356 	if (identity) {
1357 		r0->identity = os_malloc(identity_len);
1358 		if (r0->identity) {
1359 			os_memcpy(r0->identity, identity, identity_len);
1360 			r0->identity_len = identity_len;
1361 		}
1362 	}
1363 	if (radius_cui) {
1364 		r0->radius_cui = os_malloc(radius_cui_len);
1365 		if (r0->radius_cui) {
1366 			os_memcpy(r0->radius_cui, radius_cui, radius_cui_len);
1367 			r0->radius_cui_len = radius_cui_len;
1368 		}
1369 	}
1370 	if (session_timeout > 0)
1371 		r0->session_timeout = now.sec + session_timeout;
1372 
1373 	dl_list_add(&cache->pmk_r0, &r0->list);
1374 	if (expires_in > 0)
1375 		eloop_register_timeout(expires_in + 1, 0, wpa_ft_expire_pmk_r0,
1376 				       r0, NULL);
1377 	if (session_timeout > 0)
1378 		eloop_register_timeout(session_timeout + 1, 0,
1379 				       wpa_ft_expire_pmk_r0, r0, NULL);
1380 
1381 	return 0;
1382 }
1383 
1384 
wpa_ft_fetch_pmk_r0(struct wpa_authenticator * wpa_auth,const u8 * spa,const u8 * pmk_r0_name,const struct wpa_ft_pmk_r0_sa ** r0_out)1385 static int wpa_ft_fetch_pmk_r0(struct wpa_authenticator *wpa_auth,
1386 			       const u8 *spa, const u8 *pmk_r0_name,
1387 			       const struct wpa_ft_pmk_r0_sa **r0_out)
1388 {
1389 	struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1390 	struct wpa_ft_pmk_r0_sa *r0;
1391 	struct os_reltime now;
1392 
1393 	os_get_reltime(&now);
1394 	dl_list_for_each(r0, &cache->pmk_r0, struct wpa_ft_pmk_r0_sa, list) {
1395 		if (os_memcmp(r0->spa, spa, ETH_ALEN) == 0 &&
1396 		    os_memcmp_const(r0->pmk_r0_name, pmk_r0_name,
1397 				    WPA_PMK_NAME_LEN) == 0) {
1398 			*r0_out = r0;
1399 			return 0;
1400 		}
1401 	}
1402 
1403 	*r0_out = NULL;
1404 	return -1;
1405 }
1406 
1407 
wpa_ft_store_pmk_r1(struct wpa_authenticator * wpa_auth,const u8 * spa,const u8 * pmk_r1,size_t pmk_r1_len,const u8 * pmk_r1_name,int pairwise,const struct vlan_description * vlan,int expires_in,int session_timeout,const u8 * identity,size_t identity_len,const u8 * radius_cui,size_t radius_cui_len)1408 static int wpa_ft_store_pmk_r1(struct wpa_authenticator *wpa_auth,
1409 			       const u8 *spa, const u8 *pmk_r1,
1410 			       size_t pmk_r1_len,
1411 			       const u8 *pmk_r1_name, int pairwise,
1412 			       const struct vlan_description *vlan,
1413 			       int expires_in, int session_timeout,
1414 			       const u8 *identity, size_t identity_len,
1415 			       const u8 *radius_cui, size_t radius_cui_len)
1416 {
1417 	struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1418 	int max_expires_in = wpa_auth->conf.r1_max_key_lifetime;
1419 	struct wpa_ft_pmk_r1_sa *r1;
1420 	struct os_reltime now;
1421 
1422 	/* TODO: limit on number of entries in cache */
1423 	os_get_reltime(&now);
1424 
1425 	if (max_expires_in && (max_expires_in < expires_in || expires_in == 0))
1426 		expires_in = max_expires_in;
1427 
1428 	r1 = os_zalloc(sizeof(*r1));
1429 	if (r1 == NULL)
1430 		return -1;
1431 
1432 	os_memcpy(r1->pmk_r1, pmk_r1, pmk_r1_len);
1433 	r1->pmk_r1_len = pmk_r1_len;
1434 	os_memcpy(r1->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN);
1435 	os_memcpy(r1->spa, spa, ETH_ALEN);
1436 	r1->pairwise = pairwise;
1437 	if (vlan && vlan->notempty) {
1438 		r1->vlan = os_zalloc(sizeof(*vlan));
1439 		if (!r1->vlan) {
1440 			bin_clear_free(r1, sizeof(*r1));
1441 			return -1;
1442 		}
1443 		*r1->vlan = *vlan;
1444 	}
1445 	if (identity) {
1446 		r1->identity = os_malloc(identity_len);
1447 		if (r1->identity) {
1448 			os_memcpy(r1->identity, identity, identity_len);
1449 			r1->identity_len = identity_len;
1450 		}
1451 	}
1452 	if (radius_cui) {
1453 		r1->radius_cui = os_malloc(radius_cui_len);
1454 		if (r1->radius_cui) {
1455 			os_memcpy(r1->radius_cui, radius_cui, radius_cui_len);
1456 			r1->radius_cui_len = radius_cui_len;
1457 		}
1458 	}
1459 	if (session_timeout > 0)
1460 		r1->session_timeout = now.sec + session_timeout;
1461 
1462 	dl_list_add(&cache->pmk_r1, &r1->list);
1463 
1464 	if (expires_in > 0)
1465 		eloop_register_timeout(expires_in + 1, 0, wpa_ft_expire_pmk_r1,
1466 				       r1, NULL);
1467 	if (session_timeout > 0)
1468 		eloop_register_timeout(session_timeout + 1, 0,
1469 				       wpa_ft_expire_pmk_r1, r1, NULL);
1470 
1471 	return 0;
1472 }
1473 
1474 
wpa_ft_fetch_pmk_r1(struct wpa_authenticator * wpa_auth,const u8 * spa,const u8 * pmk_r1_name,u8 * pmk_r1,size_t * pmk_r1_len,int * pairwise,struct vlan_description * vlan,const u8 ** identity,size_t * identity_len,const u8 ** radius_cui,size_t * radius_cui_len,int * session_timeout)1475 static int wpa_ft_fetch_pmk_r1(struct wpa_authenticator *wpa_auth,
1476 			       const u8 *spa, const u8 *pmk_r1_name,
1477 			       u8 *pmk_r1, size_t *pmk_r1_len, int *pairwise,
1478 			       struct vlan_description *vlan,
1479 			       const u8 **identity, size_t *identity_len,
1480 			       const u8 **radius_cui, size_t *radius_cui_len,
1481 			       int *session_timeout)
1482 {
1483 	struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1484 	struct wpa_ft_pmk_r1_sa *r1;
1485 	struct os_reltime now;
1486 
1487 	os_get_reltime(&now);
1488 
1489 	dl_list_for_each(r1, &cache->pmk_r1, struct wpa_ft_pmk_r1_sa, list) {
1490 		if (os_memcmp(r1->spa, spa, ETH_ALEN) == 0 &&
1491 		    os_memcmp_const(r1->pmk_r1_name, pmk_r1_name,
1492 				    WPA_PMK_NAME_LEN) == 0) {
1493 			os_memcpy(pmk_r1, r1->pmk_r1, r1->pmk_r1_len);
1494 			*pmk_r1_len = r1->pmk_r1_len;
1495 			if (pairwise)
1496 				*pairwise = r1->pairwise;
1497 			if (vlan && r1->vlan)
1498 				*vlan = *r1->vlan;
1499 			if (vlan && !r1->vlan)
1500 				os_memset(vlan, 0, sizeof(*vlan));
1501 			if (identity && identity_len) {
1502 				*identity = r1->identity;
1503 				*identity_len = r1->identity_len;
1504 			}
1505 			if (radius_cui && radius_cui_len) {
1506 				*radius_cui = r1->radius_cui;
1507 				*radius_cui_len = r1->radius_cui_len;
1508 			}
1509 			if (session_timeout && r1->session_timeout > now.sec)
1510 				*session_timeout = r1->session_timeout -
1511 					now.sec;
1512 			else if (session_timeout && r1->session_timeout)
1513 				*session_timeout = 1;
1514 			else if (session_timeout)
1515 				*session_timeout = 0;
1516 			return 0;
1517 		}
1518 	}
1519 
1520 	return -1;
1521 }
1522 
1523 
wpa_ft_rrb_init_r0kh_seq(struct ft_remote_r0kh * r0kh)1524 static int wpa_ft_rrb_init_r0kh_seq(struct ft_remote_r0kh *r0kh)
1525 {
1526 	if (r0kh->seq)
1527 		return 0;
1528 
1529 	r0kh->seq = os_zalloc(sizeof(*r0kh->seq));
1530 	if (!r0kh->seq) {
1531 		wpa_printf(MSG_DEBUG, "FT: Failed to allocate r0kh->seq");
1532 		return -1;
1533 	}
1534 
1535 	dl_list_init(&r0kh->seq->rx.queue);
1536 
1537 	return 0;
1538 }
1539 
1540 
wpa_ft_rrb_lookup_r0kh(struct wpa_authenticator * wpa_auth,const u8 * f_r0kh_id,size_t f_r0kh_id_len,struct ft_remote_r0kh ** r0kh_out,struct ft_remote_r0kh ** r0kh_wildcard)1541 static void wpa_ft_rrb_lookup_r0kh(struct wpa_authenticator *wpa_auth,
1542 				   const u8 *f_r0kh_id, size_t f_r0kh_id_len,
1543 				   struct ft_remote_r0kh **r0kh_out,
1544 				   struct ft_remote_r0kh **r0kh_wildcard)
1545 {
1546 	struct ft_remote_r0kh *r0kh;
1547 
1548 	*r0kh_wildcard = NULL;
1549 	*r0kh_out = NULL;
1550 
1551 	if (wpa_auth->conf.r0kh_list)
1552 		r0kh = *wpa_auth->conf.r0kh_list;
1553 	else
1554 		r0kh = NULL;
1555 	for (; r0kh; r0kh = r0kh->next) {
1556 		if (r0kh->id_len == 1 && r0kh->id[0] == '*')
1557 			*r0kh_wildcard = r0kh;
1558 		if (f_r0kh_id && r0kh->id_len == f_r0kh_id_len &&
1559 		    os_memcmp_const(f_r0kh_id, r0kh->id, f_r0kh_id_len) == 0)
1560 			*r0kh_out = r0kh;
1561 	}
1562 
1563 	if (!*r0kh_out && !*r0kh_wildcard)
1564 		wpa_printf(MSG_DEBUG, "FT: No matching R0KH found");
1565 
1566 	if (*r0kh_out && wpa_ft_rrb_init_r0kh_seq(*r0kh_out) < 0)
1567 		*r0kh_out = NULL;
1568 }
1569 
1570 
wpa_ft_rrb_init_r1kh_seq(struct ft_remote_r1kh * r1kh)1571 static int wpa_ft_rrb_init_r1kh_seq(struct ft_remote_r1kh *r1kh)
1572 {
1573 	if (r1kh->seq)
1574 		return 0;
1575 
1576 	r1kh->seq = os_zalloc(sizeof(*r1kh->seq));
1577 	if (!r1kh->seq) {
1578 		wpa_printf(MSG_DEBUG, "FT: Failed to allocate r1kh->seq");
1579 		return -1;
1580 	}
1581 
1582 	dl_list_init(&r1kh->seq->rx.queue);
1583 
1584 	return 0;
1585 }
1586 
1587 
wpa_ft_rrb_lookup_r1kh(struct wpa_authenticator * wpa_auth,const u8 * f_r1kh_id,struct ft_remote_r1kh ** r1kh_out,struct ft_remote_r1kh ** r1kh_wildcard)1588 static void wpa_ft_rrb_lookup_r1kh(struct wpa_authenticator *wpa_auth,
1589 				   const u8 *f_r1kh_id,
1590 				   struct ft_remote_r1kh **r1kh_out,
1591 				   struct ft_remote_r1kh **r1kh_wildcard)
1592 {
1593 	struct ft_remote_r1kh *r1kh;
1594 
1595 	*r1kh_wildcard = NULL;
1596 	*r1kh_out = NULL;
1597 
1598 	if (wpa_auth->conf.r1kh_list)
1599 		r1kh = *wpa_auth->conf.r1kh_list;
1600 	else
1601 		r1kh = NULL;
1602 	for (; r1kh; r1kh = r1kh->next) {
1603 		if (is_zero_ether_addr(r1kh->addr) &&
1604 		    is_zero_ether_addr(r1kh->id))
1605 			*r1kh_wildcard = r1kh;
1606 		if (f_r1kh_id &&
1607 		    os_memcmp_const(r1kh->id, f_r1kh_id, FT_R1KH_ID_LEN) == 0)
1608 			*r1kh_out = r1kh;
1609 	}
1610 
1611 	if (!*r1kh_out && !*r1kh_wildcard)
1612 		wpa_printf(MSG_DEBUG, "FT: No matching R1KH found");
1613 
1614 	if (*r1kh_out && wpa_ft_rrb_init_r1kh_seq(*r1kh_out) < 0)
1615 		*r1kh_out = NULL;
1616 }
1617 
1618 
wpa_ft_rrb_check_r0kh(struct wpa_authenticator * wpa_auth,const u8 * f_r0kh_id,size_t f_r0kh_id_len)1619 static int wpa_ft_rrb_check_r0kh(struct wpa_authenticator *wpa_auth,
1620 				 const u8 *f_r0kh_id, size_t f_r0kh_id_len)
1621 {
1622 	if (f_r0kh_id_len != wpa_auth->conf.r0_key_holder_len ||
1623 	    os_memcmp_const(f_r0kh_id, wpa_auth->conf.r0_key_holder,
1624 			    f_r0kh_id_len) != 0)
1625 		return -1;
1626 
1627 	return 0;
1628 }
1629 
1630 
wpa_ft_rrb_check_r1kh(struct wpa_authenticator * wpa_auth,const u8 * f_r1kh_id)1631 static int wpa_ft_rrb_check_r1kh(struct wpa_authenticator *wpa_auth,
1632 				 const u8 *f_r1kh_id)
1633 {
1634 	if (os_memcmp_const(f_r1kh_id, wpa_auth->conf.r1_key_holder,
1635 			    FT_R1KH_ID_LEN) != 0)
1636 		return -1;
1637 
1638 	return 0;
1639 }
1640 
1641 
wpa_ft_rrb_del_r0kh(void * eloop_ctx,void * timeout_ctx)1642 static void wpa_ft_rrb_del_r0kh(void *eloop_ctx, void *timeout_ctx)
1643 {
1644 	struct wpa_authenticator *wpa_auth = eloop_ctx;
1645 	struct ft_remote_r0kh *r0kh, *prev = NULL;
1646 
1647 	if (!wpa_auth->conf.r0kh_list)
1648 		return;
1649 
1650 	for (r0kh = *wpa_auth->conf.r0kh_list; r0kh; r0kh = r0kh->next) {
1651 		if (r0kh == timeout_ctx)
1652 			break;
1653 		prev = r0kh;
1654 	}
1655 	if (!r0kh)
1656 		return;
1657 	if (prev)
1658 		prev->next = r0kh->next;
1659 	else
1660 		*wpa_auth->conf.r0kh_list = r0kh->next;
1661 	if (r0kh->seq)
1662 		wpa_ft_rrb_seq_flush(wpa_auth, r0kh->seq, 0);
1663 	os_free(r0kh->seq);
1664 	os_free(r0kh);
1665 }
1666 
1667 
wpa_ft_rrb_r0kh_replenish(struct wpa_authenticator * wpa_auth,struct ft_remote_r0kh * r0kh,int timeout)1668 static void wpa_ft_rrb_r0kh_replenish(struct wpa_authenticator *wpa_auth,
1669 				      struct ft_remote_r0kh *r0kh, int timeout)
1670 {
1671 	if (timeout > 0)
1672 		eloop_replenish_timeout(timeout, 0, wpa_ft_rrb_del_r0kh,
1673 					wpa_auth, r0kh);
1674 }
1675 
1676 
wpa_ft_rrb_r0kh_timeout(struct wpa_authenticator * wpa_auth,struct ft_remote_r0kh * r0kh,int timeout)1677 static void wpa_ft_rrb_r0kh_timeout(struct wpa_authenticator *wpa_auth,
1678 				    struct ft_remote_r0kh *r0kh, int timeout)
1679 {
1680 	eloop_cancel_timeout(wpa_ft_rrb_del_r0kh, wpa_auth, r0kh);
1681 
1682 	if (timeout > 0)
1683 		eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r0kh,
1684 				       wpa_auth, r0kh);
1685 }
1686 
1687 
1688 static struct ft_remote_r0kh *
wpa_ft_rrb_add_r0kh(struct wpa_authenticator * wpa_auth,struct ft_remote_r0kh * r0kh_wildcard,const u8 * src_addr,const u8 * r0kh_id,size_t id_len,int timeout)1689 wpa_ft_rrb_add_r0kh(struct wpa_authenticator *wpa_auth,
1690 		    struct ft_remote_r0kh *r0kh_wildcard,
1691 		    const u8 *src_addr, const u8 *r0kh_id, size_t id_len,
1692 		    int timeout)
1693 {
1694 	struct ft_remote_r0kh *r0kh;
1695 
1696 	if (!wpa_auth->conf.r0kh_list)
1697 		return NULL;
1698 
1699 	r0kh = os_zalloc(sizeof(*r0kh));
1700 	if (!r0kh)
1701 		return NULL;
1702 
1703 	if (src_addr)
1704 		os_memcpy(r0kh->addr, src_addr, sizeof(r0kh->addr));
1705 
1706 	if (id_len > FT_R0KH_ID_MAX_LEN)
1707 		id_len = FT_R0KH_ID_MAX_LEN;
1708 	os_memcpy(r0kh->id, r0kh_id, id_len);
1709 	r0kh->id_len = id_len;
1710 
1711 	os_memcpy(r0kh->key, r0kh_wildcard->key, sizeof(r0kh->key));
1712 
1713 	r0kh->next = *wpa_auth->conf.r0kh_list;
1714 	*wpa_auth->conf.r0kh_list = r0kh;
1715 
1716 	if (timeout > 0)
1717 		eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r0kh,
1718 				       wpa_auth, r0kh);
1719 
1720 	if (wpa_ft_rrb_init_r0kh_seq(r0kh) < 0)
1721 		return NULL;
1722 
1723 	return r0kh;
1724 }
1725 
1726 
wpa_ft_rrb_del_r1kh(void * eloop_ctx,void * timeout_ctx)1727 static void wpa_ft_rrb_del_r1kh(void *eloop_ctx, void *timeout_ctx)
1728 {
1729 	struct wpa_authenticator *wpa_auth = eloop_ctx;
1730 	struct ft_remote_r1kh *r1kh, *prev = NULL;
1731 
1732 	if (!wpa_auth->conf.r1kh_list)
1733 		return;
1734 
1735 	for (r1kh = *wpa_auth->conf.r1kh_list; r1kh; r1kh = r1kh->next) {
1736 		if (r1kh == timeout_ctx)
1737 			break;
1738 		prev = r1kh;
1739 	}
1740 	if (!r1kh)
1741 		return;
1742 	if (prev)
1743 		prev->next = r1kh->next;
1744 	else
1745 		*wpa_auth->conf.r1kh_list = r1kh->next;
1746 	if (r1kh->seq)
1747 		wpa_ft_rrb_seq_flush(wpa_auth, r1kh->seq, 0);
1748 	os_free(r1kh->seq);
1749 	os_free(r1kh);
1750 }
1751 
1752 
wpa_ft_rrb_r1kh_replenish(struct wpa_authenticator * wpa_auth,struct ft_remote_r1kh * r1kh,int timeout)1753 static void wpa_ft_rrb_r1kh_replenish(struct wpa_authenticator *wpa_auth,
1754 				      struct ft_remote_r1kh *r1kh, int timeout)
1755 {
1756 	if (timeout > 0)
1757 		eloop_replenish_timeout(timeout, 0, wpa_ft_rrb_del_r1kh,
1758 					wpa_auth, r1kh);
1759 }
1760 
1761 
1762 static struct ft_remote_r1kh *
wpa_ft_rrb_add_r1kh(struct wpa_authenticator * wpa_auth,struct ft_remote_r1kh * r1kh_wildcard,const u8 * src_addr,const u8 * r1kh_id,int timeout)1763 wpa_ft_rrb_add_r1kh(struct wpa_authenticator *wpa_auth,
1764 		    struct ft_remote_r1kh *r1kh_wildcard,
1765 		    const u8 *src_addr, const u8 *r1kh_id, int timeout)
1766 {
1767 	struct ft_remote_r1kh *r1kh;
1768 
1769 	if (!wpa_auth->conf.r1kh_list)
1770 		return NULL;
1771 
1772 	r1kh = os_zalloc(sizeof(*r1kh));
1773 	if (!r1kh)
1774 		return NULL;
1775 
1776 	os_memcpy(r1kh->addr, src_addr, sizeof(r1kh->addr));
1777 	os_memcpy(r1kh->id, r1kh_id, sizeof(r1kh->id));
1778 	os_memcpy(r1kh->key, r1kh_wildcard->key, sizeof(r1kh->key));
1779 	r1kh->next = *wpa_auth->conf.r1kh_list;
1780 	*wpa_auth->conf.r1kh_list = r1kh;
1781 
1782 	if (timeout > 0)
1783 		eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r1kh,
1784 				       wpa_auth, r1kh);
1785 
1786 	if (wpa_ft_rrb_init_r1kh_seq(r1kh) < 0)
1787 		return NULL;
1788 
1789 	return r1kh;
1790 }
1791 
1792 
wpa_ft_sta_deinit(struct wpa_state_machine * sm)1793 void wpa_ft_sta_deinit(struct wpa_state_machine *sm)
1794 {
1795 	eloop_cancel_timeout(wpa_ft_expire_pull, sm, NULL);
1796 }
1797 
1798 
wpa_ft_deinit_seq(struct wpa_authenticator * wpa_auth)1799 static void wpa_ft_deinit_seq(struct wpa_authenticator *wpa_auth)
1800 {
1801 	struct ft_remote_r0kh *r0kh;
1802 	struct ft_remote_r1kh *r1kh;
1803 
1804 	eloop_cancel_timeout(wpa_ft_rrb_seq_timeout, wpa_auth, ELOOP_ALL_CTX);
1805 
1806 	if (wpa_auth->conf.r0kh_list)
1807 		r0kh = *wpa_auth->conf.r0kh_list;
1808 	else
1809 		r0kh = NULL;
1810 	for (; r0kh; r0kh = r0kh->next) {
1811 		if (!r0kh->seq)
1812 			continue;
1813 		wpa_ft_rrb_seq_flush(wpa_auth, r0kh->seq, 0);
1814 		os_free(r0kh->seq);
1815 		r0kh->seq = NULL;
1816 	}
1817 
1818 	if (wpa_auth->conf.r1kh_list)
1819 		r1kh = *wpa_auth->conf.r1kh_list;
1820 	else
1821 		r1kh = NULL;
1822 	for (; r1kh; r1kh = r1kh->next) {
1823 		if (!r1kh->seq)
1824 			continue;
1825 		wpa_ft_rrb_seq_flush(wpa_auth, r1kh->seq, 0);
1826 		os_free(r1kh->seq);
1827 		r1kh->seq = NULL;
1828 	}
1829 }
1830 
1831 
wpa_ft_deinit_rkh_tmp(struct wpa_authenticator * wpa_auth)1832 static void wpa_ft_deinit_rkh_tmp(struct wpa_authenticator *wpa_auth)
1833 {
1834 	struct ft_remote_r0kh *r0kh, *r0kh_next, *r0kh_prev = NULL;
1835 	struct ft_remote_r1kh *r1kh, *r1kh_next, *r1kh_prev = NULL;
1836 
1837 	if (wpa_auth->conf.r0kh_list)
1838 		r0kh = *wpa_auth->conf.r0kh_list;
1839 	else
1840 		r0kh = NULL;
1841 	while (r0kh) {
1842 		r0kh_next = r0kh->next;
1843 		if (eloop_cancel_timeout(wpa_ft_rrb_del_r0kh, wpa_auth,
1844 					 r0kh) > 0) {
1845 			if (r0kh_prev)
1846 				r0kh_prev->next = r0kh_next;
1847 			else
1848 				*wpa_auth->conf.r0kh_list = r0kh_next;
1849 			os_free(r0kh);
1850 		} else {
1851 			r0kh_prev = r0kh;
1852 		}
1853 		r0kh = r0kh_next;
1854 	}
1855 
1856 	if (wpa_auth->conf.r1kh_list)
1857 		r1kh = *wpa_auth->conf.r1kh_list;
1858 	else
1859 		r1kh = NULL;
1860 	while (r1kh) {
1861 		r1kh_next = r1kh->next;
1862 		if (eloop_cancel_timeout(wpa_ft_rrb_del_r1kh, wpa_auth,
1863 					 r1kh) > 0) {
1864 			if (r1kh_prev)
1865 				r1kh_prev->next = r1kh_next;
1866 			else
1867 				*wpa_auth->conf.r1kh_list = r1kh_next;
1868 			os_free(r1kh);
1869 		} else {
1870 			r1kh_prev = r1kh;
1871 		}
1872 		r1kh = r1kh_next;
1873 	}
1874 }
1875 
1876 
wpa_ft_deinit(struct wpa_authenticator * wpa_auth)1877 void wpa_ft_deinit(struct wpa_authenticator *wpa_auth)
1878 {
1879 	wpa_ft_deinit_seq(wpa_auth);
1880 	wpa_ft_deinit_rkh_tmp(wpa_auth);
1881 }
1882 
1883 
wpa_ft_block_r0kh(struct wpa_authenticator * wpa_auth,const u8 * f_r0kh_id,size_t f_r0kh_id_len)1884 static void wpa_ft_block_r0kh(struct wpa_authenticator *wpa_auth,
1885 			      const u8 *f_r0kh_id, size_t f_r0kh_id_len)
1886 {
1887 	struct ft_remote_r0kh *r0kh, *r0kh_wildcard;
1888 
1889 	if (!wpa_auth->conf.rkh_neg_timeout)
1890 		return;
1891 
1892 	wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len,
1893 			       &r0kh, &r0kh_wildcard);
1894 
1895 	if (!r0kh_wildcard) {
1896 		/* r0kh removed after neg_timeout and might need re-adding */
1897 		return;
1898 	}
1899 
1900 	wpa_hexdump(MSG_DEBUG, "FT: Blacklist R0KH-ID",
1901 		    f_r0kh_id, f_r0kh_id_len);
1902 
1903 	if (r0kh) {
1904 		wpa_ft_rrb_r0kh_timeout(wpa_auth, r0kh,
1905 					wpa_auth->conf.rkh_neg_timeout);
1906 		os_memset(r0kh->addr, 0, ETH_ALEN);
1907 	} else
1908 		wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard, NULL, f_r0kh_id,
1909 				    f_r0kh_id_len,
1910 				    wpa_auth->conf.rkh_neg_timeout);
1911 }
1912 
1913 
wpa_ft_expire_pull(void * eloop_ctx,void * timeout_ctx)1914 static void wpa_ft_expire_pull(void *eloop_ctx, void *timeout_ctx)
1915 {
1916 	struct wpa_state_machine *sm = eloop_ctx;
1917 
1918 	wpa_printf(MSG_DEBUG, "FT: Timeout pending pull request for " MACSTR,
1919 		   MAC2STR(sm->addr));
1920 	if (sm->ft_pending_pull_left_retries <= 0)
1921 		wpa_ft_block_r0kh(sm->wpa_auth, sm->r0kh_id, sm->r0kh_id_len);
1922 
1923 	/* cancel multiple timeouts */
1924 	eloop_cancel_timeout(wpa_ft_expire_pull, sm, NULL);
1925 	ft_finish_pull(sm);
1926 }
1927 
1928 
wpa_ft_pull_pmk_r1(struct wpa_state_machine * sm,const u8 * ies,size_t ies_len,const u8 * pmk_r0_name)1929 static int wpa_ft_pull_pmk_r1(struct wpa_state_machine *sm,
1930 			      const u8 *ies, size_t ies_len,
1931 			      const u8 *pmk_r0_name)
1932 {
1933 	struct ft_remote_r0kh *r0kh, *r0kh_wildcard;
1934 	u8 *packet = NULL;
1935 	const u8 *key, *f_r1kh_id = sm->wpa_auth->conf.r1_key_holder;
1936 	size_t packet_len, key_len;
1937 	struct ft_rrb_seq f_seq;
1938 	int tsecs, tusecs, first;
1939 	struct wpabuf *ft_pending_req_ies;
1940 	int r0kh_timeout;
1941 	struct tlv_list req_enc[] = {
1942 		{ .type = FT_RRB_PMK_R0_NAME, .len = WPA_PMK_NAME_LEN,
1943 		  .data = pmk_r0_name },
1944 		{ .type = FT_RRB_S1KH_ID, .len = ETH_ALEN,
1945 		  .data = sm->addr },
1946 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
1947 	};
1948 	struct tlv_list req_auth[] = {
1949 		{ .type = FT_RRB_NONCE, .len = FT_RRB_NONCE_LEN,
1950 		  .data = sm->ft_pending_pull_nonce },
1951 		{ .type = FT_RRB_SEQ, .len = sizeof(f_seq),
1952 		  .data = (u8 *) &f_seq },
1953 		{ .type = FT_RRB_R0KH_ID, .len = sm->r0kh_id_len,
1954 		  .data = sm->r0kh_id },
1955 		{ .type = FT_RRB_R1KH_ID, .len = FT_R1KH_ID_LEN,
1956 		  .data = f_r1kh_id },
1957 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
1958 	};
1959 
1960 	if (sm->ft_pending_pull_left_retries <= 0)
1961 		return -1;
1962 	first = sm->ft_pending_pull_left_retries ==
1963 		sm->wpa_auth->conf.rkh_pull_retries;
1964 	sm->ft_pending_pull_left_retries--;
1965 
1966 	wpa_ft_rrb_lookup_r0kh(sm->wpa_auth, sm->r0kh_id, sm->r0kh_id_len,
1967 			       &r0kh, &r0kh_wildcard);
1968 
1969 	/* Keep r0kh sufficiently long in the list for seq num check */
1970 	r0kh_timeout = sm->wpa_auth->conf.rkh_pull_timeout / 1000 +
1971 		1 + ftRRBseqTimeout;
1972 	if (r0kh) {
1973 		wpa_ft_rrb_r0kh_replenish(sm->wpa_auth, r0kh, r0kh_timeout);
1974 	} else if (r0kh_wildcard) {
1975 		wpa_printf(MSG_DEBUG, "FT: Using wildcard R0KH-ID");
1976 		/* r0kh->addr: updated by SEQ_RESP and wpa_ft_expire_pull */
1977 		r0kh = wpa_ft_rrb_add_r0kh(sm->wpa_auth, r0kh_wildcard,
1978 					   r0kh_wildcard->addr,
1979 					   sm->r0kh_id, sm->r0kh_id_len,
1980 					   r0kh_timeout);
1981 	}
1982 	if (r0kh == NULL) {
1983 		wpa_hexdump(MSG_DEBUG, "FT: Did not find R0KH-ID",
1984 			    sm->r0kh_id, sm->r0kh_id_len);
1985 		return -1;
1986 	}
1987 	if (is_zero_ether_addr(r0kh->addr)) {
1988 		wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID is blacklisted",
1989 			    sm->r0kh_id, sm->r0kh_id_len);
1990 		return -1;
1991 	}
1992 	if (os_memcmp(r0kh->addr, sm->wpa_auth->addr, ETH_ALEN) == 0) {
1993 		wpa_printf(MSG_DEBUG,
1994 			   "FT: R0KH-ID points to self - no matching key available");
1995 		return -1;
1996 	}
1997 
1998 	key = r0kh->key;
1999 	key_len = sizeof(r0kh->key);
2000 
2001 	if (r0kh->seq->rx.num_last == 0) {
2002 		/* A sequence request will be sent out anyway when pull
2003 		 * response is received. Send it out now to avoid one RTT. */
2004 		wpa_ft_rrb_seq_req(sm->wpa_auth, r0kh->seq, r0kh->addr,
2005 				   r0kh->id, r0kh->id_len, f_r1kh_id, key,
2006 				   key_len, NULL, 0, NULL, 0, NULL);
2007 	}
2008 
2009 	wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 pull request from " MACSTR
2010 		   " to remote R0KH address " MACSTR,
2011 		   MAC2STR(sm->wpa_auth->addr), MAC2STR(r0kh->addr));
2012 
2013 	if (first &&
2014 	    random_get_bytes(sm->ft_pending_pull_nonce, FT_RRB_NONCE_LEN) < 0) {
2015 		wpa_printf(MSG_DEBUG, "FT: Failed to get random data for "
2016 			   "nonce");
2017 		return -1;
2018 	}
2019 
2020 	if (wpa_ft_new_seq(r0kh->seq, &f_seq) < 0) {
2021 		wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
2022 		return -1;
2023 	}
2024 
2025 	if (wpa_ft_rrb_build(key, key_len, req_enc, NULL, req_auth, NULL,
2026 			     sm->wpa_auth->addr, FT_PACKET_R0KH_R1KH_PULL,
2027 			     &packet, &packet_len) < 0)
2028 		return -1;
2029 
2030 	ft_pending_req_ies = wpabuf_alloc_copy(ies, ies_len);
2031 	wpabuf_free(sm->ft_pending_req_ies);
2032 	sm->ft_pending_req_ies = ft_pending_req_ies;
2033 	if (!sm->ft_pending_req_ies) {
2034 		os_free(packet);
2035 		return -1;
2036 	}
2037 
2038 	tsecs = sm->wpa_auth->conf.rkh_pull_timeout / 1000;
2039 	tusecs = (sm->wpa_auth->conf.rkh_pull_timeout % 1000) * 1000;
2040 	eloop_register_timeout(tsecs, tusecs, wpa_ft_expire_pull, sm, NULL);
2041 
2042 	wpa_ft_rrb_oui_send(sm->wpa_auth, r0kh->addr, FT_PACKET_R0KH_R1KH_PULL,
2043 			    packet, packet_len);
2044 
2045 	os_free(packet);
2046 
2047 	return 0;
2048 }
2049 
2050 
wpa_ft_store_pmk_fils(struct wpa_state_machine * sm,const u8 * pmk_r0,const u8 * pmk_r0_name)2051 int wpa_ft_store_pmk_fils(struct wpa_state_machine *sm,
2052 			  const u8 *pmk_r0, const u8 *pmk_r0_name)
2053 {
2054 	int expires_in = sm->wpa_auth->conf.r0_key_lifetime;
2055 	struct vlan_description vlan;
2056 	const u8 *identity, *radius_cui;
2057 	size_t identity_len, radius_cui_len;
2058 	int session_timeout;
2059 	size_t pmk_r0_len = wpa_key_mgmt_sha384(sm->wpa_key_mgmt) ?
2060 		SHA384_MAC_LEN : PMK_LEN;
2061 
2062 	if (wpa_ft_get_vlan(sm->wpa_auth, sm->addr, &vlan) < 0) {
2063 		wpa_printf(MSG_DEBUG, "FT: vlan not available for STA " MACSTR,
2064 			   MAC2STR(sm->addr));
2065 		return -1;
2066 	}
2067 
2068 	identity_len = wpa_ft_get_identity(sm->wpa_auth, sm->addr, &identity);
2069 	radius_cui_len = wpa_ft_get_radius_cui(sm->wpa_auth, sm->addr,
2070 					       &radius_cui);
2071 	session_timeout = wpa_ft_get_session_timeout(sm->wpa_auth, sm->addr);
2072 
2073 	return wpa_ft_store_pmk_r0(sm->wpa_auth, sm->addr, pmk_r0, pmk_r0_len,
2074 				   pmk_r0_name, sm->pairwise, &vlan, expires_in,
2075 				   session_timeout, identity, identity_len,
2076 				   radius_cui, radius_cui_len);
2077 }
2078 
2079 
wpa_auth_derive_ptk_ft(struct wpa_state_machine * sm,struct wpa_ptk * ptk)2080 int wpa_auth_derive_ptk_ft(struct wpa_state_machine *sm, struct wpa_ptk *ptk)
2081 {
2082 	u8 pmk_r0[PMK_LEN_MAX], pmk_r0_name[WPA_PMK_NAME_LEN];
2083 	size_t pmk_r0_len = wpa_key_mgmt_sha384(sm->wpa_key_mgmt) ?
2084 		SHA384_MAC_LEN : PMK_LEN;
2085 	size_t pmk_r1_len = pmk_r0_len;
2086 	u8 pmk_r1[PMK_LEN_MAX];
2087 	u8 ptk_name[WPA_PMK_NAME_LEN];
2088 	const u8 *mdid = sm->wpa_auth->conf.mobility_domain;
2089 	const u8 *r0kh = sm->wpa_auth->conf.r0_key_holder;
2090 	size_t r0kh_len = sm->wpa_auth->conf.r0_key_holder_len;
2091 	const u8 *r1kh = sm->wpa_auth->conf.r1_key_holder;
2092 	const u8 *ssid = sm->wpa_auth->conf.ssid;
2093 	size_t ssid_len = sm->wpa_auth->conf.ssid_len;
2094 	int psk_local = sm->wpa_auth->conf.ft_psk_generate_local;
2095 	int expires_in = sm->wpa_auth->conf.r0_key_lifetime;
2096 	struct vlan_description vlan;
2097 	const u8 *identity, *radius_cui;
2098 	size_t identity_len, radius_cui_len;
2099 	int session_timeout;
2100 	const u8 *mpmk;
2101 	size_t mpmk_len;
2102 
2103 	if (sm->xxkey_len > 0) {
2104 		mpmk = sm->xxkey;
2105 		mpmk_len = sm->xxkey_len;
2106 	} else if (sm->pmksa) {
2107 		mpmk = sm->pmksa->pmk;
2108 		mpmk_len = sm->pmksa->pmk_len;
2109 	} else {
2110 		wpa_printf(MSG_DEBUG, "FT: XXKey not available for key "
2111 			   "derivation");
2112 		return -1;
2113 	}
2114 
2115 	if (wpa_ft_get_vlan(sm->wpa_auth, sm->addr, &vlan) < 0) {
2116 		wpa_printf(MSG_DEBUG, "FT: vlan not available for STA " MACSTR,
2117 			   MAC2STR(sm->addr));
2118 		return -1;
2119 	}
2120 
2121 	identity_len = wpa_ft_get_identity(sm->wpa_auth, sm->addr, &identity);
2122 	radius_cui_len = wpa_ft_get_radius_cui(sm->wpa_auth, sm->addr,
2123 					       &radius_cui);
2124 	session_timeout = wpa_ft_get_session_timeout(sm->wpa_auth, sm->addr);
2125 
2126 	if (wpa_derive_pmk_r0(mpmk, mpmk_len, ssid, ssid_len, mdid,
2127 			      r0kh, r0kh_len, sm->addr,
2128 			      pmk_r0, pmk_r0_name,
2129 			      wpa_key_mgmt_sha384(sm->wpa_key_mgmt)) < 0)
2130 		return -1;
2131 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R0", pmk_r0, pmk_r0_len);
2132 	wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name", pmk_r0_name, WPA_PMK_NAME_LEN);
2133 	if (!psk_local || !wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt))
2134 		wpa_ft_store_pmk_r0(sm->wpa_auth, sm->addr, pmk_r0, pmk_r0_len,
2135 				    pmk_r0_name,
2136 				    sm->pairwise, &vlan, expires_in,
2137 				    session_timeout, identity, identity_len,
2138 				    radius_cui, radius_cui_len);
2139 
2140 	if (wpa_derive_pmk_r1(pmk_r0, pmk_r0_len, pmk_r0_name, r1kh, sm->addr,
2141 			      pmk_r1, sm->pmk_r1_name) < 0)
2142 		return -1;
2143 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", pmk_r1, pmk_r1_len);
2144 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", sm->pmk_r1_name,
2145 		    WPA_PMK_NAME_LEN);
2146 	if (!psk_local || !wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt))
2147 		wpa_ft_store_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1, pmk_r1_len,
2148 				    sm->pmk_r1_name, sm->pairwise, &vlan,
2149 				    expires_in, session_timeout, identity,
2150 				    identity_len, radius_cui, radius_cui_len);
2151 
2152 	return wpa_pmk_r1_to_ptk(pmk_r1, pmk_r1_len, sm->SNonce, sm->ANonce,
2153 				 sm->addr, sm->wpa_auth->addr, sm->pmk_r1_name,
2154 				 ptk, ptk_name, sm->wpa_key_mgmt, sm->pairwise);
2155 }
2156 
2157 
wpa_auth_get_seqnum(struct wpa_authenticator * wpa_auth,const u8 * addr,int idx,u8 * seq)2158 static inline int wpa_auth_get_seqnum(struct wpa_authenticator *wpa_auth,
2159 				      const u8 *addr, int idx, u8 *seq)
2160 {
2161 	if (wpa_auth->cb->get_seqnum == NULL)
2162 		return -1;
2163 	return wpa_auth->cb->get_seqnum(wpa_auth->cb_ctx, addr, idx, seq);
2164 }
2165 
2166 
wpa_ft_gtk_subelem(struct wpa_state_machine * sm,size_t * len)2167 static u8 * wpa_ft_gtk_subelem(struct wpa_state_machine *sm, size_t *len)
2168 {
2169 	u8 *subelem;
2170 	struct wpa_group *gsm = sm->group;
2171 	size_t subelem_len, pad_len;
2172 	const u8 *key;
2173 	size_t key_len;
2174 	u8 keybuf[32];
2175 	const u8 *kek;
2176 	size_t kek_len;
2177 
2178 	if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
2179 		kek = sm->PTK.kek2;
2180 		kek_len = sm->PTK.kek2_len;
2181 	} else {
2182 		kek = sm->PTK.kek;
2183 		kek_len = sm->PTK.kek_len;
2184 	}
2185 
2186 	key_len = gsm->GTK_len;
2187 	if (key_len > sizeof(keybuf))
2188 		return NULL;
2189 
2190 	/*
2191 	 * Pad key for AES Key Wrap if it is not multiple of 8 bytes or is less
2192 	 * than 16 bytes.
2193 	 */
2194 	pad_len = key_len % 8;
2195 	if (pad_len)
2196 		pad_len = 8 - pad_len;
2197 	if (key_len + pad_len < 16)
2198 		pad_len += 8;
2199 	if (pad_len && key_len < sizeof(keybuf)) {
2200 		os_memcpy(keybuf, gsm->GTK[gsm->GN - 1], key_len);
2201 		os_memset(keybuf + key_len, 0, pad_len);
2202 		keybuf[key_len] = 0xdd;
2203 		key_len += pad_len;
2204 		key = keybuf;
2205 	} else
2206 		key = gsm->GTK[gsm->GN - 1];
2207 
2208 	/*
2209 	 * Sub-elem ID[1] | Length[1] | Key Info[2] | Key Length[1] | RSC[8] |
2210 	 * Key[5..32].
2211 	 */
2212 	subelem_len = 13 + key_len + 8;
2213 	subelem = os_zalloc(subelem_len);
2214 	if (subelem == NULL)
2215 		return NULL;
2216 
2217 	subelem[0] = FTIE_SUBELEM_GTK;
2218 	subelem[1] = 11 + key_len + 8;
2219 	/* Key ID in B0-B1 of Key Info */
2220 	WPA_PUT_LE16(&subelem[2], gsm->GN & 0x03);
2221 	subelem[4] = gsm->GTK_len;
2222 	wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN, subelem + 5);
2223 	if (aes_wrap(kek, kek_len, key_len / 8, key, subelem + 13)) {
2224 		wpa_printf(MSG_DEBUG,
2225 			   "FT: GTK subelem encryption failed: kek_len=%d",
2226 			   (int) kek_len);
2227 		os_free(subelem);
2228 		return NULL;
2229 	}
2230 
2231 	forced_memzero(keybuf, sizeof(keybuf));
2232 	*len = subelem_len;
2233 	return subelem;
2234 }
2235 
2236 
wpa_ft_igtk_subelem(struct wpa_state_machine * sm,size_t * len)2237 static u8 * wpa_ft_igtk_subelem(struct wpa_state_machine *sm, size_t *len)
2238 {
2239 	u8 *subelem, *pos;
2240 	struct wpa_group *gsm = sm->group;
2241 	size_t subelem_len;
2242 	const u8 *kek;
2243 	size_t kek_len;
2244 	size_t igtk_len;
2245 
2246 	if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
2247 		kek = sm->PTK.kek2;
2248 		kek_len = sm->PTK.kek2_len;
2249 	} else {
2250 		kek = sm->PTK.kek;
2251 		kek_len = sm->PTK.kek_len;
2252 	}
2253 
2254 	igtk_len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
2255 
2256 	/* Sub-elem ID[1] | Length[1] | KeyID[2] | IPN[6] | Key Length[1] |
2257 	 * Key[16+8] */
2258 	subelem_len = 1 + 1 + 2 + 6 + 1 + igtk_len + 8;
2259 	subelem = os_zalloc(subelem_len);
2260 	if (subelem == NULL)
2261 		return NULL;
2262 
2263 	pos = subelem;
2264 	*pos++ = FTIE_SUBELEM_IGTK;
2265 	*pos++ = subelem_len - 2;
2266 	WPA_PUT_LE16(pos, gsm->GN_igtk);
2267 	pos += 2;
2268 	wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_igtk, pos);
2269 	pos += 6;
2270 	*pos++ = igtk_len;
2271 	if (aes_wrap(kek, kek_len, igtk_len / 8,
2272 		     gsm->IGTK[gsm->GN_igtk - 4], pos)) {
2273 		wpa_printf(MSG_DEBUG,
2274 			   "FT: IGTK subelem encryption failed: kek_len=%d",
2275 			   (int) kek_len);
2276 		os_free(subelem);
2277 		return NULL;
2278 	}
2279 
2280 	*len = subelem_len;
2281 	return subelem;
2282 }
2283 
2284 
wpa_ft_bigtk_subelem(struct wpa_state_machine * sm,size_t * len)2285 static u8 * wpa_ft_bigtk_subelem(struct wpa_state_machine *sm, size_t *len)
2286 {
2287 	u8 *subelem, *pos;
2288 	struct wpa_group *gsm = sm->group;
2289 	size_t subelem_len;
2290 	const u8 *kek;
2291 	size_t kek_len;
2292 	size_t bigtk_len;
2293 
2294 	if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
2295 		kek = sm->PTK.kek2;
2296 		kek_len = sm->PTK.kek2_len;
2297 	} else {
2298 		kek = sm->PTK.kek;
2299 		kek_len = sm->PTK.kek_len;
2300 	}
2301 
2302 	bigtk_len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
2303 
2304 	/* Sub-elem ID[1] | Length[1] | KeyID[2] | BIPN[6] | Key Length[1] |
2305 	 * Key[16+8] */
2306 	subelem_len = 1 + 1 + 2 + 6 + 1 + bigtk_len + 8;
2307 	subelem = os_zalloc(subelem_len);
2308 	if (subelem == NULL)
2309 		return NULL;
2310 
2311 	pos = subelem;
2312 	*pos++ = FTIE_SUBELEM_BIGTK;
2313 	*pos++ = subelem_len - 2;
2314 	WPA_PUT_LE16(pos, gsm->GN_bigtk);
2315 	pos += 2;
2316 	wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_bigtk, pos);
2317 	pos += 6;
2318 	*pos++ = bigtk_len;
2319 	if (aes_wrap(kek, kek_len, bigtk_len / 8,
2320 		     gsm->IGTK[gsm->GN_bigtk - 6], pos)) {
2321 		wpa_printf(MSG_DEBUG,
2322 			   "FT: BIGTK subelem encryption failed: kek_len=%d",
2323 			   (int) kek_len);
2324 		os_free(subelem);
2325 		return NULL;
2326 	}
2327 
2328 	*len = subelem_len;
2329 	return subelem;
2330 }
2331 
2332 
wpa_ft_process_rdie(struct wpa_state_machine * sm,u8 * pos,u8 * end,u8 id,u8 descr_count,const u8 * ies,size_t ies_len)2333 static u8 * wpa_ft_process_rdie(struct wpa_state_machine *sm,
2334 				u8 *pos, u8 *end, u8 id, u8 descr_count,
2335 				const u8 *ies, size_t ies_len)
2336 {
2337 	struct ieee802_11_elems parse;
2338 	struct rsn_rdie *rdie;
2339 
2340 	wpa_printf(MSG_DEBUG, "FT: Resource Request: id=%d descr_count=%d",
2341 		   id, descr_count);
2342 	wpa_hexdump(MSG_MSGDUMP, "FT: Resource descriptor IE(s)",
2343 		    ies, ies_len);
2344 
2345 	if (end - pos < (int) sizeof(*rdie)) {
2346 		wpa_printf(MSG_ERROR, "FT: Not enough room for response RDIE");
2347 		return pos;
2348 	}
2349 
2350 	*pos++ = WLAN_EID_RIC_DATA;
2351 	*pos++ = sizeof(*rdie);
2352 	rdie = (struct rsn_rdie *) pos;
2353 	rdie->id = id;
2354 	rdie->descr_count = 0;
2355 	rdie->status_code = host_to_le16(WLAN_STATUS_SUCCESS);
2356 	pos += sizeof(*rdie);
2357 
2358 	if (ieee802_11_parse_elems((u8 *) ies, ies_len, &parse, 1) ==
2359 	    ParseFailed) {
2360 		wpa_printf(MSG_DEBUG, "FT: Failed to parse request IEs");
2361 		rdie->status_code =
2362 			host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE);
2363 		return pos;
2364 	}
2365 
2366 	if (parse.wmm_tspec) {
2367 		struct wmm_tspec_element *tspec;
2368 
2369 		if (parse.wmm_tspec_len + 2 < (int) sizeof(*tspec)) {
2370 			wpa_printf(MSG_DEBUG, "FT: Too short WMM TSPEC IE "
2371 				   "(%d)", (int) parse.wmm_tspec_len);
2372 			rdie->status_code =
2373 				host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE);
2374 			return pos;
2375 		}
2376 		if (end - pos < (int) sizeof(*tspec)) {
2377 			wpa_printf(MSG_ERROR, "FT: Not enough room for "
2378 				   "response TSPEC");
2379 			rdie->status_code =
2380 				host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE);
2381 			return pos;
2382 		}
2383 		tspec = (struct wmm_tspec_element *) pos;
2384 		os_memcpy(tspec, parse.wmm_tspec - 2, sizeof(*tspec));
2385 	}
2386 
2387 #ifdef NEED_AP_MLME
2388 	if (parse.wmm_tspec && sm->wpa_auth->conf.ap_mlme) {
2389 		int res;
2390 
2391 		res = wmm_process_tspec((struct wmm_tspec_element *) pos);
2392 		wpa_printf(MSG_DEBUG, "FT: ADDTS processing result: %d", res);
2393 		if (res == WMM_ADDTS_STATUS_INVALID_PARAMETERS)
2394 			rdie->status_code =
2395 				host_to_le16(WLAN_STATUS_INVALID_PARAMETERS);
2396 		else if (res == WMM_ADDTS_STATUS_REFUSED)
2397 			rdie->status_code =
2398 				host_to_le16(WLAN_STATUS_REQUEST_DECLINED);
2399 		else {
2400 			/* TSPEC accepted; include updated TSPEC in response */
2401 			rdie->descr_count = 1;
2402 			pos += sizeof(struct wmm_tspec_element);
2403 		}
2404 		return pos;
2405 	}
2406 #endif /* NEED_AP_MLME */
2407 
2408 	if (parse.wmm_tspec && !sm->wpa_auth->conf.ap_mlme) {
2409 		int res;
2410 
2411 		res = wpa_ft_add_tspec(sm->wpa_auth, sm->addr, pos,
2412 				       sizeof(struct wmm_tspec_element));
2413 		if (res >= 0) {
2414 			if (res)
2415 				rdie->status_code = host_to_le16(res);
2416 			else {
2417 				/* TSPEC accepted; include updated TSPEC in
2418 				 * response */
2419 				rdie->descr_count = 1;
2420 				pos += sizeof(struct wmm_tspec_element);
2421 			}
2422 			return pos;
2423 		}
2424 	}
2425 
2426 	wpa_printf(MSG_DEBUG, "FT: No supported resource requested");
2427 	rdie->status_code = host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE);
2428 	return pos;
2429 }
2430 
2431 
wpa_ft_process_ric(struct wpa_state_machine * sm,u8 * pos,u8 * end,const u8 * ric,size_t ric_len)2432 static u8 * wpa_ft_process_ric(struct wpa_state_machine *sm, u8 *pos, u8 *end,
2433 			       const u8 *ric, size_t ric_len)
2434 {
2435 	const u8 *rpos, *start;
2436 	const struct rsn_rdie *rdie;
2437 
2438 	wpa_hexdump(MSG_MSGDUMP, "FT: RIC Request", ric, ric_len);
2439 
2440 	rpos = ric;
2441 	while (rpos + sizeof(*rdie) < ric + ric_len) {
2442 		if (rpos[0] != WLAN_EID_RIC_DATA || rpos[1] < sizeof(*rdie) ||
2443 		    rpos + 2 + rpos[1] > ric + ric_len)
2444 			break;
2445 		rdie = (const struct rsn_rdie *) (rpos + 2);
2446 		rpos += 2 + rpos[1];
2447 		start = rpos;
2448 
2449 		while (rpos + 2 <= ric + ric_len &&
2450 		       rpos + 2 + rpos[1] <= ric + ric_len) {
2451 			if (rpos[0] == WLAN_EID_RIC_DATA)
2452 				break;
2453 			rpos += 2 + rpos[1];
2454 		}
2455 		pos = wpa_ft_process_rdie(sm, pos, end, rdie->id,
2456 					  rdie->descr_count,
2457 					  start, rpos - start);
2458 	}
2459 
2460 	return pos;
2461 }
2462 
2463 
wpa_sm_write_assoc_resp_ies(struct wpa_state_machine * sm,u8 * pos,size_t max_len,int auth_alg,const u8 * req_ies,size_t req_ies_len,int omit_rsnxe)2464 u8 * wpa_sm_write_assoc_resp_ies(struct wpa_state_machine *sm, u8 *pos,
2465 				 size_t max_len, int auth_alg,
2466 				 const u8 *req_ies, size_t req_ies_len,
2467 				 int omit_rsnxe)
2468 {
2469 	u8 *end, *mdie, *ftie, *rsnie = NULL, *r0kh_id, *subelem = NULL;
2470 	u8 *fte_mic, *elem_count;
2471 	size_t mdie_len, ftie_len, rsnie_len = 0, r0kh_id_len, subelem_len = 0;
2472 	u8 rsnxe_buf[10], *rsnxe = rsnxe_buf;
2473 	size_t rsnxe_len;
2474 	int rsnxe_used;
2475 	int res;
2476 	struct wpa_auth_config *conf;
2477 	struct wpa_ft_ies parse;
2478 	u8 *ric_start;
2479 	u8 *anonce, *snonce;
2480 	const u8 *kck;
2481 	size_t kck_len;
2482 	int use_sha384;
2483 
2484 	if (sm == NULL)
2485 		return pos;
2486 
2487 	use_sha384 = wpa_key_mgmt_sha384(sm->wpa_key_mgmt);
2488 	conf = &sm->wpa_auth->conf;
2489 
2490 	if (!wpa_key_mgmt_ft(sm->wpa_key_mgmt))
2491 		return pos;
2492 
2493 	end = pos + max_len;
2494 
2495 #ifdef CONFIG_TESTING_OPTIONS
2496 	if (auth_alg == WLAN_AUTH_FT &&
2497 	    sm->wpa_auth->conf.rsne_override_ft_set) {
2498 		wpa_printf(MSG_DEBUG,
2499 			   "TESTING: RSNE FT override for MIC calculation");
2500 		rsnie = sm->wpa_auth->conf.rsne_override_ft;
2501 		rsnie_len = sm->wpa_auth->conf.rsne_override_ft_len;
2502 		if (end - pos < (long int) rsnie_len)
2503 			return pos;
2504 		os_memcpy(pos, rsnie, rsnie_len);
2505 		rsnie = pos;
2506 		pos += rsnie_len;
2507 		if (rsnie_len > PMKID_LEN && sm->pmk_r1_name_valid) {
2508 			int idx;
2509 
2510 			/* Replace all 0xff PMKID with the valid PMKR1Name */
2511 			for (idx = 0; idx < PMKID_LEN; idx++) {
2512 				if (rsnie[rsnie_len - 1 - idx] != 0xff)
2513 					break;
2514 			}
2515 			if (idx == PMKID_LEN)
2516 				os_memcpy(&rsnie[rsnie_len - PMKID_LEN],
2517 					  sm->pmk_r1_name, WPA_PMK_NAME_LEN);
2518 		}
2519 	} else
2520 #endif /* CONFIG_TESTING_OPTIONS */
2521 	if (auth_alg == WLAN_AUTH_FT ||
2522 	    ((auth_alg == WLAN_AUTH_FILS_SK ||
2523 	      auth_alg == WLAN_AUTH_FILS_SK_PFS ||
2524 	      auth_alg == WLAN_AUTH_FILS_PK) &&
2525 	     (sm->wpa_key_mgmt & (WPA_KEY_MGMT_FT_FILS_SHA256 |
2526 				  WPA_KEY_MGMT_FT_FILS_SHA384)))) {
2527 		if (!sm->pmk_r1_name_valid) {
2528 			wpa_printf(MSG_ERROR,
2529 				   "FT: PMKR1Name is not valid for Assoc Resp RSNE");
2530 			return NULL;
2531 		}
2532 		wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name for Assoc Resp RSNE",
2533 			    sm->pmk_r1_name, WPA_PMK_NAME_LEN);
2534 		/*
2535 		 * RSN (only present if this is a Reassociation Response and
2536 		 * part of a fast BSS transition; or if this is a
2537 		 * (Re)Association Response frame during an FT initial mobility
2538 		 * domain association using FILS)
2539 		 */
2540 		res = wpa_write_rsn_ie(conf, pos, end - pos, sm->pmk_r1_name);
2541 		if (res < 0)
2542 			return NULL;
2543 		rsnie = pos;
2544 		rsnie_len = res;
2545 		pos += res;
2546 	}
2547 
2548 	/* Mobility Domain Information */
2549 	res = wpa_write_mdie(conf, pos, end - pos);
2550 	if (res < 0)
2551 		return NULL;
2552 	mdie = pos;
2553 	mdie_len = res;
2554 	pos += res;
2555 
2556 	/* Fast BSS Transition Information */
2557 	if (auth_alg == WLAN_AUTH_FT) {
2558 		subelem = wpa_ft_gtk_subelem(sm, &subelem_len);
2559 		if (!subelem) {
2560 			wpa_printf(MSG_DEBUG,
2561 				   "FT: Failed to add GTK subelement");
2562 			return NULL;
2563 		}
2564 		r0kh_id = sm->r0kh_id;
2565 		r0kh_id_len = sm->r0kh_id_len;
2566 		anonce = sm->ANonce;
2567 		snonce = sm->SNonce;
2568 		if (sm->mgmt_frame_prot) {
2569 			u8 *igtk;
2570 			size_t igtk_len;
2571 			u8 *nbuf;
2572 			igtk = wpa_ft_igtk_subelem(sm, &igtk_len);
2573 			if (igtk == NULL) {
2574 				wpa_printf(MSG_DEBUG,
2575 					   "FT: Failed to add IGTK subelement");
2576 				os_free(subelem);
2577 				return NULL;
2578 			}
2579 			nbuf = os_realloc(subelem, subelem_len + igtk_len);
2580 			if (nbuf == NULL) {
2581 				os_free(subelem);
2582 				os_free(igtk);
2583 				return NULL;
2584 			}
2585 			subelem = nbuf;
2586 			os_memcpy(subelem + subelem_len, igtk, igtk_len);
2587 			subelem_len += igtk_len;
2588 			os_free(igtk);
2589 		}
2590 		if (sm->mgmt_frame_prot && conf->beacon_prot) {
2591 			u8 *bigtk;
2592 			size_t bigtk_len;
2593 			u8 *nbuf;
2594 
2595 			bigtk = wpa_ft_bigtk_subelem(sm, &bigtk_len);
2596 			if (!bigtk) {
2597 				wpa_printf(MSG_DEBUG,
2598 					   "FT: Failed to add BIGTK subelement");
2599 				os_free(subelem);
2600 				return NULL;
2601 			}
2602 			nbuf = os_realloc(subelem, subelem_len + bigtk_len);
2603 			if (!nbuf) {
2604 				os_free(subelem);
2605 				os_free(bigtk);
2606 				return NULL;
2607 			}
2608 			subelem = nbuf;
2609 			os_memcpy(subelem + subelem_len, bigtk, bigtk_len);
2610 			subelem_len += bigtk_len;
2611 			os_free(bigtk);
2612 		}
2613 #ifdef CONFIG_OCV
2614 		if (wpa_auth_uses_ocv(sm)) {
2615 			struct wpa_channel_info ci;
2616 			u8 *nbuf, *ocipos;
2617 
2618 			if (wpa_channel_info(sm->wpa_auth, &ci) != 0) {
2619 				wpa_printf(MSG_WARNING,
2620 					   "Failed to get channel info for OCI element");
2621 				os_free(subelem);
2622 				return NULL;
2623 			}
2624 
2625 			subelem_len += 2 + OCV_OCI_LEN;
2626 			nbuf = os_realloc(subelem, subelem_len);
2627 			if (!nbuf) {
2628 				os_free(subelem);
2629 				return NULL;
2630 			}
2631 			subelem = nbuf;
2632 
2633 			ocipos = subelem + subelem_len - 2 - OCV_OCI_LEN;
2634 			*ocipos++ = FTIE_SUBELEM_OCI;
2635 			*ocipos++ = OCV_OCI_LEN;
2636 			if (ocv_insert_oci(&ci, &ocipos) < 0) {
2637 				os_free(subelem);
2638 				return NULL;
2639 			}
2640 		}
2641 #endif /* CONFIG_OCV */
2642 	} else {
2643 		r0kh_id = conf->r0_key_holder;
2644 		r0kh_id_len = conf->r0_key_holder_len;
2645 		anonce = NULL;
2646 		snonce = NULL;
2647 	}
2648 	rsnxe_used = (auth_alg == WLAN_AUTH_FT) &&
2649 		(conf->sae_pwe == 1 || conf->sae_pwe == 2);
2650 #ifdef CONFIG_TESTING_OPTIONS
2651 	if (sm->wpa_auth->conf.ft_rsnxe_used) {
2652 		rsnxe_used = sm->wpa_auth->conf.ft_rsnxe_used == 1;
2653 		wpa_printf(MSG_DEBUG, "TESTING: FT: Force RSNXE Used %d",
2654 			   rsnxe_used);
2655 	}
2656 #endif /* CONFIG_TESTING_OPTIONS */
2657 	res = wpa_write_ftie(conf, use_sha384, r0kh_id, r0kh_id_len,
2658 			     anonce, snonce, pos, end - pos,
2659 			     subelem, subelem_len, rsnxe_used);
2660 	os_free(subelem);
2661 	if (res < 0)
2662 		return NULL;
2663 	ftie = pos;
2664 	ftie_len = res;
2665 	pos += res;
2666 
2667 	if (use_sha384) {
2668 		struct rsn_ftie_sha384 *_ftie =
2669 			(struct rsn_ftie_sha384 *) (ftie + 2);
2670 
2671 		fte_mic = _ftie->mic;
2672 		elem_count = &_ftie->mic_control[1];
2673 	} else {
2674 		struct rsn_ftie *_ftie = (struct rsn_ftie *) (ftie + 2);
2675 
2676 		fte_mic = _ftie->mic;
2677 		elem_count = &_ftie->mic_control[1];
2678 	}
2679 	if (auth_alg == WLAN_AUTH_FT)
2680 		*elem_count = 3; /* Information element count */
2681 
2682 	ric_start = pos;
2683 	if (wpa_ft_parse_ies(req_ies, req_ies_len, &parse, use_sha384) == 0
2684 	    && parse.ric) {
2685 		pos = wpa_ft_process_ric(sm, pos, end, parse.ric,
2686 					 parse.ric_len);
2687 		if (auth_alg == WLAN_AUTH_FT)
2688 			*elem_count +=
2689 				ieee802_11_ie_count(ric_start,
2690 						    pos - ric_start);
2691 	}
2692 	if (ric_start == pos)
2693 		ric_start = NULL;
2694 
2695 	if (omit_rsnxe) {
2696 		rsnxe_len = 0;
2697 	} else {
2698 		res = wpa_write_rsnxe(&sm->wpa_auth->conf, rsnxe,
2699 				      sizeof(rsnxe_buf));
2700 		if (res < 0)
2701 			return NULL;
2702 		rsnxe_len = res;
2703 	}
2704 #ifdef CONFIG_TESTING_OPTIONS
2705 	if (auth_alg == WLAN_AUTH_FT &&
2706 	    sm->wpa_auth->conf.rsnxe_override_ft_set) {
2707 		wpa_printf(MSG_DEBUG,
2708 			   "TESTING: RSNXE FT override for MIC calculation");
2709 		rsnxe = sm->wpa_auth->conf.rsnxe_override_ft;
2710 		rsnxe_len = sm->wpa_auth->conf.rsnxe_override_ft_len;
2711 	}
2712 #endif /* CONFIG_TESTING_OPTIONS */
2713 	if (auth_alg == WLAN_AUTH_FT && rsnxe_len)
2714 		*elem_count += 1;
2715 
2716 	if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
2717 		kck = sm->PTK.kck2;
2718 		kck_len = sm->PTK.kck2_len;
2719 	} else {
2720 		kck = sm->PTK.kck;
2721 		kck_len = sm->PTK.kck_len;
2722 	}
2723 	if (auth_alg == WLAN_AUTH_FT &&
2724 	    wpa_ft_mic(kck, kck_len, sm->addr, sm->wpa_auth->addr, 6,
2725 		       mdie, mdie_len, ftie, ftie_len,
2726 		       rsnie, rsnie_len,
2727 		       ric_start, ric_start ? pos - ric_start : 0,
2728 		       rsnxe_len ? rsnxe : NULL, rsnxe_len,
2729 		       fte_mic) < 0) {
2730 		wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC");
2731 		return NULL;
2732 	}
2733 
2734 	os_free(sm->assoc_resp_ftie);
2735 	sm->assoc_resp_ftie = os_malloc(ftie_len);
2736 	if (!sm->assoc_resp_ftie)
2737 		return NULL;
2738 	os_memcpy(sm->assoc_resp_ftie, ftie, ftie_len);
2739 
2740 	return pos;
2741 }
2742 
2743 
wpa_auth_set_key(struct wpa_authenticator * wpa_auth,int vlan_id,enum wpa_alg alg,const u8 * addr,int idx,u8 * key,size_t key_len,enum key_flag key_flag)2744 static inline int wpa_auth_set_key(struct wpa_authenticator *wpa_auth,
2745 				   int vlan_id,
2746 				   enum wpa_alg alg, const u8 *addr, int idx,
2747 				   u8 *key, size_t key_len,
2748 				   enum key_flag key_flag)
2749 {
2750 	if (wpa_auth->cb->set_key == NULL)
2751 		return -1;
2752 	return wpa_auth->cb->set_key(wpa_auth->cb_ctx, vlan_id, alg, addr, idx,
2753 				     key, key_len, key_flag);
2754 }
2755 
2756 
wpa_auth_add_sta_ft(struct wpa_authenticator * wpa_auth,const u8 * addr)2757 static inline int wpa_auth_add_sta_ft(struct wpa_authenticator *wpa_auth,
2758 				      const u8 *addr)
2759 {
2760 	if (!wpa_auth->cb->add_sta_ft)
2761 		return -1;
2762 	return wpa_auth->cb->add_sta_ft(wpa_auth->cb_ctx, addr);
2763 }
2764 
2765 
wpa_ft_install_ptk(struct wpa_state_machine * sm,int retry)2766 void wpa_ft_install_ptk(struct wpa_state_machine *sm, int retry)
2767 {
2768 	enum wpa_alg alg;
2769 	int klen;
2770 
2771 	/* MLME-SETKEYS.request(PTK) */
2772 	alg = wpa_cipher_to_alg(sm->pairwise);
2773 	klen = wpa_cipher_key_len(sm->pairwise);
2774 	if (!wpa_cipher_valid_pairwise(sm->pairwise)) {
2775 		wpa_printf(MSG_DEBUG, "FT: Unknown pairwise alg 0x%x - skip "
2776 			   "PTK configuration", sm->pairwise);
2777 		return;
2778 	}
2779 
2780 	if (sm->tk_already_set) {
2781 		/* Must avoid TK reconfiguration to prevent clearing of TX/RX
2782 		 * PN in the driver */
2783 		wpa_printf(MSG_DEBUG,
2784 			   "FT: Do not re-install same PTK to the driver");
2785 		return;
2786 	}
2787 
2788 	if (!retry)
2789 		wpa_auth_add_sta_ft(sm->wpa_auth, sm->addr);
2790 
2791 	/* FIX: add STA entry to kernel/driver here? The set_key will fail
2792 	 * most likely without this.. At the moment, STA entry is added only
2793 	 * after association has been completed. This function will be called
2794 	 * again after association to get the PTK configured, but that could be
2795 	 * optimized by adding the STA entry earlier.
2796 	 */
2797 	if (wpa_auth_set_key(sm->wpa_auth, 0, alg, sm->addr, sm->keyidx_active,
2798 			     sm->PTK.tk, klen, KEY_FLAG_PAIRWISE_RX_TX))
2799 		return;
2800 
2801 	/* FIX: MLME-SetProtection.Request(TA, Tx_Rx) */
2802 	sm->pairwise_set = true;
2803 	sm->tk_already_set = true;
2804 }
2805 
2806 
2807 /* Derive PMK-R1 from PSK, check all available PSK */
wpa_ft_psk_pmk_r1(struct wpa_state_machine * sm,const u8 * req_pmk_r1_name,u8 * out_pmk_r1,int * out_pairwise,struct vlan_description * out_vlan,const u8 ** out_identity,size_t * out_identity_len,const u8 ** out_radius_cui,size_t * out_radius_cui_len,int * out_session_timeout)2808 static int wpa_ft_psk_pmk_r1(struct wpa_state_machine *sm,
2809 			     const u8 *req_pmk_r1_name,
2810 			     u8 *out_pmk_r1, int *out_pairwise,
2811 			     struct vlan_description *out_vlan,
2812 			     const u8 **out_identity, size_t *out_identity_len,
2813 			     const u8 **out_radius_cui,
2814 			     size_t *out_radius_cui_len,
2815 			     int *out_session_timeout)
2816 {
2817 	const u8 *pmk = NULL;
2818 	u8 pmk_r0[PMK_LEN], pmk_r0_name[WPA_PMK_NAME_LEN];
2819 	u8 pmk_r1[PMK_LEN], pmk_r1_name[WPA_PMK_NAME_LEN];
2820 	struct wpa_authenticator *wpa_auth = sm->wpa_auth;
2821 	const u8 *mdid = wpa_auth->conf.mobility_domain;
2822 	const u8 *r0kh = sm->r0kh_id;
2823 	size_t r0kh_len = sm->r0kh_id_len;
2824 	const u8 *r1kh = wpa_auth->conf.r1_key_holder;
2825 	const u8 *ssid = wpa_auth->conf.ssid;
2826 	size_t ssid_len = wpa_auth->conf.ssid_len;
2827 	int pairwise;
2828 
2829 	pairwise = sm->pairwise;
2830 
2831 	for (;;) {
2832 		pmk = wpa_ft_get_psk(wpa_auth, sm->addr, sm->p2p_dev_addr,
2833 				     pmk);
2834 		if (pmk == NULL)
2835 			break;
2836 
2837 		if (wpa_derive_pmk_r0(pmk, PMK_LEN, ssid, ssid_len, mdid, r0kh,
2838 				      r0kh_len, sm->addr,
2839 				      pmk_r0, pmk_r0_name, 0) < 0 ||
2840 		    wpa_derive_pmk_r1(pmk_r0, PMK_LEN, pmk_r0_name, r1kh,
2841 				      sm->addr, pmk_r1, pmk_r1_name) < 0 ||
2842 		    os_memcmp_const(pmk_r1_name, req_pmk_r1_name,
2843 				    WPA_PMK_NAME_LEN) != 0)
2844 			continue;
2845 
2846 		/* We found a PSK that matches the requested pmk_r1_name */
2847 		wpa_printf(MSG_DEBUG,
2848 			   "FT: Found PSK to generate PMK-R1 locally");
2849 		os_memcpy(out_pmk_r1, pmk_r1, PMK_LEN);
2850 		if (out_pairwise)
2851 			*out_pairwise = pairwise;
2852 		os_memcpy(sm->PMK, pmk, PMK_LEN);
2853 		sm->pmk_len = PMK_LEN;
2854 		if (out_vlan &&
2855 		    wpa_ft_get_vlan(sm->wpa_auth, sm->addr, out_vlan) < 0) {
2856 			wpa_printf(MSG_DEBUG, "FT: vlan not available for STA "
2857 				   MACSTR, MAC2STR(sm->addr));
2858 			return -1;
2859 		}
2860 
2861 		if (out_identity && out_identity_len) {
2862 			*out_identity_len = wpa_ft_get_identity(
2863 				sm->wpa_auth, sm->addr, out_identity);
2864 		}
2865 
2866 		if (out_radius_cui && out_radius_cui_len) {
2867 			*out_radius_cui_len = wpa_ft_get_radius_cui(
2868 				sm->wpa_auth, sm->addr, out_radius_cui);
2869 		}
2870 
2871 		if (out_session_timeout) {
2872 			*out_session_timeout = wpa_ft_get_session_timeout(
2873 				sm->wpa_auth, sm->addr);
2874 		}
2875 
2876 		return 0;
2877 	}
2878 
2879 	wpa_printf(MSG_DEBUG,
2880 		   "FT: Did not find PSK to generate PMK-R1 locally");
2881 	return -1;
2882 }
2883 
2884 
2885 /* Detect the configuration the station asked for.
2886  * Required to detect FT-PSK and pairwise cipher.
2887  */
wpa_ft_set_key_mgmt(struct wpa_state_machine * sm,struct wpa_ft_ies * parse)2888 static int wpa_ft_set_key_mgmt(struct wpa_state_machine *sm,
2889 			       struct wpa_ft_ies *parse)
2890 {
2891 	int key_mgmt, ciphers;
2892 
2893 	if (sm->wpa_key_mgmt)
2894 		return 0;
2895 
2896 	key_mgmt = parse->key_mgmt & sm->wpa_auth->conf.wpa_key_mgmt;
2897 	if (!key_mgmt) {
2898 		wpa_printf(MSG_DEBUG, "FT: Invalid key mgmt (0x%x) from "
2899 			   MACSTR, parse->key_mgmt, MAC2STR(sm->addr));
2900 		return -1;
2901 	}
2902 	if (key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X)
2903 		sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_IEEE8021X;
2904 #ifdef CONFIG_SHA384
2905 	else if (key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X_SHA384)
2906 		sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_IEEE8021X_SHA384;
2907 #endif /* CONFIG_SHA384 */
2908 	else if (key_mgmt & WPA_KEY_MGMT_FT_PSK)
2909 		sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_PSK;
2910 #ifdef CONFIG_FILS
2911 	else if (key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA256)
2912 		sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_FILS_SHA256;
2913 	else if (key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA384)
2914 		sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_FILS_SHA384;
2915 #endif /* CONFIG_FILS */
2916 	ciphers = parse->pairwise_cipher & sm->wpa_auth->conf.rsn_pairwise;
2917 	if (!ciphers) {
2918 		wpa_printf(MSG_DEBUG, "FT: Invalid pairwise cipher (0x%x) from "
2919 			   MACSTR,
2920 			   parse->pairwise_cipher, MAC2STR(sm->addr));
2921 		return -1;
2922 	}
2923 	sm->pairwise = wpa_pick_pairwise_cipher(ciphers, 0);
2924 
2925 	return 0;
2926 }
2927 
2928 
wpa_ft_local_derive_pmk_r1(struct wpa_authenticator * wpa_auth,struct wpa_state_machine * sm,const u8 * r0kh_id,size_t r0kh_id_len,const u8 * req_pmk_r0_name,const u8 * req_pmk_r1_name,u8 * out_pmk_r1,int * out_pairwise,struct vlan_description * vlan,const u8 ** identity,size_t * identity_len,const u8 ** radius_cui,size_t * radius_cui_len,int * out_session_timeout)2929 static int wpa_ft_local_derive_pmk_r1(struct wpa_authenticator *wpa_auth,
2930 				      struct wpa_state_machine *sm,
2931 				      const u8 *r0kh_id, size_t r0kh_id_len,
2932 				      const u8 *req_pmk_r0_name,
2933 				      const u8 *req_pmk_r1_name,
2934 				      u8 *out_pmk_r1, int *out_pairwise,
2935 				      struct vlan_description *vlan,
2936 				      const u8 **identity, size_t *identity_len,
2937 				      const u8 **radius_cui,
2938 				      size_t *radius_cui_len,
2939 				      int *out_session_timeout)
2940 {
2941 	struct wpa_auth_config *conf = &wpa_auth->conf;
2942 	const struct wpa_ft_pmk_r0_sa *r0;
2943 	u8 pmk_r1_name[WPA_PMK_NAME_LEN];
2944 	int expires_in = 0;
2945 	int session_timeout = 0;
2946 	struct os_reltime now;
2947 
2948 	if (conf->r0_key_holder_len != r0kh_id_len ||
2949 	    os_memcmp(conf->r0_key_holder, r0kh_id, conf->r0_key_holder_len) !=
2950 	    0)
2951 		return -1; /* not our R0KH-ID */
2952 
2953 	wpa_printf(MSG_DEBUG, "FT: STA R0KH-ID matching local configuration");
2954 	if (wpa_ft_fetch_pmk_r0(sm->wpa_auth, sm->addr, req_pmk_r0_name, &r0) <
2955 	    0)
2956 		return -1; /* no matching PMKR0Name in local cache */
2957 
2958 	wpa_printf(MSG_DEBUG, "FT: Requested PMKR0Name found in local cache");
2959 
2960 	if (wpa_derive_pmk_r1(r0->pmk_r0, r0->pmk_r0_len, r0->pmk_r0_name,
2961 			      conf->r1_key_holder,
2962 			      sm->addr, out_pmk_r1, pmk_r1_name) < 0)
2963 		return -1;
2964 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", out_pmk_r1, r0->pmk_r0_len);
2965 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", pmk_r1_name, WPA_PMK_NAME_LEN);
2966 
2967 	os_get_reltime(&now);
2968 	if (r0->expiration)
2969 		expires_in = r0->expiration - now.sec;
2970 
2971 	if (r0->session_timeout)
2972 		session_timeout = r0->session_timeout - now.sec;
2973 
2974 	wpa_ft_store_pmk_r1(wpa_auth, sm->addr, out_pmk_r1, r0->pmk_r0_len,
2975 			    pmk_r1_name,
2976 			    sm->pairwise, r0->vlan, expires_in, session_timeout,
2977 			    r0->identity, r0->identity_len,
2978 			    r0->radius_cui, r0->radius_cui_len);
2979 
2980 	*out_pairwise = sm->pairwise;
2981 	if (vlan) {
2982 		if (r0->vlan)
2983 			*vlan = *r0->vlan;
2984 		else
2985 			os_memset(vlan, 0, sizeof(*vlan));
2986 	}
2987 
2988 	if (identity && identity_len) {
2989 		*identity = r0->identity;
2990 		*identity_len = r0->identity_len;
2991 	}
2992 
2993 	if (radius_cui && radius_cui_len) {
2994 		*radius_cui = r0->radius_cui;
2995 		*radius_cui_len = r0->radius_cui_len;
2996 	}
2997 
2998 	*out_session_timeout = session_timeout;
2999 
3000 	return 0;
3001 }
3002 
3003 
wpa_ft_process_auth_req(struct wpa_state_machine * sm,const u8 * ies,size_t ies_len,u8 ** resp_ies,size_t * resp_ies_len)3004 static int wpa_ft_process_auth_req(struct wpa_state_machine *sm,
3005 				   const u8 *ies, size_t ies_len,
3006 				   u8 **resp_ies, size_t *resp_ies_len)
3007 {
3008 	struct rsn_mdie *mdie;
3009 	u8 pmk_r1[PMK_LEN_MAX], pmk_r1_name[WPA_PMK_NAME_LEN];
3010 	u8 ptk_name[WPA_PMK_NAME_LEN];
3011 	struct wpa_auth_config *conf;
3012 	struct wpa_ft_ies parse;
3013 	size_t buflen;
3014 	int ret;
3015 	u8 *pos, *end;
3016 	int pairwise, session_timeout = 0;
3017 	struct vlan_description vlan;
3018 	const u8 *identity, *radius_cui;
3019 	size_t identity_len = 0, radius_cui_len = 0;
3020 	int use_sha384;
3021 	size_t pmk_r1_len;
3022 
3023 	*resp_ies = NULL;
3024 	*resp_ies_len = 0;
3025 
3026 	sm->pmk_r1_name_valid = 0;
3027 	conf = &sm->wpa_auth->conf;
3028 
3029 	wpa_hexdump(MSG_DEBUG, "FT: Received authentication frame IEs",
3030 		    ies, ies_len);
3031 
3032 	if (wpa_ft_parse_ies(ies, ies_len, &parse, -1)) {
3033 		wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs");
3034 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3035 	}
3036 	use_sha384 = wpa_key_mgmt_sha384(parse.key_mgmt);
3037 	pmk_r1_len = use_sha384 ? SHA384_MAC_LEN : PMK_LEN;
3038 
3039 	mdie = (struct rsn_mdie *) parse.mdie;
3040 	if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
3041 	    os_memcmp(mdie->mobility_domain,
3042 		      sm->wpa_auth->conf.mobility_domain,
3043 		      MOBILITY_DOMAIN_ID_LEN) != 0) {
3044 		wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
3045 		return WLAN_STATUS_INVALID_MDIE;
3046 	}
3047 
3048 	if (use_sha384) {
3049 		struct rsn_ftie_sha384 *ftie;
3050 
3051 		ftie = (struct rsn_ftie_sha384 *) parse.ftie;
3052 		if (!ftie || parse.ftie_len < sizeof(*ftie)) {
3053 			wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3054 			return WLAN_STATUS_INVALID_FTIE;
3055 		}
3056 
3057 		os_memcpy(sm->SNonce, ftie->snonce, WPA_NONCE_LEN);
3058 	} else {
3059 		struct rsn_ftie *ftie;
3060 
3061 		ftie = (struct rsn_ftie *) parse.ftie;
3062 		if (!ftie || parse.ftie_len < sizeof(*ftie)) {
3063 			wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3064 			return WLAN_STATUS_INVALID_FTIE;
3065 		}
3066 
3067 		os_memcpy(sm->SNonce, ftie->snonce, WPA_NONCE_LEN);
3068 	}
3069 
3070 	if (parse.r0kh_id == NULL) {
3071 		wpa_printf(MSG_DEBUG, "FT: Invalid FTIE - no R0KH-ID");
3072 		return WLAN_STATUS_INVALID_FTIE;
3073 	}
3074 
3075 	wpa_hexdump(MSG_DEBUG, "FT: STA R0KH-ID",
3076 		    parse.r0kh_id, parse.r0kh_id_len);
3077 	os_memcpy(sm->r0kh_id, parse.r0kh_id, parse.r0kh_id_len);
3078 	sm->r0kh_id_len = parse.r0kh_id_len;
3079 
3080 	if (parse.rsn_pmkid == NULL) {
3081 		wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE");
3082 		return WLAN_STATUS_INVALID_PMKID;
3083 	}
3084 
3085 	if (wpa_ft_set_key_mgmt(sm, &parse) < 0)
3086 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3087 
3088 	wpa_hexdump(MSG_DEBUG, "FT: Requested PMKR0Name",
3089 		    parse.rsn_pmkid, WPA_PMK_NAME_LEN);
3090 	if (wpa_derive_pmk_r1_name(parse.rsn_pmkid,
3091 				   sm->wpa_auth->conf.r1_key_holder, sm->addr,
3092 				   pmk_r1_name, use_sha384) < 0)
3093 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3094 	wpa_hexdump(MSG_DEBUG, "FT: Derived requested PMKR1Name",
3095 		    pmk_r1_name, WPA_PMK_NAME_LEN);
3096 
3097 	if (conf->ft_psk_generate_local &&
3098 	    wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt)) {
3099 		if (wpa_ft_psk_pmk_r1(sm, pmk_r1_name, pmk_r1, &pairwise,
3100 				      &vlan, &identity, &identity_len,
3101 				      &radius_cui, &radius_cui_len,
3102 				      &session_timeout) < 0)
3103 			return WLAN_STATUS_INVALID_PMKID;
3104 		wpa_printf(MSG_DEBUG,
3105 			   "FT: Generated PMK-R1 for FT-PSK locally");
3106 	} else if (wpa_ft_fetch_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1_name,
3107 				       pmk_r1, &pmk_r1_len, &pairwise, &vlan,
3108 				       &identity, &identity_len, &radius_cui,
3109 				       &radius_cui_len, &session_timeout) < 0) {
3110 		wpa_printf(MSG_DEBUG,
3111 			   "FT: No PMK-R1 available in local cache for the requested PMKR1Name");
3112 		if (wpa_ft_local_derive_pmk_r1(sm->wpa_auth, sm,
3113 					       parse.r0kh_id, parse.r0kh_id_len,
3114 					       parse.rsn_pmkid,
3115 					       pmk_r1_name, pmk_r1, &pairwise,
3116 					       &vlan, &identity, &identity_len,
3117 					       &radius_cui, &radius_cui_len,
3118 					       &session_timeout) == 0) {
3119 			wpa_printf(MSG_DEBUG,
3120 				   "FT: Generated PMK-R1 based on local PMK-R0");
3121 			goto pmk_r1_derived;
3122 		}
3123 
3124 		if (wpa_ft_pull_pmk_r1(sm, ies, ies_len, parse.rsn_pmkid) < 0) {
3125 			wpa_printf(MSG_DEBUG,
3126 				   "FT: Did not have matching PMK-R1 and either unknown or blocked R0KH-ID or NAK from R0KH");
3127 			return WLAN_STATUS_INVALID_PMKID;
3128 		}
3129 
3130 		return -1; /* Status pending */
3131 	} else {
3132 		wpa_printf(MSG_DEBUG, "FT: Found PMKR1Name from local cache");
3133 	}
3134 
3135 pmk_r1_derived:
3136 	wpa_hexdump_key(MSG_DEBUG, "FT: Selected PMK-R1", pmk_r1, pmk_r1_len);
3137 	sm->pmk_r1_name_valid = 1;
3138 	os_memcpy(sm->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN);
3139 	os_memcpy(sm->pmk_r1, pmk_r1, pmk_r1_len);
3140 	sm->pmk_r1_len = pmk_r1_len;
3141 
3142 	if (random_get_bytes(sm->ANonce, WPA_NONCE_LEN)) {
3143 		wpa_printf(MSG_DEBUG, "FT: Failed to get random data for "
3144 			   "ANonce");
3145 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3146 	}
3147 
3148 	wpa_hexdump(MSG_DEBUG, "FT: Received SNonce",
3149 		    sm->SNonce, WPA_NONCE_LEN);
3150 	wpa_hexdump(MSG_DEBUG, "FT: Generated ANonce",
3151 		    sm->ANonce, WPA_NONCE_LEN);
3152 
3153 	if (wpa_pmk_r1_to_ptk(pmk_r1, pmk_r1_len, sm->SNonce, sm->ANonce,
3154 			      sm->addr, sm->wpa_auth->addr, pmk_r1_name,
3155 			      &sm->PTK, ptk_name, sm->wpa_key_mgmt,
3156 			      pairwise) < 0)
3157 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3158 
3159 	sm->pairwise = pairwise;
3160 	sm->PTK_valid = true;
3161 	sm->tk_already_set = false;
3162 	wpa_ft_install_ptk(sm, 0);
3163 
3164 	if (wpa_ft_set_vlan(sm->wpa_auth, sm->addr, &vlan) < 0) {
3165 		wpa_printf(MSG_DEBUG, "FT: Failed to configure VLAN");
3166 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3167 	}
3168 	if (wpa_ft_set_identity(sm->wpa_auth, sm->addr,
3169 				identity, identity_len) < 0 ||
3170 	    wpa_ft_set_radius_cui(sm->wpa_auth, sm->addr,
3171 				  radius_cui, radius_cui_len) < 0) {
3172 		wpa_printf(MSG_DEBUG, "FT: Failed to configure identity/CUI");
3173 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3174 	}
3175 	wpa_ft_set_session_timeout(sm->wpa_auth, sm->addr, session_timeout);
3176 
3177 	buflen = 2 + sizeof(struct rsn_mdie) + 2 + sizeof(struct rsn_ftie) +
3178 		2 + FT_R1KH_ID_LEN + 200;
3179 	*resp_ies = os_zalloc(buflen);
3180 	if (*resp_ies == NULL)
3181 		goto fail;
3182 
3183 	pos = *resp_ies;
3184 	end = *resp_ies + buflen;
3185 
3186 	ret = wpa_write_rsn_ie(conf, pos, end - pos, parse.rsn_pmkid);
3187 	if (ret < 0)
3188 		goto fail;
3189 	pos += ret;
3190 
3191 	ret = wpa_write_mdie(conf, pos, end - pos);
3192 	if (ret < 0)
3193 		goto fail;
3194 	pos += ret;
3195 
3196 	ret = wpa_write_ftie(conf, use_sha384, parse.r0kh_id, parse.r0kh_id_len,
3197 			     sm->ANonce, sm->SNonce, pos, end - pos, NULL, 0,
3198 			     0);
3199 	if (ret < 0)
3200 		goto fail;
3201 	pos += ret;
3202 
3203 	*resp_ies_len = pos - *resp_ies;
3204 
3205 	return WLAN_STATUS_SUCCESS;
3206 fail:
3207 	os_free(*resp_ies);
3208 	*resp_ies = NULL;
3209 	return WLAN_STATUS_UNSPECIFIED_FAILURE;
3210 }
3211 
3212 
wpa_ft_process_auth(struct wpa_state_machine * sm,const u8 * bssid,u16 auth_transaction,const u8 * ies,size_t ies_len,void (* cb)(void * ctx,const u8 * dst,const u8 * bssid,u16 auth_transaction,u16 status,const u8 * ies,size_t ies_len),void * ctx)3213 void wpa_ft_process_auth(struct wpa_state_machine *sm, const u8 *bssid,
3214 			 u16 auth_transaction, const u8 *ies, size_t ies_len,
3215 			 void (*cb)(void *ctx, const u8 *dst, const u8 *bssid,
3216 				    u16 auth_transaction, u16 status,
3217 				    const u8 *ies, size_t ies_len),
3218 			 void *ctx)
3219 {
3220 	u16 status;
3221 	u8 *resp_ies;
3222 	size_t resp_ies_len;
3223 	int res;
3224 
3225 	if (sm == NULL) {
3226 		wpa_printf(MSG_DEBUG, "FT: Received authentication frame, but "
3227 			   "WPA SM not available");
3228 		return;
3229 	}
3230 
3231 	wpa_printf(MSG_DEBUG, "FT: Received authentication frame: STA=" MACSTR
3232 		   " BSSID=" MACSTR " transaction=%d",
3233 		   MAC2STR(sm->addr), MAC2STR(bssid), auth_transaction);
3234 	sm->ft_pending_cb = cb;
3235 	sm->ft_pending_cb_ctx = ctx;
3236 	sm->ft_pending_auth_transaction = auth_transaction;
3237 	sm->ft_pending_pull_left_retries = sm->wpa_auth->conf.rkh_pull_retries;
3238 	res = wpa_ft_process_auth_req(sm, ies, ies_len, &resp_ies,
3239 				      &resp_ies_len);
3240 	if (res < 0) {
3241 		wpa_printf(MSG_DEBUG, "FT: Callback postponed until response is available");
3242 		return;
3243 	}
3244 	status = res;
3245 
3246 	wpa_printf(MSG_DEBUG, "FT: FT authentication response: dst=" MACSTR
3247 		   " auth_transaction=%d status=%u (%s)",
3248 		   MAC2STR(sm->addr), auth_transaction + 1, status,
3249 		   status2str(status));
3250 	wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len);
3251 	cb(ctx, sm->addr, bssid, auth_transaction + 1, status,
3252 	   resp_ies, resp_ies_len);
3253 	os_free(resp_ies);
3254 }
3255 
3256 
wpa_ft_validate_reassoc(struct wpa_state_machine * sm,const u8 * ies,size_t ies_len)3257 int wpa_ft_validate_reassoc(struct wpa_state_machine *sm, const u8 *ies,
3258 			    size_t ies_len)
3259 {
3260 	struct wpa_ft_ies parse;
3261 	struct rsn_mdie *mdie;
3262 	u8 mic[WPA_EAPOL_KEY_MIC_MAX_LEN];
3263 	size_t mic_len = 16;
3264 	unsigned int count;
3265 	const u8 *kck;
3266 	size_t kck_len;
3267 	int use_sha384;
3268 	const u8 *anonce, *snonce, *fte_mic;
3269 	u8 fte_elem_count;
3270 	int rsnxe_used;
3271 	struct wpa_auth_config *conf;
3272 
3273 	if (sm == NULL)
3274 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3275 
3276 	conf = &sm->wpa_auth->conf;
3277 	use_sha384 = wpa_key_mgmt_sha384(sm->wpa_key_mgmt);
3278 
3279 	wpa_hexdump(MSG_DEBUG, "FT: Reassoc Req IEs", ies, ies_len);
3280 
3281 	if (wpa_ft_parse_ies(ies, ies_len, &parse, use_sha384) < 0) {
3282 		wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs");
3283 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3284 	}
3285 
3286 	if (parse.rsn == NULL) {
3287 		wpa_printf(MSG_DEBUG, "FT: No RSNIE in Reassoc Req");
3288 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3289 	}
3290 
3291 	if (parse.rsn_pmkid == NULL) {
3292 		wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE");
3293 		return WLAN_STATUS_INVALID_PMKID;
3294 	}
3295 
3296 	if (os_memcmp_const(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN)
3297 	    != 0) {
3298 		wpa_printf(MSG_DEBUG, "FT: PMKID in Reassoc Req did not match "
3299 			   "with the PMKR1Name derived from auth request");
3300 		return WLAN_STATUS_INVALID_PMKID;
3301 	}
3302 
3303 	mdie = (struct rsn_mdie *) parse.mdie;
3304 	if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
3305 	    os_memcmp(mdie->mobility_domain, conf->mobility_domain,
3306 		      MOBILITY_DOMAIN_ID_LEN) != 0) {
3307 		wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
3308 		return WLAN_STATUS_INVALID_MDIE;
3309 	}
3310 
3311 	if (use_sha384) {
3312 		struct rsn_ftie_sha384 *ftie;
3313 
3314 		ftie = (struct rsn_ftie_sha384 *) parse.ftie;
3315 		if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
3316 			wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3317 			return WLAN_STATUS_INVALID_FTIE;
3318 		}
3319 
3320 		anonce = ftie->anonce;
3321 		snonce = ftie->snonce;
3322 		rsnxe_used = ftie->mic_control[0] & 0x01;
3323 		fte_elem_count = ftie->mic_control[1];
3324 		fte_mic = ftie->mic;
3325 	} else {
3326 		struct rsn_ftie *ftie;
3327 
3328 		ftie = (struct rsn_ftie *) parse.ftie;
3329 		if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
3330 			wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3331 			return WLAN_STATUS_INVALID_FTIE;
3332 		}
3333 
3334 		anonce = ftie->anonce;
3335 		snonce = ftie->snonce;
3336 		rsnxe_used = ftie->mic_control[0] & 0x01;
3337 		fte_elem_count = ftie->mic_control[1];
3338 		fte_mic = ftie->mic;
3339 	}
3340 
3341 	if (os_memcmp(snonce, sm->SNonce, WPA_NONCE_LEN) != 0) {
3342 		wpa_printf(MSG_DEBUG, "FT: SNonce mismatch in FTIE");
3343 		wpa_hexdump(MSG_DEBUG, "FT: Received SNonce",
3344 			    snonce, WPA_NONCE_LEN);
3345 		wpa_hexdump(MSG_DEBUG, "FT: Expected SNonce",
3346 			    sm->SNonce, WPA_NONCE_LEN);
3347 		return WLAN_STATUS_INVALID_FTIE;
3348 	}
3349 
3350 	if (os_memcmp(anonce, sm->ANonce, WPA_NONCE_LEN) != 0) {
3351 		wpa_printf(MSG_DEBUG, "FT: ANonce mismatch in FTIE");
3352 		wpa_hexdump(MSG_DEBUG, "FT: Received ANonce",
3353 			    anonce, WPA_NONCE_LEN);
3354 		wpa_hexdump(MSG_DEBUG, "FT: Expected ANonce",
3355 			    sm->ANonce, WPA_NONCE_LEN);
3356 		return WLAN_STATUS_INVALID_FTIE;
3357 	}
3358 
3359 
3360 	if (parse.r0kh_id == NULL) {
3361 		wpa_printf(MSG_DEBUG, "FT: No R0KH-ID subelem in FTIE");
3362 		return WLAN_STATUS_INVALID_FTIE;
3363 	}
3364 
3365 	if (parse.r0kh_id_len != sm->r0kh_id_len ||
3366 	    os_memcmp_const(parse.r0kh_id, sm->r0kh_id, parse.r0kh_id_len) != 0)
3367 	{
3368 		wpa_printf(MSG_DEBUG, "FT: R0KH-ID in FTIE did not match with "
3369 			   "the current R0KH-ID");
3370 		wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID in FTIE",
3371 			    parse.r0kh_id, parse.r0kh_id_len);
3372 		wpa_hexdump(MSG_DEBUG, "FT: The current R0KH-ID",
3373 			    sm->r0kh_id, sm->r0kh_id_len);
3374 		return WLAN_STATUS_INVALID_FTIE;
3375 	}
3376 
3377 	if (parse.r1kh_id == NULL) {
3378 		wpa_printf(MSG_DEBUG, "FT: No R1KH-ID subelem in FTIE");
3379 		return WLAN_STATUS_INVALID_FTIE;
3380 	}
3381 
3382 	if (os_memcmp_const(parse.r1kh_id, conf->r1_key_holder,
3383 			    FT_R1KH_ID_LEN) != 0) {
3384 		wpa_printf(MSG_DEBUG, "FT: Unknown R1KH-ID used in "
3385 			   "ReassocReq");
3386 		wpa_hexdump(MSG_DEBUG, "FT: R1KH-ID in FTIE",
3387 			    parse.r1kh_id, FT_R1KH_ID_LEN);
3388 		wpa_hexdump(MSG_DEBUG, "FT: Expected R1KH-ID",
3389 			    conf->r1_key_holder, FT_R1KH_ID_LEN);
3390 		return WLAN_STATUS_INVALID_FTIE;
3391 	}
3392 
3393 	if (parse.rsn_pmkid == NULL ||
3394 	    os_memcmp_const(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN))
3395 	{
3396 		wpa_printf(MSG_DEBUG, "FT: No matching PMKR1Name (PMKID) in "
3397 			   "RSNIE (pmkid=%d)", !!parse.rsn_pmkid);
3398 		return WLAN_STATUS_INVALID_PMKID;
3399 	}
3400 
3401 	count = 3;
3402 	if (parse.ric)
3403 		count += ieee802_11_ie_count(parse.ric, parse.ric_len);
3404 	if (parse.rsnxe)
3405 		count++;
3406 	if (fte_elem_count != count) {
3407 		wpa_printf(MSG_DEBUG, "FT: Unexpected IE count in MIC "
3408 			   "Control: received %u expected %u",
3409 			   fte_elem_count, count);
3410 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3411 	}
3412 
3413 	if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
3414 		kck = sm->PTK.kck2;
3415 		kck_len = sm->PTK.kck2_len;
3416 	} else {
3417 		kck = sm->PTK.kck;
3418 		kck_len = sm->PTK.kck_len;
3419 	}
3420 	if (wpa_ft_mic(kck, kck_len, sm->addr, sm->wpa_auth->addr, 5,
3421 		       parse.mdie - 2, parse.mdie_len + 2,
3422 		       parse.ftie - 2, parse.ftie_len + 2,
3423 		       parse.rsn - 2, parse.rsn_len + 2,
3424 		       parse.ric, parse.ric_len,
3425 		       parse.rsnxe ? parse.rsnxe - 2 : NULL,
3426 		       parse.rsnxe ? parse.rsnxe_len + 2 : 0,
3427 		       mic) < 0) {
3428 		wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC");
3429 		return WLAN_STATUS_UNSPECIFIED_FAILURE;
3430 	}
3431 
3432 	if (os_memcmp_const(mic, fte_mic, mic_len) != 0) {
3433 		wpa_printf(MSG_DEBUG, "FT: Invalid MIC in FTIE");
3434 		wpa_printf(MSG_DEBUG, "FT: addr=" MACSTR " auth_addr=" MACSTR,
3435 			   MAC2STR(sm->addr), MAC2STR(sm->wpa_auth->addr));
3436 		wpa_hexdump(MSG_MSGDUMP, "FT: Received MIC",
3437 			    fte_mic, mic_len);
3438 		wpa_hexdump(MSG_MSGDUMP, "FT: Calculated MIC", mic, mic_len);
3439 		wpa_hexdump(MSG_MSGDUMP, "FT: MDIE",
3440 			    parse.mdie - 2, parse.mdie_len + 2);
3441 		wpa_hexdump(MSG_MSGDUMP, "FT: FTIE",
3442 			    parse.ftie - 2, parse.ftie_len + 2);
3443 		wpa_hexdump(MSG_MSGDUMP, "FT: RSN",
3444 			    parse.rsn - 2, parse.rsn_len + 2);
3445 		wpa_hexdump(MSG_MSGDUMP, "FT: RSNXE",
3446 			    parse.rsnxe ? parse.rsnxe - 2 : NULL,
3447 			    parse.rsnxe ? parse.rsnxe_len + 2 : 0);
3448 		return WLAN_STATUS_INVALID_FTIE;
3449 	}
3450 
3451 	if (rsnxe_used && (conf->sae_pwe == 1 || conf->sae_pwe == 2) &&
3452 	    !parse.rsnxe) {
3453 		wpa_printf(MSG_INFO,
3454 			   "FT: FTE indicated that STA uses RSNXE, but RSNXE was not included");
3455 		return -1; /* discard request */
3456 	}
3457 
3458 #ifdef CONFIG_OCV
3459 	if (wpa_auth_uses_ocv(sm)) {
3460 		struct wpa_channel_info ci;
3461 		int tx_chanwidth;
3462 		int tx_seg1_idx;
3463 
3464 		if (wpa_channel_info(sm->wpa_auth, &ci) != 0) {
3465 			wpa_printf(MSG_WARNING,
3466 				   "Failed to get channel info to validate received OCI in (Re)Assoc Request");
3467 			return WLAN_STATUS_UNSPECIFIED_FAILURE;
3468 		}
3469 
3470 		if (get_sta_tx_parameters(sm,
3471 					  channel_width_to_int(ci.chanwidth),
3472 					  ci.seg1_idx, &tx_chanwidth,
3473 					  &tx_seg1_idx) < 0)
3474 			return WLAN_STATUS_UNSPECIFIED_FAILURE;
3475 
3476 		if (ocv_verify_tx_params(parse.oci, parse.oci_len, &ci,
3477 					 tx_chanwidth, tx_seg1_idx) != 0) {
3478 			wpa_printf(MSG_WARNING, "%s", ocv_errorstr);
3479 			return WLAN_STATUS_UNSPECIFIED_FAILURE;
3480 		}
3481 	}
3482 #endif /* CONFIG_OCV */
3483 
3484 	return WLAN_STATUS_SUCCESS;
3485 }
3486 
3487 
wpa_ft_action_rx(struct wpa_state_machine * sm,const u8 * data,size_t len)3488 int wpa_ft_action_rx(struct wpa_state_machine *sm, const u8 *data, size_t len)
3489 {
3490 	const u8 *sta_addr, *target_ap;
3491 	const u8 *ies;
3492 	size_t ies_len;
3493 	u8 action;
3494 	struct ft_rrb_frame *frame;
3495 
3496 	if (sm == NULL)
3497 		return -1;
3498 
3499 	/*
3500 	 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6]
3501 	 * FT Request action frame body[variable]
3502 	 */
3503 
3504 	if (len < 14) {
3505 		wpa_printf(MSG_DEBUG, "FT: Too short FT Action frame "
3506 			   "(len=%lu)", (unsigned long) len);
3507 		return -1;
3508 	}
3509 
3510 	action = data[1];
3511 	sta_addr = data + 2;
3512 	target_ap = data + 8;
3513 	ies = data + 14;
3514 	ies_len = len - 14;
3515 
3516 	wpa_printf(MSG_DEBUG, "FT: Received FT Action frame (STA=" MACSTR
3517 		   " Target AP=" MACSTR " Action=%d)",
3518 		   MAC2STR(sta_addr), MAC2STR(target_ap), action);
3519 
3520 	if (os_memcmp(sta_addr, sm->addr, ETH_ALEN) != 0) {
3521 		wpa_printf(MSG_DEBUG, "FT: Mismatch in FT Action STA address: "
3522 			   "STA=" MACSTR " STA-Address=" MACSTR,
3523 			   MAC2STR(sm->addr), MAC2STR(sta_addr));
3524 		return -1;
3525 	}
3526 
3527 	/*
3528 	 * Do some sanity checking on the target AP address (not own and not
3529 	 * broadcast. This could be extended to filter based on a list of known
3530 	 * APs in the MD (if such a list were configured).
3531 	 */
3532 	if ((target_ap[0] & 0x01) ||
3533 	    os_memcmp(target_ap, sm->wpa_auth->addr, ETH_ALEN) == 0) {
3534 		wpa_printf(MSG_DEBUG, "FT: Invalid Target AP in FT Action "
3535 			   "frame");
3536 		return -1;
3537 	}
3538 
3539 	wpa_hexdump(MSG_MSGDUMP, "FT: Action frame body", ies, ies_len);
3540 
3541 	if (!sm->wpa_auth->conf.ft_over_ds) {
3542 		wpa_printf(MSG_DEBUG, "FT: Over-DS option disabled - reject");
3543 		return -1;
3544 	}
3545 
3546 	/* RRB - Forward action frame to the target AP */
3547 	frame = os_malloc(sizeof(*frame) + len);
3548 	if (frame == NULL)
3549 		return -1;
3550 	frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB;
3551 	frame->packet_type = FT_PACKET_REQUEST;
3552 	frame->action_length = host_to_le16(len);
3553 	os_memcpy(frame->ap_address, sm->wpa_auth->addr, ETH_ALEN);
3554 	os_memcpy(frame + 1, data, len);
3555 
3556 	wpa_ft_rrb_send(sm->wpa_auth, target_ap, (u8 *) frame,
3557 			sizeof(*frame) + len);
3558 	os_free(frame);
3559 
3560 	return 0;
3561 }
3562 
3563 
wpa_ft_rrb_rx_request_cb(void * ctx,const u8 * dst,const u8 * bssid,u16 auth_transaction,u16 resp,const u8 * ies,size_t ies_len)3564 static void wpa_ft_rrb_rx_request_cb(void *ctx, const u8 *dst, const u8 *bssid,
3565 				     u16 auth_transaction, u16 resp,
3566 				     const u8 *ies, size_t ies_len)
3567 {
3568 	struct wpa_state_machine *sm = ctx;
3569 	wpa_printf(MSG_DEBUG, "FT: Over-the-DS RX request cb for " MACSTR,
3570 		   MAC2STR(sm->addr));
3571 	wpa_ft_send_rrb_auth_resp(sm, sm->ft_pending_current_ap, sm->addr,
3572 				  WLAN_STATUS_SUCCESS, ies, ies_len);
3573 }
3574 
3575 
wpa_ft_rrb_rx_request(struct wpa_authenticator * wpa_auth,const u8 * current_ap,const u8 * sta_addr,const u8 * body,size_t len)3576 static int wpa_ft_rrb_rx_request(struct wpa_authenticator *wpa_auth,
3577 				 const u8 *current_ap, const u8 *sta_addr,
3578 				 const u8 *body, size_t len)
3579 {
3580 	struct wpa_state_machine *sm;
3581 	u16 status;
3582 	u8 *resp_ies;
3583 	size_t resp_ies_len;
3584 	int res;
3585 
3586 	sm = wpa_ft_add_sta(wpa_auth, sta_addr);
3587 	if (sm == NULL) {
3588 		wpa_printf(MSG_DEBUG, "FT: Failed to add new STA based on "
3589 			   "RRB Request");
3590 		return -1;
3591 	}
3592 
3593 	wpa_hexdump(MSG_MSGDUMP, "FT: RRB Request Frame body", body, len);
3594 
3595 	sm->ft_pending_cb = wpa_ft_rrb_rx_request_cb;
3596 	sm->ft_pending_cb_ctx = sm;
3597 	os_memcpy(sm->ft_pending_current_ap, current_ap, ETH_ALEN);
3598 	sm->ft_pending_pull_left_retries = sm->wpa_auth->conf.rkh_pull_retries;
3599 	res = wpa_ft_process_auth_req(sm, body, len, &resp_ies,
3600 				      &resp_ies_len);
3601 	if (res < 0) {
3602 		wpa_printf(MSG_DEBUG, "FT: No immediate response available - wait for pull response");
3603 		return 0;
3604 	}
3605 	status = res;
3606 
3607 	res = wpa_ft_send_rrb_auth_resp(sm, current_ap, sta_addr, status,
3608 					resp_ies, resp_ies_len);
3609 	os_free(resp_ies);
3610 	return res;
3611 }
3612 
3613 
wpa_ft_send_rrb_auth_resp(struct wpa_state_machine * sm,const u8 * current_ap,const u8 * sta_addr,u16 status,const u8 * resp_ies,size_t resp_ies_len)3614 static int wpa_ft_send_rrb_auth_resp(struct wpa_state_machine *sm,
3615 				     const u8 *current_ap, const u8 *sta_addr,
3616 				     u16 status, const u8 *resp_ies,
3617 				     size_t resp_ies_len)
3618 {
3619 	struct wpa_authenticator *wpa_auth = sm->wpa_auth;
3620 	size_t rlen;
3621 	struct ft_rrb_frame *frame;
3622 	u8 *pos;
3623 
3624 	wpa_printf(MSG_DEBUG, "FT: RRB authentication response: STA=" MACSTR
3625 		   " CurrentAP=" MACSTR " status=%u (%s)",
3626 		   MAC2STR(sm->addr), MAC2STR(current_ap), status,
3627 		   status2str(status));
3628 	wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len);
3629 
3630 	/* RRB - Forward action frame response to the Current AP */
3631 
3632 	/*
3633 	 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6]
3634 	 * Status_Code[2] FT Request action frame body[variable]
3635 	 */
3636 	rlen = 2 + 2 * ETH_ALEN + 2 + resp_ies_len;
3637 
3638 	frame = os_malloc(sizeof(*frame) + rlen);
3639 	if (frame == NULL)
3640 		return -1;
3641 	frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB;
3642 	frame->packet_type = FT_PACKET_RESPONSE;
3643 	frame->action_length = host_to_le16(rlen);
3644 	os_memcpy(frame->ap_address, wpa_auth->addr, ETH_ALEN);
3645 	pos = (u8 *) (frame + 1);
3646 	*pos++ = WLAN_ACTION_FT;
3647 	*pos++ = 2; /* Action: Response */
3648 	os_memcpy(pos, sta_addr, ETH_ALEN);
3649 	pos += ETH_ALEN;
3650 	os_memcpy(pos, wpa_auth->addr, ETH_ALEN);
3651 	pos += ETH_ALEN;
3652 	WPA_PUT_LE16(pos, status);
3653 	pos += 2;
3654 	if (resp_ies)
3655 		os_memcpy(pos, resp_ies, resp_ies_len);
3656 
3657 	wpa_ft_rrb_send(wpa_auth, current_ap, (u8 *) frame,
3658 			sizeof(*frame) + rlen);
3659 	os_free(frame);
3660 
3661 	return 0;
3662 }
3663 
3664 
wpa_ft_rrb_build_r0(const u8 * key,const size_t key_len,const struct tlv_list * tlvs,const struct wpa_ft_pmk_r0_sa * pmk_r0,const u8 * r1kh_id,const u8 * s1kh_id,const struct tlv_list * tlv_auth,const u8 * src_addr,u8 type,u8 ** packet,size_t * packet_len)3665 static int wpa_ft_rrb_build_r0(const u8 *key, const size_t key_len,
3666 			       const struct tlv_list *tlvs,
3667 			       const struct wpa_ft_pmk_r0_sa *pmk_r0,
3668 			       const u8 *r1kh_id, const u8 *s1kh_id,
3669 			       const struct tlv_list *tlv_auth,
3670 			       const u8 *src_addr, u8 type,
3671 			       u8 **packet, size_t *packet_len)
3672 {
3673 	u8 pmk_r1[PMK_LEN_MAX];
3674 	size_t pmk_r1_len = pmk_r0->pmk_r0_len;
3675 	u8 pmk_r1_name[WPA_PMK_NAME_LEN];
3676 	u8 f_pairwise[sizeof(le16)];
3677 	u8 f_expires_in[sizeof(le16)];
3678 	u8 f_session_timeout[sizeof(le32)];
3679 	int expires_in;
3680 	int session_timeout;
3681 	struct os_reltime now;
3682 	int ret;
3683 	struct tlv_list sess_tlv[] = {
3684 		{ .type = FT_RRB_PMK_R1, .len = pmk_r1_len,
3685 		  .data = pmk_r1 },
3686 		{ .type = FT_RRB_PMK_R1_NAME, .len = sizeof(pmk_r1_name),
3687 		  .data = pmk_r1_name },
3688 		{ .type = FT_RRB_PAIRWISE, .len = sizeof(f_pairwise),
3689 		  .data = f_pairwise },
3690 		{ .type = FT_RRB_EXPIRES_IN, .len = sizeof(f_expires_in),
3691 		  .data = f_expires_in },
3692 		{ .type = FT_RRB_IDENTITY, .len = pmk_r0->identity_len,
3693 		  .data = pmk_r0->identity },
3694 		{ .type = FT_RRB_RADIUS_CUI, .len = pmk_r0->radius_cui_len,
3695 		  .data = pmk_r0->radius_cui },
3696 		{ .type = FT_RRB_SESSION_TIMEOUT,
3697 		  .len = sizeof(f_session_timeout),
3698 		  .data = f_session_timeout },
3699 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
3700 	};
3701 
3702 	if (wpa_derive_pmk_r1(pmk_r0->pmk_r0, pmk_r0->pmk_r0_len,
3703 			      pmk_r0->pmk_r0_name, r1kh_id,
3704 			      s1kh_id, pmk_r1, pmk_r1_name) < 0)
3705 		return -1;
3706 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1 (for peer AP)",
3707 			pmk_r1, pmk_r1_len);
3708 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name (for peer AP)",
3709 		    pmk_r1_name, WPA_PMK_NAME_LEN);
3710 	WPA_PUT_LE16(f_pairwise, pmk_r0->pairwise);
3711 
3712 	os_get_reltime(&now);
3713 	if (pmk_r0->expiration > now.sec)
3714 		expires_in = pmk_r0->expiration - now.sec;
3715 	else if (pmk_r0->expiration)
3716 		expires_in = 1;
3717 	else
3718 		expires_in = 0;
3719 	WPA_PUT_LE16(f_expires_in, expires_in);
3720 
3721 	if (pmk_r0->session_timeout > now.sec)
3722 		session_timeout = pmk_r0->session_timeout - now.sec;
3723 	else if (pmk_r0->session_timeout)
3724 		session_timeout = 1;
3725 	else
3726 		session_timeout = 0;
3727 	WPA_PUT_LE32(f_session_timeout, session_timeout);
3728 
3729 	ret = wpa_ft_rrb_build(key, key_len, tlvs, sess_tlv, tlv_auth,
3730 			       pmk_r0->vlan, src_addr, type,
3731 			       packet, packet_len);
3732 
3733 	forced_memzero(pmk_r1, sizeof(pmk_r1));
3734 
3735 	return ret;
3736 }
3737 
3738 
wpa_ft_rrb_rx_pull(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer)3739 static int wpa_ft_rrb_rx_pull(struct wpa_authenticator *wpa_auth,
3740 			      const u8 *src_addr,
3741 			      const u8 *enc, size_t enc_len,
3742 			      const u8 *auth, size_t auth_len,
3743 			      int no_defer)
3744 {
3745 	const char *msgtype = "pull request";
3746 	u8 *plain = NULL, *packet = NULL;
3747 	size_t plain_len = 0, packet_len = 0;
3748 	struct ft_remote_r1kh *r1kh, *r1kh_wildcard;
3749 	const u8 *key;
3750 	size_t key_len;
3751 	int seq_ret;
3752 	const u8 *f_nonce, *f_r0kh_id, *f_r1kh_id, *f_s1kh_id, *f_pmk_r0_name;
3753 	size_t f_nonce_len, f_r0kh_id_len, f_r1kh_id_len, f_s1kh_id_len;
3754 	size_t f_pmk_r0_name_len;
3755 	const struct wpa_ft_pmk_r0_sa *r0;
3756 	int ret;
3757 	struct tlv_list resp[2];
3758 	struct tlv_list resp_auth[5];
3759 	struct ft_rrb_seq f_seq;
3760 
3761 	wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull");
3762 
3763 	RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, msgtype, -1);
3764 	wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID", f_r0kh_id, f_r0kh_id_len);
3765 
3766 	if (wpa_ft_rrb_check_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len)) {
3767 		wpa_printf(MSG_DEBUG, "FT: R0KH-ID mismatch");
3768 		goto out;
3769 	}
3770 
3771 	RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, msgtype, FT_R1KH_ID_LEN);
3772 	wpa_printf(MSG_DEBUG, "FT: R1KH-ID=" MACSTR, MAC2STR(f_r1kh_id));
3773 
3774 	wpa_ft_rrb_lookup_r1kh(wpa_auth, f_r1kh_id, &r1kh, &r1kh_wildcard);
3775 	if (r1kh) {
3776 		key = r1kh->key;
3777 		key_len = sizeof(r1kh->key);
3778 	} else if (r1kh_wildcard) {
3779 		wpa_printf(MSG_DEBUG, "FT: Using wildcard R1KH-ID");
3780 		key = r1kh_wildcard->key;
3781 		key_len = sizeof(r1kh_wildcard->key);
3782 	} else {
3783 		goto out;
3784 	}
3785 
3786 	RRB_GET_AUTH(FT_RRB_NONCE, nonce, "pull request", FT_RRB_NONCE_LEN);
3787 	wpa_hexdump(MSG_DEBUG, "FT: nonce", f_nonce, f_nonce_len);
3788 
3789 	seq_ret = FT_RRB_SEQ_DROP;
3790 	if (r1kh)
3791 		seq_ret = wpa_ft_rrb_seq_chk(r1kh->seq, src_addr, enc, enc_len,
3792 					     auth, auth_len, msgtype, no_defer);
3793 	if (!no_defer && r1kh_wildcard &&
3794 	    (!r1kh || os_memcmp(r1kh->addr, src_addr, ETH_ALEN) != 0)) {
3795 		/* wildcard: r1kh-id unknown or changed addr -> do a seq req */
3796 		seq_ret = FT_RRB_SEQ_DEFER;
3797 	}
3798 
3799 	if (seq_ret == FT_RRB_SEQ_DROP)
3800 		goto out;
3801 
3802 	if (wpa_ft_rrb_decrypt(key, key_len, enc, enc_len, auth, auth_len,
3803 			       src_addr, FT_PACKET_R0KH_R1KH_PULL,
3804 			       &plain, &plain_len) < 0)
3805 		goto out;
3806 
3807 	if (!r1kh)
3808 		r1kh = wpa_ft_rrb_add_r1kh(wpa_auth, r1kh_wildcard, src_addr,
3809 					   f_r1kh_id,
3810 					   wpa_auth->conf.rkh_pos_timeout);
3811 	if (!r1kh)
3812 		goto out;
3813 
3814 	if (seq_ret == FT_RRB_SEQ_DEFER) {
3815 		wpa_ft_rrb_seq_req(wpa_auth, r1kh->seq, src_addr, f_r0kh_id,
3816 				   f_r0kh_id_len, f_r1kh_id, key, key_len,
3817 				   enc, enc_len, auth, auth_len,
3818 				   &wpa_ft_rrb_rx_pull);
3819 		goto out;
3820 	}
3821 
3822 	wpa_ft_rrb_seq_accept(wpa_auth, r1kh->seq, src_addr, auth, auth_len,
3823 			      msgtype);
3824 	wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh,
3825 				  wpa_auth->conf.rkh_pos_timeout);
3826 
3827 	RRB_GET(FT_RRB_PMK_R0_NAME, pmk_r0_name, msgtype, WPA_PMK_NAME_LEN);
3828 	wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name", f_pmk_r0_name,
3829 		    f_pmk_r0_name_len);
3830 
3831 	RRB_GET(FT_RRB_S1KH_ID, s1kh_id, msgtype, ETH_ALEN);
3832 	wpa_printf(MSG_DEBUG, "FT: S1KH-ID=" MACSTR, MAC2STR(f_s1kh_id));
3833 
3834 	if (wpa_ft_new_seq(r1kh->seq, &f_seq) < 0) {
3835 		wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
3836 		goto out;
3837 	}
3838 
3839 	wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 pull response from " MACSTR
3840 		   " to " MACSTR,
3841 		   MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
3842 
3843 	resp[0].type = FT_RRB_S1KH_ID;
3844 	resp[0].len = f_s1kh_id_len;
3845 	resp[0].data = f_s1kh_id;
3846 	resp[1].type = FT_RRB_LAST_EMPTY;
3847 	resp[1].len = 0;
3848 	resp[1].data = NULL;
3849 
3850 	resp_auth[0].type = FT_RRB_NONCE;
3851 	resp_auth[0].len = f_nonce_len;
3852 	resp_auth[0].data = f_nonce;
3853 	resp_auth[1].type = FT_RRB_SEQ;
3854 	resp_auth[1].len = sizeof(f_seq);
3855 	resp_auth[1].data = (u8 *) &f_seq;
3856 	resp_auth[2].type = FT_RRB_R0KH_ID;
3857 	resp_auth[2].len = f_r0kh_id_len;
3858 	resp_auth[2].data = f_r0kh_id;
3859 	resp_auth[3].type = FT_RRB_R1KH_ID;
3860 	resp_auth[3].len = f_r1kh_id_len;
3861 	resp_auth[3].data = f_r1kh_id;
3862 	resp_auth[4].type = FT_RRB_LAST_EMPTY;
3863 	resp_auth[4].len = 0;
3864 	resp_auth[4].data = NULL;
3865 
3866 	if (wpa_ft_fetch_pmk_r0(wpa_auth, f_s1kh_id, f_pmk_r0_name, &r0) < 0) {
3867 		wpa_printf(MSG_DEBUG, "FT: No matching PMK-R0-Name found");
3868 		ret = wpa_ft_rrb_build(key, key_len, resp, NULL, resp_auth,
3869 				       NULL, wpa_auth->addr,
3870 				       FT_PACKET_R0KH_R1KH_RESP,
3871 				       &packet, &packet_len);
3872 	} else {
3873 		ret = wpa_ft_rrb_build_r0(key, key_len, resp, r0, f_r1kh_id,
3874 					  f_s1kh_id, resp_auth, wpa_auth->addr,
3875 					  FT_PACKET_R0KH_R1KH_RESP,
3876 					  &packet, &packet_len);
3877 	}
3878 
3879 	if (!ret)
3880 		wpa_ft_rrb_oui_send(wpa_auth, src_addr,
3881 				    FT_PACKET_R0KH_R1KH_RESP, packet,
3882 				    packet_len);
3883 
3884 out:
3885 	os_free(plain);
3886 	os_free(packet);
3887 
3888 	return 0;
3889 }
3890 
3891 
3892 /* @returns  0 on success
3893  *          -1 on error
3894  *          -2 if FR_RRB_PAIRWISE is missing
3895  */
wpa_ft_rrb_rx_r1(struct wpa_authenticator * wpa_auth,const u8 * src_addr,u8 type,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,const char * msgtype,u8 * s1kh_id_out,int (* cb)(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer))3896 static int wpa_ft_rrb_rx_r1(struct wpa_authenticator *wpa_auth,
3897 			    const u8 *src_addr, u8 type,
3898 			    const u8 *enc, size_t enc_len,
3899 			    const u8 *auth, size_t auth_len,
3900 			    const char *msgtype, u8 *s1kh_id_out,
3901 			    int (*cb)(struct wpa_authenticator *wpa_auth,
3902 				      const u8 *src_addr,
3903 				      const u8 *enc, size_t enc_len,
3904 				      const u8 *auth, size_t auth_len,
3905 				      int no_defer))
3906 {
3907 	u8 *plain = NULL;
3908 	size_t plain_len = 0;
3909 	struct ft_remote_r0kh *r0kh, *r0kh_wildcard;
3910 	const u8 *key;
3911 	size_t key_len;
3912 	int seq_ret;
3913 	const u8 *f_r1kh_id, *f_s1kh_id, *f_r0kh_id;
3914 	const u8 *f_pmk_r1_name, *f_pairwise, *f_pmk_r1;
3915 	const u8 *f_expires_in;
3916 	size_t f_r1kh_id_len, f_s1kh_id_len, f_r0kh_id_len;
3917 	const u8 *f_identity, *f_radius_cui;
3918 	const u8 *f_session_timeout;
3919 	size_t f_pmk_r1_name_len, f_pairwise_len, f_pmk_r1_len;
3920 	size_t f_expires_in_len;
3921 	size_t f_identity_len, f_radius_cui_len;
3922 	size_t f_session_timeout_len;
3923 	int pairwise;
3924 	int ret = -1;
3925 	int expires_in;
3926 	int session_timeout;
3927 	struct vlan_description vlan;
3928 	size_t pmk_r1_len;
3929 
3930 	RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, msgtype, -1);
3931 	wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID", f_r0kh_id, f_r0kh_id_len);
3932 
3933 	RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, msgtype, FT_R1KH_ID_LEN);
3934 	wpa_printf(MSG_DEBUG, "FT: R1KH-ID=" MACSTR, MAC2STR(f_r1kh_id));
3935 
3936 	if (wpa_ft_rrb_check_r1kh(wpa_auth, f_r1kh_id)) {
3937 		wpa_printf(MSG_DEBUG, "FT: R1KH-ID mismatch");
3938 		goto out;
3939 	}
3940 
3941 	wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len, &r0kh,
3942 			       &r0kh_wildcard);
3943 	if (r0kh) {
3944 		key = r0kh->key;
3945 		key_len = sizeof(r0kh->key);
3946 	} else if (r0kh_wildcard) {
3947 		wpa_printf(MSG_DEBUG, "FT: Using wildcard R0KH-ID");
3948 		key = r0kh_wildcard->key;
3949 		key_len = sizeof(r0kh_wildcard->key);
3950 	} else {
3951 		goto out;
3952 	}
3953 
3954 	seq_ret = FT_RRB_SEQ_DROP;
3955 	if (r0kh) {
3956 		seq_ret = wpa_ft_rrb_seq_chk(r0kh->seq, src_addr, enc, enc_len,
3957 					     auth, auth_len, msgtype,
3958 					     cb ? 0 : 1);
3959 	}
3960 	if (cb && r0kh_wildcard &&
3961 	    (!r0kh || os_memcmp(r0kh->addr, src_addr, ETH_ALEN) != 0)) {
3962 		/* wildcard: r0kh-id unknown or changed addr -> do a seq req */
3963 		seq_ret = FT_RRB_SEQ_DEFER;
3964 	}
3965 
3966 	if (seq_ret == FT_RRB_SEQ_DROP)
3967 		goto out;
3968 
3969 	if (wpa_ft_rrb_decrypt(key, key_len, enc, enc_len, auth, auth_len,
3970 			       src_addr, type, &plain, &plain_len) < 0)
3971 		goto out;
3972 
3973 	if (!r0kh)
3974 		r0kh = wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard, src_addr,
3975 					   f_r0kh_id, f_r0kh_id_len,
3976 					   wpa_auth->conf.rkh_pos_timeout);
3977 	if (!r0kh)
3978 		goto out;
3979 
3980 	if (seq_ret == FT_RRB_SEQ_DEFER) {
3981 		wpa_ft_rrb_seq_req(wpa_auth, r0kh->seq, src_addr, f_r0kh_id,
3982 				   f_r0kh_id_len, f_r1kh_id, key, key_len,
3983 				   enc, enc_len, auth, auth_len, cb);
3984 		goto out;
3985 	}
3986 
3987 	wpa_ft_rrb_seq_accept(wpa_auth, r0kh->seq, src_addr, auth, auth_len,
3988 			      msgtype);
3989 	wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh,
3990 				  wpa_auth->conf.rkh_pos_timeout);
3991 
3992 	RRB_GET(FT_RRB_S1KH_ID, s1kh_id, msgtype, ETH_ALEN);
3993 	wpa_printf(MSG_DEBUG, "FT: S1KH-ID=" MACSTR, MAC2STR(f_s1kh_id));
3994 
3995 	if (s1kh_id_out)
3996 		os_memcpy(s1kh_id_out, f_s1kh_id, ETH_ALEN);
3997 
3998 	ret = -2;
3999 	RRB_GET(FT_RRB_PAIRWISE, pairwise, msgtype, sizeof(le16));
4000 	wpa_hexdump(MSG_DEBUG, "FT: pairwise", f_pairwise, f_pairwise_len);
4001 
4002 	ret = -1;
4003 	RRB_GET(FT_RRB_PMK_R1_NAME, pmk_r1_name, msgtype, WPA_PMK_NAME_LEN);
4004 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name",
4005 		    f_pmk_r1_name, WPA_PMK_NAME_LEN);
4006 
4007 	pmk_r1_len = PMK_LEN;
4008 	if (wpa_ft_rrb_get_tlv(plain, plain_len, FT_RRB_PMK_R1, &f_pmk_r1_len,
4009 			       &f_pmk_r1) == 0 &&
4010 	    (f_pmk_r1_len == PMK_LEN || f_pmk_r1_len == SHA384_MAC_LEN))
4011 		pmk_r1_len = f_pmk_r1_len;
4012 	RRB_GET(FT_RRB_PMK_R1, pmk_r1, msgtype, pmk_r1_len);
4013 	wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", f_pmk_r1, pmk_r1_len);
4014 
4015 	pairwise = WPA_GET_LE16(f_pairwise);
4016 
4017 	RRB_GET_OPTIONAL(FT_RRB_EXPIRES_IN, expires_in, msgtype,
4018 			 sizeof(le16));
4019 	if (f_expires_in)
4020 		expires_in = WPA_GET_LE16(f_expires_in);
4021 	else
4022 		expires_in = 0;
4023 
4024 	wpa_printf(MSG_DEBUG, "FT: PMK-R1 %s - expires_in=%d", msgtype,
4025 		   expires_in);
4026 
4027 	if (wpa_ft_rrb_get_tlv_vlan(plain, plain_len, &vlan) < 0) {
4028 		wpa_printf(MSG_DEBUG, "FT: Cannot parse vlan");
4029 		wpa_ft_rrb_dump(plain, plain_len);
4030 		goto out;
4031 	}
4032 
4033 	wpa_printf(MSG_DEBUG, "FT: vlan %d%s",
4034 		   le_to_host16(vlan.untagged), vlan.tagged[0] ? "+" : "");
4035 
4036 	RRB_GET_OPTIONAL(FT_RRB_IDENTITY, identity, msgtype, -1);
4037 	if (f_identity)
4038 		wpa_hexdump_ascii(MSG_DEBUG, "FT: Identity", f_identity,
4039 				  f_identity_len);
4040 
4041 	RRB_GET_OPTIONAL(FT_RRB_RADIUS_CUI, radius_cui, msgtype, -1);
4042 	if (f_radius_cui)
4043 		wpa_hexdump_ascii(MSG_DEBUG, "FT: CUI", f_radius_cui,
4044 				  f_radius_cui_len);
4045 
4046 	RRB_GET_OPTIONAL(FT_RRB_SESSION_TIMEOUT, session_timeout, msgtype,
4047 			 sizeof(le32));
4048 	if (f_session_timeout)
4049 		session_timeout = WPA_GET_LE32(f_session_timeout);
4050 	else
4051 		session_timeout = 0;
4052 	wpa_printf(MSG_DEBUG, "FT: session_timeout %d", session_timeout);
4053 
4054 	if (wpa_ft_store_pmk_r1(wpa_auth, f_s1kh_id, f_pmk_r1, pmk_r1_len,
4055 				f_pmk_r1_name,
4056 				pairwise, &vlan, expires_in, session_timeout,
4057 				f_identity, f_identity_len, f_radius_cui,
4058 				f_radius_cui_len) < 0)
4059 		goto out;
4060 
4061 	ret = 0;
4062 out:
4063 	bin_clear_free(plain, plain_len);
4064 
4065 	return ret;
4066 
4067 }
4068 
4069 
ft_finish_pull(struct wpa_state_machine * sm)4070 static void ft_finish_pull(struct wpa_state_machine *sm)
4071 {
4072 	int res;
4073 	u8 *resp_ies;
4074 	size_t resp_ies_len;
4075 	u16 status;
4076 
4077 	if (!sm->ft_pending_cb || !sm->ft_pending_req_ies)
4078 		return;
4079 
4080 	res = wpa_ft_process_auth_req(sm, wpabuf_head(sm->ft_pending_req_ies),
4081 				      wpabuf_len(sm->ft_pending_req_ies),
4082 				      &resp_ies, &resp_ies_len);
4083 	if (res < 0) {
4084 		/* this loop is broken by ft_pending_pull_left_retries */
4085 		wpa_printf(MSG_DEBUG,
4086 			   "FT: Callback postponed until response is available");
4087 		return;
4088 	}
4089 	wpabuf_free(sm->ft_pending_req_ies);
4090 	sm->ft_pending_req_ies = NULL;
4091 	status = res;
4092 	wpa_printf(MSG_DEBUG, "FT: Postponed auth callback result for " MACSTR
4093 		   " - status %u", MAC2STR(sm->addr), status);
4094 
4095 	sm->ft_pending_cb(sm->ft_pending_cb_ctx, sm->addr, sm->wpa_auth->addr,
4096 			  sm->ft_pending_auth_transaction + 1, status,
4097 			  resp_ies, resp_ies_len);
4098 	os_free(resp_ies);
4099 }
4100 
4101 
4102 struct ft_get_sta_ctx {
4103 	const u8 *nonce;
4104 	const u8 *s1kh_id;
4105 	struct wpa_state_machine *sm;
4106 };
4107 
4108 
ft_get_sta_cb(struct wpa_state_machine * sm,void * ctx)4109 static int ft_get_sta_cb(struct wpa_state_machine *sm, void *ctx)
4110 {
4111 	struct ft_get_sta_ctx *info = ctx;
4112 
4113 	if ((info->s1kh_id &&
4114 	     os_memcmp(info->s1kh_id, sm->addr, ETH_ALEN) != 0) ||
4115 	    os_memcmp(info->nonce, sm->ft_pending_pull_nonce,
4116 		      FT_RRB_NONCE_LEN) != 0 ||
4117 	    sm->ft_pending_cb == NULL || sm->ft_pending_req_ies == NULL)
4118 		return 0;
4119 
4120 	info->sm = sm;
4121 
4122 	return 1;
4123 }
4124 
4125 
wpa_ft_rrb_rx_resp(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer)4126 static int wpa_ft_rrb_rx_resp(struct wpa_authenticator *wpa_auth,
4127 			      const u8 *src_addr,
4128 			      const u8 *enc, size_t enc_len,
4129 			      const u8 *auth, size_t auth_len,
4130 			      int no_defer)
4131 {
4132 	const char *msgtype = "pull response";
4133 	int nak, ret = -1;
4134 	struct ft_get_sta_ctx ctx;
4135 	u8 s1kh_id[ETH_ALEN];
4136 	const u8 *f_nonce;
4137 	size_t f_nonce_len;
4138 
4139 	wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull response");
4140 
4141 	RRB_GET_AUTH(FT_RRB_NONCE, nonce, msgtype, FT_RRB_NONCE_LEN);
4142 	wpa_hexdump(MSG_DEBUG, "FT: nonce", f_nonce, f_nonce_len);
4143 
4144 	os_memset(&ctx, 0, sizeof(ctx));
4145 	ctx.nonce = f_nonce;
4146 	if (!wpa_auth_for_each_sta(wpa_auth, ft_get_sta_cb, &ctx)) {
4147 		/* nonce not found */
4148 		wpa_printf(MSG_DEBUG, "FT: Invalid nonce");
4149 		return -1;
4150 	}
4151 
4152 	ret = wpa_ft_rrb_rx_r1(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_RESP,
4153 			       enc, enc_len, auth, auth_len, msgtype, s1kh_id,
4154 			       no_defer ? NULL : &wpa_ft_rrb_rx_resp);
4155 	if (ret == -2) {
4156 		ret = 0;
4157 		nak = 1;
4158 	} else {
4159 		nak = 0;
4160 	}
4161 	if (ret < 0)
4162 		return -1;
4163 
4164 	ctx.s1kh_id = s1kh_id;
4165 	if (wpa_auth_for_each_sta(wpa_auth, ft_get_sta_cb, &ctx)) {
4166 		wpa_printf(MSG_DEBUG,
4167 			   "FT: Response to a pending pull request for " MACSTR,
4168 			   MAC2STR(ctx.sm->addr));
4169 		eloop_cancel_timeout(wpa_ft_expire_pull, ctx.sm, NULL);
4170 		if (nak)
4171 			ctx.sm->ft_pending_pull_left_retries = 0;
4172 		ft_finish_pull(ctx.sm);
4173 	}
4174 
4175 out:
4176 	return ret;
4177 }
4178 
4179 
wpa_ft_rrb_rx_push(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer)4180 static int wpa_ft_rrb_rx_push(struct wpa_authenticator *wpa_auth,
4181 			      const u8 *src_addr,
4182 			      const u8 *enc, size_t enc_len,
4183 			      const u8 *auth, size_t auth_len, int no_defer)
4184 {
4185 	const char *msgtype = "push";
4186 
4187 	wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 push");
4188 
4189 	if (wpa_ft_rrb_rx_r1(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_PUSH,
4190 			     enc, enc_len, auth, auth_len, msgtype, NULL,
4191 			     no_defer ? NULL : wpa_ft_rrb_rx_push) < 0)
4192 		return -1;
4193 
4194 	return 0;
4195 }
4196 
4197 
wpa_ft_rrb_rx_seq(struct wpa_authenticator * wpa_auth,const u8 * src_addr,int type,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,struct ft_remote_seq ** rkh_seq,u8 ** key,size_t * key_len,struct ft_remote_r0kh ** r0kh_out,struct ft_remote_r1kh ** r1kh_out,struct ft_remote_r0kh ** r0kh_wildcard_out,struct ft_remote_r1kh ** r1kh_wildcard_out)4198 static int wpa_ft_rrb_rx_seq(struct wpa_authenticator *wpa_auth,
4199 			     const u8 *src_addr, int type,
4200 			     const u8 *enc, size_t enc_len,
4201 			     const u8 *auth, size_t auth_len,
4202 			     struct ft_remote_seq **rkh_seq,
4203 			     u8 **key, size_t *key_len,
4204 			     struct ft_remote_r0kh **r0kh_out,
4205 			     struct ft_remote_r1kh **r1kh_out,
4206 			     struct ft_remote_r0kh **r0kh_wildcard_out,
4207 			     struct ft_remote_r1kh **r1kh_wildcard_out)
4208 {
4209 	struct ft_remote_r0kh *r0kh = NULL;
4210 	struct ft_remote_r1kh *r1kh = NULL;
4211 	const u8 *f_r0kh_id, *f_r1kh_id;
4212 	size_t f_r0kh_id_len, f_r1kh_id_len;
4213 	int to_r0kh, to_r1kh;
4214 	u8 *plain = NULL;
4215 	size_t plain_len = 0;
4216 	struct ft_remote_r0kh *r0kh_wildcard;
4217 	struct ft_remote_r1kh *r1kh_wildcard;
4218 
4219 	RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, "seq", -1);
4220 	RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, "seq", FT_R1KH_ID_LEN);
4221 
4222 	to_r0kh = !wpa_ft_rrb_check_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len);
4223 	to_r1kh = !wpa_ft_rrb_check_r1kh(wpa_auth, f_r1kh_id);
4224 
4225 	if (to_r0kh && to_r1kh) {
4226 		wpa_printf(MSG_DEBUG, "FT: seq - local R0KH-ID and R1KH-ID");
4227 		goto out;
4228 	}
4229 
4230 	if (!to_r0kh && !to_r1kh) {
4231 		wpa_printf(MSG_DEBUG, "FT: seq - remote R0KH-ID and R1KH-ID");
4232 		goto out;
4233 	}
4234 
4235 	if (!to_r0kh) {
4236 		wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len,
4237 				       &r0kh, &r0kh_wildcard);
4238 		if (!r0kh_wildcard &&
4239 		    (!r0kh || os_memcmp(r0kh->addr, src_addr, ETH_ALEN) != 0)) {
4240 			wpa_hexdump(MSG_DEBUG, "FT: Did not find R0KH-ID",
4241 				    f_r0kh_id, f_r0kh_id_len);
4242 			goto out;
4243 		}
4244 		if (r0kh) {
4245 			*key = r0kh->key;
4246 			*key_len = sizeof(r0kh->key);
4247 		} else {
4248 			*key = r0kh_wildcard->key;
4249 			*key_len = sizeof(r0kh_wildcard->key);
4250 		}
4251 	}
4252 
4253 	if (!to_r1kh) {
4254 		wpa_ft_rrb_lookup_r1kh(wpa_auth, f_r1kh_id, &r1kh,
4255 				       &r1kh_wildcard);
4256 		if (!r1kh_wildcard &&
4257 		    (!r1kh || os_memcmp(r1kh->addr, src_addr, ETH_ALEN) != 0)) {
4258 			wpa_hexdump(MSG_DEBUG, "FT: Did not find R1KH-ID",
4259 				    f_r1kh_id, FT_R1KH_ID_LEN);
4260 			goto out;
4261 		}
4262 		if (r1kh) {
4263 			*key = r1kh->key;
4264 			*key_len = sizeof(r1kh->key);
4265 		} else {
4266 			*key = r1kh_wildcard->key;
4267 			*key_len = sizeof(r1kh_wildcard->key);
4268 		}
4269 	}
4270 
4271 	if (wpa_ft_rrb_decrypt(*key, *key_len, enc, enc_len, auth, auth_len,
4272 			       src_addr, type, &plain, &plain_len) < 0)
4273 		goto out;
4274 
4275 	os_free(plain);
4276 
4277 	if (!to_r0kh) {
4278 		if (!r0kh)
4279 			r0kh = wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard,
4280 						   src_addr, f_r0kh_id,
4281 						   f_r0kh_id_len,
4282 						   ftRRBseqTimeout);
4283 		if (!r0kh)
4284 			goto out;
4285 
4286 		wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh, ftRRBseqTimeout);
4287 		*rkh_seq = r0kh->seq;
4288 		if (r0kh_out)
4289 			*r0kh_out = r0kh;
4290 		if (r0kh_wildcard_out)
4291 			*r0kh_wildcard_out = r0kh_wildcard;
4292 	}
4293 
4294 	if (!to_r1kh) {
4295 		if (!r1kh)
4296 			r1kh = wpa_ft_rrb_add_r1kh(wpa_auth, r1kh_wildcard,
4297 						   src_addr, f_r1kh_id,
4298 						   ftRRBseqTimeout);
4299 		if (!r1kh)
4300 			goto out;
4301 
4302 		wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh, ftRRBseqTimeout);
4303 		*rkh_seq = r1kh->seq;
4304 		if (r1kh_out)
4305 			*r1kh_out = r1kh;
4306 		if (r1kh_wildcard_out)
4307 			*r1kh_wildcard_out = r1kh_wildcard;
4308 	}
4309 
4310 	return 0;
4311 out:
4312 	return -1;
4313 }
4314 
4315 
wpa_ft_rrb_rx_seq_req(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer)4316 static int wpa_ft_rrb_rx_seq_req(struct wpa_authenticator *wpa_auth,
4317 				 const u8 *src_addr,
4318 				 const u8 *enc, size_t enc_len,
4319 				 const u8 *auth, size_t auth_len,
4320 				 int no_defer)
4321 {
4322 	int ret = -1;
4323 	struct ft_rrb_seq f_seq;
4324 	const u8 *f_nonce, *f_r0kh_id, *f_r1kh_id;
4325 	size_t f_nonce_len, f_r0kh_id_len, f_r1kh_id_len;
4326 	struct ft_remote_seq *rkh_seq = NULL;
4327 	u8 *packet = NULL, *key = NULL;
4328 	size_t packet_len = 0, key_len = 0;
4329 	struct tlv_list seq_resp_auth[5];
4330 
4331 	wpa_printf(MSG_DEBUG, "FT: Received sequence number request");
4332 
4333 	if (wpa_ft_rrb_rx_seq(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_SEQ_REQ,
4334 			      enc, enc_len, auth, auth_len, &rkh_seq, &key,
4335 			      &key_len, NULL, NULL, NULL, NULL) < 0)
4336 		goto out;
4337 
4338 	RRB_GET_AUTH(FT_RRB_NONCE, nonce, "seq request", FT_RRB_NONCE_LEN);
4339 	wpa_hexdump(MSG_DEBUG, "FT: seq request - nonce", f_nonce, f_nonce_len);
4340 
4341 	RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, "seq", -1);
4342 	RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, "seq", FT_R1KH_ID_LEN);
4343 
4344 	if (wpa_ft_new_seq(rkh_seq, &f_seq) < 0) {
4345 		wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
4346 		goto out;
4347 	}
4348 
4349 	wpa_printf(MSG_DEBUG, "FT: Send sequence number response from " MACSTR
4350 		   " to " MACSTR,
4351 		   MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
4352 
4353 	seq_resp_auth[0].type = FT_RRB_NONCE;
4354 	seq_resp_auth[0].len = f_nonce_len;
4355 	seq_resp_auth[0].data = f_nonce;
4356 	seq_resp_auth[1].type = FT_RRB_SEQ;
4357 	seq_resp_auth[1].len = sizeof(f_seq);
4358 	seq_resp_auth[1].data = (u8 *) &f_seq;
4359 	seq_resp_auth[2].type = FT_RRB_R0KH_ID;
4360 	seq_resp_auth[2].len = f_r0kh_id_len;
4361 	seq_resp_auth[2].data = f_r0kh_id;
4362 	seq_resp_auth[3].type = FT_RRB_R1KH_ID;
4363 	seq_resp_auth[3].len = FT_R1KH_ID_LEN;
4364 	seq_resp_auth[3].data = f_r1kh_id;
4365 	seq_resp_auth[4].type = FT_RRB_LAST_EMPTY;
4366 	seq_resp_auth[4].len = 0;
4367 	seq_resp_auth[4].data = NULL;
4368 
4369 	if (wpa_ft_rrb_build(key, key_len, NULL, NULL, seq_resp_auth, NULL,
4370 			     wpa_auth->addr, FT_PACKET_R0KH_R1KH_SEQ_RESP,
4371 			     &packet, &packet_len) < 0)
4372 		goto out;
4373 
4374 	wpa_ft_rrb_oui_send(wpa_auth, src_addr,
4375 			    FT_PACKET_R0KH_R1KH_SEQ_RESP, packet,
4376 			    packet_len);
4377 
4378 out:
4379 	os_free(packet);
4380 
4381 	return ret;
4382 }
4383 
4384 
wpa_ft_rrb_rx_seq_resp(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * enc,size_t enc_len,const u8 * auth,size_t auth_len,int no_defer)4385 static int wpa_ft_rrb_rx_seq_resp(struct wpa_authenticator *wpa_auth,
4386 				  const u8 *src_addr,
4387 				  const u8 *enc, size_t enc_len,
4388 				  const u8 *auth, size_t auth_len,
4389 				  int no_defer)
4390 {
4391 	u8 *key = NULL;
4392 	size_t key_len = 0;
4393 	struct ft_remote_r0kh *r0kh = NULL, *r0kh_wildcard = NULL;
4394 	struct ft_remote_r1kh *r1kh = NULL, *r1kh_wildcard = NULL;
4395 	const u8 *f_nonce, *f_seq;
4396 	size_t f_nonce_len, f_seq_len;
4397 	struct ft_remote_seq *rkh_seq = NULL;
4398 	struct ft_remote_item *item;
4399 	struct os_reltime now, now_remote;
4400 	int seq_ret, found;
4401 	const struct ft_rrb_seq *msg_both;
4402 	u32 msg_dom, msg_seq;
4403 
4404 	wpa_printf(MSG_DEBUG, "FT: Received sequence number response");
4405 
4406 	if (wpa_ft_rrb_rx_seq(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_SEQ_RESP,
4407 			      enc, enc_len, auth, auth_len, &rkh_seq, &key,
4408 			      &key_len, &r0kh, &r1kh, &r0kh_wildcard,
4409 			      &r1kh_wildcard) < 0)
4410 		goto out;
4411 
4412 	RRB_GET_AUTH(FT_RRB_NONCE, nonce, "seq response", FT_RRB_NONCE_LEN);
4413 	wpa_hexdump(MSG_DEBUG, "FT: seq response - nonce", f_nonce,
4414 		    f_nonce_len);
4415 
4416 	found = 0;
4417 	dl_list_for_each(item, &rkh_seq->rx.queue, struct ft_remote_item,
4418 			 list) {
4419 		if (os_memcmp_const(f_nonce, item->nonce,
4420 				    FT_RRB_NONCE_LEN) != 0 ||
4421 		    os_get_reltime(&now) < 0 ||
4422 		    os_reltime_expired(&now, &item->nonce_ts, ftRRBseqTimeout))
4423 			continue;
4424 
4425 		found = 1;
4426 		break;
4427 	}
4428 	if (!found) {
4429 		wpa_printf(MSG_DEBUG, "FT: seq response - bad nonce");
4430 		goto out;
4431 	}
4432 
4433 	if (r0kh) {
4434 		wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh,
4435 					  wpa_auth->conf.rkh_pos_timeout);
4436 		if (r0kh_wildcard)
4437 			os_memcpy(r0kh->addr, src_addr, ETH_ALEN);
4438 	}
4439 
4440 	if (r1kh) {
4441 		wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh,
4442 					  wpa_auth->conf.rkh_pos_timeout);
4443 		if (r1kh_wildcard)
4444 			os_memcpy(r1kh->addr, src_addr, ETH_ALEN);
4445 	}
4446 
4447 	seq_ret = wpa_ft_rrb_seq_chk(rkh_seq, src_addr, enc, enc_len, auth,
4448 				     auth_len, "seq response", 1);
4449 	if (seq_ret == FT_RRB_SEQ_OK) {
4450 		wpa_printf(MSG_DEBUG, "FT: seq response - valid seq number");
4451 		wpa_ft_rrb_seq_accept(wpa_auth, rkh_seq, src_addr, auth,
4452 				      auth_len, "seq response");
4453 	} else {
4454 		wpa_printf(MSG_DEBUG, "FT: seq response - reset seq number");
4455 
4456 		RRB_GET_AUTH(FT_RRB_SEQ, seq, "seq response",
4457 			     sizeof(*msg_both));
4458 		msg_both = (const struct ft_rrb_seq *) f_seq;
4459 
4460 		msg_dom = le_to_host32(msg_both->dom);
4461 		msg_seq = le_to_host32(msg_both->seq);
4462 		now_remote.sec = le_to_host32(msg_both->ts);
4463 		now_remote.usec = 0;
4464 
4465 		rkh_seq->rx.num_last = 2;
4466 		rkh_seq->rx.dom = msg_dom;
4467 		rkh_seq->rx.offsetidx = 0;
4468 		/* Accept some older, possibly cached packets as well */
4469 		rkh_seq->rx.last[0] = msg_seq - FT_REMOTE_SEQ_BACKLOG -
4470 			dl_list_len(&rkh_seq->rx.queue);
4471 		rkh_seq->rx.last[1] = msg_seq;
4472 
4473 		/* local time - offset = remote time
4474 		 * <=> local time - remote time = offset */
4475 		os_reltime_sub(&now, &now_remote, &rkh_seq->rx.time_offset);
4476 	}
4477 
4478 	wpa_ft_rrb_seq_flush(wpa_auth, rkh_seq, 1);
4479 
4480 	return 0;
4481 out:
4482 	return -1;
4483 }
4484 
4485 
wpa_ft_rrb_rx(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * data,size_t data_len)4486 int wpa_ft_rrb_rx(struct wpa_authenticator *wpa_auth, const u8 *src_addr,
4487 		  const u8 *data, size_t data_len)
4488 {
4489 	struct ft_rrb_frame *frame;
4490 	u16 alen;
4491 	const u8 *pos, *end, *start;
4492 	u8 action;
4493 	const u8 *sta_addr, *target_ap_addr;
4494 
4495 	wpa_printf(MSG_DEBUG, "FT: RRB received frame from remote AP " MACSTR,
4496 		   MAC2STR(src_addr));
4497 
4498 	if (data_len < sizeof(*frame)) {
4499 		wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (data_len=%lu)",
4500 			   (unsigned long) data_len);
4501 		return -1;
4502 	}
4503 
4504 	pos = data;
4505 	frame = (struct ft_rrb_frame *) pos;
4506 	pos += sizeof(*frame);
4507 
4508 	alen = le_to_host16(frame->action_length);
4509 	wpa_printf(MSG_DEBUG, "FT: RRB frame - frame_type=%d packet_type=%d "
4510 		   "action_length=%d ap_address=" MACSTR,
4511 		   frame->frame_type, frame->packet_type, alen,
4512 		   MAC2STR(frame->ap_address));
4513 
4514 	if (frame->frame_type != RSN_REMOTE_FRAME_TYPE_FT_RRB) {
4515 		/* Discard frame per IEEE Std 802.11r-2008, 11A.10.3 */
4516 		wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with "
4517 			   "unrecognized type %d", frame->frame_type);
4518 		return -1;
4519 	}
4520 
4521 	if (alen > data_len - sizeof(*frame)) {
4522 		wpa_printf(MSG_DEBUG, "FT: RRB frame too short for action "
4523 			   "frame");
4524 		return -1;
4525 	}
4526 
4527 	wpa_hexdump(MSG_MSGDUMP, "FT: RRB - FT Action frame", pos, alen);
4528 
4529 	if (alen < 1 + 1 + 2 * ETH_ALEN) {
4530 		wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (not enough "
4531 			   "room for Action Frame body); alen=%lu",
4532 			   (unsigned long) alen);
4533 		return -1;
4534 	}
4535 	start = pos;
4536 	end = pos + alen;
4537 
4538 	if (*pos != WLAN_ACTION_FT) {
4539 		wpa_printf(MSG_DEBUG, "FT: Unexpected Action frame category "
4540 			   "%d", *pos);
4541 		return -1;
4542 	}
4543 
4544 	pos++;
4545 	action = *pos++;
4546 	sta_addr = pos;
4547 	pos += ETH_ALEN;
4548 	target_ap_addr = pos;
4549 	pos += ETH_ALEN;
4550 	wpa_printf(MSG_DEBUG, "FT: RRB Action Frame: action=%d sta_addr="
4551 		   MACSTR " target_ap_addr=" MACSTR,
4552 		   action, MAC2STR(sta_addr), MAC2STR(target_ap_addr));
4553 
4554 	if (frame->packet_type == FT_PACKET_REQUEST) {
4555 		wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Request");
4556 
4557 		if (action != 1) {
4558 			wpa_printf(MSG_DEBUG, "FT: Unexpected Action %d in "
4559 				   "RRB Request", action);
4560 			return -1;
4561 		}
4562 
4563 		if (os_memcmp(target_ap_addr, wpa_auth->addr, ETH_ALEN) != 0) {
4564 			wpa_printf(MSG_DEBUG, "FT: Target AP address in the "
4565 				   "RRB Request does not match with own "
4566 				   "address");
4567 			return -1;
4568 		}
4569 
4570 		if (wpa_ft_rrb_rx_request(wpa_auth, frame->ap_address,
4571 					  sta_addr, pos, end - pos) < 0)
4572 			return -1;
4573 	} else if (frame->packet_type == FT_PACKET_RESPONSE) {
4574 		u16 status_code;
4575 
4576 		if (end - pos < 2) {
4577 			wpa_printf(MSG_DEBUG, "FT: Not enough room for status "
4578 				   "code in RRB Response");
4579 			return -1;
4580 		}
4581 		status_code = WPA_GET_LE16(pos);
4582 
4583 		wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Response "
4584 			   "(status_code=%d)", status_code);
4585 
4586 		if (wpa_ft_action_send(wpa_auth, sta_addr, start, alen) < 0)
4587 			return -1;
4588 	} else {
4589 		wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with unknown "
4590 			   "packet_type %d", frame->packet_type);
4591 		return -1;
4592 	}
4593 
4594 	return 0;
4595 }
4596 
4597 
wpa_ft_rrb_oui_rx(struct wpa_authenticator * wpa_auth,const u8 * src_addr,const u8 * dst_addr,u8 oui_suffix,const u8 * data,size_t data_len)4598 void wpa_ft_rrb_oui_rx(struct wpa_authenticator *wpa_auth, const u8 *src_addr,
4599 		       const u8 *dst_addr, u8 oui_suffix, const u8 *data,
4600 		       size_t data_len)
4601 {
4602 	const u8 *auth, *enc;
4603 	size_t alen, elen;
4604 	int no_defer = 0;
4605 
4606 	wpa_printf(MSG_DEBUG, "FT: RRB-OUI(" MACSTR
4607 		   ") received frame from remote AP "
4608 		   MACSTR " oui_suffix=%u dst=" MACSTR,
4609 		   MAC2STR(wpa_auth->addr), MAC2STR(src_addr), oui_suffix,
4610 		   MAC2STR(dst_addr));
4611 	wpa_hexdump(MSG_MSGDUMP, "FT: RRB frame payload", data, data_len);
4612 
4613 	if (is_multicast_ether_addr(src_addr)) {
4614 		wpa_printf(MSG_DEBUG,
4615 			   "FT: RRB-OUI received frame from multicast address "
4616 			   MACSTR, MAC2STR(src_addr));
4617 		return;
4618 	}
4619 
4620 	if (is_multicast_ether_addr(dst_addr))
4621 		no_defer = 1;
4622 
4623 	if (data_len < sizeof(u16)) {
4624 		wpa_printf(MSG_DEBUG, "FT: RRB-OUI frame too short");
4625 		return;
4626 	}
4627 
4628 	alen = WPA_GET_LE16(data);
4629 	if (data_len < sizeof(u16) + alen) {
4630 		wpa_printf(MSG_DEBUG, "FT: RRB-OUI frame too short");
4631 		return;
4632 	}
4633 
4634 	auth = data + sizeof(u16);
4635 	wpa_hexdump(MSG_MSGDUMP, "FT: Authenticated payload", auth, alen);
4636 	enc = data + sizeof(u16) + alen;
4637 	elen = data_len - sizeof(u16) - alen;
4638 	wpa_hexdump(MSG_MSGDUMP, "FT: Encrypted payload", enc, elen);
4639 
4640 	switch (oui_suffix) {
4641 	case FT_PACKET_R0KH_R1KH_PULL:
4642 		wpa_ft_rrb_rx_pull(wpa_auth, src_addr, enc, elen, auth, alen,
4643 				   no_defer);
4644 		break;
4645 	case FT_PACKET_R0KH_R1KH_RESP:
4646 		wpa_ft_rrb_rx_resp(wpa_auth, src_addr, enc, elen, auth, alen,
4647 				   no_defer);
4648 		break;
4649 	case FT_PACKET_R0KH_R1KH_PUSH:
4650 		wpa_ft_rrb_rx_push(wpa_auth, src_addr, enc, elen, auth, alen,
4651 				   no_defer);
4652 		break;
4653 	case FT_PACKET_R0KH_R1KH_SEQ_REQ:
4654 		wpa_ft_rrb_rx_seq_req(wpa_auth, src_addr, enc, elen, auth, alen,
4655 				      no_defer);
4656 		break;
4657 	case FT_PACKET_R0KH_R1KH_SEQ_RESP:
4658 		wpa_ft_rrb_rx_seq_resp(wpa_auth, src_addr, enc, elen, auth,
4659 				       alen, no_defer);
4660 		break;
4661 	}
4662 }
4663 
4664 
wpa_ft_generate_pmk_r1(struct wpa_authenticator * wpa_auth,struct wpa_ft_pmk_r0_sa * pmk_r0,struct ft_remote_r1kh * r1kh,const u8 * s1kh_id)4665 static int wpa_ft_generate_pmk_r1(struct wpa_authenticator *wpa_auth,
4666 				  struct wpa_ft_pmk_r0_sa *pmk_r0,
4667 				  struct ft_remote_r1kh *r1kh,
4668 				  const u8 *s1kh_id)
4669 {
4670 	u8 *packet;
4671 	size_t packet_len;
4672 	struct ft_rrb_seq f_seq;
4673 	struct tlv_list push[] = {
4674 		{ .type = FT_RRB_S1KH_ID, .len = ETH_ALEN,
4675 		  .data = s1kh_id },
4676 		{ .type = FT_RRB_PMK_R0_NAME, .len = WPA_PMK_NAME_LEN,
4677 		  .data = pmk_r0->pmk_r0_name },
4678 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
4679 	};
4680 	struct tlv_list push_auth[] = {
4681 		{ .type = FT_RRB_SEQ, .len = sizeof(f_seq),
4682 		  .data = (u8 *) &f_seq },
4683 		{ .type = FT_RRB_R0KH_ID,
4684 		  .len = wpa_auth->conf.r0_key_holder_len,
4685 		  .data = wpa_auth->conf.r0_key_holder },
4686 		{ .type = FT_RRB_R1KH_ID, .len = FT_R1KH_ID_LEN,
4687 		  .data = r1kh->id },
4688 		{ .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
4689 	};
4690 
4691 	if (wpa_ft_new_seq(r1kh->seq, &f_seq) < 0) {
4692 		wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
4693 		return -1;
4694 	}
4695 
4696 	wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 push from " MACSTR
4697 		   " to remote R0KH address " MACSTR,
4698 		   MAC2STR(wpa_auth->addr), MAC2STR(r1kh->addr));
4699 
4700 	if (wpa_ft_rrb_build_r0(r1kh->key, sizeof(r1kh->key), push, pmk_r0,
4701 				r1kh->id, s1kh_id, push_auth, wpa_auth->addr,
4702 				FT_PACKET_R0KH_R1KH_PUSH,
4703 				&packet, &packet_len) < 0)
4704 		return -1;
4705 
4706 	wpa_ft_rrb_oui_send(wpa_auth, r1kh->addr, FT_PACKET_R0KH_R1KH_PUSH,
4707 			    packet, packet_len);
4708 
4709 	os_free(packet);
4710 	return 0;
4711 }
4712 
4713 
wpa_ft_push_pmk_r1(struct wpa_authenticator * wpa_auth,const u8 * addr)4714 void wpa_ft_push_pmk_r1(struct wpa_authenticator *wpa_auth, const u8 *addr)
4715 {
4716 	struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
4717 	struct wpa_ft_pmk_r0_sa *r0, *r0found = NULL;
4718 	struct ft_remote_r1kh *r1kh;
4719 
4720 	if (!wpa_auth->conf.pmk_r1_push)
4721 		return;
4722 	if (!wpa_auth->conf.r1kh_list)
4723 		return;
4724 
4725 	dl_list_for_each(r0, &cache->pmk_r0, struct wpa_ft_pmk_r0_sa, list) {
4726 		if (os_memcmp(r0->spa, addr, ETH_ALEN) == 0) {
4727 			r0found = r0;
4728 			break;
4729 		}
4730 	}
4731 
4732 	r0 = r0found;
4733 	if (r0 == NULL || r0->pmk_r1_pushed)
4734 		return;
4735 	r0->pmk_r1_pushed = 1;
4736 
4737 	wpa_printf(MSG_DEBUG, "FT: Deriving and pushing PMK-R1 keys to R1KHs "
4738 		   "for STA " MACSTR, MAC2STR(addr));
4739 
4740 	for (r1kh = *wpa_auth->conf.r1kh_list; r1kh; r1kh = r1kh->next) {
4741 		if (is_zero_ether_addr(r1kh->addr) ||
4742 		    is_zero_ether_addr(r1kh->id))
4743 			continue;
4744 		if (wpa_ft_rrb_init_r1kh_seq(r1kh) < 0)
4745 			continue;
4746 		wpa_ft_generate_pmk_r1(wpa_auth, r0, r1kh, addr);
4747 	}
4748 }
4749 
4750 #endif /* CONFIG_IEEE80211R_AP */
4751