]>
Commit | Line | Data |
---|---|---|
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 |
33 | const unsigned int ftRRBseqTimeout = 10; |
34 | const unsigned int ftRRBmaxQueueLen = 100; | |
35 | ||
36 | ||
692ec305 JM |
37 | static int wpa_ft_send_rrb_auth_resp(struct wpa_state_machine *sm, |
38 | const u8 *current_ap, const u8 *sta_addr, | |
39 | u16 status, const u8 *resp_ies, | |
40 | size_t resp_ies_len); | |
3a46cf93 MB |
41 | static void ft_finish_pull(struct wpa_state_machine *sm); |
42 | static void wpa_ft_expire_pull(void *eloop_ctx, void *timeout_ctx); | |
eefe8630 | 43 | static void wpa_ft_rrb_seq_timeout(void *eloop_ctx, void *timeout_ctx); |
692ec305 | 44 | |
245fc96e MB |
45 | struct tlv_list { |
46 | u16 type; | |
47 | size_t len; | |
48 | const u8 *data; | |
49 | }; | |
50 | ||
51 | ||
52 | /** | |
53 | * wpa_ft_rrb_decrypt - Decrypt FT RRB message | |
54 | * @key: AES-SIV key for AEAD | |
55 | * @key_len: Length of key in octets | |
56 | * @enc: Pointer to encrypted TLVs | |
57 | * @enc_len: Length of encrypted TLVs in octets | |
58 | * @auth: Pointer to authenticated TLVs | |
59 | * @auth_len: Length of authenticated TLVs in octets | |
60 | * @src_addr: MAC address of the frame sender | |
61 | * @type: Vendor-specific subtype of the RRB frame (FT_PACKET_*) | |
62 | * @plain: Pointer to return the pointer to the allocated plaintext buffer; | |
63 | * needs to be freed by the caller if not NULL; | |
64 | * will only be returned on success | |
65 | * @plain_len: Pointer to return the length of the allocated plaintext buffer | |
66 | * in octets | |
67 | * Returns: 0 on success, -1 on error | |
68 | */ | |
69 | static 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; | |
122 | err: | |
123 | os_free(*plain); | |
124 | *plain = NULL; | |
125 | *plain_size = 0; | |
126 | ||
127 | wpa_printf(MSG_ERROR, "FT(RRB): Failed to decrypt"); | |
128 | ||
129 | return -1; | |
130 | } | |
131 | ||
132 | ||
133 | /* get first tlv record in packet matching type | |
134 | * @data (decrypted) packet | |
135 | * @return 0 on success else -1 | |
136 | */ | |
137 | static int wpa_ft_rrb_get_tlv(const u8 *plain, size_t plain_len, | |
138 | u16 type, size_t *tlv_len, const u8 **tlv_data) | |
139 | { | |
140 | const struct ft_rrb_tlv *f; | |
141 | size_t left; | |
142 | le16 type16; | |
143 | size_t len; | |
144 | ||
145 | left = plain_len; | |
146 | type16 = host_to_le16(type); | |
147 | ||
148 | while (left >= sizeof(*f)) { | |
149 | f = (const struct ft_rrb_tlv *) plain; | |
150 | ||
151 | left -= sizeof(*f); | |
152 | plain += sizeof(*f); | |
153 | len = le_to_host16(f->len); | |
154 | ||
155 | if (left < len) { | |
156 | wpa_printf(MSG_DEBUG, "FT: RRB message truncated"); | |
157 | break; | |
158 | } | |
159 | ||
160 | if (f->type == type16) { | |
161 | *tlv_len = len; | |
162 | *tlv_data = plain; | |
163 | return 0; | |
164 | } | |
165 | ||
166 | left -= len; | |
167 | plain += len; | |
168 | } | |
169 | ||
170 | return -1; | |
171 | } | |
172 | ||
173 | ||
174 | static void wpa_ft_rrb_dump(const u8 *plain, const size_t plain_len) | |
175 | { | |
176 | const struct ft_rrb_tlv *f; | |
177 | size_t left; | |
178 | size_t len; | |
179 | ||
180 | left = plain_len; | |
181 | ||
182 | wpa_printf(MSG_DEBUG, "FT: RRB dump message"); | |
183 | while (left >= sizeof(*f)) { | |
184 | f = (const struct ft_rrb_tlv *) plain; | |
185 | ||
186 | left -= sizeof(*f); | |
187 | plain += sizeof(*f); | |
188 | len = le_to_host16(f->len); | |
189 | ||
190 | wpa_printf(MSG_DEBUG, "FT: RRB TLV type = %d, len = %zu", | |
191 | le_to_host16(f->type), len); | |
192 | ||
193 | if (left < len) { | |
194 | wpa_printf(MSG_DEBUG, | |
195 | "FT: RRB message truncated: left %zu bytes, need %zu", | |
196 | left, len); | |
197 | break; | |
198 | } | |
199 | ||
200 | wpa_hexdump(MSG_DEBUG, "FT: RRB TLV data", plain, len); | |
201 | ||
202 | left -= len; | |
203 | plain += len; | |
204 | } | |
205 | ||
206 | if (left > 0) | |
207 | wpa_hexdump(MSG_DEBUG, "FT: RRB TLV padding", plain, left); | |
208 | ||
209 | wpa_printf(MSG_DEBUG, "FT: RRB dump message end"); | |
210 | } | |
211 | ||
212 | ||
17010c38 MB |
213 | static int cmp_int(const void *a, const void *b) |
214 | { | |
215 | int x, y; | |
216 | ||
217 | x = *((int *) a); | |
218 | y = *((int *) b); | |
219 | return x - y; | |
220 | } | |
221 | ||
222 | ||
223 | static int wpa_ft_rrb_get_tlv_vlan(const u8 *plain, const size_t plain_len, | |
224 | struct vlan_description *vlan) | |
225 | { | |
226 | struct ft_rrb_tlv *f; | |
227 | size_t left; | |
228 | size_t len; | |
229 | int taggedidx; | |
230 | int vlan_id; | |
231 | int type; | |
232 | ||
233 | left = plain_len; | |
234 | taggedidx = 0; | |
235 | os_memset(vlan, 0, sizeof(*vlan)); | |
236 | ||
237 | while (left >= sizeof(*f)) { | |
238 | f = (struct ft_rrb_tlv *) plain; | |
239 | ||
240 | left -= sizeof(*f); | |
241 | plain += sizeof(*f); | |
242 | ||
243 | len = le_to_host16(f->len); | |
244 | type = le_to_host16(f->type); | |
245 | ||
246 | if (left < len) { | |
247 | wpa_printf(MSG_DEBUG, "FT: RRB message truncated"); | |
248 | return -1; | |
249 | } | |
250 | ||
251 | if (type != FT_RRB_VLAN_UNTAGGED && type != FT_RRB_VLAN_TAGGED) | |
252 | goto skip; | |
253 | ||
254 | if (type == FT_RRB_VLAN_UNTAGGED && len != sizeof(le16)) { | |
255 | wpa_printf(MSG_DEBUG, | |
256 | "FT: RRB VLAN_UNTAGGED invalid length"); | |
257 | return -1; | |
258 | } | |
259 | ||
260 | if (type == FT_RRB_VLAN_TAGGED && len % sizeof(le16) != 0) { | |
261 | wpa_printf(MSG_DEBUG, | |
262 | "FT: RRB VLAN_TAGGED invalid length"); | |
263 | return -1; | |
264 | } | |
265 | ||
266 | while (len >= sizeof(le16)) { | |
267 | vlan_id = WPA_GET_LE16(plain); | |
268 | plain += sizeof(le16); | |
269 | left -= sizeof(le16); | |
270 | len -= sizeof(le16); | |
271 | ||
272 | if (vlan_id <= 0 || vlan_id > MAX_VLAN_ID) { | |
273 | wpa_printf(MSG_DEBUG, | |
274 | "FT: RRB VLAN ID invalid %d", | |
275 | vlan_id); | |
276 | continue; | |
277 | } | |
278 | ||
279 | if (type == FT_RRB_VLAN_UNTAGGED) | |
280 | vlan->untagged = vlan_id; | |
281 | ||
282 | if (type == FT_RRB_VLAN_TAGGED && | |
283 | taggedidx < MAX_NUM_TAGGED_VLAN) { | |
284 | vlan->tagged[taggedidx] = vlan_id; | |
285 | taggedidx++; | |
286 | } else if (type == FT_RRB_VLAN_TAGGED) { | |
287 | wpa_printf(MSG_DEBUG, "FT: RRB too many VLANs"); | |
288 | } | |
289 | } | |
290 | ||
291 | skip: | |
292 | left -= len; | |
293 | plain += len; | |
294 | } | |
295 | ||
296 | if (taggedidx) | |
297 | qsort(vlan->tagged, taggedidx, sizeof(int), cmp_int); | |
298 | ||
299 | vlan->notempty = vlan->untagged || vlan->tagged[0]; | |
300 | ||
301 | return 0; | |
302 | } | |
303 | ||
304 | ||
245fc96e MB |
305 | static size_t wpa_ft_tlv_len(const struct tlv_list *tlvs) |
306 | { | |
307 | size_t tlv_len = 0; | |
308 | int i; | |
309 | ||
310 | if (!tlvs) | |
311 | return 0; | |
312 | ||
313 | for (i = 0; tlvs[i].type != FT_RRB_LAST_EMPTY; i++) { | |
314 | tlv_len += sizeof(struct ft_rrb_tlv); | |
315 | tlv_len += tlvs[i].len; | |
316 | } | |
317 | ||
318 | return tlv_len; | |
319 | } | |
320 | ||
321 | ||
322 | static size_t wpa_ft_tlv_lin(const struct tlv_list *tlvs, u8 *start, | |
323 | u8 *endpos) | |
324 | { | |
325 | int i; | |
326 | size_t tlv_len; | |
327 | struct ft_rrb_tlv *hdr; | |
328 | u8 *pos; | |
329 | ||
330 | if (!tlvs) | |
331 | return 0; | |
332 | ||
333 | tlv_len = 0; | |
334 | pos = start; | |
335 | for (i = 0; tlvs[i].type != FT_RRB_LAST_EMPTY; i++) { | |
336 | if (tlv_len + sizeof(*hdr) > (size_t) (endpos - start)) | |
337 | return tlv_len; | |
338 | tlv_len += sizeof(*hdr); | |
339 | hdr = (struct ft_rrb_tlv *) pos; | |
340 | hdr->type = host_to_le16(tlvs[i].type); | |
341 | hdr->len = host_to_le16(tlvs[i].len); | |
342 | pos = start + tlv_len; | |
343 | ||
344 | if (tlv_len + tlvs[i].len > (size_t) (endpos - start)) | |
345 | return tlv_len; | |
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 |
357 | static size_t wpa_ft_vlan_len(const struct vlan_description *vlan) |
358 | { | |
359 | size_t tlv_len = 0; | |
360 | int i; | |
361 | ||
362 | if (!vlan || !vlan->notempty) | |
363 | return 0; | |
364 | ||
365 | if (vlan->untagged) { | |
366 | tlv_len += sizeof(struct ft_rrb_tlv); | |
367 | tlv_len += sizeof(le16); | |
368 | } | |
369 | if (vlan->tagged[0]) | |
370 | tlv_len += sizeof(struct ft_rrb_tlv); | |
371 | for (i = 0; i < MAX_NUM_TAGGED_VLAN && vlan->tagged[i]; i++) | |
372 | tlv_len += sizeof(le16); | |
373 | ||
374 | return tlv_len; | |
375 | } | |
376 | ||
377 | ||
378 | static size_t wpa_ft_vlan_lin(const struct vlan_description *vlan, | |
379 | u8 *start, u8 *endpos) | |
380 | { | |
381 | size_t tlv_len; | |
382 | int i, len; | |
383 | struct ft_rrb_tlv *hdr; | |
384 | u8 *pos = start; | |
385 | ||
386 | if (!vlan || !vlan->notempty) | |
387 | return 0; | |
388 | ||
389 | tlv_len = 0; | |
390 | if (vlan->untagged) { | |
391 | tlv_len += sizeof(*hdr); | |
392 | if (start + tlv_len > endpos) | |
393 | return tlv_len; | |
394 | hdr = (struct ft_rrb_tlv *) pos; | |
395 | hdr->type = host_to_le16(FT_RRB_VLAN_UNTAGGED); | |
396 | hdr->len = host_to_le16(sizeof(le16)); | |
397 | pos = start + tlv_len; | |
398 | ||
399 | tlv_len += sizeof(le16); | |
400 | if (start + tlv_len > endpos) | |
401 | return tlv_len; | |
402 | WPA_PUT_LE16(pos, vlan->untagged); | |
403 | pos = start + tlv_len; | |
404 | } | |
405 | ||
406 | if (!vlan->tagged[0]) | |
407 | return tlv_len; | |
408 | ||
409 | tlv_len += sizeof(*hdr); | |
410 | if (start + tlv_len > endpos) | |
411 | return tlv_len; | |
412 | hdr = (struct ft_rrb_tlv *) pos; | |
413 | hdr->type = host_to_le16(FT_RRB_VLAN_TAGGED); | |
414 | len = 0; /* len is computed below */ | |
415 | pos = start + tlv_len; | |
416 | ||
417 | for (i = 0; i < MAX_NUM_TAGGED_VLAN && vlan->tagged[i]; i++) { | |
418 | tlv_len += sizeof(le16); | |
419 | if (start + tlv_len > endpos) | |
420 | break; | |
421 | len += sizeof(le16); | |
422 | WPA_PUT_LE16(pos, vlan->tagged[i]); | |
423 | pos = start + tlv_len; | |
424 | } | |
425 | ||
426 | hdr->len = host_to_le16(len); | |
427 | ||
428 | return tlv_len; | |
429 | } | |
430 | ||
431 | ||
245fc96e MB |
432 | static 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 | ||
465 | err: | |
466 | os_free(*plain); | |
467 | *plain = NULL; | |
468 | *plain_len = 0; | |
469 | return -1; | |
470 | } | |
471 | ||
472 | ||
473 | static int wpa_ft_rrb_encrypt(const u8 *key, const size_t key_len, | |
474 | const u8 *plain, const size_t plain_len, | |
475 | const u8 *auth, const size_t auth_len, | |
476 | const u8 *src_addr, u8 type, u8 *enc) | |
477 | { | |
478 | const u8 *ad[3] = { src_addr, auth, &type }; | |
479 | size_t ad_len[3] = { ETH_ALEN, auth_len, sizeof(type) }; | |
480 | ||
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 | */ | |
518 | static int wpa_ft_rrb_build(const u8 *key, const size_t key_len, | |
519 | const struct tlv_list *tlvs_enc0, | |
520 | const struct tlv_list *tlvs_enc1, | |
521 | const struct tlv_list *tlvs_auth, | |
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 | ||
579 | out: | |
580 | bin_clear_free(plain, plain_len); | |
581 | os_free(auth); | |
582 | ||
583 | if (ret) { | |
584 | wpa_printf(MSG_ERROR, "FT: Failed to build RRB-OUI message"); | |
585 | os_free(*packet); | |
586 | *packet = NULL; | |
587 | *packet_len = 0; | |
588 | } | |
589 | ||
590 | return ret; | |
591 | } | |
592 | ||
593 | ||
594 | #define RRB_GET_SRC(srcfield, type, field, txt, checklength) do { \ | |
595 | if (wpa_ft_rrb_get_tlv(srcfield, srcfield##_len, type, \ | |
596 | &f_##field##_len, &f_##field) < 0 || \ | |
597 | (checklength > 0 && ((size_t) checklength) != f_##field##_len)) { \ | |
598 | wpa_printf(MSG_INFO, "FT: Missing required " #field \ | |
599 | " in %s from " MACSTR, txt, MAC2STR(src_addr)); \ | |
600 | wpa_ft_rrb_dump(srcfield, srcfield##_len); \ | |
601 | goto out; \ | |
602 | } \ | |
603 | } while (0) | |
604 | ||
605 | #define RRB_GET(type, field, txt, checklength) \ | |
606 | RRB_GET_SRC(plain, type, field, txt, checklength) | |
607 | #define RRB_GET_AUTH(type, field, txt, checklength) \ | |
608 | RRB_GET_SRC(auth, type, field, txt, checklength) | |
609 | ||
610 | #define RRB_GET_OPTIONAL_SRC(srcfield, type, field, txt, checklength) do { \ | |
611 | if (wpa_ft_rrb_get_tlv(srcfield, srcfield##_len, type, \ | |
612 | &f_##field##_len, &f_##field) < 0 || \ | |
613 | (checklength > 0 && ((size_t) checklength) != f_##field##_len)) { \ | |
614 | wpa_printf(MSG_DEBUG, "FT: Missing optional " #field \ | |
615 | " in %s from " MACSTR, txt, MAC2STR(src_addr)); \ | |
616 | f_##field##_len = 0; \ | |
617 | f_##field = NULL; \ | |
618 | } \ | |
619 | } while (0) | |
620 | ||
621 | #define RRB_GET_OPTIONAL(type, field, txt, checklength) \ | |
622 | RRB_GET_OPTIONAL_SRC(plain, type, field, txt, checklength) | |
623 | #define RRB_GET_OPTIONAL_AUTH(type, field, txt, checklength) \ | |
624 | RRB_GET_OPTIONAL_SRC(auth, type, field, txt, checklength) | |
692ec305 | 625 | |
6fc6879b JM |
626 | static 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 |
637 | static int wpa_ft_rrb_oui_send(struct wpa_authenticator *wpa_auth, |
638 | const u8 *dst, u8 oui_suffix, | |
639 | const u8 *data, size_t data_len) | |
640 | { | |
641 | if (!wpa_auth->cb->send_oui) | |
642 | return -1; | |
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 |
650 | static 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 |
660 | static const u8 * wpa_ft_get_psk(struct wpa_authenticator *wpa_auth, |
661 | const u8 *addr, const u8 *p2p_dev_addr, | |
662 | const u8 *prev_psk) | |
663 | { | |
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 |
671 | static struct wpa_state_machine * |
672 | wpa_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 |
680 | static int wpa_ft_set_vlan(struct wpa_authenticator *wpa_auth, |
681 | const u8 *sta_addr, struct vlan_description *vlan) | |
682 | { | |
683 | if (!wpa_auth->cb->set_vlan) | |
684 | return -1; | |
685 | return wpa_auth->cb->set_vlan(wpa_auth->cb_ctx, sta_addr, vlan); | |
686 | } | |
687 | ||
688 | ||
689 | static int wpa_ft_get_vlan(struct wpa_authenticator *wpa_auth, | |
690 | const u8 *sta_addr, struct vlan_description *vlan) | |
691 | { | |
692 | if (!wpa_auth->cb->get_vlan) | |
693 | return -1; | |
694 | return wpa_auth->cb->get_vlan(wpa_auth->cb_ctx, sta_addr, vlan); | |
695 | } | |
696 | ||
697 | ||
069b4e30 MB |
698 | static int |
699 | wpa_ft_set_identity(struct wpa_authenticator *wpa_auth, const u8 *sta_addr, | |
700 | const u8 *identity, size_t identity_len) | |
701 | { | |
702 | if (!wpa_auth->cb->set_identity) | |
703 | return -1; | |
704 | return wpa_auth->cb->set_identity(wpa_auth->cb_ctx, sta_addr, identity, | |
705 | identity_len); | |
706 | } | |
707 | ||
708 | ||
709 | static size_t | |
710 | wpa_ft_get_identity(struct wpa_authenticator *wpa_auth, const u8 *sta_addr, | |
711 | const u8 **buf) | |
712 | { | |
713 | *buf = NULL; | |
714 | if (!wpa_auth->cb->get_identity) | |
715 | return 0; | |
716 | return wpa_auth->cb->get_identity(wpa_auth->cb_ctx, sta_addr, buf); | |
717 | } | |
718 | ||
719 | ||
720 | static int | |
721 | wpa_ft_set_radius_cui(struct wpa_authenticator *wpa_auth, const u8 *sta_addr, | |
722 | const u8 *radius_cui, size_t radius_cui_len) | |
723 | { | |
724 | if (!wpa_auth->cb->set_radius_cui) | |
725 | return -1; | |
726 | return wpa_auth->cb->set_radius_cui(wpa_auth->cb_ctx, sta_addr, | |
727 | radius_cui, radius_cui_len); | |
728 | } | |
729 | ||
730 | ||
731 | static size_t | |
732 | wpa_ft_get_radius_cui(struct wpa_authenticator *wpa_auth, const u8 *sta_addr, | |
733 | const u8 **buf) | |
734 | { | |
735 | *buf = NULL; | |
736 | if (!wpa_auth->cb->get_radius_cui) | |
737 | return 0; | |
738 | return wpa_auth->cb->get_radius_cui(wpa_auth->cb_ctx, sta_addr, buf); | |
739 | } | |
740 | ||
741 | ||
a6509e85 MB |
742 | static void |
743 | wpa_ft_set_session_timeout(struct wpa_authenticator *wpa_auth, | |
744 | const u8 *sta_addr, int session_timeout) | |
745 | { | |
746 | if (!wpa_auth->cb->set_session_timeout) | |
747 | return; | |
748 | wpa_auth->cb->set_session_timeout(wpa_auth->cb_ctx, sta_addr, | |
749 | session_timeout); | |
750 | } | |
751 | ||
752 | ||
753 | static int | |
754 | wpa_ft_get_session_timeout(struct wpa_authenticator *wpa_auth, | |
755 | const u8 *sta_addr) | |
756 | { | |
757 | if (!wpa_auth->cb->get_session_timeout) | |
758 | return 0; | |
759 | return wpa_auth->cb->get_session_timeout(wpa_auth->cb_ctx, sta_addr); | |
760 | } | |
761 | ||
762 | ||
88b32a99 SP |
763 | static int wpa_ft_add_tspec(struct wpa_authenticator *wpa_auth, |
764 | const u8 *sta_addr, | |
765 | u8 *tspec_ie, size_t tspec_ielen) | |
766 | { | |
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 |
777 | static int wpa_channel_info(struct wpa_authenticator *wpa_auth, | |
778 | struct wpa_channel_info *ci) | |
779 | { | |
780 | if (!wpa_auth->cb->channel_info) | |
781 | return -1; | |
782 | return wpa_auth->cb->channel_info(wpa_auth->cb_ctx, ci); | |
783 | } | |
784 | #endif /* CONFIG_OCV */ | |
785 | ||
786 | ||
6fc6879b JM |
787 | int wpa_write_mdie(struct wpa_auth_config *conf, u8 *buf, size_t len) |
788 | { | |
789 | u8 *pos = buf; | |
790 | u8 capab; | |
791 | if (len < 2 + sizeof(struct rsn_mdie)) | |
792 | return -1; | |
793 | ||
794 | *pos++ = WLAN_EID_MOBILITY_DOMAIN; | |
795 | *pos++ = MOBILITY_DOMAIN_ID_LEN + 1; | |
796 | os_memcpy(pos, conf->mobility_domain, MOBILITY_DOMAIN_ID_LEN); | |
797 | pos += MOBILITY_DOMAIN_ID_LEN; | |
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 |
807 | int 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 */ |
871 | struct ft_remote_item { | |
872 | struct dl_list list; | |
873 | ||
874 | u8 nonce[FT_RRB_NONCE_LEN]; | |
875 | struct os_reltime nonce_ts; | |
876 | ||
877 | u8 src_addr[ETH_ALEN]; | |
878 | u8 *enc; | |
879 | size_t enc_len; | |
880 | u8 *auth; | |
881 | size_t auth_len; | |
882 | int (*cb)(struct wpa_authenticator *wpa_auth, | |
883 | const u8 *src_addr, | |
884 | const u8 *enc, size_t enc_len, | |
885 | const u8 *auth, size_t auth_len, | |
886 | int no_defer); | |
887 | }; | |
888 | ||
889 | ||
890 | static void wpa_ft_rrb_seq_free(struct ft_remote_item *item) | |
891 | { | |
892 | eloop_cancel_timeout(wpa_ft_rrb_seq_timeout, ELOOP_ALL_CTX, item); | |
893 | dl_list_del(&item->list); | |
894 | bin_clear_free(item->enc, item->enc_len); | |
895 | os_free(item->auth); | |
896 | os_free(item); | |
897 | } | |
898 | ||
899 | ||
900 | static void wpa_ft_rrb_seq_flush(struct wpa_authenticator *wpa_auth, | |
901 | struct ft_remote_seq *rkh_seq, int cb) | |
902 | { | |
903 | struct ft_remote_item *item, *n; | |
904 | ||
905 | dl_list_for_each_safe(item, n, &rkh_seq->rx.queue, | |
906 | struct ft_remote_item, list) { | |
907 | if (cb && item->cb) | |
908 | item->cb(wpa_auth, item->src_addr, item->enc, | |
909 | item->enc_len, item->auth, item->auth_len, 1); | |
910 | wpa_ft_rrb_seq_free(item); | |
911 | } | |
912 | } | |
913 | ||
914 | ||
915 | static void wpa_ft_rrb_seq_timeout(void *eloop_ctx, void *timeout_ctx) | |
916 | { | |
917 | struct ft_remote_item *item = timeout_ctx; | |
918 | ||
919 | wpa_ft_rrb_seq_free(item); | |
920 | } | |
921 | ||
922 | ||
923 | static int | |
924 | wpa_ft_rrb_seq_req(struct wpa_authenticator *wpa_auth, | |
925 | struct ft_remote_seq *rkh_seq, const u8 *src_addr, | |
926 | const u8 *f_r0kh_id, size_t f_r0kh_id_len, | |
927 | const u8 *f_r1kh_id, const u8 *key, size_t key_len, | |
928 | const u8 *enc, size_t enc_len, | |
929 | const u8 *auth, size_t auth_len, | |
930 | int (*cb)(struct wpa_authenticator *wpa_auth, | |
931 | const u8 *src_addr, | |
932 | const u8 *enc, size_t enc_len, | |
933 | const u8 *auth, size_t auth_len, | |
934 | int no_defer)) | |
935 | { | |
936 | struct ft_remote_item *item = NULL; | |
937 | u8 *packet = NULL; | |
938 | size_t packet_len; | |
939 | struct tlv_list seq_req_auth[] = { | |
940 | { .type = FT_RRB_NONCE, .len = FT_RRB_NONCE_LEN, | |
941 | .data = NULL /* to be filled: item->nonce */ }, | |
942 | { .type = FT_RRB_R0KH_ID, .len = f_r0kh_id_len, | |
943 | .data = f_r0kh_id }, | |
944 | { .type = FT_RRB_R1KH_ID, .len = FT_R1KH_ID_LEN, | |
945 | .data = f_r1kh_id }, | |
946 | { .type = FT_RRB_LAST_EMPTY, .len = 0, .data = NULL }, | |
947 | }; | |
948 | ||
949 | if (dl_list_len(&rkh_seq->rx.queue) >= ftRRBmaxQueueLen) { | |
950 | wpa_printf(MSG_DEBUG, "FT: Sequence number queue too long"); | |
951 | goto err; | |
952 | } | |
953 | ||
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; | |
1006 | err: | |
1007 | wpa_printf(MSG_DEBUG, "FT: Failed to send sequence number request"); | |
1008 | if (item) { | |
1009 | os_free(item->auth); | |
1010 | bin_clear_free(item->enc, item->enc_len); | |
1011 | os_free(item); | |
1012 | } | |
1013 | ||
1014 | return -1; | |
1015 | } | |
1016 | ||
1017 | ||
1018 | #define FT_RRB_SEQ_OK 0 | |
1019 | #define FT_RRB_SEQ_DROP 1 | |
1020 | #define FT_RRB_SEQ_DEFER 2 | |
1021 | ||
1022 | static int | |
1023 | wpa_ft_rrb_seq_chk(struct ft_remote_seq *rkh_seq, const u8 *src_addr, | |
1024 | const u8 *enc, size_t enc_len, | |
1025 | const u8 *auth, size_t auth_len, | |
1026 | const char *msgtype, int no_defer) | |
1027 | { | |
1028 | const u8 *f_seq; | |
1029 | size_t f_seq_len; | |
1030 | const struct ft_rrb_seq *msg_both; | |
1031 | u32 msg_seq, msg_off, rkh_off; | |
1032 | struct os_reltime now; | |
1033 | unsigned int i; | |
1034 | ||
1035 | RRB_GET_AUTH(FT_RRB_SEQ, seq, msgtype, sizeof(*msg_both)); | |
1036 | wpa_hexdump(MSG_DEBUG, "FT: sequence number", f_seq, f_seq_len); | |
1037 | msg_both = (const struct ft_rrb_seq *) f_seq; | |
1038 | ||
1039 | if (rkh_seq->rx.num_last == 0) { | |
1040 | /* first packet from remote */ | |
1041 | goto defer; | |
1042 | } | |
1043 | ||
1044 | if (le_to_host32(msg_both->dom) != rkh_seq->rx.dom) { | |
1045 | /* remote might have rebooted */ | |
1046 | goto defer; | |
1047 | } | |
1048 | ||
1049 | if (os_get_reltime(&now) == 0) { | |
1050 | u32 msg_ts_now_remote, msg_ts_off; | |
1051 | struct os_reltime now_remote; | |
1052 | ||
1053 | os_reltime_sub(&now, &rkh_seq->rx.time_offset, &now_remote); | |
1054 | msg_ts_now_remote = now_remote.sec; | |
1055 | msg_ts_off = le_to_host32(msg_both->ts) - | |
1056 | (msg_ts_now_remote - ftRRBseqTimeout); | |
1057 | if (msg_ts_off > 2 * ftRRBseqTimeout) | |
1058 | goto defer; | |
1059 | } | |
1060 | ||
1061 | msg_seq = le_to_host32(msg_both->seq); | |
1062 | rkh_off = rkh_seq->rx.last[rkh_seq->rx.offsetidx]; | |
1063 | msg_off = msg_seq - rkh_off; | |
1064 | if (msg_off > 0xC0000000) | |
1065 | goto out; /* too old message, drop it */ | |
1066 | ||
1067 | if (msg_off <= 0x40000000) { | |
1068 | for (i = 0; i < rkh_seq->rx.num_last; i++) { | |
1069 | if (rkh_seq->rx.last[i] == msg_seq) | |
1070 | goto out; /* duplicate message, drop it */ | |
1071 | } | |
1072 | ||
1073 | return FT_RRB_SEQ_OK; | |
1074 | } | |
1075 | ||
1076 | defer: | |
1077 | if (no_defer) | |
1078 | goto out; | |
1079 | ||
1080 | wpa_printf(MSG_DEBUG, "FT: Possibly invalid sequence number in %s from " | |
1081 | MACSTR, msgtype, MAC2STR(src_addr)); | |
1082 | ||
1083 | return FT_RRB_SEQ_DEFER; | |
1084 | out: | |
1085 | wpa_printf(MSG_DEBUG, "FT: Invalid sequence number in %s from " MACSTR, | |
1086 | msgtype, MAC2STR(src_addr)); | |
1087 | ||
1088 | return FT_RRB_SEQ_DROP; | |
1089 | } | |
1090 | ||
1091 | ||
1092 | static void | |
1093 | wpa_ft_rrb_seq_accept(struct wpa_authenticator *wpa_auth, | |
1094 | struct ft_remote_seq *rkh_seq, const u8 *src_addr, | |
1095 | const u8 *auth, size_t auth_len, | |
1096 | const char *msgtype) | |
1097 | { | |
1098 | const u8 *f_seq; | |
1099 | size_t f_seq_len; | |
1100 | const struct ft_rrb_seq *msg_both; | |
1101 | u32 msg_seq, msg_off, min_off, rkh_off; | |
1102 | int minidx = 0; | |
1103 | unsigned int i; | |
1104 | ||
1105 | RRB_GET_AUTH(FT_RRB_SEQ, seq, msgtype, sizeof(*msg_both)); | |
1106 | msg_both = (const struct ft_rrb_seq *) f_seq; | |
1107 | ||
1108 | msg_seq = le_to_host32(msg_both->seq); | |
1109 | ||
1110 | if (rkh_seq->rx.num_last < FT_REMOTE_SEQ_BACKLOG) { | |
1111 | rkh_seq->rx.last[rkh_seq->rx.num_last] = msg_seq; | |
1112 | rkh_seq->rx.num_last++; | |
1113 | return; | |
1114 | } | |
1115 | ||
1116 | rkh_off = rkh_seq->rx.last[rkh_seq->rx.offsetidx]; | |
1117 | for (i = 0; i < rkh_seq->rx.num_last; i++) { | |
1118 | msg_off = rkh_seq->rx.last[i] - rkh_off; | |
1119 | min_off = rkh_seq->rx.last[minidx] - rkh_off; | |
1120 | if (msg_off < min_off && i != rkh_seq->rx.offsetidx) | |
1121 | minidx = i; | |
1122 | } | |
1123 | rkh_seq->rx.last[rkh_seq->rx.offsetidx] = msg_seq; | |
1124 | rkh_seq->rx.offsetidx = minidx; | |
1125 | ||
1126 | return; | |
1127 | out: | |
1128 | /* RRB_GET_AUTH should never fail here as | |
1129 | * wpa_ft_rrb_seq_chk() verified FT_RRB_SEQ presence. */ | |
1130 | wpa_printf(MSG_ERROR, "FT: %s() failed", __func__); | |
1131 | } | |
1132 | ||
1133 | ||
1134 | static int wpa_ft_new_seq(struct ft_remote_seq *rkh_seq, | |
1135 | struct ft_rrb_seq *f_seq) | |
1136 | { | |
1137 | struct os_reltime now; | |
1138 | ||
1139 | if (os_get_reltime(&now) < 0) | |
1140 | return -1; | |
1141 | ||
1142 | if (!rkh_seq->tx.dom) { | |
1143 | if (random_get_bytes((u8 *) &rkh_seq->tx.seq, | |
1144 | sizeof(rkh_seq->tx.seq))) { | |
1145 | wpa_printf(MSG_ERROR, | |
1146 | "FT: Failed to get random data for sequence number initialization"); | |
1147 | rkh_seq->tx.seq = now.usec; | |
1148 | } | |
1149 | if (random_get_bytes((u8 *) &rkh_seq->tx.dom, | |
1150 | sizeof(rkh_seq->tx.dom))) { | |
1151 | wpa_printf(MSG_ERROR, | |
1152 | "FT: Failed to get random data for sequence number initialization"); | |
1153 | rkh_seq->tx.dom = now.usec; | |
1154 | } | |
1155 | rkh_seq->tx.dom |= 1; | |
1156 | } | |
1157 | ||
1158 | f_seq->dom = host_to_le32(rkh_seq->tx.dom); | |
1159 | f_seq->seq = host_to_le32(rkh_seq->tx.seq); | |
1160 | f_seq->ts = host_to_le32(now.sec); | |
1161 | ||
1162 | rkh_seq->tx.seq++; | |
1163 | ||
1164 | return 0; | |
1165 | } | |
1166 | ||
1167 | ||
6fc6879b | 1168 | struct 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 | ||
1186 | struct 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 | ||
1202 | struct 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 |
1208 | static void wpa_ft_expire_pmk_r0(void *eloop_ctx, void *timeout_ctx); |
1209 | static void wpa_ft_expire_pmk_r1(void *eloop_ctx, void *timeout_ctx); | |
1210 | ||
1211 | ||
09211c98 MB |
1212 | static void wpa_ft_free_pmk_r0(struct wpa_ft_pmk_r0_sa *r0) |
1213 | { | |
1214 | if (!r0) | |
1215 | return; | |
1216 | ||
1217 | dl_list_del(&r0->list); | |
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 |
1228 | static void wpa_ft_expire_pmk_r0(void *eloop_ctx, void *timeout_ctx) |
1229 | { | |
1230 | struct wpa_ft_pmk_r0_sa *r0 = eloop_ctx; | |
1231 | struct os_reltime now; | |
1232 | int expires_in; | |
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 |
1266 | static void wpa_ft_free_pmk_r1(struct wpa_ft_pmk_r1_sa *r1) |
1267 | { | |
1268 | if (!r1) | |
1269 | return; | |
1270 | ||
1271 | dl_list_del(&r1->list); | |
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 |
1282 | static void wpa_ft_expire_pmk_r1(void *eloop_ctx, void *timeout_ctx) |
1283 | { | |
1284 | struct wpa_ft_pmk_r1_sa *r1 = eloop_ctx; | |
1285 | ||
1286 | wpa_ft_free_pmk_r1(r1); | |
1287 | } | |
1288 | ||
1289 | ||
6fc6879b JM |
1290 | struct wpa_ft_pmk_cache * wpa_ft_pmk_cache_init(void) |
1291 | { | |
1292 | struct wpa_ft_pmk_cache *cache; | |
1293 | ||
1294 | cache = os_zalloc(sizeof(*cache)); | |
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 | ||
1304 | void wpa_ft_pmk_cache_deinit(struct wpa_ft_pmk_cache *cache) | |
1305 | { | |
1306 | struct wpa_ft_pmk_r0_sa *r0, *r0prev; | |
1307 | struct wpa_ft_pmk_r1_sa *r1, *r1prev; | |
1308 | ||
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 |
1321 | static 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 | ||
1385 | static 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 | ||
1408 | static 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 | ||
1475 | static 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 |
1524 | static int wpa_ft_rrb_init_r0kh_seq(struct ft_remote_r0kh *r0kh) |
1525 | { | |
1526 | if (r0kh->seq) | |
1527 | return 0; | |
1528 | ||
1529 | r0kh->seq = os_zalloc(sizeof(*r0kh->seq)); | |
1530 | if (!r0kh->seq) { | |
1531 | wpa_printf(MSG_DEBUG, "FT: Failed to allocate r0kh->seq"); | |
1532 | return -1; | |
1533 | } | |
1534 | ||
1535 | dl_list_init(&r0kh->seq->rx.queue); | |
1536 | ||
1537 | return 0; | |
1538 | } | |
1539 | ||
1540 | ||
245fc96e | 1541 | static 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 | ||
1571 | static int wpa_ft_rrb_init_r1kh_seq(struct ft_remote_r1kh *r1kh) | |
1572 | { | |
1573 | if (r1kh->seq) | |
1574 | return 0; | |
1575 | ||
1576 | r1kh->seq = os_zalloc(sizeof(*r1kh->seq)); | |
1577 | if (!r1kh->seq) { | |
1578 | wpa_printf(MSG_DEBUG, "FT: Failed to allocate r1kh->seq"); | |
1579 | return -1; | |
1580 | } | |
1581 | ||
1582 | dl_list_init(&r1kh->seq->rx.queue); | |
1583 | ||
1584 | return 0; | |
245fc96e MB |
1585 | } |
1586 | ||
1587 | ||
1588 | static 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 | ||
1619 | static int wpa_ft_rrb_check_r0kh(struct wpa_authenticator *wpa_auth, | |
1620 | const u8 *f_r0kh_id, size_t f_r0kh_id_len) | |
1621 | { | |
1622 | if (f_r0kh_id_len != wpa_auth->conf.r0_key_holder_len || | |
1623 | os_memcmp_const(f_r0kh_id, wpa_auth->conf.r0_key_holder, | |
1624 | f_r0kh_id_len) != 0) | |
1625 | return -1; | |
1626 | ||
1627 | return 0; | |
1628 | } | |
1629 | ||
1630 | ||
1631 | static int wpa_ft_rrb_check_r1kh(struct wpa_authenticator *wpa_auth, | |
1632 | const u8 *f_r1kh_id) | |
1633 | { | |
1634 | if (os_memcmp_const(f_r1kh_id, wpa_auth->conf.r1_key_holder, | |
1635 | FT_R1KH_ID_LEN) != 0) | |
1636 | return -1; | |
1637 | ||
1638 | return 0; | |
1639 | } | |
1640 | ||
1641 | ||
3a46cf93 MB |
1642 | static void wpa_ft_rrb_del_r0kh(void *eloop_ctx, void *timeout_ctx) |
1643 | { | |
1644 | struct wpa_authenticator *wpa_auth = eloop_ctx; | |
1645 | struct ft_remote_r0kh *r0kh, *prev = NULL; | |
1646 | ||
1647 | if (!wpa_auth->conf.r0kh_list) | |
1648 | return; | |
1649 | ||
1650 | for (r0kh = *wpa_auth->conf.r0kh_list; r0kh; r0kh = r0kh->next) { | |
1651 | if (r0kh == timeout_ctx) | |
1652 | break; | |
1653 | prev = r0kh; | |
1654 | } | |
1655 | if (!r0kh) | |
1656 | return; | |
1657 | if (prev) | |
1658 | prev->next = r0kh->next; | |
1659 | else | |
1660 | *wpa_auth->conf.r0kh_list = r0kh->next; | |
1661 | if (r0kh->seq) | |
1662 | wpa_ft_rrb_seq_flush(wpa_auth, r0kh->seq, 0); | |
1663 | os_free(r0kh->seq); | |
1664 | os_free(r0kh); | |
1665 | } | |
1666 | ||
1667 | ||
1668 | static void wpa_ft_rrb_r0kh_replenish(struct wpa_authenticator *wpa_auth, | |
1669 | struct ft_remote_r0kh *r0kh, int timeout) | |
1670 | { | |
1671 | if (timeout > 0) | |
1672 | eloop_replenish_timeout(timeout, 0, wpa_ft_rrb_del_r0kh, | |
1673 | wpa_auth, r0kh); | |
1674 | } | |
1675 | ||
1676 | ||
1677 | static void wpa_ft_rrb_r0kh_timeout(struct wpa_authenticator *wpa_auth, | |
1678 | struct ft_remote_r0kh *r0kh, int timeout) | |
1679 | { | |
1680 | eloop_cancel_timeout(wpa_ft_rrb_del_r0kh, wpa_auth, r0kh); | |
1681 | ||
1682 | if (timeout > 0) | |
1683 | eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r0kh, | |
1684 | wpa_auth, r0kh); | |
1685 | } | |
1686 | ||
1687 | ||
1688 | static struct ft_remote_r0kh * | |
1689 | wpa_ft_rrb_add_r0kh(struct wpa_authenticator *wpa_auth, | |
1690 | struct ft_remote_r0kh *r0kh_wildcard, | |
1691 | const u8 *src_addr, const u8 *r0kh_id, size_t id_len, | |
1692 | int timeout) | |
1693 | { | |
1694 | struct ft_remote_r0kh *r0kh; | |
1695 | ||
1696 | if (!wpa_auth->conf.r0kh_list) | |
1697 | return NULL; | |
1698 | ||
1699 | r0kh = os_zalloc(sizeof(*r0kh)); | |
1700 | if (!r0kh) | |
1701 | return NULL; | |
1702 | ||
1703 | if (src_addr) | |
1704 | os_memcpy(r0kh->addr, src_addr, sizeof(r0kh->addr)); | |
1705 | ||
1706 | if (id_len > FT_R0KH_ID_MAX_LEN) | |
1707 | id_len = FT_R0KH_ID_MAX_LEN; | |
1708 | os_memcpy(r0kh->id, r0kh_id, id_len); | |
1709 | r0kh->id_len = id_len; | |
1710 | ||
1711 | os_memcpy(r0kh->key, r0kh_wildcard->key, sizeof(r0kh->key)); | |
1712 | ||
1713 | r0kh->next = *wpa_auth->conf.r0kh_list; | |
1714 | *wpa_auth->conf.r0kh_list = r0kh; | |
1715 | ||
1716 | if (timeout > 0) | |
1717 | eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r0kh, | |
1718 | wpa_auth, r0kh); | |
1719 | ||
1720 | if (wpa_ft_rrb_init_r0kh_seq(r0kh) < 0) | |
1721 | return NULL; | |
1722 | ||
1723 | return r0kh; | |
1724 | } | |
1725 | ||
1726 | ||
1727 | static void wpa_ft_rrb_del_r1kh(void *eloop_ctx, void *timeout_ctx) | |
1728 | { | |
1729 | struct wpa_authenticator *wpa_auth = eloop_ctx; | |
1730 | struct ft_remote_r1kh *r1kh, *prev = NULL; | |
1731 | ||
1732 | if (!wpa_auth->conf.r1kh_list) | |
1733 | return; | |
1734 | ||
1735 | for (r1kh = *wpa_auth->conf.r1kh_list; r1kh; r1kh = r1kh->next) { | |
1736 | if (r1kh == timeout_ctx) | |
1737 | break; | |
1738 | prev = r1kh; | |
1739 | } | |
1740 | if (!r1kh) | |
1741 | return; | |
1742 | if (prev) | |
1743 | prev->next = r1kh->next; | |
1744 | else | |
1745 | *wpa_auth->conf.r1kh_list = r1kh->next; | |
1746 | if (r1kh->seq) | |
1747 | wpa_ft_rrb_seq_flush(wpa_auth, r1kh->seq, 0); | |
1748 | os_free(r1kh->seq); | |
1749 | os_free(r1kh); | |
1750 | } | |
1751 | ||
1752 | ||
1753 | static void wpa_ft_rrb_r1kh_replenish(struct wpa_authenticator *wpa_auth, | |
1754 | struct ft_remote_r1kh *r1kh, int timeout) | |
1755 | { | |
1756 | if (timeout > 0) | |
1757 | eloop_replenish_timeout(timeout, 0, wpa_ft_rrb_del_r1kh, | |
1758 | wpa_auth, r1kh); | |
1759 | } | |
1760 | ||
1761 | ||
1762 | static struct ft_remote_r1kh * | |
1763 | wpa_ft_rrb_add_r1kh(struct wpa_authenticator *wpa_auth, | |
1764 | struct ft_remote_r1kh *r1kh_wildcard, | |
1765 | const u8 *src_addr, const u8 *r1kh_id, int timeout) | |
1766 | { | |
1767 | struct ft_remote_r1kh *r1kh; | |
1768 | ||
1769 | if (!wpa_auth->conf.r1kh_list) | |
1770 | return NULL; | |
1771 | ||
1772 | r1kh = os_zalloc(sizeof(*r1kh)); | |
1773 | if (!r1kh) | |
1774 | return NULL; | |
1775 | ||
1776 | os_memcpy(r1kh->addr, src_addr, sizeof(r1kh->addr)); | |
1777 | os_memcpy(r1kh->id, r1kh_id, sizeof(r1kh->id)); | |
1778 | os_memcpy(r1kh->key, r1kh_wildcard->key, sizeof(r1kh->key)); | |
1779 | r1kh->next = *wpa_auth->conf.r1kh_list; | |
1780 | *wpa_auth->conf.r1kh_list = r1kh; | |
1781 | ||
1782 | if (timeout > 0) | |
1783 | eloop_register_timeout(timeout, 0, wpa_ft_rrb_del_r1kh, | |
1784 | wpa_auth, r1kh); | |
1785 | ||
1786 | if (wpa_ft_rrb_init_r1kh_seq(r1kh) < 0) | |
1787 | return NULL; | |
1788 | ||
1789 | return r1kh; | |
1790 | } | |
1791 | ||
1792 | ||
1793 | void wpa_ft_sta_deinit(struct wpa_state_machine *sm) | |
1794 | { | |
1795 | eloop_cancel_timeout(wpa_ft_expire_pull, sm, NULL); | |
1796 | } | |
1797 | ||
1798 | ||
eefe8630 MB |
1799 | static void wpa_ft_deinit_seq(struct wpa_authenticator *wpa_auth) |
1800 | { | |
1801 | struct ft_remote_r0kh *r0kh; | |
1802 | struct ft_remote_r1kh *r1kh; | |
1803 | ||
1804 | eloop_cancel_timeout(wpa_ft_rrb_seq_timeout, wpa_auth, ELOOP_ALL_CTX); | |
1805 | ||
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 |
1832 | static void wpa_ft_deinit_rkh_tmp(struct wpa_authenticator *wpa_auth) |
1833 | { | |
1834 | struct ft_remote_r0kh *r0kh, *r0kh_next, *r0kh_prev = NULL; | |
1835 | struct ft_remote_r1kh *r1kh, *r1kh_next, *r1kh_prev = NULL; | |
1836 | ||
1837 | if (wpa_auth->conf.r0kh_list) | |
1838 | r0kh = *wpa_auth->conf.r0kh_list; | |
1839 | else | |
1840 | r0kh = NULL; | |
1841 | while (r0kh) { | |
1842 | r0kh_next = r0kh->next; | |
1843 | if (eloop_cancel_timeout(wpa_ft_rrb_del_r0kh, wpa_auth, | |
1844 | r0kh) > 0) { | |
1845 | if (r0kh_prev) | |
1846 | r0kh_prev->next = r0kh_next; | |
1847 | else | |
1848 | *wpa_auth->conf.r0kh_list = r0kh_next; | |
1849 | os_free(r0kh); | |
1850 | } else { | |
1851 | r0kh_prev = r0kh; | |
1852 | } | |
1853 | r0kh = r0kh_next; | |
1854 | } | |
1855 | ||
1856 | if (wpa_auth->conf.r1kh_list) | |
1857 | r1kh = *wpa_auth->conf.r1kh_list; | |
1858 | else | |
1859 | r1kh = NULL; | |
1860 | while (r1kh) { | |
1861 | r1kh_next = r1kh->next; | |
1862 | if (eloop_cancel_timeout(wpa_ft_rrb_del_r1kh, wpa_auth, | |
1863 | r1kh) > 0) { | |
1864 | if (r1kh_prev) | |
1865 | r1kh_prev->next = r1kh_next; | |
1866 | else | |
1867 | *wpa_auth->conf.r1kh_list = r1kh_next; | |
1868 | os_free(r1kh); | |
1869 | } else { | |
1870 | r1kh_prev = r1kh; | |
1871 | } | |
1872 | r1kh = r1kh_next; | |
1873 | } | |
1874 | } | |
1875 | ||
1876 | ||
eefe8630 MB |
1877 | void 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 | ||
1884 | static void wpa_ft_block_r0kh(struct wpa_authenticator *wpa_auth, | |
1885 | const u8 *f_r0kh_id, size_t f_r0kh_id_len) | |
1886 | { | |
1887 | struct ft_remote_r0kh *r0kh, *r0kh_wildcard; | |
1888 | ||
1889 | if (!wpa_auth->conf.rkh_neg_timeout) | |
1890 | return; | |
1891 | ||
1892 | wpa_ft_rrb_lookup_r0kh(wpa_auth, f_r0kh_id, f_r0kh_id_len, | |
1893 | &r0kh, &r0kh_wildcard); | |
1894 | ||
1895 | if (!r0kh_wildcard) { | |
1896 | /* r0kh removed after neg_timeout and might need re-adding */ | |
1897 | return; | |
1898 | } | |
1899 | ||
1900 | wpa_hexdump(MSG_DEBUG, "FT: Blacklist R0KH-ID", | |
1901 | f_r0kh_id, f_r0kh_id_len); | |
1902 | ||
1903 | if (r0kh) { | |
1904 | wpa_ft_rrb_r0kh_timeout(wpa_auth, r0kh, | |
1905 | wpa_auth->conf.rkh_neg_timeout); | |
1906 | os_memset(r0kh->addr, 0, ETH_ALEN); | |
1907 | } else | |
1908 | wpa_ft_rrb_add_r0kh(wpa_auth, r0kh_wildcard, NULL, f_r0kh_id, | |
1909 | f_r0kh_id_len, | |
1910 | wpa_auth->conf.rkh_neg_timeout); | |
1911 | } | |
1912 | ||
1913 | ||
1914 | static void wpa_ft_expire_pull(void *eloop_ctx, void *timeout_ctx) | |
1915 | { | |
1916 | struct wpa_state_machine *sm = eloop_ctx; | |
1917 | ||
1918 | wpa_printf(MSG_DEBUG, "FT: Timeout pending pull request for " MACSTR, | |
1919 | MAC2STR(sm->addr)); | |
1920 | if (sm->ft_pending_pull_left_retries <= 0) | |
1921 | wpa_ft_block_r0kh(sm->wpa_auth, sm->r0kh_id, sm->r0kh_id_len); | |
1922 | ||
1923 | /* cancel multiple timeouts */ | |
1924 | eloop_cancel_timeout(wpa_ft_expire_pull, sm, NULL); | |
1925 | ft_finish_pull(sm); | |
eefe8630 MB |
1926 | } |
1927 | ||
1928 | ||
692ec305 JM |
1929 | static int wpa_ft_pull_pmk_r1(struct wpa_state_machine *sm, |
1930 | const u8 *ies, size_t ies_len, | |
1931 | const u8 *pmk_r0_name) | |
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 |
2051 | int 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 | 2080 | int 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 | ||
2158 | static 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 | ||
2167 | static u8 * wpa_ft_gtk_subelem(struct wpa_state_machine *sm, size_t *len) | |
2168 | { | |
2169 | u8 *subelem; | |
2170 | struct wpa_group *gsm = sm->group; | |
2171 | size_t subelem_len, pad_len; | |
2172 | const u8 *key; | |
2173 | size_t key_len; | |
2174 | u8 keybuf[32]; | |
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 |
2237 | static u8 * wpa_ft_igtk_subelem(struct wpa_state_machine *sm, size_t *len) |
2238 | { | |
2239 | u8 *subelem, *pos; | |
2240 | struct wpa_group *gsm = sm->group; | |
2241 | size_t subelem_len; | |
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 |
2285 | static u8 * wpa_ft_bigtk_subelem(struct wpa_state_machine *sm, size_t *len) |
2286 | { | |
2287 | u8 *subelem, *pos; | |
2288 | struct wpa_group *gsm = sm->group; | |
2289 | size_t subelem_len; | |
2290 | const u8 *kek; | |
2291 | size_t kek_len; | |
2292 | size_t bigtk_len; | |
2293 | ||
2294 | if (wpa_key_mgmt_fils(sm->wpa_key_mgmt)) { | |
2295 | kek = sm->PTK.kek2; | |
2296 | kek_len = sm->PTK.kek2_len; | |
2297 | } else { | |
2298 | kek = sm->PTK.kek; | |
2299 | kek_len = sm->PTK.kek_len; | |
2300 | } | |
2301 | ||
2302 | bigtk_len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher); | |
2303 | ||
2304 | /* Sub-elem ID[1] | Length[1] | KeyID[2] | BIPN[6] | Key Length[1] | | |
2305 | * Key[16+8] */ | |
2306 | subelem_len = 1 + 1 + 2 + 6 + 1 + bigtk_len + 8; | |
2307 | subelem = os_zalloc(subelem_len); | |
2308 | if (subelem == NULL) | |
2309 | return NULL; | |
2310 | ||
2311 | pos = subelem; | |
2312 | *pos++ = FTIE_SUBELEM_BIGTK; | |
2313 | *pos++ = subelem_len - 2; | |
2314 | WPA_PUT_LE16(pos, gsm->GN_bigtk); | |
2315 | pos += 2; | |
2316 | wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_bigtk, pos); | |
2317 | pos += 6; | |
2318 | *pos++ = bigtk_len; | |
2319 | if (aes_wrap(kek, kek_len, bigtk_len / 8, | |
2320 | gsm->IGTK[gsm->GN_bigtk - 6], pos)) { | |
2321 | wpa_printf(MSG_DEBUG, | |
2322 | "FT: BIGTK subelem encryption failed: kek_len=%d", | |
2323 | (int) kek_len); | |
2324 | os_free(subelem); | |
2325 | return NULL; | |
2326 | } | |
2327 | ||
2328 | *len = subelem_len; | |
2329 | return subelem; | |
2330 | } | |
2331 | ||
2332 | ||
88b32a99 SP |
2333 | static 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 |
2432 | static 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 | 2464 | u8 * 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 |
2737 | static 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 | 2750 | void 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 */ |
2789 | static 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 | */ | |
2869 | static 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 |
2910 | static 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 | 2985 | static 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 | 3116 | pmk_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 |
3187 | fail: |
3188 | os_free(*resp_ies); | |
3189 | *resp_ies = NULL; | |
3190 | return WLAN_STATUS_UNSPECIFIED_FAILURE; | |
6fc6879b JM |
3191 | } |
3192 | ||
3193 | ||
3194 | void 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 | ||
3238 | u16 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 | ||
3469 | int 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 |
3545 | static 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 |
3557 | static 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 | ||
3595 | static 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 |
3646 | static 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 |
3720 | static 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 | ||
3865 | out: | |
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 | */ |
3877 | static 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; | |
4043 | out: | |
31bc66e4 | 4044 | bin_clear_free(plain, plain_len); |
245fc96e MB |
4045 | |
4046 | return ret; | |
6fc6879b | 4047 | |
6fc6879b JM |
4048 | } |
4049 | ||
4050 | ||
245fc96e | 4051 | static 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 |
4083 | struct ft_get_sta_ctx { |
4084 | const u8 *nonce; | |
4085 | const u8 *s1kh_id; | |
4086 | struct wpa_state_machine *sm; | |
4087 | }; | |
4088 | ||
4089 | ||
4090 | static 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 |
4107 | static 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 |
4156 | out: |
4157 | return ret; | |
6fc6879b JM |
4158 | } |
4159 | ||
4160 | ||
4161 | static 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 | ||
4179 | static 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; |
4292 | out: | |
4293 | return -1; | |
4294 | } | |
4295 | ||
4296 | ||
4297 | static 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 | ||
4359 | out: | |
4360 | os_free(packet); | |
4361 | ||
4362 | return ret; | |
4363 | } | |
4364 | ||
4365 | ||
4366 | static 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 |
4462 | out: |
4463 | return -1; | |
6fc6879b JM |
4464 | } |
4465 | ||
4466 | ||
4467 | int 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 |
4585 | void 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 |
4652 | static 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 | ||
4701 | void 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 */ |