]> git.ipfire.org Git - thirdparty/hostap.git/blame - src/ap/wpa_auth_ft.c
AP: Support Extended Key ID
[thirdparty/hostap.git] / src / ap / wpa_auth_ft.c
CommitLineData
6fc6879b
JM
1/*
2 * hostapd - IEEE 802.11r - Fast BSS Transition
c22bb5bb 3 * Copyright (c) 2004-2018, Jouni Malinen <j@w1.fi>
6fc6879b 4 *
0f3d578e
JM
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
6fc6879b
JM
7 */
8
6226e38d 9#include "utils/includes.h"
6fc6879b 10
6226e38d 11#include "utils/common.h"
692ec305 12#include "utils/eloop.h"
76967603 13#include "utils/list.h"
81f4f619
JM
14#include "common/ieee802_11_defs.h"
15#include "common/ieee802_11_common.h"
dd8df6af
MV
16#include "common/ocv.h"
17#include "drivers/driver.h"
245fc96e
MB
18#include "crypto/aes.h"
19#include "crypto/aes_siv.h"
03da66bd 20#include "crypto/aes_wrap.h"
a3e18dbb 21#include "crypto/sha384.h"
3642c431 22#include "crypto/random.h"
6226e38d 23#include "ap_config.h"
6fc6879b 24#include "ieee802_11.h"
1057d78e 25#include "wmm.h"
6226e38d 26#include "wpa_auth.h"
6fc6879b 27#include "wpa_auth_i.h"
a7b7ce82 28#include "pmksa_cache_auth.h"
6fc6879b
JM
29
30
4ec1fd8e 31#ifdef CONFIG_IEEE80211R_AP
6fc6879b 32
eefe8630
MB
33const unsigned int ftRRBseqTimeout = 10;
34const unsigned int ftRRBmaxQueueLen = 100;
35
36
692ec305
JM
37static 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);
3a46cf93
MB
41static void ft_finish_pull(struct wpa_state_machine *sm);
42static void wpa_ft_expire_pull(void *eloop_ctx, void *timeout_ctx);
eefe8630 43static void wpa_ft_rrb_seq_timeout(void *eloop_ctx, void *timeout_ctx);
692ec305 44
245fc96e
MB
45struct 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 */
69static int wpa_ft_rrb_decrypt(const u8 *key, const size_t key_len,
2ffd8076 70 const u8 *enc, size_t enc_len,
245fc96e
MB
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
555c93e2
JM
78 wpa_printf(MSG_DEBUG, "FT(RRB): src_addr=" MACSTR " type=%u",
79 MAC2STR(src_addr), type);
245fc96e 80 wpa_hexdump_key(MSG_DEBUG, "FT(RRB): decrypt using key", key, key_len);
555c93e2
JM
81 wpa_hexdump(MSG_DEBUG, "FT(RRB): encrypted TLVs", enc, enc_len);
82 wpa_hexdump(MSG_DEBUG, "FT(RRB): authenticated TLVs", auth, auth_len);
245fc96e
MB
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,
2ffd8076
JM
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 }
245fc96e
MB
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;
122err:
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 */
137static 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
174static 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
17010c38
MB
213static 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
223static 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
245fc96e
MB
305static 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
322static 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;
069b4e30
MB
346 if (tlvs[i].len == 0)
347 continue;
245fc96e
MB
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
17010c38
MB
357static 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
378static 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
245fc96e
MB
432static int wpa_ft_rrb_lin(const struct tlv_list *tlvs1,
433 const struct tlv_list *tlvs2,
17010c38 434 const struct vlan_description *vlan,
245fc96e
MB
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);
17010c38 442 tlv_len += wpa_ft_vlan_len(vlan);
245fc96e
MB
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);
17010c38 455 pos += wpa_ft_vlan_lin(vlan, pos, endpos);
245fc96e
MB
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
465err:
466 os_free(*plain);
467 *plain = NULL;
468 *plain_len = 0;
469 return -1;
470}
471
472
473static 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
555c93e2
JM
481 wpa_printf(MSG_DEBUG, "FT(RRB): src_addr=" MACSTR " type=%u",
482 MAC2STR(src_addr), type);
245fc96e
MB
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);
555c93e2 486 wpa_hexdump(MSG_DEBUG, "FT(RRB): authenticated TLVs", auth, auth_len);
245fc96e
MB
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 }
555c93e2
JM
496 wpa_hexdump(MSG_DEBUG, "FT(RRB): encrypted TLVs",
497 enc, plain_len + AES_BLOCK_SIZE);
245fc96e
MB
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 */
518static 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,
17010c38 522 const struct vlan_description *vlan,
245fc96e
MB
523 const u8 *src_addr, u8 type,
524 u8 **packet, size_t *packet_len)
525{
2ffd8076 526 u8 *plain = NULL, *auth = NULL, *pos, *tmp;
245fc96e
MB
527 size_t plain_len = 0, auth_len = 0;
528 int ret = -1;
2ffd8076 529 size_t pad_len = 0;
245fc96e 530
661afb2e 531 *packet = NULL;
17010c38 532 if (wpa_ft_rrb_lin(tlvs_enc0, tlvs_enc1, vlan, &plain, &plain_len) < 0)
245fc96e
MB
533 goto out;
534
17010c38 535 if (wpa_ft_rrb_lin(tlvs_auth, NULL, NULL, &auth, &auth_len) < 0)
245fc96e
MB
536 goto out;
537
538 *packet_len = sizeof(u16) + auth_len + plain_len;
539 if (key)
540 *packet_len += AES_BLOCK_SIZE;
2ffd8076
JM
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 }
245fc96e
MB
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;
555c93e2 575 wpa_hexdump(MSG_MSGDUMP, "FT: RRB frame payload", *packet, *packet_len);
245fc96e
MB
576
577 ret = 0;
578
579out:
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)
692ec305 625
6fc6879b
JM
626static int wpa_ft_rrb_send(struct wpa_authenticator *wpa_auth, const u8 *dst,
627 const u8 *data, size_t data_len)
628{
cef8fac0 629 if (wpa_auth->cb->send_ether == NULL)
6fc6879b 630 return -1;
67ccef7e 631 wpa_printf(MSG_DEBUG, "FT: RRB send to " MACSTR, MAC2STR(dst));
cef8fac0
JB
632 return wpa_auth->cb->send_ether(wpa_auth->cb_ctx, dst, ETH_P_RRB,
633 data, data_len);
6fc6879b
JM
634}
635
636
50bd8e0a
MB
637static 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;
555c93e2
JM
643 wpa_printf(MSG_DEBUG, "FT: RRB-OUI type %u send to " MACSTR " (len=%u)",
644 oui_suffix, MAC2STR(dst), (unsigned int) data_len);
50bd8e0a
MB
645 return wpa_auth->cb->send_oui(wpa_auth->cb_ctx, dst, oui_suffix, data,
646 data_len);
647}
648
649
6fc6879b
JM
650static int wpa_ft_action_send(struct wpa_authenticator *wpa_auth,
651 const u8 *dst, const u8 *data, size_t data_len)
652{
cef8fac0 653 if (wpa_auth->cb->send_ft_action == NULL)
6fc6879b 654 return -1;
cef8fac0
JB
655 return wpa_auth->cb->send_ft_action(wpa_auth->cb_ctx, dst,
656 data, data_len);
6fc6879b
JM
657}
658
659
96590564
MB
660static 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{
cef8fac0 664 if (wpa_auth->cb->get_psk == NULL)
96590564 665 return NULL;
cef8fac0 666 return wpa_auth->cb->get_psk(wpa_auth->cb_ctx, addr, p2p_dev_addr,
dbfa691d 667 prev_psk, NULL, NULL);
96590564
MB
668}
669
670
6fc6879b
JM
671static struct wpa_state_machine *
672wpa_ft_add_sta(struct wpa_authenticator *wpa_auth, const u8 *sta_addr)
673{
cef8fac0 674 if (wpa_auth->cb->add_sta == NULL)
6fc6879b 675 return NULL;
cef8fac0 676 return wpa_auth->cb->add_sta(wpa_auth->cb_ctx, sta_addr);
6fc6879b
JM
677}
678
679
17010c38
MB
680static 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
689static 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
069b4e30
MB
698static int
699wpa_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
709static size_t
710wpa_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
720static int
721wpa_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
731static size_t
732wpa_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
a6509e85
MB
742static void
743wpa_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
753static int
754wpa_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
88b32a99
SP
763static int wpa_ft_add_tspec(struct wpa_authenticator *wpa_auth,
764 const u8 *sta_addr,
765 u8 *tspec_ie, size_t tspec_ielen)
766{
cef8fac0 767 if (wpa_auth->cb->add_tspec == NULL) {
006309b5 768 wpa_printf(MSG_DEBUG, "FT: add_tspec is not initialized");
88b32a99
SP
769 return -1;
770 }
cef8fac0
JB
771 return wpa_auth->cb->add_tspec(wpa_auth->cb_ctx, sta_addr, tspec_ie,
772 tspec_ielen);
88b32a99
SP
773}
774
775
dd8df6af
MV
776#ifdef CONFIG_OCV
777static 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
6fc6879b
JM
787int 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;
d7956add
SP
798 capab = 0;
799 if (conf->ft_over_ds)
800 capab |= RSN_FT_CAPAB_FT_OVER_DS;
6fc6879b
JM
801 *pos++ = capab;
802
803 return pos - buf;
804}
805
806
a7968ea5
JM
807int wpa_write_ftie(struct wpa_auth_config *conf, int use_sha384,
808 const u8 *r0kh_id, size_t r0kh_id_len,
86dfabb8
JM
809 const u8 *anonce, const u8 *snonce,
810 u8 *buf, size_t len, const u8 *subelem,
51d1924b 811 size_t subelem_len, int rsnxe_used)
6fc6879b
JM
812{
813 u8 *pos = buf, *ielen;
a7968ea5
JM
814 size_t hdrlen = use_sha384 ? sizeof(struct rsn_ftie_sha384) :
815 sizeof(struct rsn_ftie);
6fc6879b 816
a7968ea5 817 if (len < 2 + hdrlen + 2 + FT_R1KH_ID_LEN + 2 + r0kh_id_len +
6fc6879b
JM
818 subelem_len)
819 return -1;
820
821 *pos++ = WLAN_EID_FAST_BSS_TRANSITION;
822 ielen = pos++;
823
a7968ea5
JM
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);
51d1924b 829 WPA_PUT_LE16(hdr->mic_control, !!rsnxe_used);
a7968ea5
JM
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);
51d1924b 839 WPA_PUT_LE16(hdr->mic_control, !!rsnxe_used);
a7968ea5
JM
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 }
6fc6879b
JM
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
eefe8630
MB
870/* A packet to be handled after seq response */
871struct 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
890static 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
900static 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
915static 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
923static int
924wpa_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
a422d9b4
JM
954 wpa_printf(MSG_DEBUG, "FT: Send sequence number request from " MACSTR
955 " to " MACSTR,
956 MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
eefe8630
MB
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
17010c38 991 if (wpa_ft_rrb_build(key, key_len, NULL, NULL, seq_req_auth, NULL,
eefe8630
MB
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;
1006err:
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
1022static int
1023wpa_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
1076defer:
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;
1084out:
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
1092static void
1093wpa_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;
1127out:
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
1134static 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
6fc6879b 1168struct wpa_ft_pmk_r0_sa {
09211c98 1169 struct dl_list list;
a3e18dbb
JM
1170 u8 pmk_r0[PMK_LEN_MAX];
1171 size_t pmk_r0_len;
6fc6879b
JM
1172 u8 pmk_r0_name[WPA_PMK_NAME_LEN];
1173 u8 spa[ETH_ALEN];
1b484d60 1174 int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */
17010c38 1175 struct vlan_description *vlan;
3a3e2832 1176 os_time_t expiration; /* 0 for no expiration */
069b4e30
MB
1177 u8 *identity;
1178 size_t identity_len;
1179 u8 *radius_cui;
1180 size_t radius_cui_len;
a6509e85
MB
1181 os_time_t session_timeout; /* 0 for no expiration */
1182 /* TODO: radius_class, EAP type */
6fc6879b
JM
1183 int pmk_r1_pushed;
1184};
1185
1186struct wpa_ft_pmk_r1_sa {
09211c98 1187 struct dl_list list;
a3e18dbb
JM
1188 u8 pmk_r1[PMK_LEN_MAX];
1189 size_t pmk_r1_len;
6fc6879b
JM
1190 u8 pmk_r1_name[WPA_PMK_NAME_LEN];
1191 u8 spa[ETH_ALEN];
1b484d60 1192 int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */
17010c38 1193 struct vlan_description *vlan;
069b4e30
MB
1194 u8 *identity;
1195 size_t identity_len;
1196 u8 *radius_cui;
1197 size_t radius_cui_len;
a6509e85
MB
1198 os_time_t session_timeout; /* 0 for no expiration */
1199 /* TODO: radius_class, EAP type */
6fc6879b
JM
1200};
1201
1202struct wpa_ft_pmk_cache {
09211c98
MB
1203 struct dl_list pmk_r0; /* struct wpa_ft_pmk_r0_sa */
1204 struct dl_list pmk_r1; /* struct wpa_ft_pmk_r1_sa */
6fc6879b
JM
1205};
1206
09211c98 1207
3a3e2832
MB
1208static void wpa_ft_expire_pmk_r0(void *eloop_ctx, void *timeout_ctx);
1209static void wpa_ft_expire_pmk_r1(void *eloop_ctx, void *timeout_ctx);
1210
1211
09211c98
MB
1212static 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);
3a3e2832 1218 eloop_cancel_timeout(wpa_ft_expire_pmk_r0, r0, NULL);
09211c98 1219
a3e18dbb 1220 os_memset(r0->pmk_r0, 0, PMK_LEN_MAX);
17010c38 1221 os_free(r0->vlan);
069b4e30
MB
1222 os_free(r0->identity);
1223 os_free(r0->radius_cui);
09211c98
MB
1224 os_free(r0);
1225}
1226
1227
3a3e2832
MB
1228static 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;
a6509e85 1233 int session_timeout;
3a3e2832
MB
1234
1235 os_get_reltime(&now);
1236
1237 if (!r0)
1238 return;
1239
1240 expires_in = r0->expiration - now.sec;
a6509e85
MB
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)) {
3a3e2832 1249 wpa_printf(MSG_ERROR,
a6509e85
MB
1250 "FT: %s() called for non-expired entry %p",
1251 __func__, r0);
3a3e2832 1252 eloop_cancel_timeout(wpa_ft_expire_pmk_r0, r0, NULL);
a6509e85
MB
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);
3a3e2832
MB
1259 return;
1260 }
1261
1262 wpa_ft_free_pmk_r0(r0);
1263}
1264
1265
09211c98
MB
1266static 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);
3a3e2832 1272 eloop_cancel_timeout(wpa_ft_expire_pmk_r1, r1, NULL);
09211c98 1273
a3e18dbb 1274 os_memset(r1->pmk_r1, 0, PMK_LEN_MAX);
17010c38 1275 os_free(r1->vlan);
069b4e30
MB
1276 os_free(r1->identity);
1277 os_free(r1->radius_cui);
09211c98
MB
1278 os_free(r1);
1279}
1280
1281
3a3e2832
MB
1282static 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
6fc6879b
JM
1290struct 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));
09211c98
MB
1295 if (cache) {
1296 dl_list_init(&cache->pmk_r0);
1297 dl_list_init(&cache->pmk_r1);
1298 }
6fc6879b
JM
1299
1300 return cache;
1301}
1302
1303
1304void 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
09211c98
MB
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);
6fc6879b 1312
09211c98
MB
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);
6fc6879b
JM
1316
1317 os_free(cache);
1318}
1319
1320
89dea17e
MB
1321static int wpa_ft_store_pmk_r0(struct wpa_authenticator *wpa_auth,
1322 const u8 *spa, const u8 *pmk_r0,
a3e18dbb 1323 size_t pmk_r0_len,
3a3e2832 1324 const u8 *pmk_r0_name, int pairwise,
17010c38 1325 const struct vlan_description *vlan,
a6509e85 1326 int expires_in, int session_timeout,
069b4e30
MB
1327 const u8 *identity, size_t identity_len,
1328 const u8 *radius_cui, size_t radius_cui_len)
6fc6879b
JM
1329{
1330 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1331 struct wpa_ft_pmk_r0_sa *r0;
3a3e2832 1332 struct os_reltime now;
6fc6879b 1333
3a3e2832
MB
1334 /* TODO: add limit on number of entries in cache */
1335 os_get_reltime(&now);
6fc6879b
JM
1336
1337 r0 = os_zalloc(sizeof(*r0));
1338 if (r0 == NULL)
1339 return -1;
1340
a3e18dbb
JM
1341 os_memcpy(r0->pmk_r0, pmk_r0, pmk_r0_len);
1342 r0->pmk_r0_len = pmk_r0_len;
6fc6879b
JM
1343 os_memcpy(r0->pmk_r0_name, pmk_r0_name, WPA_PMK_NAME_LEN);
1344 os_memcpy(r0->spa, spa, ETH_ALEN);
1b484d60 1345 r0->pairwise = pairwise;
3a3e2832
MB
1346 if (expires_in > 0)
1347 r0->expiration = now.sec + expires_in;
17010c38
MB
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 }
069b4e30
MB
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 }
a6509e85
MB
1370 if (session_timeout > 0)
1371 r0->session_timeout = now.sec + session_timeout;
6fc6879b 1372
09211c98 1373 dl_list_add(&cache->pmk_r0, &r0->list);
3a3e2832
MB
1374 if (expires_in > 0)
1375 eloop_register_timeout(expires_in + 1, 0, wpa_ft_expire_pmk_r0,
1376 r0, NULL);
a6509e85
MB
1377 if (session_timeout > 0)
1378 eloop_register_timeout(session_timeout + 1, 0,
1379 wpa_ft_expire_pmk_r0, r0, NULL);
6fc6879b
JM
1380
1381 return 0;
1382}
1383
1384
1385static int wpa_ft_fetch_pmk_r0(struct wpa_authenticator *wpa_auth,
1386 const u8 *spa, const u8 *pmk_r0_name,
245fc96e 1387 const struct wpa_ft_pmk_r0_sa **r0_out)
6fc6879b
JM
1388{
1389 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1390 struct wpa_ft_pmk_r0_sa *r0;
3a3e2832 1391 struct os_reltime now;
6fc6879b 1392
3a3e2832 1393 os_get_reltime(&now);
09211c98 1394 dl_list_for_each(r0, &cache->pmk_r0, struct wpa_ft_pmk_r0_sa, list) {
6fc6879b 1395 if (os_memcmp(r0->spa, spa, ETH_ALEN) == 0 &&
870834a1
JM
1396 os_memcmp_const(r0->pmk_r0_name, pmk_r0_name,
1397 WPA_PMK_NAME_LEN) == 0) {
245fc96e 1398 *r0_out = r0;
6fc6879b
JM
1399 return 0;
1400 }
6fc6879b
JM
1401 }
1402
245fc96e 1403 *r0_out = NULL;
6fc6879b
JM
1404 return -1;
1405}
1406
1407
1408static int wpa_ft_store_pmk_r1(struct wpa_authenticator *wpa_auth,
1409 const u8 *spa, const u8 *pmk_r1,
a3e18dbb 1410 size_t pmk_r1_len,
3a3e2832 1411 const u8 *pmk_r1_name, int pairwise,
17010c38 1412 const struct vlan_description *vlan,
a6509e85 1413 int expires_in, int session_timeout,
069b4e30
MB
1414 const u8 *identity, size_t identity_len,
1415 const u8 *radius_cui, size_t radius_cui_len)
6fc6879b
JM
1416{
1417 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
3a3e2832 1418 int max_expires_in = wpa_auth->conf.r1_max_key_lifetime;
6fc6879b 1419 struct wpa_ft_pmk_r1_sa *r1;
a6509e85 1420 struct os_reltime now;
6fc6879b 1421
3a3e2832 1422 /* TODO: limit on number of entries in cache */
a6509e85 1423 os_get_reltime(&now);
3a3e2832
MB
1424
1425 if (max_expires_in && (max_expires_in < expires_in || expires_in == 0))
1426 expires_in = max_expires_in;
6fc6879b
JM
1427
1428 r1 = os_zalloc(sizeof(*r1));
1429 if (r1 == NULL)
1430 return -1;
1431
a3e18dbb
JM
1432 os_memcpy(r1->pmk_r1, pmk_r1, pmk_r1_len);
1433 r1->pmk_r1_len = pmk_r1_len;
6fc6879b
JM
1434 os_memcpy(r1->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN);
1435 os_memcpy(r1->spa, spa, ETH_ALEN);
1b484d60 1436 r1->pairwise = pairwise;
17010c38
MB
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 }
069b4e30
MB
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 }
a6509e85
MB
1459 if (session_timeout > 0)
1460 r1->session_timeout = now.sec + session_timeout;
6fc6879b 1461
09211c98 1462 dl_list_add(&cache->pmk_r1, &r1->list);
6fc6879b 1463
3a3e2832
MB
1464 if (expires_in > 0)
1465 eloop_register_timeout(expires_in + 1, 0, wpa_ft_expire_pmk_r1,
1466 r1, NULL);
a6509e85
MB
1467 if (session_timeout > 0)
1468 eloop_register_timeout(session_timeout + 1, 0,
1469 wpa_ft_expire_pmk_r1, r1, NULL);
3a3e2832 1470
6fc6879b
JM
1471 return 0;
1472}
1473
1474
1475static int wpa_ft_fetch_pmk_r1(struct wpa_authenticator *wpa_auth,
1476 const u8 *spa, const u8 *pmk_r1_name,
a3e18dbb 1477 u8 *pmk_r1, size_t *pmk_r1_len, int *pairwise,
069b4e30
MB
1478 struct vlan_description *vlan,
1479 const u8 **identity, size_t *identity_len,
a6509e85
MB
1480 const u8 **radius_cui, size_t *radius_cui_len,
1481 int *session_timeout)
6fc6879b
JM
1482{
1483 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
1484 struct wpa_ft_pmk_r1_sa *r1;
a6509e85
MB
1485 struct os_reltime now;
1486
1487 os_get_reltime(&now);
6fc6879b 1488
09211c98 1489 dl_list_for_each(r1, &cache->pmk_r1, struct wpa_ft_pmk_r1_sa, list) {
6fc6879b 1490 if (os_memcmp(r1->spa, spa, ETH_ALEN) == 0 &&
870834a1
JM
1491 os_memcmp_const(r1->pmk_r1_name, pmk_r1_name,
1492 WPA_PMK_NAME_LEN) == 0) {
a3e18dbb
JM
1493 os_memcpy(pmk_r1, r1->pmk_r1, r1->pmk_r1_len);
1494 *pmk_r1_len = r1->pmk_r1_len;
1b484d60
JM
1495 if (pairwise)
1496 *pairwise = r1->pairwise;
17010c38
MB
1497 if (vlan && r1->vlan)
1498 *vlan = *r1->vlan;
1499 if (vlan && !r1->vlan)
1500 os_memset(vlan, 0, sizeof(*vlan));
069b4e30
MB
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 }
a6509e85
MB
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;
ff501011 1514 else if (session_timeout)
a6509e85 1515 *session_timeout = 0;
6fc6879b
JM
1516 return 0;
1517 }
6fc6879b
JM
1518 }
1519
1520 return -1;
1521}
1522
1523
eefe8630
MB
1524static 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
245fc96e 1541static void wpa_ft_rrb_lookup_r0kh(struct wpa_authenticator *wpa_auth,
eefe8630 1542 const u8 *f_r0kh_id, size_t f_r0kh_id_len,
3a46cf93
MB
1543 struct ft_remote_r0kh **r0kh_out,
1544 struct ft_remote_r0kh **r0kh_wildcard)
245fc96e
MB
1545{
1546 struct ft_remote_r0kh *r0kh;
1547
3a46cf93 1548 *r0kh_wildcard = NULL;
eefe8630
MB
1549 *r0kh_out = NULL;
1550
3a46cf93
MB
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;
eefe8630 1558 if (f_r0kh_id && r0kh->id_len == f_r0kh_id_len &&
3a46cf93 1559 os_memcmp_const(f_r0kh_id, r0kh->id, f_r0kh_id_len) == 0)
eefe8630 1560 *r0kh_out = r0kh;
245fc96e
MB
1561 }
1562
3a46cf93 1563 if (!*r0kh_out && !*r0kh_wildcard)
245fc96e
MB
1564 wpa_printf(MSG_DEBUG, "FT: No matching R0KH found");
1565
eefe8630
MB
1566 if (*r0kh_out && wpa_ft_rrb_init_r0kh_seq(*r0kh_out) < 0)
1567 *r0kh_out = NULL;
1568}
1569
1570
1571static 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;
245fc96e
MB
1585}
1586
1587
1588static void wpa_ft_rrb_lookup_r1kh(struct wpa_authenticator *wpa_auth,
eefe8630 1589 const u8 *f_r1kh_id,
3a46cf93
MB
1590 struct ft_remote_r1kh **r1kh_out,
1591 struct ft_remote_r1kh **r1kh_wildcard)
245fc96e
MB
1592{
1593 struct ft_remote_r1kh *r1kh;
1594
3a46cf93 1595 *r1kh_wildcard = NULL;
eefe8630
MB
1596 *r1kh_out = NULL;
1597
3a46cf93
MB
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;
245fc96e 1606 if (f_r1kh_id &&
3a46cf93 1607 os_memcmp_const(r1kh->id, f_r1kh_id, FT_R1KH_ID_LEN) == 0)
eefe8630 1608 *r1kh_out = r1kh;
245fc96e
MB
1609 }
1610
3a46cf93 1611 if (!*r1kh_out && !*r1kh_wildcard)
245fc96e
MB
1612 wpa_printf(MSG_DEBUG, "FT: No matching R1KH found");
1613
eefe8630
MB
1614 if (*r1kh_out && wpa_ft_rrb_init_r1kh_seq(*r1kh_out) < 0)
1615 *r1kh_out = NULL;
245fc96e
MB
1616}
1617
1618
1619static 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
1631static 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
3a46cf93
MB
1642static 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
1668static 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
1677static 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
1688static struct ft_remote_r0kh *
1689wpa_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
1727static 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
1753static 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
1762static struct ft_remote_r1kh *
1763wpa_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
1793void wpa_ft_sta_deinit(struct wpa_state_machine *sm)
1794{
1795 eloop_cancel_timeout(wpa_ft_expire_pull, sm, NULL);
1796}
1797
1798
eefe8630
MB
1799static 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
3a46cf93
MB
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) {
eefe8630
MB
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
3a46cf93
MB
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) {
eefe8630
MB
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
3a46cf93
MB
1832static 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
eefe8630
MB
1877void wpa_ft_deinit(struct wpa_authenticator *wpa_auth)
1878{
1879 wpa_ft_deinit_seq(wpa_auth);
3a46cf93
MB
1880 wpa_ft_deinit_rkh_tmp(wpa_auth);
1881}
1882
1883
1884static 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
1914static 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);
eefe8630
MB
1926}
1927
1928
692ec305
JM
1929static 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)
6fc6879b 1932{
3a46cf93 1933 struct ft_remote_r0kh *r0kh, *r0kh_wildcard;
245fc96e 1934 u8 *packet = NULL;
eefe8630 1935 const u8 *key, *f_r1kh_id = sm->wpa_auth->conf.r1_key_holder;
245fc96e 1936 size_t packet_len, key_len;
eefe8630 1937 struct ft_rrb_seq f_seq;
3a46cf93
MB
1938 int tsecs, tusecs, first;
1939 struct wpabuf *ft_pending_req_ies;
1940 int r0kh_timeout;
245fc96e
MB
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 },
eefe8630
MB
1951 { .type = FT_RRB_SEQ, .len = sizeof(f_seq),
1952 .data = (u8 *) &f_seq },
245fc96e
MB
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,
eefe8630 1956 .data = f_r1kh_id },
245fc96e
MB
1957 { .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
1958 };
1959
3a46cf93
MB
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
eefe8630 1966 wpa_ft_rrb_lookup_r0kh(sm->wpa_auth, sm->r0kh_id, sm->r0kh_id_len,
3a46cf93
MB
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 }
692ec305
JM
1982 if (r0kh == NULL) {
1983 wpa_hexdump(MSG_DEBUG, "FT: Did not find R0KH-ID",
1984 sm->r0kh_id, sm->r0kh_id_len);
6fc6879b 1985 return -1;
692ec305 1986 }
3a46cf93
MB
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 }
1dc0945c
JM
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 }
eefe8630 1997
245fc96e
MB
1998 key = r0kh->key;
1999 key_len = sizeof(r0kh->key);
6fc6879b 2000
eefe8630
MB
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
a422d9b4
JM
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
3a46cf93
MB
2013 if (first &&
2014 random_get_bytes(sm->ft_pending_pull_nonce, FT_RRB_NONCE_LEN) < 0) {
6fc6879b
JM
2015 wpa_printf(MSG_DEBUG, "FT: Failed to get random data for "
2016 "nonce");
2017 return -1;
2018 }
6fc6879b 2019
eefe8630
MB
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
17010c38 2025 if (wpa_ft_rrb_build(key, key_len, req_enc, NULL, req_auth, NULL,
245fc96e
MB
2026 sm->wpa_auth->addr, FT_PACKET_R0KH_R1KH_PULL,
2027 &packet, &packet_len) < 0)
6fc6879b
JM
2028 return -1;
2029
3a46cf93 2030 ft_pending_req_ies = wpabuf_alloc_copy(ies, ies_len);
692ec305 2031 wpabuf_free(sm->ft_pending_req_ies);
3a46cf93 2032 sm->ft_pending_req_ies = ft_pending_req_ies;
245fc96e
MB
2033 if (!sm->ft_pending_req_ies) {
2034 os_free(packet);
692ec305 2035 return -1;
245fc96e 2036 }
692ec305 2037
3a46cf93
MB
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
50bd8e0a 2042 wpa_ft_rrb_oui_send(sm->wpa_auth, r0kh->addr, FT_PACKET_R0KH_R1KH_PULL,
245fc96e
MB
2043 packet, packet_len);
2044
2045 os_free(packet);
6fc6879b
JM
2046
2047 return 0;
2048}
2049
2050
89dea17e
MB
2051int wpa_ft_store_pmk_fils(struct wpa_state_machine *sm,
2052 const u8 *pmk_r0, const u8 *pmk_r0_name)
2053{
3a3e2832 2054 int expires_in = sm->wpa_auth->conf.r0_key_lifetime;
17010c38 2055 struct vlan_description vlan;
069b4e30
MB
2056 const u8 *identity, *radius_cui;
2057 size_t identity_len, radius_cui_len;
a6509e85 2058 int session_timeout;
994eac7e
JM
2059 size_t pmk_r0_len = wpa_key_mgmt_sha384(sm->wpa_key_mgmt) ?
2060 SHA384_MAC_LEN : PMK_LEN;
17010c38
MB
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 }
3a3e2832 2067
069b4e30
MB
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);
a6509e85 2071 session_timeout = wpa_ft_get_session_timeout(sm->wpa_auth, sm->addr);
069b4e30 2072
a3e18dbb
JM
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,
a6509e85
MB
2075 session_timeout, identity, identity_len,
2076 radius_cui, radius_cui_len);
89dea17e
MB
2077}
2078
2079
267c366f 2080int wpa_auth_derive_ptk_ft(struct wpa_state_machine *sm, struct wpa_ptk *ptk)
6fc6879b 2081{
a3e18dbb 2082 u8 pmk_r0[PMK_LEN_MAX], pmk_r0_name[WPA_PMK_NAME_LEN];
994eac7e
JM
2083 size_t pmk_r0_len = wpa_key_mgmt_sha384(sm->wpa_key_mgmt) ?
2084 SHA384_MAC_LEN : PMK_LEN;
a3e18dbb
JM
2085 size_t pmk_r1_len = pmk_r0_len;
2086 u8 pmk_r1[PMK_LEN_MAX];
6fc6879b
JM
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;
96590564 2094 int psk_local = sm->wpa_auth->conf.ft_psk_generate_local;
3a3e2832 2095 int expires_in = sm->wpa_auth->conf.r0_key_lifetime;
17010c38 2096 struct vlan_description vlan;
069b4e30
MB
2097 const u8 *identity, *radius_cui;
2098 size_t identity_len, radius_cui_len;
a6509e85 2099 int session_timeout;
a7b7ce82
JM
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 {
6fc6879b
JM
2110 wpa_printf(MSG_DEBUG, "FT: XXKey not available for key "
2111 "derivation");
2112 return -1;
2113 }
2114
17010c38
MB
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
069b4e30
MB
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);
a6509e85 2124 session_timeout = wpa_ft_get_session_timeout(sm->wpa_auth, sm->addr);
069b4e30 2125
a7b7ce82 2126 if (wpa_derive_pmk_r0(mpmk, mpmk_len, ssid, ssid_len, mdid,
364c064a 2127 r0kh, r0kh_len, sm->addr,
994eac7e
JM
2128 pmk_r0, pmk_r0_name,
2129 wpa_key_mgmt_sha384(sm->wpa_key_mgmt)) < 0)
364c064a 2130 return -1;
a3e18dbb 2131 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R0", pmk_r0, pmk_r0_len);
6fc6879b 2132 wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name", pmk_r0_name, WPA_PMK_NAME_LEN);
96590564 2133 if (!psk_local || !wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt))
a3e18dbb
JM
2134 wpa_ft_store_pmk_r0(sm->wpa_auth, sm->addr, pmk_r0, pmk_r0_len,
2135 pmk_r0_name,
a6509e85
MB
2136 sm->pairwise, &vlan, expires_in,
2137 session_timeout, identity, identity_len,
2138 radius_cui, radius_cui_len);
6fc6879b 2139
a3e18dbb 2140 if (wpa_derive_pmk_r1(pmk_r0, pmk_r0_len, pmk_r0_name, r1kh, sm->addr,
364c064a
JM
2141 pmk_r1, sm->pmk_r1_name) < 0)
2142 return -1;
a3e18dbb 2143 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", pmk_r1, pmk_r1_len);
26e23750
JM
2144 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", sm->pmk_r1_name,
2145 WPA_PMK_NAME_LEN);
96590564 2146 if (!psk_local || !wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt))
a3e18dbb 2147 wpa_ft_store_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1, pmk_r1_len,
17010c38 2148 sm->pmk_r1_name, sm->pairwise, &vlan,
a6509e85
MB
2149 expires_in, session_timeout, identity,
2150 identity_len, radius_cui, radius_cui_len);
6fc6879b 2151
a3e18dbb
JM
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,
98cd3d1c 2154 ptk, ptk_name, sm->wpa_key_mgmt, sm->pairwise);
6fc6879b
JM
2155}
2156
2157
2158static inline int wpa_auth_get_seqnum(struct wpa_authenticator *wpa_auth,
2159 const u8 *addr, int idx, u8 *seq)
2160{
cef8fac0 2161 if (wpa_auth->cb->get_seqnum == NULL)
6fc6879b 2162 return -1;
cef8fac0 2163 return wpa_auth->cb->get_seqnum(wpa_auth->cb_ctx, addr, idx, seq);
6fc6879b
JM
2164}
2165
2166
2167static 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];
657b4c45
JM
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 }
6fc6879b
JM
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;
5bfc46bb 2199 if (pad_len && key_len < sizeof(keybuf)) {
6fc6879b
JM
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 /*
39eb4d08 2209 * Sub-elem ID[1] | Length[1] | Key Info[2] | Key Length[1] | RSC[8] |
6fc6879b
JM
2210 * Key[5..32].
2211 */
39eb4d08 2212 subelem_len = 13 + key_len + 8;
6fc6879b
JM
2213 subelem = os_zalloc(subelem_len);
2214 if (subelem == NULL)
2215 return NULL;
2216
2217 subelem[0] = FTIE_SUBELEM_GTK;
39eb4d08
JM
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);
657b4c45
JM
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);
6fc6879b
JM
2227 os_free(subelem);
2228 return NULL;
2229 }
2230
31bc66e4 2231 forced_memzero(keybuf, sizeof(keybuf));
6fc6879b
JM
2232 *len = subelem_len;
2233 return subelem;
2234}
2235
2236
b27f13ed
JM
2237static 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;
657b4c45
JM
2242 const u8 *kek;
2243 size_t kek_len;
ff168f8c 2244 size_t igtk_len;
657b4c45
JM
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 }
b27f13ed 2253
ff168f8c
JM
2254 igtk_len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
2255
ff89afb7
JM
2256 /* Sub-elem ID[1] | Length[1] | KeyID[2] | IPN[6] | Key Length[1] |
2257 * Key[16+8] */
ff168f8c 2258 subelem_len = 1 + 1 + 2 + 6 + 1 + igtk_len + 8;
b27f13ed
JM
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;
9008a3e4 2268 wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_igtk, pos);
b27f13ed 2269 pos += 6;
ff168f8c
JM
2270 *pos++ = igtk_len;
2271 if (aes_wrap(kek, kek_len, igtk_len / 8,
b27f13ed 2272 gsm->IGTK[gsm->GN_igtk - 4], pos)) {
657b4c45
JM
2273 wpa_printf(MSG_DEBUG,
2274 "FT: IGTK subelem encryption failed: kek_len=%d",
2275 (int) kek_len);
b27f13ed
JM
2276 os_free(subelem);
2277 return NULL;
2278 }
2279
2280 *len = subelem_len;
2281 return subelem;
2282}
b27f13ed
JM
2283
2284
16889aff
JM
2285static 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
88b32a99
SP
2333static u8 * wpa_ft_process_rdie(struct wpa_state_machine *sm,
2334 u8 *pos, u8 *end, u8 id, u8 descr_count,
f238cf9f
JM
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
25310368 2366 if (parse.wmm_tspec) {
f238cf9f 2367 struct wmm_tspec_element *tspec;
f238cf9f
JM
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));
25310368
JM
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);
f238cf9f
JM
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;
25310368 2402 pos += sizeof(struct wmm_tspec_element);
f238cf9f
JM
2403 }
2404 return pos;
2405 }
fe6bdb77 2406#endif /* NEED_AP_MLME */
f238cf9f 2407
88b32a99 2408 if (parse.wmm_tspec && !sm->wpa_auth->conf.ap_mlme) {
88b32a99
SP
2409 int res;
2410
88b32a99 2411 res = wpa_ft_add_tspec(sm->wpa_auth, sm->addr, pos,
25310368 2412 sizeof(struct wmm_tspec_element));
88b32a99
SP
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 */
006309b5 2419 rdie->descr_count = 1;
25310368 2420 pos += sizeof(struct wmm_tspec_element);
88b32a99
SP
2421 }
2422 return pos;
2423 }
2424 }
2425
f238cf9f
JM
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
88b32a99
SP
2432static u8 * wpa_ft_process_ric(struct wpa_state_machine *sm, u8 *pos, u8 *end,
2433 const u8 *ric, size_t ric_len)
f238cf9f
JM
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 }
88b32a99 2455 pos = wpa_ft_process_rdie(sm, pos, end, rdie->id,
f238cf9f
JM
2456 rdie->descr_count,
2457 start, rpos - start);
2458 }
2459
2460 return pos;
2461}
2462
2463
6fc6879b 2464u8 * wpa_sm_write_assoc_resp_ies(struct wpa_state_machine *sm, u8 *pos,
f238cf9f 2465 size_t max_len, int auth_alg,
b7366a94
JM
2466 const u8 *req_ies, size_t req_ies_len,
2467 int omit_rsnxe)
6fc6879b 2468{
738a1cb2 2469 u8 *end, *mdie, *ftie, *rsnie = NULL, *r0kh_id, *subelem = NULL;
a7968ea5 2470 u8 *fte_mic, *elem_count;
738a1cb2 2471 size_t mdie_len, ftie_len, rsnie_len = 0, r0kh_id_len, subelem_len = 0;
46e147fc 2472 u8 rsnxe_buf[10], *rsnxe = rsnxe_buf;
f73dd0a6 2473 size_t rsnxe_len;
51d1924b 2474 int rsnxe_used;
6fc6879b
JM
2475 int res;
2476 struct wpa_auth_config *conf;
f238cf9f
JM
2477 struct wpa_ft_ies parse;
2478 u8 *ric_start;
6e80516a 2479 u8 *anonce, *snonce;
2f373878
JM
2480 const u8 *kck;
2481 size_t kck_len;
9a33737a 2482 int use_sha384;
6fc6879b
JM
2483
2484 if (sm == NULL)
2485 return pos;
2486
9a33737a 2487 use_sha384 = wpa_key_mgmt_sha384(sm->wpa_key_mgmt);
6fc6879b
JM
2488 conf = &sm->wpa_auth->conf;
2489
aa189ac9 2490 if (!wpa_key_mgmt_ft(sm->wpa_key_mgmt))
6fc6879b
JM
2491 return pos;
2492
2493 end = pos + max_len;
2494
46e147fc
JM
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 */
36536639
JM
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);
738a1cb2
JM
2534 /*
2535 * RSN (only present if this is a Reassociation Response and
36536639
JM
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)
738a1cb2
JM
2539 */
2540 res = wpa_write_rsn_ie(conf, pos, end - pos, sm->pmk_r1_name);
2541 if (res < 0)
2cf36d60 2542 return NULL;
738a1cb2
JM
2543 rsnie = pos;
2544 rsnie_len = res;
2545 pos += res;
2546 }
6fc6879b
JM
2547
2548 /* Mobility Domain Information */
2549 res = wpa_write_mdie(conf, pos, end - pos);
2550 if (res < 0)
2cf36d60 2551 return NULL;
6fc6879b
JM
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);
657b4c45
JM
2559 if (!subelem) {
2560 wpa_printf(MSG_DEBUG,
2561 "FT: Failed to add GTK subelement");
2cf36d60 2562 return NULL;
657b4c45 2563 }
6fc6879b
JM
2564 r0kh_id = sm->r0kh_id;
2565 r0kh_id_len = sm->r0kh_id_len;
6e80516a
JM
2566 anonce = sm->ANonce;
2567 snonce = sm->SNonce;
b27f13ed
JM
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) {
657b4c45
JM
2574 wpa_printf(MSG_DEBUG,
2575 "FT: Failed to add IGTK subelement");
b27f13ed 2576 os_free(subelem);
2cf36d60 2577 return NULL;
b27f13ed
JM
2578 }
2579 nbuf = os_realloc(subelem, subelem_len + igtk_len);
2580 if (nbuf == NULL) {
2581 os_free(subelem);
2582 os_free(igtk);
2cf36d60 2583 return NULL;
b27f13ed
JM
2584 }
2585 subelem = nbuf;
2586 os_memcpy(subelem + subelem_len, igtk, igtk_len);
2587 subelem_len += igtk_len;
2588 os_free(igtk);
2589 }
16889aff
JM
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 }
dd8df6af
MV
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 */
6fc6879b
JM
2642 } else {
2643 r0kh_id = conf->r0_key_holder;
2644 r0kh_id_len = conf->r0_key_holder_len;
6e80516a
JM
2645 anonce = NULL;
2646 snonce = NULL;
6fc6879b 2647 }
51d1924b
JM
2648 rsnxe_used = (auth_alg == WLAN_AUTH_FT) &&
2649 (conf->sae_pwe == 1 || conf->sae_pwe == 2);
a7968ea5
JM
2650 res = wpa_write_ftie(conf, use_sha384, r0kh_id, r0kh_id_len,
2651 anonce, snonce, pos, end - pos,
51d1924b 2652 subelem, subelem_len, rsnxe_used);
6fc6879b
JM
2653 os_free(subelem);
2654 if (res < 0)
2cf36d60 2655 return NULL;
6fc6879b
JM
2656 ftie = pos;
2657 ftie_len = res;
2658 pos += res;
2659
a7968ea5
JM
2660 if (use_sha384) {
2661 struct rsn_ftie_sha384 *_ftie =
2662 (struct rsn_ftie_sha384 *) (ftie + 2);
2663
2664 fte_mic = _ftie->mic;
2665 elem_count = &_ftie->mic_control[1];
2666 } else {
2667 struct rsn_ftie *_ftie = (struct rsn_ftie *) (ftie + 2);
2668
2669 fte_mic = _ftie->mic;
2670 elem_count = &_ftie->mic_control[1];
2671 }
1f6e69e0 2672 if (auth_alg == WLAN_AUTH_FT)
a7968ea5 2673 *elem_count = 3; /* Information element count */
f238cf9f
JM
2674
2675 ric_start = pos;
9a33737a
JM
2676 if (wpa_ft_parse_ies(req_ies, req_ies_len, &parse, use_sha384) == 0
2677 && parse.ric) {
88b32a99
SP
2678 pos = wpa_ft_process_ric(sm, pos, end, parse.ric,
2679 parse.ric_len);
1f6e69e0 2680 if (auth_alg == WLAN_AUTH_FT)
a7968ea5 2681 *elem_count +=
1f6e69e0
JM
2682 ieee802_11_ie_count(ric_start,
2683 pos - ric_start);
f238cf9f
JM
2684 }
2685 if (ric_start == pos)
2686 ric_start = NULL;
2687
b7366a94
JM
2688 if (omit_rsnxe) {
2689 rsnxe_len = 0;
2690 } else {
2691 res = wpa_write_rsnxe(&sm->wpa_auth->conf, rsnxe,
2692 sizeof(rsnxe_buf));
2693 if (res < 0)
2694 return NULL;
2695 rsnxe_len = res;
2696 }
46e147fc
JM
2697#ifdef CONFIG_TESTING_OPTIONS
2698 if (auth_alg == WLAN_AUTH_FT &&
2699 sm->wpa_auth->conf.rsnxe_override_ft_set) {
2700 wpa_printf(MSG_DEBUG,
2701 "TESTING: RSNXE FT override for MIC calculation");
2702 rsnxe = sm->wpa_auth->conf.rsnxe_override_ft;
2703 rsnxe_len = sm->wpa_auth->conf.rsnxe_override_ft_len;
2704 }
2705#endif /* CONFIG_TESTING_OPTIONS */
f73dd0a6
JM
2706 if (auth_alg == WLAN_AUTH_FT && rsnxe_len)
2707 *elem_count += 1;
2708
2f373878
JM
2709 if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
2710 kck = sm->PTK.kck2;
2711 kck_len = sm->PTK.kck2_len;
2712 } else {
2713 kck = sm->PTK.kck;
2714 kck_len = sm->PTK.kck_len;
2715 }
1f6e69e0 2716 if (auth_alg == WLAN_AUTH_FT &&
2f373878 2717 wpa_ft_mic(kck, kck_len, sm->addr, sm->wpa_auth->addr, 6,
6fc6879b 2718 mdie, mdie_len, ftie, ftie_len,
f238cf9f
JM
2719 rsnie, rsnie_len,
2720 ric_start, ric_start ? pos - ric_start : 0,
f73dd0a6 2721 rsnxe_len ? rsnxe : NULL, rsnxe_len,
2cf36d60 2722 fte_mic) < 0) {
6fc6879b 2723 wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC");
2cf36d60
JM
2724 return NULL;
2725 }
6fc6879b 2726
e44bd28c
JM
2727 os_free(sm->assoc_resp_ftie);
2728 sm->assoc_resp_ftie = os_malloc(ftie_len);
2cf36d60
JM
2729 if (!sm->assoc_resp_ftie)
2730 return NULL;
2731 os_memcpy(sm->assoc_resp_ftie, ftie, ftie_len);
e44bd28c 2732
6fc6879b
JM
2733 return pos;
2734}
2735
2736
6fc6879b
JM
2737static inline int wpa_auth_set_key(struct wpa_authenticator *wpa_auth,
2738 int vlan_id,
71934751 2739 enum wpa_alg alg, const u8 *addr, int idx,
a919a260
AW
2740 u8 *key, size_t key_len,
2741 enum key_flag key_flag)
6fc6879b 2742{
cef8fac0 2743 if (wpa_auth->cb->set_key == NULL)
6fc6879b 2744 return -1;
cef8fac0 2745 return wpa_auth->cb->set_key(wpa_auth->cb_ctx, vlan_id, alg, addr, idx,
a919a260 2746 key, key_len, key_flag);
6fc6879b
JM
2747}
2748
2749
0e84c254 2750void wpa_ft_install_ptk(struct wpa_state_machine *sm)
6fc6879b 2751{
71934751 2752 enum wpa_alg alg;
6fc6879b
JM
2753 int klen;
2754
2755 /* MLME-SETKEYS.request(PTK) */
c3550295
JM
2756 alg = wpa_cipher_to_alg(sm->pairwise);
2757 klen = wpa_cipher_key_len(sm->pairwise);
2758 if (!wpa_cipher_valid_pairwise(sm->pairwise)) {
0e84c254
JM
2759 wpa_printf(MSG_DEBUG, "FT: Unknown pairwise alg 0x%x - skip "
2760 "PTK configuration", sm->pairwise);
6fc6879b 2761 return;
0e84c254 2762 }
6fc6879b 2763
0e3bd7ac
MV
2764 if (sm->tk_already_set) {
2765 /* Must avoid TK reconfiguration to prevent clearing of TX/RX
2766 * PN in the driver */
2767 wpa_printf(MSG_DEBUG,
2768 "FT: Do not re-install same PTK to the driver");
2769 return;
2770 }
2771
6fc6879b
JM
2772 /* FIX: add STA entry to kernel/driver here? The set_key will fail
2773 * most likely without this.. At the moment, STA entry is added only
0e84c254
JM
2774 * after association has been completed. This function will be called
2775 * again after association to get the PTK configured, but that could be
2776 * optimized by adding the STA entry earlier.
6fc6879b 2777 */
862aac1f 2778 if (wpa_auth_set_key(sm->wpa_auth, 0, alg, sm->addr, sm->keyidx_active,
a919a260 2779 sm->PTK.tk, klen, KEY_FLAG_PAIRWISE_RX_TX))
6fc6879b
JM
2780 return;
2781
2782 /* FIX: MLME-SetProtection.Request(TA, Tx_Rx) */
2783 sm->pairwise_set = TRUE;
0e3bd7ac 2784 sm->tk_already_set = TRUE;
6fc6879b
JM
2785}
2786
2787
96590564
MB
2788/* Derive PMK-R1 from PSK, check all available PSK */
2789static int wpa_ft_psk_pmk_r1(struct wpa_state_machine *sm,
2790 const u8 *req_pmk_r1_name,
17010c38 2791 u8 *out_pmk_r1, int *out_pairwise,
069b4e30
MB
2792 struct vlan_description *out_vlan,
2793 const u8 **out_identity, size_t *out_identity_len,
2794 const u8 **out_radius_cui,
a6509e85
MB
2795 size_t *out_radius_cui_len,
2796 int *out_session_timeout)
96590564
MB
2797{
2798 const u8 *pmk = NULL;
2799 u8 pmk_r0[PMK_LEN], pmk_r0_name[WPA_PMK_NAME_LEN];
2800 u8 pmk_r1[PMK_LEN], pmk_r1_name[WPA_PMK_NAME_LEN];
2801 struct wpa_authenticator *wpa_auth = sm->wpa_auth;
2802 const u8 *mdid = wpa_auth->conf.mobility_domain;
2803 const u8 *r0kh = sm->r0kh_id;
2804 size_t r0kh_len = sm->r0kh_id_len;
2805 const u8 *r1kh = wpa_auth->conf.r1_key_holder;
2806 const u8 *ssid = wpa_auth->conf.ssid;
2807 size_t ssid_len = wpa_auth->conf.ssid_len;
2808 int pairwise;
2809
2810 pairwise = sm->pairwise;
2811
2812 for (;;) {
2813 pmk = wpa_ft_get_psk(wpa_auth, sm->addr, sm->p2p_dev_addr,
2814 pmk);
2815 if (pmk == NULL)
2816 break;
2817
364c064a
JM
2818 if (wpa_derive_pmk_r0(pmk, PMK_LEN, ssid, ssid_len, mdid, r0kh,
2819 r0kh_len, sm->addr,
994eac7e 2820 pmk_r0, pmk_r0_name, 0) < 0 ||
a3e18dbb
JM
2821 wpa_derive_pmk_r1(pmk_r0, PMK_LEN, pmk_r0_name, r1kh,
2822 sm->addr, pmk_r1, pmk_r1_name) < 0 ||
364c064a 2823 os_memcmp_const(pmk_r1_name, req_pmk_r1_name,
96590564
MB
2824 WPA_PMK_NAME_LEN) != 0)
2825 continue;
2826
2827 /* We found a PSK that matches the requested pmk_r1_name */
2828 wpa_printf(MSG_DEBUG,
2829 "FT: Found PSK to generate PMK-R1 locally");
2830 os_memcpy(out_pmk_r1, pmk_r1, PMK_LEN);
2831 if (out_pairwise)
2832 *out_pairwise = pairwise;
b08c9ad0
MK
2833 os_memcpy(sm->PMK, pmk, PMK_LEN);
2834 sm->pmk_len = PMK_LEN;
17010c38
MB
2835 if (out_vlan &&
2836 wpa_ft_get_vlan(sm->wpa_auth, sm->addr, out_vlan) < 0) {
2837 wpa_printf(MSG_DEBUG, "FT: vlan not available for STA "
2838 MACSTR, MAC2STR(sm->addr));
2839 return -1;
2840 }
2841
069b4e30
MB
2842 if (out_identity && out_identity_len) {
2843 *out_identity_len = wpa_ft_get_identity(
2844 sm->wpa_auth, sm->addr, out_identity);
2845 }
2846
2847 if (out_radius_cui && out_radius_cui_len) {
2848 *out_radius_cui_len = wpa_ft_get_radius_cui(
2849 sm->wpa_auth, sm->addr, out_radius_cui);
2850 }
2851
a6509e85
MB
2852 if (out_session_timeout) {
2853 *out_session_timeout = wpa_ft_get_session_timeout(
2854 sm->wpa_auth, sm->addr);
2855 }
2856
96590564
MB
2857 return 0;
2858 }
2859
2860 wpa_printf(MSG_DEBUG,
2861 "FT: Did not find PSK to generate PMK-R1 locally");
2862 return -1;
2863}
2864
2865
2866/* Detect the configuration the station asked for.
2867 * Required to detect FT-PSK and pairwise cipher.
2868 */
2869static int wpa_ft_set_key_mgmt(struct wpa_state_machine *sm,
2870 struct wpa_ft_ies *parse)
2871{
2872 int key_mgmt, ciphers;
2873
2874 if (sm->wpa_key_mgmt)
2875 return 0;
2876
2877 key_mgmt = parse->key_mgmt & sm->wpa_auth->conf.wpa_key_mgmt;
2878 if (!key_mgmt) {
2879 wpa_printf(MSG_DEBUG, "FT: Invalid key mgmt (0x%x) from "
2880 MACSTR, parse->key_mgmt, MAC2STR(sm->addr));
2881 return -1;
2882 }
2883 if (key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X)
2884 sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_IEEE8021X;
c22bb5bb
JM
2885#ifdef CONFIG_SHA384
2886 else if (key_mgmt & WPA_KEY_MGMT_FT_IEEE8021X_SHA384)
2887 sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_IEEE8021X_SHA384;
2888#endif /* CONFIG_SHA384 */
96590564
MB
2889 else if (key_mgmt & WPA_KEY_MGMT_FT_PSK)
2890 sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_PSK;
5aa08153
JM
2891#ifdef CONFIG_FILS
2892 else if (key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA256)
2893 sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_FILS_SHA256;
2894 else if (key_mgmt & WPA_KEY_MGMT_FT_FILS_SHA384)
2895 sm->wpa_key_mgmt = WPA_KEY_MGMT_FT_FILS_SHA384;
2896#endif /* CONFIG_FILS */
96590564
MB
2897 ciphers = parse->pairwise_cipher & sm->wpa_auth->conf.rsn_pairwise;
2898 if (!ciphers) {
2899 wpa_printf(MSG_DEBUG, "FT: Invalid pairwise cipher (0x%x) from "
2900 MACSTR,
2901 parse->pairwise_cipher, MAC2STR(sm->addr));
2902 return -1;
2903 }
2904 sm->pairwise = wpa_pick_pairwise_cipher(ciphers, 0);
2905
2906 return 0;
2907}
2908
2909
4ddca814
JM
2910static int wpa_ft_local_derive_pmk_r1(struct wpa_authenticator *wpa_auth,
2911 struct wpa_state_machine *sm,
2912 const u8 *r0kh_id, size_t r0kh_id_len,
2913 const u8 *req_pmk_r0_name,
2914 const u8 *req_pmk_r1_name,
17010c38 2915 u8 *out_pmk_r1, int *out_pairwise,
069b4e30
MB
2916 struct vlan_description *vlan,
2917 const u8 **identity, size_t *identity_len,
2918 const u8 **radius_cui,
a6509e85
MB
2919 size_t *radius_cui_len,
2920 int *out_session_timeout)
4ddca814
JM
2921{
2922 struct wpa_auth_config *conf = &wpa_auth->conf;
2923 const struct wpa_ft_pmk_r0_sa *r0;
2924 u8 pmk_r1_name[WPA_PMK_NAME_LEN];
3a3e2832 2925 int expires_in = 0;
a6509e85
MB
2926 int session_timeout = 0;
2927 struct os_reltime now;
4ddca814
JM
2928
2929 if (conf->r0_key_holder_len != r0kh_id_len ||
2930 os_memcmp(conf->r0_key_holder, r0kh_id, conf->r0_key_holder_len) !=
2931 0)
2932 return -1; /* not our R0KH-ID */
2933
2934 wpa_printf(MSG_DEBUG, "FT: STA R0KH-ID matching local configuration");
2935 if (wpa_ft_fetch_pmk_r0(sm->wpa_auth, sm->addr, req_pmk_r0_name, &r0) <
2936 0)
2937 return -1; /* no matching PMKR0Name in local cache */
2938
2939 wpa_printf(MSG_DEBUG, "FT: Requested PMKR0Name found in local cache");
2940
a3e18dbb
JM
2941 if (wpa_derive_pmk_r1(r0->pmk_r0, r0->pmk_r0_len, r0->pmk_r0_name,
2942 conf->r1_key_holder,
4ddca814
JM
2943 sm->addr, out_pmk_r1, pmk_r1_name) < 0)
2944 return -1;
a3e18dbb 2945 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", out_pmk_r1, r0->pmk_r0_len);
4ddca814
JM
2946 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", pmk_r1_name, WPA_PMK_NAME_LEN);
2947
a6509e85
MB
2948 os_get_reltime(&now);
2949 if (r0->expiration)
3a3e2832 2950 expires_in = r0->expiration - now.sec;
a6509e85
MB
2951
2952 if (r0->session_timeout)
2953 session_timeout = r0->session_timeout - now.sec;
3a3e2832 2954
a3e18dbb
JM
2955 wpa_ft_store_pmk_r1(wpa_auth, sm->addr, out_pmk_r1, r0->pmk_r0_len,
2956 pmk_r1_name,
a6509e85 2957 sm->pairwise, r0->vlan, expires_in, session_timeout,
069b4e30
MB
2958 r0->identity, r0->identity_len,
2959 r0->radius_cui, r0->radius_cui_len);
4ddca814
JM
2960
2961 *out_pairwise = sm->pairwise;
17010c38
MB
2962 if (vlan) {
2963 if (r0->vlan)
2964 *vlan = *r0->vlan;
2965 else
2966 os_memset(vlan, 0, sizeof(*vlan));
2967 }
069b4e30
MB
2968
2969 if (identity && identity_len) {
2970 *identity = r0->identity;
2971 *identity_len = r0->identity_len;
2972 }
2973
2974 if (radius_cui && radius_cui_len) {
2975 *radius_cui = r0->radius_cui;
2976 *radius_cui_len = r0->radius_cui_len;
2977 }
2978
a6509e85
MB
2979 *out_session_timeout = session_timeout;
2980
4ddca814
JM
2981 return 0;
2982}
2983
2984
692ec305 2985static int wpa_ft_process_auth_req(struct wpa_state_machine *sm,
6fc6879b
JM
2986 const u8 *ies, size_t ies_len,
2987 u8 **resp_ies, size_t *resp_ies_len)
2988{
2989 struct rsn_mdie *mdie;
a3e18dbb 2990 u8 pmk_r1[PMK_LEN_MAX], pmk_r1_name[WPA_PMK_NAME_LEN];
6fc6879b
JM
2991 u8 ptk_name[WPA_PMK_NAME_LEN];
2992 struct wpa_auth_config *conf;
2993 struct wpa_ft_ies parse;
98cd3d1c 2994 size_t buflen;
6fc6879b
JM
2995 int ret;
2996 u8 *pos, *end;
a6509e85 2997 int pairwise, session_timeout = 0;
17010c38 2998 struct vlan_description vlan;
069b4e30
MB
2999 const u8 *identity, *radius_cui;
3000 size_t identity_len = 0, radius_cui_len = 0;
9a33737a
JM
3001 int use_sha384;
3002 size_t pmk_r1_len;
6fc6879b
JM
3003
3004 *resp_ies = NULL;
3005 *resp_ies_len = 0;
3006
3007 sm->pmk_r1_name_valid = 0;
3008 conf = &sm->wpa_auth->conf;
3009
3010 wpa_hexdump(MSG_DEBUG, "FT: Received authentication frame IEs",
3011 ies, ies_len);
3012
9a33737a 3013 if (wpa_ft_parse_ies(ies, ies_len, &parse, -1)) {
6fc6879b
JM
3014 wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs");
3015 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3016 }
9a33737a
JM
3017 use_sha384 = wpa_key_mgmt_sha384(parse.key_mgmt);
3018 pmk_r1_len = use_sha384 ? SHA384_MAC_LEN : PMK_LEN;
6fc6879b
JM
3019
3020 mdie = (struct rsn_mdie *) parse.mdie;
3021 if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
3022 os_memcmp(mdie->mobility_domain,
3023 sm->wpa_auth->conf.mobility_domain,
3024 MOBILITY_DOMAIN_ID_LEN) != 0) {
3025 wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
3026 return WLAN_STATUS_INVALID_MDIE;
3027 }
3028
9a33737a
JM
3029 if (use_sha384) {
3030 struct rsn_ftie_sha384 *ftie;
3031
3032 ftie = (struct rsn_ftie_sha384 *) parse.ftie;
3033 if (!ftie || parse.ftie_len < sizeof(*ftie)) {
3034 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3035 return WLAN_STATUS_INVALID_FTIE;
3036 }
6fc6879b 3037
9a33737a
JM
3038 os_memcpy(sm->SNonce, ftie->snonce, WPA_NONCE_LEN);
3039 } else {
3040 struct rsn_ftie *ftie;
3041
3042 ftie = (struct rsn_ftie *) parse.ftie;
3043 if (!ftie || parse.ftie_len < sizeof(*ftie)) {
3044 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3045 return WLAN_STATUS_INVALID_FTIE;
3046 }
3047
3048 os_memcpy(sm->SNonce, ftie->snonce, WPA_NONCE_LEN);
3049 }
6fc6879b
JM
3050
3051 if (parse.r0kh_id == NULL) {
3052 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE - no R0KH-ID");
3053 return WLAN_STATUS_INVALID_FTIE;
3054 }
3055
3056 wpa_hexdump(MSG_DEBUG, "FT: STA R0KH-ID",
3057 parse.r0kh_id, parse.r0kh_id_len);
3058 os_memcpy(sm->r0kh_id, parse.r0kh_id, parse.r0kh_id_len);
3059 sm->r0kh_id_len = parse.r0kh_id_len;
3060
3061 if (parse.rsn_pmkid == NULL) {
3062 wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE");
3063 return WLAN_STATUS_INVALID_PMKID;
3064 }
3065
96590564
MB
3066 if (wpa_ft_set_key_mgmt(sm, &parse) < 0)
3067 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3068
6fc6879b
JM
3069 wpa_hexdump(MSG_DEBUG, "FT: Requested PMKR0Name",
3070 parse.rsn_pmkid, WPA_PMK_NAME_LEN);
364c064a
JM
3071 if (wpa_derive_pmk_r1_name(parse.rsn_pmkid,
3072 sm->wpa_auth->conf.r1_key_holder, sm->addr,
c3e4f40c 3073 pmk_r1_name, use_sha384) < 0)
364c064a 3074 return WLAN_STATUS_UNSPECIFIED_FAILURE;
6fc6879b
JM
3075 wpa_hexdump(MSG_DEBUG, "FT: Derived requested PMKR1Name",
3076 pmk_r1_name, WPA_PMK_NAME_LEN);
3077
96590564
MB
3078 if (conf->ft_psk_generate_local &&
3079 wpa_key_mgmt_ft_psk(sm->wpa_key_mgmt)) {
17010c38 3080 if (wpa_ft_psk_pmk_r1(sm, pmk_r1_name, pmk_r1, &pairwise,
069b4e30 3081 &vlan, &identity, &identity_len,
a6509e85
MB
3082 &radius_cui, &radius_cui_len,
3083 &session_timeout) < 0)
96590564 3084 return WLAN_STATUS_INVALID_PMKID;
4ddca814
JM
3085 wpa_printf(MSG_DEBUG,
3086 "FT: Generated PMK-R1 for FT-PSK locally");
96590564 3087 } else if (wpa_ft_fetch_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1_name,
a3e18dbb
JM
3088 pmk_r1, &pmk_r1_len, &pairwise, &vlan,
3089 &identity, &identity_len, &radius_cui,
a6509e85 3090 &radius_cui_len, &session_timeout) < 0) {
4ddca814
JM
3091 wpa_printf(MSG_DEBUG,
3092 "FT: No PMK-R1 available in local cache for the requested PMKR1Name");
3093 if (wpa_ft_local_derive_pmk_r1(sm->wpa_auth, sm,
3094 parse.r0kh_id, parse.r0kh_id_len,
3095 parse.rsn_pmkid,
17010c38 3096 pmk_r1_name, pmk_r1, &pairwise,
069b4e30 3097 &vlan, &identity, &identity_len,
a6509e85
MB
3098 &radius_cui, &radius_cui_len,
3099 &session_timeout) == 0) {
4ddca814
JM
3100 wpa_printf(MSG_DEBUG,
3101 "FT: Generated PMK-R1 based on local PMK-R0");
3102 goto pmk_r1_derived;
3103 }
3104
692ec305 3105 if (wpa_ft_pull_pmk_r1(sm, ies, ies_len, parse.rsn_pmkid) < 0) {
3a46cf93
MB
3106 wpa_printf(MSG_DEBUG,
3107 "FT: Did not have matching PMK-R1 and either unknown or blocked R0KH-ID or NAK from R0KH");
6fc6879b
JM
3108 return WLAN_STATUS_INVALID_PMKID;
3109 }
3110
692ec305 3111 return -1; /* Status pending */
4ddca814
JM
3112 } else {
3113 wpa_printf(MSG_DEBUG, "FT: Found PMKR1Name from local cache");
6fc6879b
JM
3114 }
3115
4ddca814 3116pmk_r1_derived:
a3e18dbb 3117 wpa_hexdump_key(MSG_DEBUG, "FT: Selected PMK-R1", pmk_r1, pmk_r1_len);
6fc6879b
JM
3118 sm->pmk_r1_name_valid = 1;
3119 os_memcpy(sm->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN);
8a576f5e
JM
3120 os_memcpy(sm->pmk_r1, pmk_r1, pmk_r1_len);
3121 sm->pmk_r1_len = pmk_r1_len;
6fc6879b 3122
3642c431 3123 if (random_get_bytes(sm->ANonce, WPA_NONCE_LEN)) {
6fc6879b
JM
3124 wpa_printf(MSG_DEBUG, "FT: Failed to get random data for "
3125 "ANonce");
3126 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3127 }
3128
3129 wpa_hexdump(MSG_DEBUG, "FT: Received SNonce",
3130 sm->SNonce, WPA_NONCE_LEN);
3131 wpa_hexdump(MSG_DEBUG, "FT: Generated ANonce",
3132 sm->ANonce, WPA_NONCE_LEN);
3133
a3e18dbb
JM
3134 if (wpa_pmk_r1_to_ptk(pmk_r1, pmk_r1_len, sm->SNonce, sm->ANonce,
3135 sm->addr, sm->wpa_auth->addr, pmk_r1_name,
98cd3d1c
JM
3136 &sm->PTK, ptk_name, sm->wpa_key_mgmt,
3137 pairwise) < 0)
3138 return WLAN_STATUS_UNSPECIFIED_FAILURE;
6fc6879b 3139
0e84c254 3140 sm->pairwise = pairwise;
3d4d2348 3141 sm->PTK_valid = TRUE;
0e3bd7ac 3142 sm->tk_already_set = FALSE;
6fc6879b
JM
3143 wpa_ft_install_ptk(sm);
3144
17010c38
MB
3145 if (wpa_ft_set_vlan(sm->wpa_auth, sm->addr, &vlan) < 0) {
3146 wpa_printf(MSG_DEBUG, "FT: Failed to configure VLAN");
3147 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3148 }
069b4e30
MB
3149 if (wpa_ft_set_identity(sm->wpa_auth, sm->addr,
3150 identity, identity_len) < 0 ||
3151 wpa_ft_set_radius_cui(sm->wpa_auth, sm->addr,
3152 radius_cui, radius_cui_len) < 0) {
3153 wpa_printf(MSG_DEBUG, "FT: Failed to configure identity/CUI");
3154 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3155 }
a6509e85 3156 wpa_ft_set_session_timeout(sm->wpa_auth, sm->addr, session_timeout);
17010c38 3157
6fc6879b
JM
3158 buflen = 2 + sizeof(struct rsn_mdie) + 2 + sizeof(struct rsn_ftie) +
3159 2 + FT_R1KH_ID_LEN + 200;
3160 *resp_ies = os_zalloc(buflen);
a8e25dee
JM
3161 if (*resp_ies == NULL)
3162 goto fail;
6fc6879b
JM
3163
3164 pos = *resp_ies;
3165 end = *resp_ies + buflen;
3166
3167 ret = wpa_write_rsn_ie(conf, pos, end - pos, parse.rsn_pmkid);
a8e25dee
JM
3168 if (ret < 0)
3169 goto fail;
6fc6879b
JM
3170 pos += ret;
3171
3172 ret = wpa_write_mdie(conf, pos, end - pos);
a8e25dee
JM
3173 if (ret < 0)
3174 goto fail;
6fc6879b
JM
3175 pos += ret;
3176
a7968ea5 3177 ret = wpa_write_ftie(conf, use_sha384, parse.r0kh_id, parse.r0kh_id_len,
51d1924b
JM
3178 sm->ANonce, sm->SNonce, pos, end - pos, NULL, 0,
3179 0);
a8e25dee
JM
3180 if (ret < 0)
3181 goto fail;
6fc6879b
JM
3182 pos += ret;
3183
3184 *resp_ies_len = pos - *resp_ies;
3185
3186 return WLAN_STATUS_SUCCESS;
a8e25dee
JM
3187fail:
3188 os_free(*resp_ies);
3189 *resp_ies = NULL;
3190 return WLAN_STATUS_UNSPECIFIED_FAILURE;
6fc6879b
JM
3191}
3192
3193
3194void wpa_ft_process_auth(struct wpa_state_machine *sm, const u8 *bssid,
3195 u16 auth_transaction, const u8 *ies, size_t ies_len,
3196 void (*cb)(void *ctx, const u8 *dst, const u8 *bssid,
3197 u16 auth_transaction, u16 status,
3198 const u8 *ies, size_t ies_len),
3199 void *ctx)
3200{
3201 u16 status;
3202 u8 *resp_ies;
3203 size_t resp_ies_len;
692ec305 3204 int res;
6fc6879b
JM
3205
3206 if (sm == NULL) {
3207 wpa_printf(MSG_DEBUG, "FT: Received authentication frame, but "
3208 "WPA SM not available");
3209 return;
3210 }
3211
3212 wpa_printf(MSG_DEBUG, "FT: Received authentication frame: STA=" MACSTR
3213 " BSSID=" MACSTR " transaction=%d",
3214 MAC2STR(sm->addr), MAC2STR(bssid), auth_transaction);
692ec305
JM
3215 sm->ft_pending_cb = cb;
3216 sm->ft_pending_cb_ctx = ctx;
3217 sm->ft_pending_auth_transaction = auth_transaction;
3a46cf93 3218 sm->ft_pending_pull_left_retries = sm->wpa_auth->conf.rkh_pull_retries;
692ec305
JM
3219 res = wpa_ft_process_auth_req(sm, ies, ies_len, &resp_ies,
3220 &resp_ies_len);
3221 if (res < 0) {
3222 wpa_printf(MSG_DEBUG, "FT: Callback postponed until response is available");
3223 return;
3224 }
3225 status = res;
6fc6879b
JM
3226
3227 wpa_printf(MSG_DEBUG, "FT: FT authentication response: dst=" MACSTR
9c951244
AK
3228 " auth_transaction=%d status=%u (%s)",
3229 MAC2STR(sm->addr), auth_transaction + 1, status,
3230 status2str(status));
6fc6879b
JM
3231 wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len);
3232 cb(ctx, sm->addr, bssid, auth_transaction + 1, status,
3233 resp_ies, resp_ies_len);
3234 os_free(resp_ies);
3235}
3236
3237
3238u16 wpa_ft_validate_reassoc(struct wpa_state_machine *sm, const u8 *ies,
3239 size_t ies_len)
3240{
3241 struct wpa_ft_ies parse;
3242 struct rsn_mdie *mdie;
98cd3d1c
JM
3243 u8 mic[WPA_EAPOL_KEY_MIC_MAX_LEN];
3244 size_t mic_len = 16;
8aaf894d 3245 unsigned int count;
2f373878
JM
3246 const u8 *kck;
3247 size_t kck_len;
9a33737a
JM
3248 int use_sha384;
3249 const u8 *anonce, *snonce, *fte_mic;
3250 u8 fte_elem_count;
497ae9f0
JM
3251 int rsnxe_used;
3252 struct wpa_auth_config *conf;
6fc6879b
JM
3253
3254 if (sm == NULL)
3255 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3256
497ae9f0 3257 conf = &sm->wpa_auth->conf;
9a33737a
JM
3258 use_sha384 = wpa_key_mgmt_sha384(sm->wpa_key_mgmt);
3259
6fc6879b
JM
3260 wpa_hexdump(MSG_DEBUG, "FT: Reassoc Req IEs", ies, ies_len);
3261
9a33737a 3262 if (wpa_ft_parse_ies(ies, ies_len, &parse, use_sha384) < 0) {
6fc6879b
JM
3263 wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs");
3264 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3265 }
3266
3267 if (parse.rsn == NULL) {
3268 wpa_printf(MSG_DEBUG, "FT: No RSNIE in Reassoc Req");
3269 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3270 }
3271
3272 if (parse.rsn_pmkid == NULL) {
3273 wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE");
3274 return WLAN_STATUS_INVALID_PMKID;
3275 }
3276
870834a1
JM
3277 if (os_memcmp_const(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN)
3278 != 0) {
6fc6879b
JM
3279 wpa_printf(MSG_DEBUG, "FT: PMKID in Reassoc Req did not match "
3280 "with the PMKR1Name derived from auth request");
3281 return WLAN_STATUS_INVALID_PMKID;
3282 }
3283
3284 mdie = (struct rsn_mdie *) parse.mdie;
3285 if (mdie == NULL || parse.mdie_len < sizeof(*mdie) ||
497ae9f0 3286 os_memcmp(mdie->mobility_domain, conf->mobility_domain,
6fc6879b
JM
3287 MOBILITY_DOMAIN_ID_LEN) != 0) {
3288 wpa_printf(MSG_DEBUG, "FT: Invalid MDIE");
3289 return WLAN_STATUS_INVALID_MDIE;
3290 }
3291
9a33737a
JM
3292 if (use_sha384) {
3293 struct rsn_ftie_sha384 *ftie;
3294
3295 ftie = (struct rsn_ftie_sha384 *) parse.ftie;
3296 if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
3297 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3298 return WLAN_STATUS_INVALID_FTIE;
3299 }
3300
3301 anonce = ftie->anonce;
3302 snonce = ftie->snonce;
497ae9f0 3303 rsnxe_used = ftie->mic_control[0] & 0x01;
9a33737a
JM
3304 fte_elem_count = ftie->mic_control[1];
3305 fte_mic = ftie->mic;
3306 } else {
3307 struct rsn_ftie *ftie;
3308
3309 ftie = (struct rsn_ftie *) parse.ftie;
3310 if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) {
3311 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE");
3312 return WLAN_STATUS_INVALID_FTIE;
3313 }
3314
3315 anonce = ftie->anonce;
3316 snonce = ftie->snonce;
497ae9f0 3317 rsnxe_used = ftie->mic_control[0] & 0x01;
9a33737a
JM
3318 fte_elem_count = ftie->mic_control[1];
3319 fte_mic = ftie->mic;
6fc6879b
JM
3320 }
3321
9a33737a 3322 if (os_memcmp(snonce, sm->SNonce, WPA_NONCE_LEN) != 0) {
0ae145cd
JM
3323 wpa_printf(MSG_DEBUG, "FT: SNonce mismatch in FTIE");
3324 wpa_hexdump(MSG_DEBUG, "FT: Received SNonce",
9a33737a 3325 snonce, WPA_NONCE_LEN);
0ae145cd
JM
3326 wpa_hexdump(MSG_DEBUG, "FT: Expected SNonce",
3327 sm->SNonce, WPA_NONCE_LEN);
0a63635e 3328 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3329 }
3330
9a33737a 3331 if (os_memcmp(anonce, sm->ANonce, WPA_NONCE_LEN) != 0) {
0ae145cd
JM
3332 wpa_printf(MSG_DEBUG, "FT: ANonce mismatch in FTIE");
3333 wpa_hexdump(MSG_DEBUG, "FT: Received ANonce",
9a33737a 3334 anonce, WPA_NONCE_LEN);
0ae145cd
JM
3335 wpa_hexdump(MSG_DEBUG, "FT: Expected ANonce",
3336 sm->ANonce, WPA_NONCE_LEN);
0a63635e 3337 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3338 }
3339
3340
3341 if (parse.r0kh_id == NULL) {
3342 wpa_printf(MSG_DEBUG, "FT: No R0KH-ID subelem in FTIE");
0a63635e 3343 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3344 }
3345
3346 if (parse.r0kh_id_len != sm->r0kh_id_len ||
870834a1
JM
3347 os_memcmp_const(parse.r0kh_id, sm->r0kh_id, parse.r0kh_id_len) != 0)
3348 {
0ae145cd
JM
3349 wpa_printf(MSG_DEBUG, "FT: R0KH-ID in FTIE did not match with "
3350 "the current R0KH-ID");
3351 wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID in FTIE",
3352 parse.r0kh_id, parse.r0kh_id_len);
3353 wpa_hexdump(MSG_DEBUG, "FT: The current R0KH-ID",
3354 sm->r0kh_id, sm->r0kh_id_len);
0a63635e 3355 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3356 }
3357
3358 if (parse.r1kh_id == NULL) {
3359 wpa_printf(MSG_DEBUG, "FT: No R1KH-ID subelem in FTIE");
0a63635e 3360 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3361 }
3362
497ae9f0 3363 if (os_memcmp_const(parse.r1kh_id, conf->r1_key_holder,
870834a1 3364 FT_R1KH_ID_LEN) != 0) {
0ae145cd
JM
3365 wpa_printf(MSG_DEBUG, "FT: Unknown R1KH-ID used in "
3366 "ReassocReq");
3367 wpa_hexdump(MSG_DEBUG, "FT: R1KH-ID in FTIE",
3368 parse.r1kh_id, FT_R1KH_ID_LEN);
3369 wpa_hexdump(MSG_DEBUG, "FT: Expected R1KH-ID",
497ae9f0 3370 conf->r1_key_holder, FT_R1KH_ID_LEN);
0a63635e 3371 return WLAN_STATUS_INVALID_FTIE;
0ae145cd
JM
3372 }
3373
3374 if (parse.rsn_pmkid == NULL ||
870834a1
JM
3375 os_memcmp_const(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN))
3376 {
0ae145cd
JM
3377 wpa_printf(MSG_DEBUG, "FT: No matching PMKR1Name (PMKID) in "
3378 "RSNIE (pmkid=%d)", !!parse.rsn_pmkid);
0a63635e 3379 return WLAN_STATUS_INVALID_PMKID;
0ae145cd
JM
3380 }
3381
8aaf894d
JM
3382 count = 3;
3383 if (parse.ric)
c284b461 3384 count += ieee802_11_ie_count(parse.ric, parse.ric_len);
f73dd0a6
JM
3385 if (parse.rsnxe)
3386 count++;
9a33737a 3387 if (fte_elem_count != count) {
8aaf894d
JM
3388 wpa_printf(MSG_DEBUG, "FT: Unexpected IE count in MIC "
3389 "Control: received %u expected %u",
9a33737a 3390 fte_elem_count, count);
0a63635e 3391 return WLAN_STATUS_UNSPECIFIED_FAILURE;
8aaf894d
JM
3392 }
3393
2f373878
JM
3394 if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) {
3395 kck = sm->PTK.kck2;
3396 kck_len = sm->PTK.kck2_len;
3397 } else {
3398 kck = sm->PTK.kck;
3399 kck_len = sm->PTK.kck_len;
3400 }
3401 if (wpa_ft_mic(kck, kck_len, sm->addr, sm->wpa_auth->addr, 5,
6fc6879b
JM
3402 parse.mdie - 2, parse.mdie_len + 2,
3403 parse.ftie - 2, parse.ftie_len + 2,
babfbf15
JM
3404 parse.rsn - 2, parse.rsn_len + 2,
3405 parse.ric, parse.ric_len,
f73dd0a6
JM
3406 parse.rsnxe ? parse.rsnxe - 2 : NULL,
3407 parse.rsnxe ? parse.rsnxe_len + 2 : 0,
6fc6879b
JM
3408 mic) < 0) {
3409 wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC");
3410 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3411 }
3412
9a33737a 3413 if (os_memcmp_const(mic, fte_mic, mic_len) != 0) {
6fc6879b 3414 wpa_printf(MSG_DEBUG, "FT: Invalid MIC in FTIE");
88b32a99
SP
3415 wpa_printf(MSG_DEBUG, "FT: addr=" MACSTR " auth_addr=" MACSTR,
3416 MAC2STR(sm->addr), MAC2STR(sm->wpa_auth->addr));
98cd3d1c 3417 wpa_hexdump(MSG_MSGDUMP, "FT: Received MIC",
9a33737a 3418 fte_mic, mic_len);
98cd3d1c 3419 wpa_hexdump(MSG_MSGDUMP, "FT: Calculated MIC", mic, mic_len);
88b32a99
SP
3420 wpa_hexdump(MSG_MSGDUMP, "FT: MDIE",
3421 parse.mdie - 2, parse.mdie_len + 2);
3422 wpa_hexdump(MSG_MSGDUMP, "FT: FTIE",
3423 parse.ftie - 2, parse.ftie_len + 2);
3424 wpa_hexdump(MSG_MSGDUMP, "FT: RSN",
3425 parse.rsn - 2, parse.rsn_len + 2);
f73dd0a6
JM
3426 wpa_hexdump(MSG_MSGDUMP, "FT: RSNXE",
3427 parse.rsnxe ? parse.rsnxe - 2 : NULL,
3428 parse.rsnxe ? parse.rsnxe_len + 2 : 0);
6fc6879b
JM
3429 return WLAN_STATUS_INVALID_FTIE;
3430 }
3431
497ae9f0
JM
3432 if (rsnxe_used && (conf->sae_pwe == 1 || conf->sae_pwe == 2) &&
3433 !parse.rsnxe) {
3434 wpa_printf(MSG_INFO,
3435 "FT: FTE indicated that STA uses RSNXE, but RSNXE was not included");
3436 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3437 }
3438
dd8df6af
MV
3439#ifdef CONFIG_OCV
3440 if (wpa_auth_uses_ocv(sm)) {
3441 struct wpa_channel_info ci;
3442 int tx_chanwidth;
3443 int tx_seg1_idx;
3444
3445 if (wpa_channel_info(sm->wpa_auth, &ci) != 0) {
3446 wpa_printf(MSG_WARNING,
3447 "Failed to get channel info to validate received OCI in (Re)Assoc Request");
3448 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3449 }
3450
3451 if (get_sta_tx_parameters(sm,
3452 channel_width_to_int(ci.chanwidth),
3453 ci.seg1_idx, &tx_chanwidth,
3454 &tx_seg1_idx) < 0)
3455 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3456
3457 if (ocv_verify_tx_params(parse.oci, parse.oci_len, &ci,
3458 tx_chanwidth, tx_seg1_idx) != 0) {
3459 wpa_printf(MSG_WARNING, "%s", ocv_errorstr);
3460 return WLAN_STATUS_UNSPECIFIED_FAILURE;
3461 }
3462 }
3463#endif /* CONFIG_OCV */
3464
6fc6879b
JM
3465 return WLAN_STATUS_SUCCESS;
3466}
3467
3468
3469int wpa_ft_action_rx(struct wpa_state_machine *sm, const u8 *data, size_t len)
3470{
3471 const u8 *sta_addr, *target_ap;
3472 const u8 *ies;
3473 size_t ies_len;
3474 u8 action;
3475 struct ft_rrb_frame *frame;
3476
3477 if (sm == NULL)
3478 return -1;
3479
3480 /*
3481 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6]
3482 * FT Request action frame body[variable]
3483 */
3484
3485 if (len < 14) {
3486 wpa_printf(MSG_DEBUG, "FT: Too short FT Action frame "
3487 "(len=%lu)", (unsigned long) len);
3488 return -1;
3489 }
3490
3491 action = data[1];
3492 sta_addr = data + 2;
3493 target_ap = data + 8;
3494 ies = data + 14;
3495 ies_len = len - 14;
3496
3497 wpa_printf(MSG_DEBUG, "FT: Received FT Action frame (STA=" MACSTR
3498 " Target AP=" MACSTR " Action=%d)",
3499 MAC2STR(sta_addr), MAC2STR(target_ap), action);
3500
3501 if (os_memcmp(sta_addr, sm->addr, ETH_ALEN) != 0) {
3502 wpa_printf(MSG_DEBUG, "FT: Mismatch in FT Action STA address: "
3503 "STA=" MACSTR " STA-Address=" MACSTR,
3504 MAC2STR(sm->addr), MAC2STR(sta_addr));
3505 return -1;
3506 }
3507
3508 /*
3509 * Do some sanity checking on the target AP address (not own and not
3510 * broadcast. This could be extended to filter based on a list of known
3511 * APs in the MD (if such a list were configured).
3512 */
3513 if ((target_ap[0] & 0x01) ||
3514 os_memcmp(target_ap, sm->wpa_auth->addr, ETH_ALEN) == 0) {
3515 wpa_printf(MSG_DEBUG, "FT: Invalid Target AP in FT Action "
3516 "frame");
3517 return -1;
3518 }
3519
3520 wpa_hexdump(MSG_MSGDUMP, "FT: Action frame body", ies, ies_len);
3521
1940559e
JM
3522 if (!sm->wpa_auth->conf.ft_over_ds) {
3523 wpa_printf(MSG_DEBUG, "FT: Over-DS option disabled - reject");
3524 return -1;
3525 }
3526
6fc6879b
JM
3527 /* RRB - Forward action frame to the target AP */
3528 frame = os_malloc(sizeof(*frame) + len);
2c48211c
JM
3529 if (frame == NULL)
3530 return -1;
6fc6879b
JM
3531 frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB;
3532 frame->packet_type = FT_PACKET_REQUEST;
3533 frame->action_length = host_to_le16(len);
3534 os_memcpy(frame->ap_address, sm->wpa_auth->addr, ETH_ALEN);
3535 os_memcpy(frame + 1, data, len);
3536
3537 wpa_ft_rrb_send(sm->wpa_auth, target_ap, (u8 *) frame,
3538 sizeof(*frame) + len);
3539 os_free(frame);
3540
3541 return 0;
3542}
3543
3544
692ec305
JM
3545static void wpa_ft_rrb_rx_request_cb(void *ctx, const u8 *dst, const u8 *bssid,
3546 u16 auth_transaction, u16 resp,
3547 const u8 *ies, size_t ies_len)
3548{
3549 struct wpa_state_machine *sm = ctx;
3550 wpa_printf(MSG_DEBUG, "FT: Over-the-DS RX request cb for " MACSTR,
3551 MAC2STR(sm->addr));
3552 wpa_ft_send_rrb_auth_resp(sm, sm->ft_pending_current_ap, sm->addr,
3553 WLAN_STATUS_SUCCESS, ies, ies_len);
3554}
3555
3556
6fc6879b
JM
3557static int wpa_ft_rrb_rx_request(struct wpa_authenticator *wpa_auth,
3558 const u8 *current_ap, const u8 *sta_addr,
3559 const u8 *body, size_t len)
3560{
3561 struct wpa_state_machine *sm;
3562 u16 status;
692ec305
JM
3563 u8 *resp_ies;
3564 size_t resp_ies_len;
3565 int res;
6fc6879b
JM
3566
3567 sm = wpa_ft_add_sta(wpa_auth, sta_addr);
3568 if (sm == NULL) {
3569 wpa_printf(MSG_DEBUG, "FT: Failed to add new STA based on "
3570 "RRB Request");
3571 return -1;
3572 }
3573
3574 wpa_hexdump(MSG_MSGDUMP, "FT: RRB Request Frame body", body, len);
3575
692ec305
JM
3576 sm->ft_pending_cb = wpa_ft_rrb_rx_request_cb;
3577 sm->ft_pending_cb_ctx = sm;
3578 os_memcpy(sm->ft_pending_current_ap, current_ap, ETH_ALEN);
3a46cf93 3579 sm->ft_pending_pull_left_retries = sm->wpa_auth->conf.rkh_pull_retries;
692ec305
JM
3580 res = wpa_ft_process_auth_req(sm, body, len, &resp_ies,
3581 &resp_ies_len);
3582 if (res < 0) {
3583 wpa_printf(MSG_DEBUG, "FT: No immediate response available - wait for pull response");
3584 return 0;
3585 }
3586 status = res;
3587
3588 res = wpa_ft_send_rrb_auth_resp(sm, current_ap, sta_addr, status,
3589 resp_ies, resp_ies_len);
3590 os_free(resp_ies);
3591 return res;
3592}
3593
3594
3595static int wpa_ft_send_rrb_auth_resp(struct wpa_state_machine *sm,
3596 const u8 *current_ap, const u8 *sta_addr,
3597 u16 status, const u8 *resp_ies,
3598 size_t resp_ies_len)
3599{
3600 struct wpa_authenticator *wpa_auth = sm->wpa_auth;
3601 size_t rlen;
3602 struct ft_rrb_frame *frame;
3603 u8 *pos;
6fc6879b
JM
3604
3605 wpa_printf(MSG_DEBUG, "FT: RRB authentication response: STA=" MACSTR
9c951244
AK
3606 " CurrentAP=" MACSTR " status=%u (%s)",
3607 MAC2STR(sm->addr), MAC2STR(current_ap), status,
3608 status2str(status));
6fc6879b
JM
3609 wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len);
3610
3611 /* RRB - Forward action frame response to the Current AP */
3612
3613 /*
3614 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6]
3615 * Status_Code[2] FT Request action frame body[variable]
3616 */
3617 rlen = 2 + 2 * ETH_ALEN + 2 + resp_ies_len;
3618
3619 frame = os_malloc(sizeof(*frame) + rlen);
692ec305 3620 if (frame == NULL)
2c48211c 3621 return -1;
6fc6879b
JM
3622 frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB;
3623 frame->packet_type = FT_PACKET_RESPONSE;
3624 frame->action_length = host_to_le16(rlen);
3625 os_memcpy(frame->ap_address, wpa_auth->addr, ETH_ALEN);
3626 pos = (u8 *) (frame + 1);
3627 *pos++ = WLAN_ACTION_FT;
3628 *pos++ = 2; /* Action: Response */
3629 os_memcpy(pos, sta_addr, ETH_ALEN);
3630 pos += ETH_ALEN;
3631 os_memcpy(pos, wpa_auth->addr, ETH_ALEN);
3632 pos += ETH_ALEN;
3633 WPA_PUT_LE16(pos, status);
3634 pos += 2;
692ec305 3635 if (resp_ies)
6fc6879b 3636 os_memcpy(pos, resp_ies, resp_ies_len);
6fc6879b
JM
3637
3638 wpa_ft_rrb_send(wpa_auth, current_ap, (u8 *) frame,
3639 sizeof(*frame) + rlen);
3640 os_free(frame);
3641
3642 return 0;
3643}
3644
3645
245fc96e
MB
3646static int wpa_ft_rrb_build_r0(const u8 *key, const size_t key_len,
3647 const struct tlv_list *tlvs,
3648 const struct wpa_ft_pmk_r0_sa *pmk_r0,
3649 const u8 *r1kh_id, const u8 *s1kh_id,
3650 const struct tlv_list *tlv_auth,
3651 const u8 *src_addr, u8 type,
3652 u8 **packet, size_t *packet_len)
3653{
a3e18dbb
JM
3654 u8 pmk_r1[PMK_LEN_MAX];
3655 size_t pmk_r1_len = pmk_r0->pmk_r0_len;
245fc96e
MB
3656 u8 pmk_r1_name[WPA_PMK_NAME_LEN];
3657 u8 f_pairwise[sizeof(le16)];
3a3e2832 3658 u8 f_expires_in[sizeof(le16)];
a6509e85 3659 u8 f_session_timeout[sizeof(le32)];
3a3e2832 3660 int expires_in;
a6509e85 3661 int session_timeout;
3a3e2832 3662 struct os_reltime now;
245fc96e
MB
3663 int ret;
3664 struct tlv_list sess_tlv[] = {
a3e18dbb 3665 { .type = FT_RRB_PMK_R1, .len = pmk_r1_len,
245fc96e
MB
3666 .data = pmk_r1 },
3667 { .type = FT_RRB_PMK_R1_NAME, .len = sizeof(pmk_r1_name),
3668 .data = pmk_r1_name },
3669 { .type = FT_RRB_PAIRWISE, .len = sizeof(f_pairwise),
3670 .data = f_pairwise },
3a3e2832
MB
3671 { .type = FT_RRB_EXPIRES_IN, .len = sizeof(f_expires_in),
3672 .data = f_expires_in },
069b4e30
MB
3673 { .type = FT_RRB_IDENTITY, .len = pmk_r0->identity_len,
3674 .data = pmk_r0->identity },
3675 { .type = FT_RRB_RADIUS_CUI, .len = pmk_r0->radius_cui_len,
3676 .data = pmk_r0->radius_cui },
a6509e85
MB
3677 { .type = FT_RRB_SESSION_TIMEOUT,
3678 .len = sizeof(f_session_timeout),
3679 .data = f_session_timeout },
245fc96e
MB
3680 { .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
3681 };
3682
a3e18dbb
JM
3683 if (wpa_derive_pmk_r1(pmk_r0->pmk_r0, pmk_r0->pmk_r0_len,
3684 pmk_r0->pmk_r0_name, r1kh_id,
245fc96e
MB
3685 s1kh_id, pmk_r1, pmk_r1_name) < 0)
3686 return -1;
a3e18dbb
JM
3687 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1 (for peer AP)",
3688 pmk_r1, pmk_r1_len);
3689 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name (for peer AP)",
3690 pmk_r1_name, WPA_PMK_NAME_LEN);
245fc96e
MB
3691 WPA_PUT_LE16(f_pairwise, pmk_r0->pairwise);
3692
3a3e2832
MB
3693 os_get_reltime(&now);
3694 if (pmk_r0->expiration > now.sec)
3695 expires_in = pmk_r0->expiration - now.sec;
3696 else if (pmk_r0->expiration)
3697 expires_in = 1;
3698 else
3699 expires_in = 0;
3700 WPA_PUT_LE16(f_expires_in, expires_in);
3701
a6509e85
MB
3702 if (pmk_r0->session_timeout > now.sec)
3703 session_timeout = pmk_r0->session_timeout - now.sec;
3704 else if (pmk_r0->session_timeout)
3705 session_timeout = 1;
3706 else
3707 session_timeout = 0;
3708 WPA_PUT_LE32(f_session_timeout, session_timeout);
3709
245fc96e 3710 ret = wpa_ft_rrb_build(key, key_len, tlvs, sess_tlv, tlv_auth,
17010c38
MB
3711 pmk_r0->vlan, src_addr, type,
3712 packet, packet_len);
245fc96e 3713
31bc66e4 3714 forced_memzero(pmk_r1, sizeof(pmk_r1));
245fc96e
MB
3715
3716 return ret;
3717}
3718
3719
6fc6879b
JM
3720static int wpa_ft_rrb_rx_pull(struct wpa_authenticator *wpa_auth,
3721 const u8 *src_addr,
245fc96e 3722 const u8 *enc, size_t enc_len,
eefe8630
MB
3723 const u8 *auth, size_t auth_len,
3724 int no_defer)
6fc6879b 3725{
245fc96e
MB
3726 const char *msgtype = "pull request";
3727 u8 *plain = NULL, *packet = NULL;
3728 size_t plain_len = 0, packet_len = 0;
3a46cf93 3729 struct ft_remote_r1kh *r1kh, *r1kh_wildcard;
245fc96e
MB
3730 const u8 *key;
3731 size_t key_len;
eefe8630 3732 int seq_ret;
245fc96e
MB
3733 const u8 *f_nonce, *f_r0kh_id, *f_r1kh_id, *f_s1kh_id, *f_pmk_r0_name;
3734 size_t f_nonce_len, f_r0kh_id_len, f_r1kh_id_len, f_s1kh_id_len;
3735 size_t f_pmk_r0_name_len;
3736 const struct wpa_ft_pmk_r0_sa *r0;
3737 int ret;
3738 struct tlv_list resp[2];
eefe8630
MB
3739 struct tlv_list resp_auth[5];
3740 struct ft_rrb_seq f_seq;
6fc6879b
JM
3741
3742 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull");
3743
245fc96e
MB
3744 RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, msgtype, -1);
3745 wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID", f_r0kh_id, f_r0kh_id_len);
3746
3747 if (wpa_ft_rrb_check_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len)) {
3748 wpa_printf(MSG_DEBUG, "FT: R0KH-ID mismatch");
3749 goto out;
3750 }
3751
3752 RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, msgtype, FT_R1KH_ID_LEN);
3753 wpa_printf(MSG_DEBUG, "FT: R1KH-ID=" MACSTR, MAC2STR(f_r1kh_id));
3754
3a46cf93
MB
3755 wpa_ft_rrb_lookup_r1kh(wpa_auth, f_r1kh_id, &r1kh, &r1kh_wildcard);
3756 if (r1kh) {
3757 key = r1kh->key;
3758 key_len = sizeof(r1kh->key);
3759 } else if (r1kh_wildcard) {
3760 wpa_printf(MSG_DEBUG, "FT: Using wildcard R1KH-ID");
3761 key = r1kh_wildcard->key;
3762 key_len = sizeof(r1kh_wildcard->key);
3763 } else {
245fc96e 3764 goto out;
3a46cf93 3765 }
245fc96e
MB
3766
3767 RRB_GET_AUTH(FT_RRB_NONCE, nonce, "pull request", FT_RRB_NONCE_LEN);
3768 wpa_hexdump(MSG_DEBUG, "FT: nonce", f_nonce, f_nonce_len);
3769
3a46cf93
MB
3770 seq_ret = FT_RRB_SEQ_DROP;
3771 if (r1kh)
3772 seq_ret = wpa_ft_rrb_seq_chk(r1kh->seq, src_addr, enc, enc_len,
3773 auth, auth_len, msgtype, no_defer);
3774 if (!no_defer && r1kh_wildcard &&
3775 (!r1kh || os_memcmp(r1kh->addr, src_addr, ETH_ALEN) != 0)) {
3776 /* wildcard: r1kh-id unknown or changed addr -> do a seq req */
3777 seq_ret = FT_RRB_SEQ_DEFER;
3778 }
3779
eefe8630
MB
3780 if (seq_ret == FT_RRB_SEQ_DROP)
3781 goto out;
3782
245fc96e
MB
3783 if (wpa_ft_rrb_decrypt(key, key_len, enc, enc_len, auth, auth_len,
3784 src_addr, FT_PACKET_R0KH_R1KH_PULL,
3785 &plain, &plain_len) < 0)
3786 goto out;
3787
3a46cf93
MB
3788 if (!r1kh)
3789 r1kh = wpa_ft_rrb_add_r1kh(wpa_auth, r1kh_wildcard, src_addr,
3790 f_r1kh_id,
3791 wpa_auth->conf.rkh_pos_timeout);
3792 if (!r1kh)
3793 goto out;
3794
eefe8630
MB
3795 if (seq_ret == FT_RRB_SEQ_DEFER) {
3796 wpa_ft_rrb_seq_req(wpa_auth, r1kh->seq, src_addr, f_r0kh_id,
3797 f_r0kh_id_len, f_r1kh_id, key, key_len,
3798 enc, enc_len, auth, auth_len,
3799 &wpa_ft_rrb_rx_pull);
3800 goto out;
3801 }
3802
3803 wpa_ft_rrb_seq_accept(wpa_auth, r1kh->seq, src_addr, auth, auth_len,
3804 msgtype);
3a46cf93
MB
3805 wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh,
3806 wpa_auth->conf.rkh_pos_timeout);
eefe8630 3807
245fc96e
MB
3808 RRB_GET(FT_RRB_PMK_R0_NAME, pmk_r0_name, msgtype, WPA_PMK_NAME_LEN);
3809 wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name", f_pmk_r0_name,
3810 f_pmk_r0_name_len);
3811
3812 RRB_GET(FT_RRB_S1KH_ID, s1kh_id, msgtype, ETH_ALEN);
3813 wpa_printf(MSG_DEBUG, "FT: S1KH-ID=" MACSTR, MAC2STR(f_s1kh_id));
3814
eefe8630
MB
3815 if (wpa_ft_new_seq(r1kh->seq, &f_seq) < 0) {
3816 wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
3817 goto out;
3818 }
3819
a422d9b4
JM
3820 wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 pull response from " MACSTR
3821 " to " MACSTR,
3822 MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
3823
245fc96e
MB
3824 resp[0].type = FT_RRB_S1KH_ID;
3825 resp[0].len = f_s1kh_id_len;
3826 resp[0].data = f_s1kh_id;
3827 resp[1].type = FT_RRB_LAST_EMPTY;
3828 resp[1].len = 0;
3829 resp[1].data = NULL;
3830
3831 resp_auth[0].type = FT_RRB_NONCE;
3832 resp_auth[0].len = f_nonce_len;
3833 resp_auth[0].data = f_nonce;
eefe8630
MB
3834 resp_auth[1].type = FT_RRB_SEQ;
3835 resp_auth[1].len = sizeof(f_seq);
3836 resp_auth[1].data = (u8 *) &f_seq;
3837 resp_auth[2].type = FT_RRB_R0KH_ID;
3838 resp_auth[2].len = f_r0kh_id_len;
3839 resp_auth[2].data = f_r0kh_id;
3840 resp_auth[3].type = FT_RRB_R1KH_ID;
3841 resp_auth[3].len = f_r1kh_id_len;
3842 resp_auth[3].data = f_r1kh_id;
3843 resp_auth[4].type = FT_RRB_LAST_EMPTY;
3844 resp_auth[4].len = 0;
3845 resp_auth[4].data = NULL;
245fc96e 3846
9fbe292f 3847 if (wpa_ft_fetch_pmk_r0(wpa_auth, f_s1kh_id, f_pmk_r0_name, &r0) < 0) {
245fc96e 3848 wpa_printf(MSG_DEBUG, "FT: No matching PMK-R0-Name found");
9fbe292f
MB
3849 ret = wpa_ft_rrb_build(key, key_len, resp, NULL, resp_auth,
3850 NULL, wpa_auth->addr,
3851 FT_PACKET_R0KH_R1KH_RESP,
3852 &packet, &packet_len);
3853 } else {
3854 ret = wpa_ft_rrb_build_r0(key, key_len, resp, r0, f_r1kh_id,
3855 f_s1kh_id, resp_auth, wpa_auth->addr,
3856 FT_PACKET_R0KH_R1KH_RESP,
3857 &packet, &packet_len);
3858 }
245fc96e
MB
3859
3860 if (!ret)
3861 wpa_ft_rrb_oui_send(wpa_auth, src_addr,
3862 FT_PACKET_R0KH_R1KH_RESP, packet,
3863 packet_len);
3864
3865out:
3866 os_free(plain);
3867 os_free(packet);
6fc6879b 3868
245fc96e
MB
3869 return 0;
3870}
6fc6879b 3871
6fc6879b 3872
245fc96e
MB
3873/* @returns 0 on success
3874 * -1 on error
3a46cf93 3875 * -2 if FR_RRB_PAIRWISE is missing
245fc96e
MB
3876 */
3877static int wpa_ft_rrb_rx_r1(struct wpa_authenticator *wpa_auth,
3878 const u8 *src_addr, u8 type,
3879 const u8 *enc, size_t enc_len,
3880 const u8 *auth, size_t auth_len,
eefe8630
MB
3881 const char *msgtype, u8 *s1kh_id_out,
3882 int (*cb)(struct wpa_authenticator *wpa_auth,
3883 const u8 *src_addr,
3884 const u8 *enc, size_t enc_len,
3885 const u8 *auth, size_t auth_len,
3886 int no_defer))
245fc96e
MB
3887{
3888 u8 *plain = NULL;
3889 size_t plain_len = 0;
3a46cf93 3890 struct ft_remote_r0kh *r0kh, *r0kh_wildcard;
245fc96e
MB
3891 const u8 *key;
3892 size_t key_len;
eefe8630 3893 int seq_ret;
245fc96e
MB
3894 const u8 *f_r1kh_id, *f_s1kh_id, *f_r0kh_id;
3895 const u8 *f_pmk_r1_name, *f_pairwise, *f_pmk_r1;
3a3e2832 3896 const u8 *f_expires_in;
245fc96e 3897 size_t f_r1kh_id_len, f_s1kh_id_len, f_r0kh_id_len;
069b4e30 3898 const u8 *f_identity, *f_radius_cui;
a6509e85 3899 const u8 *f_session_timeout;
245fc96e 3900 size_t f_pmk_r1_name_len, f_pairwise_len, f_pmk_r1_len;
3a3e2832 3901 size_t f_expires_in_len;
069b4e30 3902 size_t f_identity_len, f_radius_cui_len;
a6509e85 3903 size_t f_session_timeout_len;
245fc96e
MB
3904 int pairwise;
3905 int ret = -1;
3a3e2832 3906 int expires_in;
a6509e85 3907 int session_timeout;
17010c38 3908 struct vlan_description vlan;
3d9cd084 3909 size_t pmk_r1_len;
6fc6879b 3910
245fc96e
MB
3911 RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, msgtype, -1);
3912 wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID", f_r0kh_id, f_r0kh_id_len);
6fc6879b 3913
245fc96e
MB
3914 RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, msgtype, FT_R1KH_ID_LEN);
3915 wpa_printf(MSG_DEBUG, "FT: R1KH-ID=" MACSTR, MAC2STR(f_r1kh_id));
3916
3917 if (wpa_ft_rrb_check_r1kh(wpa_auth, f_r1kh_id)) {
3918 wpa_printf(MSG_DEBUG, "FT: R1KH-ID mismatch");
3919 goto out;
6fc6879b
JM
3920 }
3921
3a46cf93
MB
3922 wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len, &r0kh,
3923 &r0kh_wildcard);
3924 if (r0kh) {
3925 key = r0kh->key;
3926 key_len = sizeof(r0kh->key);
3927 } else if (r0kh_wildcard) {
3928 wpa_printf(MSG_DEBUG, "FT: Using wildcard R0KH-ID");
3929 key = r0kh_wildcard->key;
3930 key_len = sizeof(r0kh_wildcard->key);
3931 } else {
245fc96e 3932 goto out;
3a46cf93
MB
3933 }
3934
3935 seq_ret = FT_RRB_SEQ_DROP;
3936 if (r0kh) {
3937 seq_ret = wpa_ft_rrb_seq_chk(r0kh->seq, src_addr, enc, enc_len,
3938 auth, auth_len, msgtype,
3939 cb ? 0 : 1);
3940 }
3941 if (cb && r0kh_wildcard &&
3942 (!r0kh || os_memcmp(r0kh->addr, src_addr, ETH_ALEN) != 0)) {
3943 /* wildcard: r0kh-id unknown or changed addr -> do a seq req */
3944 seq_ret = FT_RRB_SEQ_DEFER;
3945 }
6fc6879b 3946
eefe8630
MB
3947 if (seq_ret == FT_RRB_SEQ_DROP)
3948 goto out;
3949
245fc96e
MB
3950 if (wpa_ft_rrb_decrypt(key, key_len, enc, enc_len, auth, auth_len,
3951 src_addr, type, &plain, &plain_len) < 0)
3952 goto out;
3953
3a46cf93
MB
3954 if (!r0kh)
3955 r0kh = wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard, src_addr,
3956 f_r0kh_id, f_r0kh_id_len,
3957 wpa_auth->conf.rkh_pos_timeout);
3958 if (!r0kh)
3959 goto out;
3960
eefe8630
MB
3961 if (seq_ret == FT_RRB_SEQ_DEFER) {
3962 wpa_ft_rrb_seq_req(wpa_auth, r0kh->seq, src_addr, f_r0kh_id,
3963 f_r0kh_id_len, f_r1kh_id, key, key_len,
3964 enc, enc_len, auth, auth_len, cb);
3965 goto out;
3966 }
3967
3968 wpa_ft_rrb_seq_accept(wpa_auth, r0kh->seq, src_addr, auth, auth_len,
3969 msgtype);
3a46cf93
MB
3970 wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh,
3971 wpa_auth->conf.rkh_pos_timeout);
eefe8630 3972
245fc96e
MB
3973 RRB_GET(FT_RRB_S1KH_ID, s1kh_id, msgtype, ETH_ALEN);
3974 wpa_printf(MSG_DEBUG, "FT: S1KH-ID=" MACSTR, MAC2STR(f_s1kh_id));
3975
3976 if (s1kh_id_out)
3977 os_memcpy(s1kh_id_out, f_s1kh_id, ETH_ALEN);
3978
3a46cf93 3979 ret = -2;
245fc96e
MB
3980 RRB_GET(FT_RRB_PAIRWISE, pairwise, msgtype, sizeof(le16));
3981 wpa_hexdump(MSG_DEBUG, "FT: pairwise", f_pairwise, f_pairwise_len);
3982
3a46cf93 3983 ret = -1;
245fc96e
MB
3984 RRB_GET(FT_RRB_PMK_R1_NAME, pmk_r1_name, msgtype, WPA_PMK_NAME_LEN);
3985 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name",
3986 f_pmk_r1_name, WPA_PMK_NAME_LEN);
3987
3d9cd084
JM
3988 pmk_r1_len = PMK_LEN;
3989 if (wpa_ft_rrb_get_tlv(plain, plain_len, FT_RRB_PMK_R1, &f_pmk_r1_len,
3990 &f_pmk_r1) == 0 &&
3991 (f_pmk_r1_len == PMK_LEN || f_pmk_r1_len == SHA384_MAC_LEN))
3992 pmk_r1_len = f_pmk_r1_len;
3993 RRB_GET(FT_RRB_PMK_R1, pmk_r1, msgtype, pmk_r1_len);
3994 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", f_pmk_r1, pmk_r1_len);
245fc96e
MB
3995
3996 pairwise = WPA_GET_LE16(f_pairwise);
3997
3a3e2832
MB
3998 RRB_GET_OPTIONAL(FT_RRB_EXPIRES_IN, expires_in, msgtype,
3999 sizeof(le16));
4000 if (f_expires_in)
4001 expires_in = WPA_GET_LE16(f_expires_in);
4002 else
4003 expires_in = 0;
4004
4005 wpa_printf(MSG_DEBUG, "FT: PMK-R1 %s - expires_in=%d", msgtype,
4006 expires_in);
4007
17010c38
MB
4008 if (wpa_ft_rrb_get_tlv_vlan(plain, plain_len, &vlan) < 0) {
4009 wpa_printf(MSG_DEBUG, "FT: Cannot parse vlan");
4010 wpa_ft_rrb_dump(plain, plain_len);
4011 goto out;
4012 }
4013
4014 wpa_printf(MSG_DEBUG, "FT: vlan %d%s",
4015 le_to_host16(vlan.untagged), vlan.tagged[0] ? "+" : "");
4016
069b4e30
MB
4017 RRB_GET_OPTIONAL(FT_RRB_IDENTITY, identity, msgtype, -1);
4018 if (f_identity)
4019 wpa_hexdump_ascii(MSG_DEBUG, "FT: Identity", f_identity,
4020 f_identity_len);
4021
4022 RRB_GET_OPTIONAL(FT_RRB_RADIUS_CUI, radius_cui, msgtype, -1);
4023 if (f_radius_cui)
4024 wpa_hexdump_ascii(MSG_DEBUG, "FT: CUI", f_radius_cui,
4025 f_radius_cui_len);
4026
a6509e85
MB
4027 RRB_GET_OPTIONAL(FT_RRB_SESSION_TIMEOUT, session_timeout, msgtype,
4028 sizeof(le32));
4029 if (f_session_timeout)
4030 session_timeout = WPA_GET_LE32(f_session_timeout);
4031 else
4032 session_timeout = 0;
4033 wpa_printf(MSG_DEBUG, "FT: session_timeout %d", session_timeout);
4034
3d9cd084 4035 if (wpa_ft_store_pmk_r1(wpa_auth, f_s1kh_id, f_pmk_r1, pmk_r1_len,
a3e18dbb 4036 f_pmk_r1_name,
a6509e85
MB
4037 pairwise, &vlan, expires_in, session_timeout,
4038 f_identity, f_identity_len, f_radius_cui,
069b4e30 4039 f_radius_cui_len) < 0)
245fc96e
MB
4040 goto out;
4041
4042 ret = 0;
4043out:
31bc66e4 4044 bin_clear_free(plain, plain_len);
245fc96e
MB
4045
4046 return ret;
6fc6879b 4047
6fc6879b
JM
4048}
4049
4050
245fc96e 4051static void ft_finish_pull(struct wpa_state_machine *sm)
692ec305 4052{
692ec305
JM
4053 int res;
4054 u8 *resp_ies;
4055 size_t resp_ies_len;
4056 u16 status;
4057
3a46cf93
MB
4058 if (!sm->ft_pending_cb || !sm->ft_pending_req_ies)
4059 return;
4060
692ec305
JM
4061 res = wpa_ft_process_auth_req(sm, wpabuf_head(sm->ft_pending_req_ies),
4062 wpabuf_len(sm->ft_pending_req_ies),
4063 &resp_ies, &resp_ies_len);
3a46cf93
MB
4064 if (res < 0) {
4065 /* this loop is broken by ft_pending_pull_left_retries */
4066 wpa_printf(MSG_DEBUG,
4067 "FT: Callback postponed until response is available");
4068 return;
4069 }
692ec305
JM
4070 wpabuf_free(sm->ft_pending_req_ies);
4071 sm->ft_pending_req_ies = NULL;
692ec305
JM
4072 status = res;
4073 wpa_printf(MSG_DEBUG, "FT: Postponed auth callback result for " MACSTR
4074 " - status %u", MAC2STR(sm->addr), status);
4075
4076 sm->ft_pending_cb(sm->ft_pending_cb_ctx, sm->addr, sm->wpa_auth->addr,
4077 sm->ft_pending_auth_transaction + 1, status,
4078 resp_ies, resp_ies_len);
4079 os_free(resp_ies);
4080}
4081
4082
245fc96e
MB
4083struct ft_get_sta_ctx {
4084 const u8 *nonce;
4085 const u8 *s1kh_id;
4086 struct wpa_state_machine *sm;
4087};
4088
4089
4090static int ft_get_sta_cb(struct wpa_state_machine *sm, void *ctx)
692ec305 4091{
245fc96e 4092 struct ft_get_sta_ctx *info = ctx;
692ec305 4093
245fc96e
MB
4094 if ((info->s1kh_id &&
4095 os_memcmp(info->s1kh_id, sm->addr, ETH_ALEN) != 0) ||
4096 os_memcmp(info->nonce, sm->ft_pending_pull_nonce,
4097 FT_RRB_NONCE_LEN) != 0 ||
a8e25dee 4098 sm->ft_pending_cb == NULL || sm->ft_pending_req_ies == NULL)
692ec305
JM
4099 return 0;
4100
245fc96e
MB
4101 info->sm = sm;
4102
692ec305
JM
4103 return 1;
4104}
4105
4106
6fc6879b
JM
4107static int wpa_ft_rrb_rx_resp(struct wpa_authenticator *wpa_auth,
4108 const u8 *src_addr,
245fc96e 4109 const u8 *enc, size_t enc_len,
eefe8630
MB
4110 const u8 *auth, size_t auth_len,
4111 int no_defer)
6fc6879b 4112{
245fc96e 4113 const char *msgtype = "pull response";
3a46cf93 4114 int nak, ret = -1;
245fc96e
MB
4115 struct ft_get_sta_ctx ctx;
4116 u8 s1kh_id[ETH_ALEN];
4117 const u8 *f_nonce;
4118 size_t f_nonce_len;
6fc6879b
JM
4119
4120 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull response");
4121
245fc96e
MB
4122 RRB_GET_AUTH(FT_RRB_NONCE, nonce, msgtype, FT_RRB_NONCE_LEN);
4123 wpa_hexdump(MSG_DEBUG, "FT: nonce", f_nonce, f_nonce_len);
6fc6879b 4124
245fc96e
MB
4125 os_memset(&ctx, 0, sizeof(ctx));
4126 ctx.nonce = f_nonce;
4127 if (!wpa_auth_for_each_sta(wpa_auth, ft_get_sta_cb, &ctx)) {
4128 /* nonce not found */
4129 wpa_printf(MSG_DEBUG, "FT: Invalid nonce");
6fc6879b
JM
4130 return -1;
4131 }
4132
245fc96e 4133 ret = wpa_ft_rrb_rx_r1(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_RESP,
eefe8630
MB
4134 enc, enc_len, auth, auth_len, msgtype, s1kh_id,
4135 no_defer ? NULL : &wpa_ft_rrb_rx_resp);
3a46cf93
MB
4136 if (ret == -2) {
4137 ret = 0;
4138 nak = 1;
4139 } else {
4140 nak = 0;
4141 }
245fc96e 4142 if (ret < 0)
6fc6879b 4143 return -1;
6fc6879b 4144
245fc96e
MB
4145 ctx.s1kh_id = s1kh_id;
4146 if (wpa_auth_for_each_sta(wpa_auth, ft_get_sta_cb, &ctx)) {
4147 wpa_printf(MSG_DEBUG,
4148 "FT: Response to a pending pull request for " MACSTR,
4149 MAC2STR(ctx.sm->addr));
3a46cf93
MB
4150 eloop_cancel_timeout(wpa_ft_expire_pull, ctx.sm, NULL);
4151 if (nak)
4152 ctx.sm->ft_pending_pull_left_retries = 0;
245fc96e 4153 ft_finish_pull(ctx.sm);
6fc6879b
JM
4154 }
4155
245fc96e
MB
4156out:
4157 return ret;
6fc6879b
JM
4158}
4159
4160
4161static int wpa_ft_rrb_rx_push(struct wpa_authenticator *wpa_auth,
4162 const u8 *src_addr,
245fc96e 4163 const u8 *enc, size_t enc_len,
eefe8630 4164 const u8 *auth, size_t auth_len, int no_defer)
6fc6879b 4165{
245fc96e 4166 const char *msgtype = "push";
6fc6879b
JM
4167
4168 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 push");
4169
eefe8630
MB
4170 if (wpa_ft_rrb_rx_r1(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_PUSH,
4171 enc, enc_len, auth, auth_len, msgtype, NULL,
4172 no_defer ? NULL : wpa_ft_rrb_rx_push) < 0)
6fc6879b 4173 return -1;
eefe8630
MB
4174
4175 return 0;
4176}
4177
4178
4179static int wpa_ft_rrb_rx_seq(struct wpa_authenticator *wpa_auth,
4180 const u8 *src_addr, int type,
4181 const u8 *enc, size_t enc_len,
4182 const u8 *auth, size_t auth_len,
4183 struct ft_remote_seq **rkh_seq,
3a46cf93
MB
4184 u8 **key, size_t *key_len,
4185 struct ft_remote_r0kh **r0kh_out,
4186 struct ft_remote_r1kh **r1kh_out,
4187 struct ft_remote_r0kh **r0kh_wildcard_out,
4188 struct ft_remote_r1kh **r1kh_wildcard_out)
eefe8630
MB
4189{
4190 struct ft_remote_r0kh *r0kh = NULL;
4191 struct ft_remote_r1kh *r1kh = NULL;
4192 const u8 *f_r0kh_id, *f_r1kh_id;
4193 size_t f_r0kh_id_len, f_r1kh_id_len;
4194 int to_r0kh, to_r1kh;
4195 u8 *plain = NULL;
4196 size_t plain_len = 0;
3a46cf93
MB
4197 struct ft_remote_r0kh *r0kh_wildcard;
4198 struct ft_remote_r1kh *r1kh_wildcard;
eefe8630
MB
4199
4200 RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, "seq", -1);
4201 RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, "seq", FT_R1KH_ID_LEN);
4202
4203 to_r0kh = !wpa_ft_rrb_check_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len);
4204 to_r1kh = !wpa_ft_rrb_check_r1kh(wpa_auth, f_r1kh_id);
4205
4206 if (to_r0kh && to_r1kh) {
4207 wpa_printf(MSG_DEBUG, "FT: seq - local R0KH-ID and R1KH-ID");
4208 goto out;
6fc6879b
JM
4209 }
4210
eefe8630
MB
4211 if (!to_r0kh && !to_r1kh) {
4212 wpa_printf(MSG_DEBUG, "FT: seq - remote R0KH-ID and R1KH-ID");
4213 goto out;
4214 }
4215
4216 if (!to_r0kh) {
4217 wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len,
3a46cf93
MB
4218 &r0kh, &r0kh_wildcard);
4219 if (!r0kh_wildcard &&
4220 (!r0kh || os_memcmp(r0kh->addr, src_addr, ETH_ALEN) != 0)) {
eefe8630
MB
4221 wpa_hexdump(MSG_DEBUG, "FT: Did not find R0KH-ID",
4222 f_r0kh_id, f_r0kh_id_len);
4223 goto out;
4224 }
3a46cf93
MB
4225 if (r0kh) {
4226 *key = r0kh->key;
4227 *key_len = sizeof(r0kh->key);
4228 } else {
4229 *key = r0kh_wildcard->key;
4230 *key_len = sizeof(r0kh_wildcard->key);
4231 }
eefe8630
MB
4232 }
4233
4234 if (!to_r1kh) {
3a46cf93
MB
4235 wpa_ft_rrb_lookup_r1kh(wpa_auth, f_r1kh_id, &r1kh,
4236 &r1kh_wildcard);
4237 if (!r1kh_wildcard &&
4238 (!r1kh || os_memcmp(r1kh->addr, src_addr, ETH_ALEN) != 0)) {
eefe8630
MB
4239 wpa_hexdump(MSG_DEBUG, "FT: Did not find R1KH-ID",
4240 f_r1kh_id, FT_R1KH_ID_LEN);
4241 goto out;
4242 }
3a46cf93
MB
4243 if (r1kh) {
4244 *key = r1kh->key;
4245 *key_len = sizeof(r1kh->key);
4246 } else {
4247 *key = r1kh_wildcard->key;
4248 *key_len = sizeof(r1kh_wildcard->key);
4249 }
eefe8630
MB
4250 }
4251
4252 if (wpa_ft_rrb_decrypt(*key, *key_len, enc, enc_len, auth, auth_len,
4253 src_addr, type, &plain, &plain_len) < 0)
4254 goto out;
4255
4256 os_free(plain);
4257
3a46cf93
MB
4258 if (!to_r0kh) {
4259 if (!r0kh)
4260 r0kh = wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard,
4261 src_addr, f_r0kh_id,
4262 f_r0kh_id_len,
4263 ftRRBseqTimeout);
4264 if (!r0kh)
4265 goto out;
4266
4267 wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh, ftRRBseqTimeout);
4268 *rkh_seq = r0kh->seq;
4269 if (r0kh_out)
4270 *r0kh_out = r0kh;
4271 if (r0kh_wildcard_out)
4272 *r0kh_wildcard_out = r0kh_wildcard;
4273 }
4274
4275 if (!to_r1kh) {
4276 if (!r1kh)
4277 r1kh = wpa_ft_rrb_add_r1kh(wpa_auth, r1kh_wildcard,
4278 src_addr, f_r1kh_id,
4279 ftRRBseqTimeout);
4280 if (!r1kh)
4281 goto out;
4282
4283 wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh, ftRRBseqTimeout);
4284 *rkh_seq = r1kh->seq;
4285 if (r1kh_out)
4286 *r1kh_out = r1kh;
4287 if (r1kh_wildcard_out)
4288 *r1kh_wildcard_out = r1kh_wildcard;
4289 }
4290
eefe8630
MB
4291 return 0;
4292out:
4293 return -1;
4294}
4295
4296
4297static int wpa_ft_rrb_rx_seq_req(struct wpa_authenticator *wpa_auth,
4298 const u8 *src_addr,
4299 const u8 *enc, size_t enc_len,
4300 const u8 *auth, size_t auth_len,
4301 int no_defer)
4302{
4303 int ret = -1;
4304 struct ft_rrb_seq f_seq;
4305 const u8 *f_nonce, *f_r0kh_id, *f_r1kh_id;
4306 size_t f_nonce_len, f_r0kh_id_len, f_r1kh_id_len;
3a46cf93 4307 struct ft_remote_seq *rkh_seq = NULL;
eefe8630
MB
4308 u8 *packet = NULL, *key = NULL;
4309 size_t packet_len = 0, key_len = 0;
4310 struct tlv_list seq_resp_auth[5];
4311
4312 wpa_printf(MSG_DEBUG, "FT: Received sequence number request");
4313
4314 if (wpa_ft_rrb_rx_seq(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_SEQ_REQ,
4315 enc, enc_len, auth, auth_len, &rkh_seq, &key,
3a46cf93 4316 &key_len, NULL, NULL, NULL, NULL) < 0)
eefe8630
MB
4317 goto out;
4318
4319 RRB_GET_AUTH(FT_RRB_NONCE, nonce, "seq request", FT_RRB_NONCE_LEN);
4320 wpa_hexdump(MSG_DEBUG, "FT: seq request - nonce", f_nonce, f_nonce_len);
4321
4322 RRB_GET_AUTH(FT_RRB_R0KH_ID, r0kh_id, "seq", -1);
4323 RRB_GET_AUTH(FT_RRB_R1KH_ID, r1kh_id, "seq", FT_R1KH_ID_LEN);
4324
4325 if (wpa_ft_new_seq(rkh_seq, &f_seq) < 0) {
4326 wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
4327 goto out;
4328 }
4329
a422d9b4
JM
4330 wpa_printf(MSG_DEBUG, "FT: Send sequence number response from " MACSTR
4331 " to " MACSTR,
4332 MAC2STR(wpa_auth->addr), MAC2STR(src_addr));
4333
eefe8630
MB
4334 seq_resp_auth[0].type = FT_RRB_NONCE;
4335 seq_resp_auth[0].len = f_nonce_len;
4336 seq_resp_auth[0].data = f_nonce;
4337 seq_resp_auth[1].type = FT_RRB_SEQ;
4338 seq_resp_auth[1].len = sizeof(f_seq);
4339 seq_resp_auth[1].data = (u8 *) &f_seq;
4340 seq_resp_auth[2].type = FT_RRB_R0KH_ID;
4341 seq_resp_auth[2].len = f_r0kh_id_len;
4342 seq_resp_auth[2].data = f_r0kh_id;
4343 seq_resp_auth[3].type = FT_RRB_R1KH_ID;
4344 seq_resp_auth[3].len = FT_R1KH_ID_LEN;
4345 seq_resp_auth[3].data = f_r1kh_id;
4346 seq_resp_auth[4].type = FT_RRB_LAST_EMPTY;
4347 seq_resp_auth[4].len = 0;
4348 seq_resp_auth[4].data = NULL;
4349
17010c38 4350 if (wpa_ft_rrb_build(key, key_len, NULL, NULL, seq_resp_auth, NULL,
eefe8630
MB
4351 wpa_auth->addr, FT_PACKET_R0KH_R1KH_SEQ_RESP,
4352 &packet, &packet_len) < 0)
4353 goto out;
4354
4355 wpa_ft_rrb_oui_send(wpa_auth, src_addr,
4356 FT_PACKET_R0KH_R1KH_SEQ_RESP, packet,
4357 packet_len);
4358
4359out:
4360 os_free(packet);
4361
4362 return ret;
4363}
4364
4365
4366static int wpa_ft_rrb_rx_seq_resp(struct wpa_authenticator *wpa_auth,
4367 const u8 *src_addr,
4368 const u8 *enc, size_t enc_len,
4369 const u8 *auth, size_t auth_len,
4370 int no_defer)
4371{
4372 u8 *key = NULL;
4373 size_t key_len = 0;
3a46cf93
MB
4374 struct ft_remote_r0kh *r0kh = NULL, *r0kh_wildcard = NULL;
4375 struct ft_remote_r1kh *r1kh = NULL, *r1kh_wildcard = NULL;
eefe8630
MB
4376 const u8 *f_nonce, *f_seq;
4377 size_t f_nonce_len, f_seq_len;
4378 struct ft_remote_seq *rkh_seq = NULL;
4379 struct ft_remote_item *item;
4380 struct os_reltime now, now_remote;
4381 int seq_ret, found;
4382 const struct ft_rrb_seq *msg_both;
4383 u32 msg_dom, msg_seq;
4384
4385 wpa_printf(MSG_DEBUG, "FT: Received sequence number response");
4386
4387 if (wpa_ft_rrb_rx_seq(wpa_auth, src_addr, FT_PACKET_R0KH_R1KH_SEQ_RESP,
4388 enc, enc_len, auth, auth_len, &rkh_seq, &key,
3a46cf93
MB
4389 &key_len, &r0kh, &r1kh, &r0kh_wildcard,
4390 &r1kh_wildcard) < 0)
eefe8630
MB
4391 goto out;
4392
4393 RRB_GET_AUTH(FT_RRB_NONCE, nonce, "seq response", FT_RRB_NONCE_LEN);
4394 wpa_hexdump(MSG_DEBUG, "FT: seq response - nonce", f_nonce,
4395 f_nonce_len);
4396
4397 found = 0;
4398 dl_list_for_each(item, &rkh_seq->rx.queue, struct ft_remote_item,
4399 list) {
4400 if (os_memcmp_const(f_nonce, item->nonce,
4401 FT_RRB_NONCE_LEN) != 0 ||
4402 os_get_reltime(&now) < 0 ||
4403 os_reltime_expired(&now, &item->nonce_ts, ftRRBseqTimeout))
4404 continue;
4405
4406 found = 1;
4407 break;
4408 }
4409 if (!found) {
4410 wpa_printf(MSG_DEBUG, "FT: seq response - bad nonce");
4411 goto out;
4412 }
4413
3a46cf93
MB
4414 if (r0kh) {
4415 wpa_ft_rrb_r0kh_replenish(wpa_auth, r0kh,
4416 wpa_auth->conf.rkh_pos_timeout);
4417 if (r0kh_wildcard)
4418 os_memcpy(r0kh->addr, src_addr, ETH_ALEN);
4419 }
4420
4421 if (r1kh) {
4422 wpa_ft_rrb_r1kh_replenish(wpa_auth, r1kh,
4423 wpa_auth->conf.rkh_pos_timeout);
4424 if (r1kh_wildcard)
4425 os_memcpy(r1kh->addr, src_addr, ETH_ALEN);
4426 }
4427
eefe8630
MB
4428 seq_ret = wpa_ft_rrb_seq_chk(rkh_seq, src_addr, enc, enc_len, auth,
4429 auth_len, "seq response", 1);
4430 if (seq_ret == FT_RRB_SEQ_OK) {
4431 wpa_printf(MSG_DEBUG, "FT: seq response - valid seq number");
4432 wpa_ft_rrb_seq_accept(wpa_auth, rkh_seq, src_addr, auth,
4433 auth_len, "seq response");
4434 } else {
4435 wpa_printf(MSG_DEBUG, "FT: seq response - reset seq number");
4436
4437 RRB_GET_AUTH(FT_RRB_SEQ, seq, "seq response",
4438 sizeof(*msg_both));
4439 msg_both = (const struct ft_rrb_seq *) f_seq;
4440
4441 msg_dom = le_to_host32(msg_both->dom);
4442 msg_seq = le_to_host32(msg_both->seq);
4443 now_remote.sec = le_to_host32(msg_both->ts);
4444 now_remote.usec = 0;
4445
4446 rkh_seq->rx.num_last = 2;
4447 rkh_seq->rx.dom = msg_dom;
4448 rkh_seq->rx.offsetidx = 0;
4449 /* Accept some older, possibly cached packets as well */
4450 rkh_seq->rx.last[0] = msg_seq - FT_REMOTE_SEQ_BACKLOG -
4451 dl_list_len(&rkh_seq->rx.queue);
4452 rkh_seq->rx.last[1] = msg_seq;
4453
4454 /* local time - offset = remote time
4455 * <=> local time - remote time = offset */
4456 os_reltime_sub(&now, &now_remote, &rkh_seq->rx.time_offset);
4457 }
4458
4459 wpa_ft_rrb_seq_flush(wpa_auth, rkh_seq, 1);
6fc6879b
JM
4460
4461 return 0;
245fc96e
MB
4462out:
4463 return -1;
6fc6879b
JM
4464}
4465
4466
4467int wpa_ft_rrb_rx(struct wpa_authenticator *wpa_auth, const u8 *src_addr,
4468 const u8 *data, size_t data_len)
4469{
4470 struct ft_rrb_frame *frame;
4471 u16 alen;
4472 const u8 *pos, *end, *start;
4473 u8 action;
4474 const u8 *sta_addr, *target_ap_addr;
4475
4476 wpa_printf(MSG_DEBUG, "FT: RRB received frame from remote AP " MACSTR,
4477 MAC2STR(src_addr));
4478
4479 if (data_len < sizeof(*frame)) {
4480 wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (data_len=%lu)",
4481 (unsigned long) data_len);
4482 return -1;
4483 }
4484
4485 pos = data;
4486 frame = (struct ft_rrb_frame *) pos;
4487 pos += sizeof(*frame);
4488
4489 alen = le_to_host16(frame->action_length);
4490 wpa_printf(MSG_DEBUG, "FT: RRB frame - frame_type=%d packet_type=%d "
4491 "action_length=%d ap_address=" MACSTR,
4492 frame->frame_type, frame->packet_type, alen,
4493 MAC2STR(frame->ap_address));
4494
4495 if (frame->frame_type != RSN_REMOTE_FRAME_TYPE_FT_RRB) {
c1e033b0 4496 /* Discard frame per IEEE Std 802.11r-2008, 11A.10.3 */
6fc6879b
JM
4497 wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with "
4498 "unrecognized type %d", frame->frame_type);
4499 return -1;
4500 }
4501
4502 if (alen > data_len - sizeof(*frame)) {
4503 wpa_printf(MSG_DEBUG, "FT: RRB frame too short for action "
4504 "frame");
4505 return -1;
4506 }
4507
6fc6879b
JM
4508 wpa_hexdump(MSG_MSGDUMP, "FT: RRB - FT Action frame", pos, alen);
4509
4510 if (alen < 1 + 1 + 2 * ETH_ALEN) {
4511 wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (not enough "
4512 "room for Action Frame body); alen=%lu",
4513 (unsigned long) alen);
4514 return -1;
4515 }
4516 start = pos;
4517 end = pos + alen;
4518
4519 if (*pos != WLAN_ACTION_FT) {
4520 wpa_printf(MSG_DEBUG, "FT: Unexpected Action frame category "
4521 "%d", *pos);
4522 return -1;
4523 }
4524
4525 pos++;
4526 action = *pos++;
4527 sta_addr = pos;
4528 pos += ETH_ALEN;
4529 target_ap_addr = pos;
4530 pos += ETH_ALEN;
4531 wpa_printf(MSG_DEBUG, "FT: RRB Action Frame: action=%d sta_addr="
4532 MACSTR " target_ap_addr=" MACSTR,
4533 action, MAC2STR(sta_addr), MAC2STR(target_ap_addr));
4534
4535 if (frame->packet_type == FT_PACKET_REQUEST) {
4536 wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Request");
4537
4538 if (action != 1) {
4539 wpa_printf(MSG_DEBUG, "FT: Unexpected Action %d in "
4540 "RRB Request", action);
4541 return -1;
4542 }
4543
4544 if (os_memcmp(target_ap_addr, wpa_auth->addr, ETH_ALEN) != 0) {
4545 wpa_printf(MSG_DEBUG, "FT: Target AP address in the "
4546 "RRB Request does not match with own "
4547 "address");
4548 return -1;
4549 }
4550
4551 if (wpa_ft_rrb_rx_request(wpa_auth, frame->ap_address,
4552 sta_addr, pos, end - pos) < 0)
4553 return -1;
4554 } else if (frame->packet_type == FT_PACKET_RESPONSE) {
4555 u16 status_code;
4556
4557 if (end - pos < 2) {
4558 wpa_printf(MSG_DEBUG, "FT: Not enough room for status "
4559 "code in RRB Response");
4560 return -1;
4561 }
4562 status_code = WPA_GET_LE16(pos);
4563 pos += 2;
4564
4565 wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Response "
4566 "(status_code=%d)", status_code);
4567
4568 if (wpa_ft_action_send(wpa_auth, sta_addr, start, alen) < 0)
4569 return -1;
4570 } else {
4571 wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with unknown "
4572 "packet_type %d", frame->packet_type);
4573 return -1;
4574 }
4575
164a453f
JM
4576 if (end > pos) {
4577 wpa_hexdump(MSG_DEBUG, "FT: Ignore extra data in end",
4578 pos, end - pos);
4579 }
4580
6fc6879b
JM
4581 return 0;
4582}
4583
4584
50bd8e0a
MB
4585void wpa_ft_rrb_oui_rx(struct wpa_authenticator *wpa_auth, const u8 *src_addr,
4586 const u8 *dst_addr, u8 oui_suffix, const u8 *data,
4587 size_t data_len)
4588{
245fc96e
MB
4589 const u8 *auth, *enc;
4590 size_t alen, elen;
3a46cf93 4591 int no_defer = 0;
245fc96e 4592
a422d9b4
JM
4593 wpa_printf(MSG_DEBUG, "FT: RRB-OUI(" MACSTR
4594 ") received frame from remote AP "
4595 MACSTR " oui_suffix=%u dst=" MACSTR,
4596 MAC2STR(wpa_auth->addr), MAC2STR(src_addr), oui_suffix,
4597 MAC2STR(dst_addr));
555c93e2 4598 wpa_hexdump(MSG_MSGDUMP, "FT: RRB frame payload", data, data_len);
50bd8e0a
MB
4599
4600 if (is_multicast_ether_addr(src_addr)) {
4601 wpa_printf(MSG_DEBUG,
4602 "FT: RRB-OUI received frame from multicast address "
4603 MACSTR, MAC2STR(src_addr));
4604 return;
4605 }
4606
a422d9b4 4607 if (is_multicast_ether_addr(dst_addr))
3a46cf93 4608 no_defer = 1;
50bd8e0a 4609
245fc96e
MB
4610 if (data_len < sizeof(u16)) {
4611 wpa_printf(MSG_DEBUG, "FT: RRB-OUI frame too short");
4612 return;
4613 }
4614
4615 alen = WPA_GET_LE16(data);
4616 if (data_len < sizeof(u16) + alen) {
4617 wpa_printf(MSG_DEBUG, "FT: RRB-OUI frame too short");
4618 return;
4619 }
4620
4621 auth = data + sizeof(u16);
555c93e2 4622 wpa_hexdump(MSG_MSGDUMP, "FT: Authenticated payload", auth, alen);
245fc96e
MB
4623 enc = data + sizeof(u16) + alen;
4624 elen = data_len - sizeof(u16) - alen;
555c93e2 4625 wpa_hexdump(MSG_MSGDUMP, "FT: Encrypted payload", enc, elen);
245fc96e 4626
50bd8e0a
MB
4627 switch (oui_suffix) {
4628 case FT_PACKET_R0KH_R1KH_PULL:
eefe8630 4629 wpa_ft_rrb_rx_pull(wpa_auth, src_addr, enc, elen, auth, alen,
3a46cf93 4630 no_defer);
50bd8e0a
MB
4631 break;
4632 case FT_PACKET_R0KH_R1KH_RESP:
eefe8630 4633 wpa_ft_rrb_rx_resp(wpa_auth, src_addr, enc, elen, auth, alen,
3a46cf93 4634 no_defer);
50bd8e0a
MB
4635 break;
4636 case FT_PACKET_R0KH_R1KH_PUSH:
eefe8630 4637 wpa_ft_rrb_rx_push(wpa_auth, src_addr, enc, elen, auth, alen,
3a46cf93 4638 no_defer);
eefe8630
MB
4639 break;
4640 case FT_PACKET_R0KH_R1KH_SEQ_REQ:
4641 wpa_ft_rrb_rx_seq_req(wpa_auth, src_addr, enc, elen, auth, alen,
3a46cf93 4642 no_defer);
eefe8630
MB
4643 break;
4644 case FT_PACKET_R0KH_R1KH_SEQ_RESP:
4645 wpa_ft_rrb_rx_seq_resp(wpa_auth, src_addr, enc, elen, auth,
3a46cf93 4646 alen, no_defer);
50bd8e0a
MB
4647 break;
4648 }
4649}
4650
4651
364c064a
JM
4652static int wpa_ft_generate_pmk_r1(struct wpa_authenticator *wpa_auth,
4653 struct wpa_ft_pmk_r0_sa *pmk_r0,
4654 struct ft_remote_r1kh *r1kh,
245fc96e 4655 const u8 *s1kh_id)
6fc6879b 4656{
245fc96e
MB
4657 u8 *packet;
4658 size_t packet_len;
eefe8630 4659 struct ft_rrb_seq f_seq;
245fc96e
MB
4660 struct tlv_list push[] = {
4661 { .type = FT_RRB_S1KH_ID, .len = ETH_ALEN,
4662 .data = s1kh_id },
4663 { .type = FT_RRB_PMK_R0_NAME, .len = WPA_PMK_NAME_LEN,
4664 .data = pmk_r0->pmk_r0_name },
4665 { .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
4666 };
4667 struct tlv_list push_auth[] = {
eefe8630
MB
4668 { .type = FT_RRB_SEQ, .len = sizeof(f_seq),
4669 .data = (u8 *) &f_seq },
245fc96e
MB
4670 { .type = FT_RRB_R0KH_ID,
4671 .len = wpa_auth->conf.r0_key_holder_len,
4672 .data = wpa_auth->conf.r0_key_holder },
4673 { .type = FT_RRB_R1KH_ID, .len = FT_R1KH_ID_LEN,
4674 .data = r1kh->id },
4675 { .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL },
4676 };
4677
eefe8630
MB
4678 if (wpa_ft_new_seq(r1kh->seq, &f_seq) < 0) {
4679 wpa_printf(MSG_DEBUG, "FT: Failed to get seq num");
4680 return -1;
4681 }
245fc96e 4682
a422d9b4
JM
4683 wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 push from " MACSTR
4684 " to remote R0KH address " MACSTR,
4685 MAC2STR(wpa_auth->addr), MAC2STR(r1kh->addr));
4686
245fc96e
MB
4687 if (wpa_ft_rrb_build_r0(r1kh->key, sizeof(r1kh->key), push, pmk_r0,
4688 r1kh->id, s1kh_id, push_auth, wpa_auth->addr,
4689 FT_PACKET_R0KH_R1KH_PUSH,
4690 &packet, &packet_len) < 0)
364c064a 4691 return -1;
6fc6879b 4692
50bd8e0a 4693 wpa_ft_rrb_oui_send(wpa_auth, r1kh->addr, FT_PACKET_R0KH_R1KH_PUSH,
245fc96e
MB
4694 packet, packet_len);
4695
4696 os_free(packet);
364c064a 4697 return 0;
6fc6879b
JM
4698}
4699
4700
4701void wpa_ft_push_pmk_r1(struct wpa_authenticator *wpa_auth, const u8 *addr)
4702{
09211c98
MB
4703 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache;
4704 struct wpa_ft_pmk_r0_sa *r0, *r0found = NULL;
6fc6879b
JM
4705 struct ft_remote_r1kh *r1kh;
4706
4707 if (!wpa_auth->conf.pmk_r1_push)
4708 return;
3a46cf93
MB
4709 if (!wpa_auth->conf.r1kh_list)
4710 return;
6fc6879b 4711
09211c98
MB
4712 dl_list_for_each(r0, &cache->pmk_r0, struct wpa_ft_pmk_r0_sa, list) {
4713 if (os_memcmp(r0->spa, addr, ETH_ALEN) == 0) {
4714 r0found = r0;
6fc6879b 4715 break;
09211c98 4716 }
6fc6879b
JM
4717 }
4718
09211c98 4719 r0 = r0found;
6fc6879b
JM
4720 if (r0 == NULL || r0->pmk_r1_pushed)
4721 return;
4722 r0->pmk_r1_pushed = 1;
4723
4724 wpa_printf(MSG_DEBUG, "FT: Deriving and pushing PMK-R1 keys to R1KHs "
4725 "for STA " MACSTR, MAC2STR(addr));
4726
3a46cf93
MB
4727 for (r1kh = *wpa_auth->conf.r1kh_list; r1kh; r1kh = r1kh->next) {
4728 if (is_zero_ether_addr(r1kh->addr) ||
4729 is_zero_ether_addr(r1kh->id))
4730 continue;
eefe8630
MB
4731 if (wpa_ft_rrb_init_r1kh_seq(r1kh) < 0)
4732 continue;
245fc96e 4733 wpa_ft_generate_pmk_r1(wpa_auth, r0, r1kh, addr);
6fc6879b
JM
4734 }
4735}
4736
4ec1fd8e 4737#endif /* CONFIG_IEEE80211R_AP */