wpa_auth_ft.c revision 61d9df3e62aaa0e87ad05452fcb95142159a17b6
1/* 2 * hostapd - IEEE 802.11r - Fast BSS Transition 3 * Copyright (c) 2004-2009, Jouni Malinen <j@w1.fi> 4 * 5 * This software may be distributed under the terms of the BSD license. 6 * See README for more details. 7 */ 8 9#include "utils/includes.h" 10 11#include "utils/common.h" 12#include "common/ieee802_11_defs.h" 13#include "common/ieee802_11_common.h" 14#include "crypto/aes_wrap.h" 15#include "crypto/random.h" 16#include "ap_config.h" 17#include "ieee802_11.h" 18#include "wmm.h" 19#include "wpa_auth.h" 20#include "wpa_auth_i.h" 21 22 23#ifdef CONFIG_IEEE80211R 24 25static int wpa_ft_rrb_send(struct wpa_authenticator *wpa_auth, const u8 *dst, 26 const u8 *data, size_t data_len) 27{ 28 if (wpa_auth->cb.send_ether == NULL) 29 return -1; 30 wpa_printf(MSG_DEBUG, "FT: RRB send to " MACSTR, MAC2STR(dst)); 31 return wpa_auth->cb.send_ether(wpa_auth->cb.ctx, dst, ETH_P_RRB, 32 data, data_len); 33} 34 35 36static int wpa_ft_action_send(struct wpa_authenticator *wpa_auth, 37 const u8 *dst, const u8 *data, size_t data_len) 38{ 39 if (wpa_auth->cb.send_ft_action == NULL) 40 return -1; 41 return wpa_auth->cb.send_ft_action(wpa_auth->cb.ctx, dst, 42 data, data_len); 43} 44 45 46static struct wpa_state_machine * 47wpa_ft_add_sta(struct wpa_authenticator *wpa_auth, const u8 *sta_addr) 48{ 49 if (wpa_auth->cb.add_sta == NULL) 50 return NULL; 51 return wpa_auth->cb.add_sta(wpa_auth->cb.ctx, sta_addr); 52} 53 54 55static int wpa_ft_add_tspec(struct wpa_authenticator *wpa_auth, 56 const u8 *sta_addr, 57 u8 *tspec_ie, size_t tspec_ielen) 58{ 59 if (wpa_auth->cb.add_tspec == NULL) { 60 wpa_printf(MSG_DEBUG, "FT: add_tspec is not initialized"); 61 return -1; 62 } 63 return wpa_auth->cb.add_tspec(wpa_auth->cb.ctx, sta_addr, tspec_ie, 64 tspec_ielen); 65} 66 67 68int wpa_write_mdie(struct wpa_auth_config *conf, u8 *buf, size_t len) 69{ 70 u8 *pos = buf; 71 u8 capab; 72 if (len < 2 + sizeof(struct rsn_mdie)) 73 return -1; 74 75 *pos++ = WLAN_EID_MOBILITY_DOMAIN; 76 *pos++ = MOBILITY_DOMAIN_ID_LEN + 1; 77 os_memcpy(pos, conf->mobility_domain, MOBILITY_DOMAIN_ID_LEN); 78 pos += MOBILITY_DOMAIN_ID_LEN; 79 capab = 0; 80 if (conf->ft_over_ds) 81 capab |= RSN_FT_CAPAB_FT_OVER_DS; 82 *pos++ = capab; 83 84 return pos - buf; 85} 86 87 88int wpa_write_ftie(struct wpa_auth_config *conf, const u8 *r0kh_id, 89 size_t r0kh_id_len, 90 const u8 *anonce, const u8 *snonce, 91 u8 *buf, size_t len, const u8 *subelem, 92 size_t subelem_len) 93{ 94 u8 *pos = buf, *ielen; 95 struct rsn_ftie *hdr; 96 97 if (len < 2 + sizeof(*hdr) + 2 + FT_R1KH_ID_LEN + 2 + r0kh_id_len + 98 subelem_len) 99 return -1; 100 101 *pos++ = WLAN_EID_FAST_BSS_TRANSITION; 102 ielen = pos++; 103 104 hdr = (struct rsn_ftie *) pos; 105 os_memset(hdr, 0, sizeof(*hdr)); 106 pos += sizeof(*hdr); 107 WPA_PUT_LE16(hdr->mic_control, 0); 108 if (anonce) 109 os_memcpy(hdr->anonce, anonce, WPA_NONCE_LEN); 110 if (snonce) 111 os_memcpy(hdr->snonce, snonce, WPA_NONCE_LEN); 112 113 /* Optional Parameters */ 114 *pos++ = FTIE_SUBELEM_R1KH_ID; 115 *pos++ = FT_R1KH_ID_LEN; 116 os_memcpy(pos, conf->r1_key_holder, FT_R1KH_ID_LEN); 117 pos += FT_R1KH_ID_LEN; 118 119 if (r0kh_id) { 120 *pos++ = FTIE_SUBELEM_R0KH_ID; 121 *pos++ = r0kh_id_len; 122 os_memcpy(pos, r0kh_id, r0kh_id_len); 123 pos += r0kh_id_len; 124 } 125 126 if (subelem) { 127 os_memcpy(pos, subelem, subelem_len); 128 pos += subelem_len; 129 } 130 131 *ielen = pos - buf - 2; 132 133 return pos - buf; 134} 135 136 137struct wpa_ft_pmk_r0_sa { 138 struct wpa_ft_pmk_r0_sa *next; 139 u8 pmk_r0[PMK_LEN]; 140 u8 pmk_r0_name[WPA_PMK_NAME_LEN]; 141 u8 spa[ETH_ALEN]; 142 int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */ 143 /* TODO: expiration, identity, radius_class, EAP type, VLAN ID */ 144 int pmk_r1_pushed; 145}; 146 147struct wpa_ft_pmk_r1_sa { 148 struct wpa_ft_pmk_r1_sa *next; 149 u8 pmk_r1[PMK_LEN]; 150 u8 pmk_r1_name[WPA_PMK_NAME_LEN]; 151 u8 spa[ETH_ALEN]; 152 int pairwise; /* Pairwise cipher suite, WPA_CIPHER_* */ 153 /* TODO: expiration, identity, radius_class, EAP type, VLAN ID */ 154}; 155 156struct wpa_ft_pmk_cache { 157 struct wpa_ft_pmk_r0_sa *pmk_r0; 158 struct wpa_ft_pmk_r1_sa *pmk_r1; 159}; 160 161struct wpa_ft_pmk_cache * wpa_ft_pmk_cache_init(void) 162{ 163 struct wpa_ft_pmk_cache *cache; 164 165 cache = os_zalloc(sizeof(*cache)); 166 167 return cache; 168} 169 170 171void wpa_ft_pmk_cache_deinit(struct wpa_ft_pmk_cache *cache) 172{ 173 struct wpa_ft_pmk_r0_sa *r0, *r0prev; 174 struct wpa_ft_pmk_r1_sa *r1, *r1prev; 175 176 r0 = cache->pmk_r0; 177 while (r0) { 178 r0prev = r0; 179 r0 = r0->next; 180 os_memset(r0prev->pmk_r0, 0, PMK_LEN); 181 os_free(r0prev); 182 } 183 184 r1 = cache->pmk_r1; 185 while (r1) { 186 r1prev = r1; 187 r1 = r1->next; 188 os_memset(r1prev->pmk_r1, 0, PMK_LEN); 189 os_free(r1prev); 190 } 191 192 os_free(cache); 193} 194 195 196static int wpa_ft_store_pmk_r0(struct wpa_authenticator *wpa_auth, 197 const u8 *spa, const u8 *pmk_r0, 198 const u8 *pmk_r0_name, int pairwise) 199{ 200 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache; 201 struct wpa_ft_pmk_r0_sa *r0; 202 203 /* TODO: add expiration and limit on number of entries in cache */ 204 205 r0 = os_zalloc(sizeof(*r0)); 206 if (r0 == NULL) 207 return -1; 208 209 os_memcpy(r0->pmk_r0, pmk_r0, PMK_LEN); 210 os_memcpy(r0->pmk_r0_name, pmk_r0_name, WPA_PMK_NAME_LEN); 211 os_memcpy(r0->spa, spa, ETH_ALEN); 212 r0->pairwise = pairwise; 213 214 r0->next = cache->pmk_r0; 215 cache->pmk_r0 = r0; 216 217 return 0; 218} 219 220 221static int wpa_ft_fetch_pmk_r0(struct wpa_authenticator *wpa_auth, 222 const u8 *spa, const u8 *pmk_r0_name, 223 u8 *pmk_r0, int *pairwise) 224{ 225 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache; 226 struct wpa_ft_pmk_r0_sa *r0; 227 228 r0 = cache->pmk_r0; 229 while (r0) { 230 if (os_memcmp(r0->spa, spa, ETH_ALEN) == 0 && 231 os_memcmp(r0->pmk_r0_name, pmk_r0_name, WPA_PMK_NAME_LEN) 232 == 0) { 233 os_memcpy(pmk_r0, r0->pmk_r0, PMK_LEN); 234 if (pairwise) 235 *pairwise = r0->pairwise; 236 return 0; 237 } 238 239 r0 = r0->next; 240 } 241 242 return -1; 243} 244 245 246static int wpa_ft_store_pmk_r1(struct wpa_authenticator *wpa_auth, 247 const u8 *spa, const u8 *pmk_r1, 248 const u8 *pmk_r1_name, int pairwise) 249{ 250 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache; 251 struct wpa_ft_pmk_r1_sa *r1; 252 253 /* TODO: add expiration and limit on number of entries in cache */ 254 255 r1 = os_zalloc(sizeof(*r1)); 256 if (r1 == NULL) 257 return -1; 258 259 os_memcpy(r1->pmk_r1, pmk_r1, PMK_LEN); 260 os_memcpy(r1->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN); 261 os_memcpy(r1->spa, spa, ETH_ALEN); 262 r1->pairwise = pairwise; 263 264 r1->next = cache->pmk_r1; 265 cache->pmk_r1 = r1; 266 267 return 0; 268} 269 270 271static int wpa_ft_fetch_pmk_r1(struct wpa_authenticator *wpa_auth, 272 const u8 *spa, const u8 *pmk_r1_name, 273 u8 *pmk_r1, int *pairwise) 274{ 275 struct wpa_ft_pmk_cache *cache = wpa_auth->ft_pmk_cache; 276 struct wpa_ft_pmk_r1_sa *r1; 277 278 r1 = cache->pmk_r1; 279 while (r1) { 280 if (os_memcmp(r1->spa, spa, ETH_ALEN) == 0 && 281 os_memcmp(r1->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN) 282 == 0) { 283 os_memcpy(pmk_r1, r1->pmk_r1, PMK_LEN); 284 if (pairwise) 285 *pairwise = r1->pairwise; 286 return 0; 287 } 288 289 r1 = r1->next; 290 } 291 292 return -1; 293} 294 295 296static int wpa_ft_pull_pmk_r1(struct wpa_authenticator *wpa_auth, 297 const u8 *s1kh_id, const u8 *r0kh_id, 298 size_t r0kh_id_len, const u8 *pmk_r0_name) 299{ 300 struct ft_remote_r0kh *r0kh; 301 struct ft_r0kh_r1kh_pull_frame frame, f; 302 303 r0kh = wpa_auth->conf.r0kh_list; 304 while (r0kh) { 305 if (r0kh->id_len == r0kh_id_len && 306 os_memcmp(r0kh->id, r0kh_id, r0kh_id_len) == 0) 307 break; 308 r0kh = r0kh->next; 309 } 310 if (r0kh == NULL) 311 return -1; 312 313 wpa_printf(MSG_DEBUG, "FT: Send PMK-R1 pull request to remote R0KH " 314 "address " MACSTR, MAC2STR(r0kh->addr)); 315 316 os_memset(&frame, 0, sizeof(frame)); 317 frame.frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB; 318 frame.packet_type = FT_PACKET_R0KH_R1KH_PULL; 319 frame.data_length = host_to_le16(FT_R0KH_R1KH_PULL_DATA_LEN); 320 os_memcpy(frame.ap_address, wpa_auth->addr, ETH_ALEN); 321 322 /* aes_wrap() does not support inplace encryption, so use a temporary 323 * buffer for the data. */ 324 if (random_get_bytes(f.nonce, sizeof(f.nonce))) { 325 wpa_printf(MSG_DEBUG, "FT: Failed to get random data for " 326 "nonce"); 327 return -1; 328 } 329 os_memcpy(f.pmk_r0_name, pmk_r0_name, WPA_PMK_NAME_LEN); 330 os_memcpy(f.r1kh_id, wpa_auth->conf.r1_key_holder, FT_R1KH_ID_LEN); 331 os_memcpy(f.s1kh_id, s1kh_id, ETH_ALEN); 332 333 if (aes_wrap(r0kh->key, (FT_R0KH_R1KH_PULL_DATA_LEN + 7) / 8, 334 f.nonce, frame.nonce) < 0) 335 return -1; 336 337 wpa_ft_rrb_send(wpa_auth, r0kh->addr, (u8 *) &frame, sizeof(frame)); 338 339 return 0; 340} 341 342 343int wpa_auth_derive_ptk_ft(struct wpa_state_machine *sm, const u8 *pmk, 344 struct wpa_ptk *ptk, size_t ptk_len) 345{ 346 u8 pmk_r0[PMK_LEN], pmk_r0_name[WPA_PMK_NAME_LEN]; 347 u8 pmk_r1[PMK_LEN]; 348 u8 ptk_name[WPA_PMK_NAME_LEN]; 349 const u8 *mdid = sm->wpa_auth->conf.mobility_domain; 350 const u8 *r0kh = sm->wpa_auth->conf.r0_key_holder; 351 size_t r0kh_len = sm->wpa_auth->conf.r0_key_holder_len; 352 const u8 *r1kh = sm->wpa_auth->conf.r1_key_holder; 353 const u8 *ssid = sm->wpa_auth->conf.ssid; 354 size_t ssid_len = sm->wpa_auth->conf.ssid_len; 355 356 357 if (sm->xxkey_len == 0) { 358 wpa_printf(MSG_DEBUG, "FT: XXKey not available for key " 359 "derivation"); 360 return -1; 361 } 362 363 wpa_derive_pmk_r0(sm->xxkey, sm->xxkey_len, ssid, ssid_len, mdid, 364 r0kh, r0kh_len, sm->addr, pmk_r0, pmk_r0_name); 365 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R0", pmk_r0, PMK_LEN); 366 wpa_hexdump(MSG_DEBUG, "FT: PMKR0Name", pmk_r0_name, WPA_PMK_NAME_LEN); 367 wpa_ft_store_pmk_r0(sm->wpa_auth, sm->addr, pmk_r0, pmk_r0_name, 368 sm->pairwise); 369 370 wpa_derive_pmk_r1(pmk_r0, pmk_r0_name, r1kh, sm->addr, 371 pmk_r1, sm->pmk_r1_name); 372 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", pmk_r1, PMK_LEN); 373 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", sm->pmk_r1_name, 374 WPA_PMK_NAME_LEN); 375 wpa_ft_store_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1, sm->pmk_r1_name, 376 sm->pairwise); 377 378 wpa_pmk_r1_to_ptk(pmk_r1, sm->SNonce, sm->ANonce, sm->addr, 379 sm->wpa_auth->addr, sm->pmk_r1_name, 380 (u8 *) ptk, ptk_len, ptk_name); 381 wpa_hexdump_key(MSG_DEBUG, "FT: PTK", (u8 *) ptk, ptk_len); 382 wpa_hexdump(MSG_DEBUG, "FT: PTKName", ptk_name, WPA_PMK_NAME_LEN); 383 384 return 0; 385} 386 387 388static inline int wpa_auth_get_seqnum(struct wpa_authenticator *wpa_auth, 389 const u8 *addr, int idx, u8 *seq) 390{ 391 if (wpa_auth->cb.get_seqnum == NULL) 392 return -1; 393 return wpa_auth->cb.get_seqnum(wpa_auth->cb.ctx, addr, idx, seq); 394} 395 396 397static u8 * wpa_ft_gtk_subelem(struct wpa_state_machine *sm, size_t *len) 398{ 399 u8 *subelem; 400 struct wpa_group *gsm = sm->group; 401 size_t subelem_len, pad_len; 402 const u8 *key; 403 size_t key_len; 404 u8 keybuf[32]; 405 406 key_len = gsm->GTK_len; 407 if (key_len > sizeof(keybuf)) 408 return NULL; 409 410 /* 411 * Pad key for AES Key Wrap if it is not multiple of 8 bytes or is less 412 * than 16 bytes. 413 */ 414 pad_len = key_len % 8; 415 if (pad_len) 416 pad_len = 8 - pad_len; 417 if (key_len + pad_len < 16) 418 pad_len += 8; 419 if (pad_len) { 420 os_memcpy(keybuf, gsm->GTK[gsm->GN - 1], key_len); 421 os_memset(keybuf + key_len, 0, pad_len); 422 keybuf[key_len] = 0xdd; 423 key_len += pad_len; 424 key = keybuf; 425 } else 426 key = gsm->GTK[gsm->GN - 1]; 427 428 /* 429 * Sub-elem ID[1] | Length[1] | Key Info[2] | Key Length[1] | RSC[8] | 430 * Key[5..32]. 431 */ 432 subelem_len = 13 + key_len + 8; 433 subelem = os_zalloc(subelem_len); 434 if (subelem == NULL) 435 return NULL; 436 437 subelem[0] = FTIE_SUBELEM_GTK; 438 subelem[1] = 11 + key_len + 8; 439 /* Key ID in B0-B1 of Key Info */ 440 WPA_PUT_LE16(&subelem[2], gsm->GN & 0x03); 441 subelem[4] = gsm->GTK_len; 442 wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN, subelem + 5); 443 if (aes_wrap(sm->PTK.kek, key_len / 8, key, subelem + 13)) { 444 os_free(subelem); 445 return NULL; 446 } 447 448 *len = subelem_len; 449 return subelem; 450} 451 452 453#ifdef CONFIG_IEEE80211W 454static u8 * wpa_ft_igtk_subelem(struct wpa_state_machine *sm, size_t *len) 455{ 456 u8 *subelem, *pos; 457 struct wpa_group *gsm = sm->group; 458 size_t subelem_len; 459 460 /* Sub-elem ID[1] | Length[1] | KeyID[2] | IPN[6] | Key Length[1] | 461 * Key[16+8] */ 462 subelem_len = 1 + 1 + 2 + 6 + 1 + WPA_IGTK_LEN + 8; 463 subelem = os_zalloc(subelem_len); 464 if (subelem == NULL) 465 return NULL; 466 467 pos = subelem; 468 *pos++ = FTIE_SUBELEM_IGTK; 469 *pos++ = subelem_len - 2; 470 WPA_PUT_LE16(pos, gsm->GN_igtk); 471 pos += 2; 472 wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_igtk, pos); 473 pos += 6; 474 *pos++ = WPA_IGTK_LEN; 475 if (aes_wrap(sm->PTK.kek, WPA_IGTK_LEN / 8, 476 gsm->IGTK[gsm->GN_igtk - 4], pos)) { 477 os_free(subelem); 478 return NULL; 479 } 480 481 *len = subelem_len; 482 return subelem; 483} 484#endif /* CONFIG_IEEE80211W */ 485 486 487static u8 * wpa_ft_process_rdie(struct wpa_state_machine *sm, 488 u8 *pos, u8 *end, u8 id, u8 descr_count, 489 const u8 *ies, size_t ies_len) 490{ 491 struct ieee802_11_elems parse; 492 struct rsn_rdie *rdie; 493 494 wpa_printf(MSG_DEBUG, "FT: Resource Request: id=%d descr_count=%d", 495 id, descr_count); 496 wpa_hexdump(MSG_MSGDUMP, "FT: Resource descriptor IE(s)", 497 ies, ies_len); 498 499 if (end - pos < (int) sizeof(*rdie)) { 500 wpa_printf(MSG_ERROR, "FT: Not enough room for response RDIE"); 501 return pos; 502 } 503 504 *pos++ = WLAN_EID_RIC_DATA; 505 *pos++ = sizeof(*rdie); 506 rdie = (struct rsn_rdie *) pos; 507 rdie->id = id; 508 rdie->descr_count = 0; 509 rdie->status_code = host_to_le16(WLAN_STATUS_SUCCESS); 510 pos += sizeof(*rdie); 511 512 if (ieee802_11_parse_elems((u8 *) ies, ies_len, &parse, 1) == 513 ParseFailed) { 514 wpa_printf(MSG_DEBUG, "FT: Failed to parse request IEs"); 515 rdie->status_code = 516 host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE); 517 return pos; 518 } 519 520#ifdef NEED_AP_MLME 521 if (parse.wmm_tspec && sm->wpa_auth->conf.ap_mlme) { 522 struct wmm_tspec_element *tspec; 523 int res; 524 525 if (parse.wmm_tspec_len + 2 < (int) sizeof(*tspec)) { 526 wpa_printf(MSG_DEBUG, "FT: Too short WMM TSPEC IE " 527 "(%d)", (int) parse.wmm_tspec_len); 528 rdie->status_code = 529 host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE); 530 return pos; 531 } 532 if (end - pos < (int) sizeof(*tspec)) { 533 wpa_printf(MSG_ERROR, "FT: Not enough room for " 534 "response TSPEC"); 535 rdie->status_code = 536 host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE); 537 return pos; 538 } 539 tspec = (struct wmm_tspec_element *) pos; 540 os_memcpy(tspec, parse.wmm_tspec - 2, sizeof(*tspec)); 541 res = wmm_process_tspec(tspec); 542 wpa_printf(MSG_DEBUG, "FT: ADDTS processing result: %d", res); 543 if (res == WMM_ADDTS_STATUS_INVALID_PARAMETERS) 544 rdie->status_code = 545 host_to_le16(WLAN_STATUS_INVALID_PARAMETERS); 546 else if (res == WMM_ADDTS_STATUS_REFUSED) 547 rdie->status_code = 548 host_to_le16(WLAN_STATUS_REQUEST_DECLINED); 549 else { 550 /* TSPEC accepted; include updated TSPEC in response */ 551 rdie->descr_count = 1; 552 pos += sizeof(*tspec); 553 } 554 return pos; 555 } 556#endif /* NEED_AP_MLME */ 557 558 if (parse.wmm_tspec && !sm->wpa_auth->conf.ap_mlme) { 559 struct wmm_tspec_element *tspec; 560 int res; 561 562 tspec = (struct wmm_tspec_element *) pos; 563 os_memcpy(tspec, parse.wmm_tspec - 2, sizeof(*tspec)); 564 res = wpa_ft_add_tspec(sm->wpa_auth, sm->addr, pos, 565 sizeof(*tspec)); 566 if (res >= 0) { 567 if (res) 568 rdie->status_code = host_to_le16(res); 569 else { 570 /* TSPEC accepted; include updated TSPEC in 571 * response */ 572 rdie->descr_count = 1; 573 pos += sizeof(*tspec); 574 } 575 return pos; 576 } 577 } 578 579 wpa_printf(MSG_DEBUG, "FT: No supported resource requested"); 580 rdie->status_code = host_to_le16(WLAN_STATUS_UNSPECIFIED_FAILURE); 581 return pos; 582} 583 584 585static u8 * wpa_ft_process_ric(struct wpa_state_machine *sm, u8 *pos, u8 *end, 586 const u8 *ric, size_t ric_len) 587{ 588 const u8 *rpos, *start; 589 const struct rsn_rdie *rdie; 590 591 wpa_hexdump(MSG_MSGDUMP, "FT: RIC Request", ric, ric_len); 592 593 rpos = ric; 594 while (rpos + sizeof(*rdie) < ric + ric_len) { 595 if (rpos[0] != WLAN_EID_RIC_DATA || rpos[1] < sizeof(*rdie) || 596 rpos + 2 + rpos[1] > ric + ric_len) 597 break; 598 rdie = (const struct rsn_rdie *) (rpos + 2); 599 rpos += 2 + rpos[1]; 600 start = rpos; 601 602 while (rpos + 2 <= ric + ric_len && 603 rpos + 2 + rpos[1] <= ric + ric_len) { 604 if (rpos[0] == WLAN_EID_RIC_DATA) 605 break; 606 rpos += 2 + rpos[1]; 607 } 608 pos = wpa_ft_process_rdie(sm, pos, end, rdie->id, 609 rdie->descr_count, 610 start, rpos - start); 611 } 612 613 return pos; 614} 615 616 617u8 * wpa_sm_write_assoc_resp_ies(struct wpa_state_machine *sm, u8 *pos, 618 size_t max_len, int auth_alg, 619 const u8 *req_ies, size_t req_ies_len) 620{ 621 u8 *end, *mdie, *ftie, *rsnie = NULL, *r0kh_id, *subelem = NULL; 622 size_t mdie_len, ftie_len, rsnie_len = 0, r0kh_id_len, subelem_len = 0; 623 int res; 624 struct wpa_auth_config *conf; 625 struct rsn_ftie *_ftie; 626 struct wpa_ft_ies parse; 627 u8 *ric_start; 628 u8 *anonce, *snonce; 629 630 if (sm == NULL) 631 return pos; 632 633 conf = &sm->wpa_auth->conf; 634 635 if (sm->wpa_key_mgmt != WPA_KEY_MGMT_FT_IEEE8021X && 636 sm->wpa_key_mgmt != WPA_KEY_MGMT_FT_PSK) 637 return pos; 638 639 end = pos + max_len; 640 641 if (auth_alg == WLAN_AUTH_FT) { 642 /* 643 * RSN (only present if this is a Reassociation Response and 644 * part of a fast BSS transition) 645 */ 646 res = wpa_write_rsn_ie(conf, pos, end - pos, sm->pmk_r1_name); 647 if (res < 0) 648 return pos; 649 rsnie = pos; 650 rsnie_len = res; 651 pos += res; 652 } 653 654 /* Mobility Domain Information */ 655 res = wpa_write_mdie(conf, pos, end - pos); 656 if (res < 0) 657 return pos; 658 mdie = pos; 659 mdie_len = res; 660 pos += res; 661 662 /* Fast BSS Transition Information */ 663 if (auth_alg == WLAN_AUTH_FT) { 664 subelem = wpa_ft_gtk_subelem(sm, &subelem_len); 665 r0kh_id = sm->r0kh_id; 666 r0kh_id_len = sm->r0kh_id_len; 667 anonce = sm->ANonce; 668 snonce = sm->SNonce; 669#ifdef CONFIG_IEEE80211W 670 if (sm->mgmt_frame_prot) { 671 u8 *igtk; 672 size_t igtk_len; 673 u8 *nbuf; 674 igtk = wpa_ft_igtk_subelem(sm, &igtk_len); 675 if (igtk == NULL) { 676 os_free(subelem); 677 return pos; 678 } 679 nbuf = os_realloc(subelem, subelem_len + igtk_len); 680 if (nbuf == NULL) { 681 os_free(subelem); 682 os_free(igtk); 683 return pos; 684 } 685 subelem = nbuf; 686 os_memcpy(subelem + subelem_len, igtk, igtk_len); 687 subelem_len += igtk_len; 688 os_free(igtk); 689 } 690#endif /* CONFIG_IEEE80211W */ 691 } else { 692 r0kh_id = conf->r0_key_holder; 693 r0kh_id_len = conf->r0_key_holder_len; 694 anonce = NULL; 695 snonce = NULL; 696 } 697 res = wpa_write_ftie(conf, r0kh_id, r0kh_id_len, anonce, snonce, pos, 698 end - pos, subelem, subelem_len); 699 os_free(subelem); 700 if (res < 0) 701 return pos; 702 ftie = pos; 703 ftie_len = res; 704 pos += res; 705 706 os_free(sm->assoc_resp_ftie); 707 sm->assoc_resp_ftie = os_malloc(ftie_len); 708 if (sm->assoc_resp_ftie) 709 os_memcpy(sm->assoc_resp_ftie, ftie, ftie_len); 710 711 _ftie = (struct rsn_ftie *) (ftie + 2); 712 if (auth_alg == WLAN_AUTH_FT) 713 _ftie->mic_control[1] = 3; /* Information element count */ 714 715 ric_start = pos; 716 if (wpa_ft_parse_ies(req_ies, req_ies_len, &parse) == 0 && parse.ric) { 717 pos = wpa_ft_process_ric(sm, pos, end, parse.ric, 718 parse.ric_len); 719 if (auth_alg == WLAN_AUTH_FT) 720 _ftie->mic_control[1] += 721 ieee802_11_ie_count(ric_start, 722 pos - ric_start); 723 } 724 if (ric_start == pos) 725 ric_start = NULL; 726 727 if (auth_alg == WLAN_AUTH_FT && 728 wpa_ft_mic(sm->PTK.kck, sm->addr, sm->wpa_auth->addr, 6, 729 mdie, mdie_len, ftie, ftie_len, 730 rsnie, rsnie_len, 731 ric_start, ric_start ? pos - ric_start : 0, 732 _ftie->mic) < 0) 733 wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC"); 734 735 return pos; 736} 737 738 739static inline int wpa_auth_set_key(struct wpa_authenticator *wpa_auth, 740 int vlan_id, 741 enum wpa_alg alg, const u8 *addr, int idx, 742 u8 *key, size_t key_len) 743{ 744 if (wpa_auth->cb.set_key == NULL) 745 return -1; 746 return wpa_auth->cb.set_key(wpa_auth->cb.ctx, vlan_id, alg, addr, idx, 747 key, key_len); 748} 749 750 751void wpa_ft_install_ptk(struct wpa_state_machine *sm) 752{ 753 enum wpa_alg alg; 754 int klen; 755 756 /* MLME-SETKEYS.request(PTK) */ 757 if (sm->pairwise == WPA_CIPHER_TKIP) { 758 alg = WPA_ALG_TKIP; 759 klen = 32; 760 } else if (sm->pairwise == WPA_CIPHER_CCMP) { 761 alg = WPA_ALG_CCMP; 762 klen = 16; 763 } else if (sm->pairwise == WPA_CIPHER_GCMP) { 764 alg = WPA_ALG_GCMP; 765 klen = 16; 766 } else { 767 wpa_printf(MSG_DEBUG, "FT: Unknown pairwise alg 0x%x - skip " 768 "PTK configuration", sm->pairwise); 769 return; 770 } 771 772 /* FIX: add STA entry to kernel/driver here? The set_key will fail 773 * most likely without this.. At the moment, STA entry is added only 774 * after association has been completed. This function will be called 775 * again after association to get the PTK configured, but that could be 776 * optimized by adding the STA entry earlier. 777 */ 778 if (wpa_auth_set_key(sm->wpa_auth, 0, alg, sm->addr, 0, 779 sm->PTK.tk1, klen)) 780 return; 781 782 /* FIX: MLME-SetProtection.Request(TA, Tx_Rx) */ 783 sm->pairwise_set = TRUE; 784} 785 786 787static u16 wpa_ft_process_auth_req(struct wpa_state_machine *sm, 788 const u8 *ies, size_t ies_len, 789 u8 **resp_ies, size_t *resp_ies_len) 790{ 791 struct rsn_mdie *mdie; 792 struct rsn_ftie *ftie; 793 u8 pmk_r1[PMK_LEN], pmk_r1_name[WPA_PMK_NAME_LEN]; 794 u8 ptk_name[WPA_PMK_NAME_LEN]; 795 struct wpa_auth_config *conf; 796 struct wpa_ft_ies parse; 797 size_t buflen, ptk_len; 798 int ret; 799 u8 *pos, *end; 800 int pairwise; 801 802 *resp_ies = NULL; 803 *resp_ies_len = 0; 804 805 sm->pmk_r1_name_valid = 0; 806 conf = &sm->wpa_auth->conf; 807 808 wpa_hexdump(MSG_DEBUG, "FT: Received authentication frame IEs", 809 ies, ies_len); 810 811 if (wpa_ft_parse_ies(ies, ies_len, &parse) < 0) { 812 wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs"); 813 return WLAN_STATUS_UNSPECIFIED_FAILURE; 814 } 815 816 mdie = (struct rsn_mdie *) parse.mdie; 817 if (mdie == NULL || parse.mdie_len < sizeof(*mdie) || 818 os_memcmp(mdie->mobility_domain, 819 sm->wpa_auth->conf.mobility_domain, 820 MOBILITY_DOMAIN_ID_LEN) != 0) { 821 wpa_printf(MSG_DEBUG, "FT: Invalid MDIE"); 822 return WLAN_STATUS_INVALID_MDIE; 823 } 824 825 ftie = (struct rsn_ftie *) parse.ftie; 826 if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) { 827 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE"); 828 return WLAN_STATUS_INVALID_FTIE; 829 } 830 831 os_memcpy(sm->SNonce, ftie->snonce, WPA_NONCE_LEN); 832 833 if (parse.r0kh_id == NULL) { 834 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE - no R0KH-ID"); 835 return WLAN_STATUS_INVALID_FTIE; 836 } 837 838 wpa_hexdump(MSG_DEBUG, "FT: STA R0KH-ID", 839 parse.r0kh_id, parse.r0kh_id_len); 840 os_memcpy(sm->r0kh_id, parse.r0kh_id, parse.r0kh_id_len); 841 sm->r0kh_id_len = parse.r0kh_id_len; 842 843 if (parse.rsn_pmkid == NULL) { 844 wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE"); 845 return WLAN_STATUS_INVALID_PMKID; 846 } 847 848 wpa_hexdump(MSG_DEBUG, "FT: Requested PMKR0Name", 849 parse.rsn_pmkid, WPA_PMK_NAME_LEN); 850 wpa_derive_pmk_r1_name(parse.rsn_pmkid, 851 sm->wpa_auth->conf.r1_key_holder, sm->addr, 852 pmk_r1_name); 853 wpa_hexdump(MSG_DEBUG, "FT: Derived requested PMKR1Name", 854 pmk_r1_name, WPA_PMK_NAME_LEN); 855 856 if (wpa_ft_fetch_pmk_r1(sm->wpa_auth, sm->addr, pmk_r1_name, pmk_r1, 857 &pairwise) < 0) { 858 if (wpa_ft_pull_pmk_r1(sm->wpa_auth, sm->addr, sm->r0kh_id, 859 sm->r0kh_id_len, parse.rsn_pmkid) < 0) { 860 wpa_printf(MSG_DEBUG, "FT: Did not have matching " 861 "PMK-R1 and unknown R0KH-ID"); 862 return WLAN_STATUS_INVALID_PMKID; 863 } 864 865 /* 866 * TODO: Should return "status pending" (and the caller should 867 * not send out response now). The real response will be sent 868 * once the response from R0KH is received. 869 */ 870 return WLAN_STATUS_INVALID_PMKID; 871 } 872 873 wpa_hexdump_key(MSG_DEBUG, "FT: Selected PMK-R1", pmk_r1, PMK_LEN); 874 sm->pmk_r1_name_valid = 1; 875 os_memcpy(sm->pmk_r1_name, pmk_r1_name, WPA_PMK_NAME_LEN); 876 877 if (random_get_bytes(sm->ANonce, WPA_NONCE_LEN)) { 878 wpa_printf(MSG_DEBUG, "FT: Failed to get random data for " 879 "ANonce"); 880 return WLAN_STATUS_UNSPECIFIED_FAILURE; 881 } 882 883 wpa_hexdump(MSG_DEBUG, "FT: Received SNonce", 884 sm->SNonce, WPA_NONCE_LEN); 885 wpa_hexdump(MSG_DEBUG, "FT: Generated ANonce", 886 sm->ANonce, WPA_NONCE_LEN); 887 888 ptk_len = pairwise == WPA_CIPHER_TKIP ? 64 : 48; 889 wpa_pmk_r1_to_ptk(pmk_r1, sm->SNonce, sm->ANonce, sm->addr, 890 sm->wpa_auth->addr, pmk_r1_name, 891 (u8 *) &sm->PTK, ptk_len, ptk_name); 892 wpa_hexdump_key(MSG_DEBUG, "FT: PTK", 893 (u8 *) &sm->PTK, ptk_len); 894 wpa_hexdump(MSG_DEBUG, "FT: PTKName", ptk_name, WPA_PMK_NAME_LEN); 895 896 sm->pairwise = pairwise; 897 wpa_ft_install_ptk(sm); 898 899 buflen = 2 + sizeof(struct rsn_mdie) + 2 + sizeof(struct rsn_ftie) + 900 2 + FT_R1KH_ID_LEN + 200; 901 *resp_ies = os_zalloc(buflen); 902 if (*resp_ies == NULL) { 903 return WLAN_STATUS_UNSPECIFIED_FAILURE; 904 } 905 906 pos = *resp_ies; 907 end = *resp_ies + buflen; 908 909 ret = wpa_write_rsn_ie(conf, pos, end - pos, parse.rsn_pmkid); 910 if (ret < 0) { 911 os_free(*resp_ies); 912 *resp_ies = NULL; 913 return WLAN_STATUS_UNSPECIFIED_FAILURE; 914 } 915 pos += ret; 916 917 ret = wpa_write_mdie(conf, pos, end - pos); 918 if (ret < 0) { 919 os_free(*resp_ies); 920 *resp_ies = NULL; 921 return WLAN_STATUS_UNSPECIFIED_FAILURE; 922 } 923 pos += ret; 924 925 ret = wpa_write_ftie(conf, parse.r0kh_id, parse.r0kh_id_len, 926 sm->ANonce, sm->SNonce, pos, end - pos, NULL, 0); 927 if (ret < 0) { 928 os_free(*resp_ies); 929 *resp_ies = NULL; 930 return WLAN_STATUS_UNSPECIFIED_FAILURE; 931 } 932 pos += ret; 933 934 *resp_ies_len = pos - *resp_ies; 935 936 return WLAN_STATUS_SUCCESS; 937} 938 939 940void wpa_ft_process_auth(struct wpa_state_machine *sm, const u8 *bssid, 941 u16 auth_transaction, const u8 *ies, size_t ies_len, 942 void (*cb)(void *ctx, const u8 *dst, const u8 *bssid, 943 u16 auth_transaction, u16 status, 944 const u8 *ies, size_t ies_len), 945 void *ctx) 946{ 947 u16 status; 948 u8 *resp_ies; 949 size_t resp_ies_len; 950 951 if (sm == NULL) { 952 wpa_printf(MSG_DEBUG, "FT: Received authentication frame, but " 953 "WPA SM not available"); 954 return; 955 } 956 957 wpa_printf(MSG_DEBUG, "FT: Received authentication frame: STA=" MACSTR 958 " BSSID=" MACSTR " transaction=%d", 959 MAC2STR(sm->addr), MAC2STR(bssid), auth_transaction); 960 status = wpa_ft_process_auth_req(sm, ies, ies_len, &resp_ies, 961 &resp_ies_len); 962 963 wpa_printf(MSG_DEBUG, "FT: FT authentication response: dst=" MACSTR 964 " auth_transaction=%d status=%d", 965 MAC2STR(sm->addr), auth_transaction + 1, status); 966 wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len); 967 cb(ctx, sm->addr, bssid, auth_transaction + 1, status, 968 resp_ies, resp_ies_len); 969 os_free(resp_ies); 970} 971 972 973u16 wpa_ft_validate_reassoc(struct wpa_state_machine *sm, const u8 *ies, 974 size_t ies_len) 975{ 976 struct wpa_ft_ies parse; 977 struct rsn_mdie *mdie; 978 struct rsn_ftie *ftie; 979 u8 mic[16]; 980 unsigned int count; 981 982 if (sm == NULL) 983 return WLAN_STATUS_UNSPECIFIED_FAILURE; 984 985 wpa_hexdump(MSG_DEBUG, "FT: Reassoc Req IEs", ies, ies_len); 986 987 if (wpa_ft_parse_ies(ies, ies_len, &parse) < 0) { 988 wpa_printf(MSG_DEBUG, "FT: Failed to parse FT IEs"); 989 return WLAN_STATUS_UNSPECIFIED_FAILURE; 990 } 991 992 if (parse.rsn == NULL) { 993 wpa_printf(MSG_DEBUG, "FT: No RSNIE in Reassoc Req"); 994 return WLAN_STATUS_UNSPECIFIED_FAILURE; 995 } 996 997 if (parse.rsn_pmkid == NULL) { 998 wpa_printf(MSG_DEBUG, "FT: No PMKID in RSNIE"); 999 return WLAN_STATUS_INVALID_PMKID; 1000 } 1001 1002 if (os_memcmp(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN) != 0) 1003 { 1004 wpa_printf(MSG_DEBUG, "FT: PMKID in Reassoc Req did not match " 1005 "with the PMKR1Name derived from auth request"); 1006 return WLAN_STATUS_INVALID_PMKID; 1007 } 1008 1009 mdie = (struct rsn_mdie *) parse.mdie; 1010 if (mdie == NULL || parse.mdie_len < sizeof(*mdie) || 1011 os_memcmp(mdie->mobility_domain, 1012 sm->wpa_auth->conf.mobility_domain, 1013 MOBILITY_DOMAIN_ID_LEN) != 0) { 1014 wpa_printf(MSG_DEBUG, "FT: Invalid MDIE"); 1015 return WLAN_STATUS_INVALID_MDIE; 1016 } 1017 1018 ftie = (struct rsn_ftie *) parse.ftie; 1019 if (ftie == NULL || parse.ftie_len < sizeof(*ftie)) { 1020 wpa_printf(MSG_DEBUG, "FT: Invalid FTIE"); 1021 return WLAN_STATUS_INVALID_FTIE; 1022 } 1023 1024 if (os_memcmp(ftie->snonce, sm->SNonce, WPA_NONCE_LEN) != 0) { 1025 wpa_printf(MSG_DEBUG, "FT: SNonce mismatch in FTIE"); 1026 wpa_hexdump(MSG_DEBUG, "FT: Received SNonce", 1027 ftie->snonce, WPA_NONCE_LEN); 1028 wpa_hexdump(MSG_DEBUG, "FT: Expected SNonce", 1029 sm->SNonce, WPA_NONCE_LEN); 1030 return -1; 1031 } 1032 1033 if (os_memcmp(ftie->anonce, sm->ANonce, WPA_NONCE_LEN) != 0) { 1034 wpa_printf(MSG_DEBUG, "FT: ANonce mismatch in FTIE"); 1035 wpa_hexdump(MSG_DEBUG, "FT: Received ANonce", 1036 ftie->anonce, WPA_NONCE_LEN); 1037 wpa_hexdump(MSG_DEBUG, "FT: Expected ANonce", 1038 sm->ANonce, WPA_NONCE_LEN); 1039 return -1; 1040 } 1041 1042 1043 if (parse.r0kh_id == NULL) { 1044 wpa_printf(MSG_DEBUG, "FT: No R0KH-ID subelem in FTIE"); 1045 return -1; 1046 } 1047 1048 if (parse.r0kh_id_len != sm->r0kh_id_len || 1049 os_memcmp(parse.r0kh_id, sm->r0kh_id, parse.r0kh_id_len) != 0) { 1050 wpa_printf(MSG_DEBUG, "FT: R0KH-ID in FTIE did not match with " 1051 "the current R0KH-ID"); 1052 wpa_hexdump(MSG_DEBUG, "FT: R0KH-ID in FTIE", 1053 parse.r0kh_id, parse.r0kh_id_len); 1054 wpa_hexdump(MSG_DEBUG, "FT: The current R0KH-ID", 1055 sm->r0kh_id, sm->r0kh_id_len); 1056 return -1; 1057 } 1058 1059 if (parse.r1kh_id == NULL) { 1060 wpa_printf(MSG_DEBUG, "FT: No R1KH-ID subelem in FTIE"); 1061 return -1; 1062 } 1063 1064 if (os_memcmp(parse.r1kh_id, sm->wpa_auth->conf.r1_key_holder, 1065 FT_R1KH_ID_LEN) != 0) { 1066 wpa_printf(MSG_DEBUG, "FT: Unknown R1KH-ID used in " 1067 "ReassocReq"); 1068 wpa_hexdump(MSG_DEBUG, "FT: R1KH-ID in FTIE", 1069 parse.r1kh_id, FT_R1KH_ID_LEN); 1070 wpa_hexdump(MSG_DEBUG, "FT: Expected R1KH-ID", 1071 sm->wpa_auth->conf.r1_key_holder, FT_R1KH_ID_LEN); 1072 return -1; 1073 } 1074 1075 if (parse.rsn_pmkid == NULL || 1076 os_memcmp(parse.rsn_pmkid, sm->pmk_r1_name, WPA_PMK_NAME_LEN)) { 1077 wpa_printf(MSG_DEBUG, "FT: No matching PMKR1Name (PMKID) in " 1078 "RSNIE (pmkid=%d)", !!parse.rsn_pmkid); 1079 return -1; 1080 } 1081 1082 count = 3; 1083 if (parse.ric) 1084 count += ieee802_11_ie_count(parse.ric, parse.ric_len); 1085 if (ftie->mic_control[1] != count) { 1086 wpa_printf(MSG_DEBUG, "FT: Unexpected IE count in MIC " 1087 "Control: received %u expected %u", 1088 ftie->mic_control[1], count); 1089 return -1; 1090 } 1091 1092 if (wpa_ft_mic(sm->PTK.kck, sm->addr, sm->wpa_auth->addr, 5, 1093 parse.mdie - 2, parse.mdie_len + 2, 1094 parse.ftie - 2, parse.ftie_len + 2, 1095 parse.rsn - 2, parse.rsn_len + 2, 1096 parse.ric, parse.ric_len, 1097 mic) < 0) { 1098 wpa_printf(MSG_DEBUG, "FT: Failed to calculate MIC"); 1099 return WLAN_STATUS_UNSPECIFIED_FAILURE; 1100 } 1101 1102 if (os_memcmp(mic, ftie->mic, 16) != 0) { 1103 wpa_printf(MSG_DEBUG, "FT: Invalid MIC in FTIE"); 1104 wpa_printf(MSG_DEBUG, "FT: addr=" MACSTR " auth_addr=" MACSTR, 1105 MAC2STR(sm->addr), MAC2STR(sm->wpa_auth->addr)); 1106 wpa_hexdump(MSG_MSGDUMP, "FT: Received MIC", ftie->mic, 16); 1107 wpa_hexdump(MSG_MSGDUMP, "FT: Calculated MIC", mic, 16); 1108 wpa_hexdump(MSG_MSGDUMP, "FT: MDIE", 1109 parse.mdie - 2, parse.mdie_len + 2); 1110 wpa_hexdump(MSG_MSGDUMP, "FT: FTIE", 1111 parse.ftie - 2, parse.ftie_len + 2); 1112 wpa_hexdump(MSG_MSGDUMP, "FT: RSN", 1113 parse.rsn - 2, parse.rsn_len + 2); 1114 return WLAN_STATUS_INVALID_FTIE; 1115 } 1116 1117 return WLAN_STATUS_SUCCESS; 1118} 1119 1120 1121int wpa_ft_action_rx(struct wpa_state_machine *sm, const u8 *data, size_t len) 1122{ 1123 const u8 *sta_addr, *target_ap; 1124 const u8 *ies; 1125 size_t ies_len; 1126 u8 action; 1127 struct ft_rrb_frame *frame; 1128 1129 if (sm == NULL) 1130 return -1; 1131 1132 /* 1133 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6] 1134 * FT Request action frame body[variable] 1135 */ 1136 1137 if (len < 14) { 1138 wpa_printf(MSG_DEBUG, "FT: Too short FT Action frame " 1139 "(len=%lu)", (unsigned long) len); 1140 return -1; 1141 } 1142 1143 action = data[1]; 1144 sta_addr = data + 2; 1145 target_ap = data + 8; 1146 ies = data + 14; 1147 ies_len = len - 14; 1148 1149 wpa_printf(MSG_DEBUG, "FT: Received FT Action frame (STA=" MACSTR 1150 " Target AP=" MACSTR " Action=%d)", 1151 MAC2STR(sta_addr), MAC2STR(target_ap), action); 1152 1153 if (os_memcmp(sta_addr, sm->addr, ETH_ALEN) != 0) { 1154 wpa_printf(MSG_DEBUG, "FT: Mismatch in FT Action STA address: " 1155 "STA=" MACSTR " STA-Address=" MACSTR, 1156 MAC2STR(sm->addr), MAC2STR(sta_addr)); 1157 return -1; 1158 } 1159 1160 /* 1161 * Do some sanity checking on the target AP address (not own and not 1162 * broadcast. This could be extended to filter based on a list of known 1163 * APs in the MD (if such a list were configured). 1164 */ 1165 if ((target_ap[0] & 0x01) || 1166 os_memcmp(target_ap, sm->wpa_auth->addr, ETH_ALEN) == 0) { 1167 wpa_printf(MSG_DEBUG, "FT: Invalid Target AP in FT Action " 1168 "frame"); 1169 return -1; 1170 } 1171 1172 wpa_hexdump(MSG_MSGDUMP, "FT: Action frame body", ies, ies_len); 1173 1174 /* RRB - Forward action frame to the target AP */ 1175 frame = os_malloc(sizeof(*frame) + len); 1176 frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB; 1177 frame->packet_type = FT_PACKET_REQUEST; 1178 frame->action_length = host_to_le16(len); 1179 os_memcpy(frame->ap_address, sm->wpa_auth->addr, ETH_ALEN); 1180 os_memcpy(frame + 1, data, len); 1181 1182 wpa_ft_rrb_send(sm->wpa_auth, target_ap, (u8 *) frame, 1183 sizeof(*frame) + len); 1184 os_free(frame); 1185 1186 return 0; 1187} 1188 1189 1190static int wpa_ft_rrb_rx_request(struct wpa_authenticator *wpa_auth, 1191 const u8 *current_ap, const u8 *sta_addr, 1192 const u8 *body, size_t len) 1193{ 1194 struct wpa_state_machine *sm; 1195 u16 status; 1196 u8 *resp_ies, *pos; 1197 size_t resp_ies_len, rlen; 1198 struct ft_rrb_frame *frame; 1199 1200 sm = wpa_ft_add_sta(wpa_auth, sta_addr); 1201 if (sm == NULL) { 1202 wpa_printf(MSG_DEBUG, "FT: Failed to add new STA based on " 1203 "RRB Request"); 1204 return -1; 1205 } 1206 1207 wpa_hexdump(MSG_MSGDUMP, "FT: RRB Request Frame body", body, len); 1208 1209 status = wpa_ft_process_auth_req(sm, body, len, &resp_ies, 1210 &resp_ies_len); 1211 1212 wpa_printf(MSG_DEBUG, "FT: RRB authentication response: STA=" MACSTR 1213 " CurrentAP=" MACSTR " status=%d", 1214 MAC2STR(sm->addr), MAC2STR(current_ap), status); 1215 wpa_hexdump(MSG_DEBUG, "FT: Response IEs", resp_ies, resp_ies_len); 1216 1217 /* RRB - Forward action frame response to the Current AP */ 1218 1219 /* 1220 * data: Category[1] Action[1] STA_Address[6] Target_AP_Address[6] 1221 * Status_Code[2] FT Request action frame body[variable] 1222 */ 1223 rlen = 2 + 2 * ETH_ALEN + 2 + resp_ies_len; 1224 1225 frame = os_malloc(sizeof(*frame) + rlen); 1226 frame->frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB; 1227 frame->packet_type = FT_PACKET_RESPONSE; 1228 frame->action_length = host_to_le16(rlen); 1229 os_memcpy(frame->ap_address, wpa_auth->addr, ETH_ALEN); 1230 pos = (u8 *) (frame + 1); 1231 *pos++ = WLAN_ACTION_FT; 1232 *pos++ = 2; /* Action: Response */ 1233 os_memcpy(pos, sta_addr, ETH_ALEN); 1234 pos += ETH_ALEN; 1235 os_memcpy(pos, wpa_auth->addr, ETH_ALEN); 1236 pos += ETH_ALEN; 1237 WPA_PUT_LE16(pos, status); 1238 pos += 2; 1239 if (resp_ies) { 1240 os_memcpy(pos, resp_ies, resp_ies_len); 1241 os_free(resp_ies); 1242 } 1243 1244 wpa_ft_rrb_send(wpa_auth, current_ap, (u8 *) frame, 1245 sizeof(*frame) + rlen); 1246 os_free(frame); 1247 1248 return 0; 1249} 1250 1251 1252static int wpa_ft_rrb_rx_pull(struct wpa_authenticator *wpa_auth, 1253 const u8 *src_addr, 1254 const u8 *data, size_t data_len) 1255{ 1256 struct ft_r0kh_r1kh_pull_frame *frame, f; 1257 struct ft_remote_r1kh *r1kh; 1258 struct ft_r0kh_r1kh_resp_frame resp, r; 1259 u8 pmk_r0[PMK_LEN]; 1260 int pairwise; 1261 1262 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull"); 1263 1264 if (data_len < sizeof(*frame)) 1265 return -1; 1266 1267 r1kh = wpa_auth->conf.r1kh_list; 1268 while (r1kh) { 1269 if (os_memcmp(r1kh->addr, src_addr, ETH_ALEN) == 0) 1270 break; 1271 r1kh = r1kh->next; 1272 } 1273 if (r1kh == NULL) { 1274 wpa_printf(MSG_DEBUG, "FT: No matching R1KH address found for " 1275 "PMK-R1 pull source address " MACSTR, 1276 MAC2STR(src_addr)); 1277 return -1; 1278 } 1279 1280 frame = (struct ft_r0kh_r1kh_pull_frame *) data; 1281 /* aes_unwrap() does not support inplace decryption, so use a temporary 1282 * buffer for the data. */ 1283 if (aes_unwrap(r1kh->key, (FT_R0KH_R1KH_PULL_DATA_LEN + 7) / 8, 1284 frame->nonce, f.nonce) < 0) { 1285 wpa_printf(MSG_DEBUG, "FT: Failed to decrypt PMK-R1 pull " 1286 "request from " MACSTR, MAC2STR(src_addr)); 1287 return -1; 1288 } 1289 1290 wpa_hexdump(MSG_DEBUG, "FT: PMK-R1 pull - nonce", 1291 f.nonce, sizeof(f.nonce)); 1292 wpa_hexdump(MSG_DEBUG, "FT: PMK-R1 pull - PMKR0Name", 1293 f.pmk_r0_name, WPA_PMK_NAME_LEN); 1294 wpa_printf(MSG_DEBUG, "FT: PMK-R1 pull - R1KH-ID=" MACSTR "S1KH-ID=" 1295 MACSTR, MAC2STR(f.r1kh_id), MAC2STR(f.s1kh_id)); 1296 1297 os_memset(&resp, 0, sizeof(resp)); 1298 resp.frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB; 1299 resp.packet_type = FT_PACKET_R0KH_R1KH_RESP; 1300 resp.data_length = host_to_le16(FT_R0KH_R1KH_RESP_DATA_LEN); 1301 os_memcpy(resp.ap_address, wpa_auth->addr, ETH_ALEN); 1302 1303 /* aes_wrap() does not support inplace encryption, so use a temporary 1304 * buffer for the data. */ 1305 os_memcpy(r.nonce, f.nonce, sizeof(f.nonce)); 1306 os_memcpy(r.r1kh_id, f.r1kh_id, FT_R1KH_ID_LEN); 1307 os_memcpy(r.s1kh_id, f.s1kh_id, ETH_ALEN); 1308 if (wpa_ft_fetch_pmk_r0(wpa_auth, f.s1kh_id, f.pmk_r0_name, pmk_r0, 1309 &pairwise) < 0) { 1310 wpa_printf(MSG_DEBUG, "FT: No matching PMKR0Name found for " 1311 "PMK-R1 pull"); 1312 return -1; 1313 } 1314 1315 wpa_derive_pmk_r1(pmk_r0, f.pmk_r0_name, f.r1kh_id, f.s1kh_id, 1316 r.pmk_r1, r.pmk_r1_name); 1317 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", r.pmk_r1, PMK_LEN); 1318 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", r.pmk_r1_name, 1319 WPA_PMK_NAME_LEN); 1320 r.pairwise = host_to_le16(pairwise); 1321 1322 if (aes_wrap(r1kh->key, (FT_R0KH_R1KH_RESP_DATA_LEN + 7) / 8, 1323 r.nonce, resp.nonce) < 0) { 1324 os_memset(pmk_r0, 0, PMK_LEN); 1325 return -1; 1326 } 1327 1328 os_memset(pmk_r0, 0, PMK_LEN); 1329 1330 wpa_ft_rrb_send(wpa_auth, src_addr, (u8 *) &resp, sizeof(resp)); 1331 1332 return 0; 1333} 1334 1335 1336static int wpa_ft_rrb_rx_resp(struct wpa_authenticator *wpa_auth, 1337 const u8 *src_addr, 1338 const u8 *data, size_t data_len) 1339{ 1340 struct ft_r0kh_r1kh_resp_frame *frame, f; 1341 struct ft_remote_r0kh *r0kh; 1342 int pairwise; 1343 1344 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 pull response"); 1345 1346 if (data_len < sizeof(*frame)) 1347 return -1; 1348 1349 r0kh = wpa_auth->conf.r0kh_list; 1350 while (r0kh) { 1351 if (os_memcmp(r0kh->addr, src_addr, ETH_ALEN) == 0) 1352 break; 1353 r0kh = r0kh->next; 1354 } 1355 if (r0kh == NULL) { 1356 wpa_printf(MSG_DEBUG, "FT: No matching R0KH address found for " 1357 "PMK-R0 pull response source address " MACSTR, 1358 MAC2STR(src_addr)); 1359 return -1; 1360 } 1361 1362 frame = (struct ft_r0kh_r1kh_resp_frame *) data; 1363 /* aes_unwrap() does not support inplace decryption, so use a temporary 1364 * buffer for the data. */ 1365 if (aes_unwrap(r0kh->key, (FT_R0KH_R1KH_RESP_DATA_LEN + 7) / 8, 1366 frame->nonce, f.nonce) < 0) { 1367 wpa_printf(MSG_DEBUG, "FT: Failed to decrypt PMK-R1 pull " 1368 "response from " MACSTR, MAC2STR(src_addr)); 1369 return -1; 1370 } 1371 1372 if (os_memcmp(f.r1kh_id, wpa_auth->conf.r1_key_holder, FT_R1KH_ID_LEN) 1373 != 0) { 1374 wpa_printf(MSG_DEBUG, "FT: PMK-R1 pull response did not use a " 1375 "matching R1KH-ID"); 1376 return -1; 1377 } 1378 1379 /* TODO: verify that <nonce,s1kh_id> matches with a pending request 1380 * and call this requests callback function to finish request 1381 * processing */ 1382 1383 pairwise = le_to_host16(f.pairwise); 1384 wpa_hexdump(MSG_DEBUG, "FT: PMK-R1 pull - nonce", 1385 f.nonce, sizeof(f.nonce)); 1386 wpa_printf(MSG_DEBUG, "FT: PMK-R1 pull - R1KH-ID=" MACSTR "S1KH-ID=" 1387 MACSTR " pairwise=0x%x", 1388 MAC2STR(f.r1kh_id), MAC2STR(f.s1kh_id), pairwise); 1389 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1 pull - PMK-R1", 1390 f.pmk_r1, PMK_LEN); 1391 wpa_hexdump(MSG_DEBUG, "FT: PMK-R1 pull - PMKR1Name", 1392 f.pmk_r1_name, WPA_PMK_NAME_LEN); 1393 1394 wpa_ft_store_pmk_r1(wpa_auth, f.s1kh_id, f.pmk_r1, f.pmk_r1_name, 1395 pairwise); 1396 os_memset(f.pmk_r1, 0, PMK_LEN); 1397 1398 return 0; 1399} 1400 1401 1402static int wpa_ft_rrb_rx_push(struct wpa_authenticator *wpa_auth, 1403 const u8 *src_addr, 1404 const u8 *data, size_t data_len) 1405{ 1406 struct ft_r0kh_r1kh_push_frame *frame, f; 1407 struct ft_remote_r0kh *r0kh; 1408 struct os_time now; 1409 os_time_t tsend; 1410 int pairwise; 1411 1412 wpa_printf(MSG_DEBUG, "FT: Received PMK-R1 push"); 1413 1414 if (data_len < sizeof(*frame)) 1415 return -1; 1416 1417 r0kh = wpa_auth->conf.r0kh_list; 1418 while (r0kh) { 1419 if (os_memcmp(r0kh->addr, src_addr, ETH_ALEN) == 0) 1420 break; 1421 r0kh = r0kh->next; 1422 } 1423 if (r0kh == NULL) { 1424 wpa_printf(MSG_DEBUG, "FT: No matching R0KH address found for " 1425 "PMK-R0 push source address " MACSTR, 1426 MAC2STR(src_addr)); 1427 return -1; 1428 } 1429 1430 frame = (struct ft_r0kh_r1kh_push_frame *) data; 1431 /* aes_unwrap() does not support inplace decryption, so use a temporary 1432 * buffer for the data. */ 1433 if (aes_unwrap(r0kh->key, (FT_R0KH_R1KH_PUSH_DATA_LEN + 7) / 8, 1434 frame->timestamp, f.timestamp) < 0) { 1435 wpa_printf(MSG_DEBUG, "FT: Failed to decrypt PMK-R1 push from " 1436 MACSTR, MAC2STR(src_addr)); 1437 return -1; 1438 } 1439 1440 os_get_time(&now); 1441 tsend = WPA_GET_LE32(f.timestamp); 1442 if ((now.sec > tsend && now.sec - tsend > 60) || 1443 (now.sec < tsend && tsend - now.sec > 60)) { 1444 wpa_printf(MSG_DEBUG, "FT: PMK-R1 push did not have a valid " 1445 "timestamp: sender time %d own time %d\n", 1446 (int) tsend, (int) now.sec); 1447 return -1; 1448 } 1449 1450 if (os_memcmp(f.r1kh_id, wpa_auth->conf.r1_key_holder, FT_R1KH_ID_LEN) 1451 != 0) { 1452 wpa_printf(MSG_DEBUG, "FT: PMK-R1 push did not use a matching " 1453 "R1KH-ID (received " MACSTR " own " MACSTR ")", 1454 MAC2STR(f.r1kh_id), 1455 MAC2STR(wpa_auth->conf.r1_key_holder)); 1456 return -1; 1457 } 1458 1459 pairwise = le_to_host16(f.pairwise); 1460 wpa_printf(MSG_DEBUG, "FT: PMK-R1 push - R1KH-ID=" MACSTR " S1KH-ID=" 1461 MACSTR " pairwise=0x%x", 1462 MAC2STR(f.r1kh_id), MAC2STR(f.s1kh_id), pairwise); 1463 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1 push - PMK-R1", 1464 f.pmk_r1, PMK_LEN); 1465 wpa_hexdump(MSG_DEBUG, "FT: PMK-R1 push - PMKR1Name", 1466 f.pmk_r1_name, WPA_PMK_NAME_LEN); 1467 1468 wpa_ft_store_pmk_r1(wpa_auth, f.s1kh_id, f.pmk_r1, f.pmk_r1_name, 1469 pairwise); 1470 os_memset(f.pmk_r1, 0, PMK_LEN); 1471 1472 return 0; 1473} 1474 1475 1476int wpa_ft_rrb_rx(struct wpa_authenticator *wpa_auth, const u8 *src_addr, 1477 const u8 *data, size_t data_len) 1478{ 1479 struct ft_rrb_frame *frame; 1480 u16 alen; 1481 const u8 *pos, *end, *start; 1482 u8 action; 1483 const u8 *sta_addr, *target_ap_addr; 1484 1485 wpa_printf(MSG_DEBUG, "FT: RRB received frame from remote AP " MACSTR, 1486 MAC2STR(src_addr)); 1487 1488 if (data_len < sizeof(*frame)) { 1489 wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (data_len=%lu)", 1490 (unsigned long) data_len); 1491 return -1; 1492 } 1493 1494 pos = data; 1495 frame = (struct ft_rrb_frame *) pos; 1496 pos += sizeof(*frame); 1497 1498 alen = le_to_host16(frame->action_length); 1499 wpa_printf(MSG_DEBUG, "FT: RRB frame - frame_type=%d packet_type=%d " 1500 "action_length=%d ap_address=" MACSTR, 1501 frame->frame_type, frame->packet_type, alen, 1502 MAC2STR(frame->ap_address)); 1503 1504 if (frame->frame_type != RSN_REMOTE_FRAME_TYPE_FT_RRB) { 1505 /* Discard frame per IEEE Std 802.11r-2008, 11A.10.3 */ 1506 wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with " 1507 "unrecognized type %d", frame->frame_type); 1508 return -1; 1509 } 1510 1511 if (alen > data_len - sizeof(*frame)) { 1512 wpa_printf(MSG_DEBUG, "FT: RRB frame too short for action " 1513 "frame"); 1514 return -1; 1515 } 1516 1517 if (frame->packet_type == FT_PACKET_R0KH_R1KH_PULL) 1518 return wpa_ft_rrb_rx_pull(wpa_auth, src_addr, data, data_len); 1519 if (frame->packet_type == FT_PACKET_R0KH_R1KH_RESP) 1520 return wpa_ft_rrb_rx_resp(wpa_auth, src_addr, data, data_len); 1521 if (frame->packet_type == FT_PACKET_R0KH_R1KH_PUSH) 1522 return wpa_ft_rrb_rx_push(wpa_auth, src_addr, data, data_len); 1523 1524 wpa_hexdump(MSG_MSGDUMP, "FT: RRB - FT Action frame", pos, alen); 1525 1526 if (alen < 1 + 1 + 2 * ETH_ALEN) { 1527 wpa_printf(MSG_DEBUG, "FT: Too short RRB frame (not enough " 1528 "room for Action Frame body); alen=%lu", 1529 (unsigned long) alen); 1530 return -1; 1531 } 1532 start = pos; 1533 end = pos + alen; 1534 1535 if (*pos != WLAN_ACTION_FT) { 1536 wpa_printf(MSG_DEBUG, "FT: Unexpected Action frame category " 1537 "%d", *pos); 1538 return -1; 1539 } 1540 1541 pos++; 1542 action = *pos++; 1543 sta_addr = pos; 1544 pos += ETH_ALEN; 1545 target_ap_addr = pos; 1546 pos += ETH_ALEN; 1547 wpa_printf(MSG_DEBUG, "FT: RRB Action Frame: action=%d sta_addr=" 1548 MACSTR " target_ap_addr=" MACSTR, 1549 action, MAC2STR(sta_addr), MAC2STR(target_ap_addr)); 1550 1551 if (frame->packet_type == FT_PACKET_REQUEST) { 1552 wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Request"); 1553 1554 if (action != 1) { 1555 wpa_printf(MSG_DEBUG, "FT: Unexpected Action %d in " 1556 "RRB Request", action); 1557 return -1; 1558 } 1559 1560 if (os_memcmp(target_ap_addr, wpa_auth->addr, ETH_ALEN) != 0) { 1561 wpa_printf(MSG_DEBUG, "FT: Target AP address in the " 1562 "RRB Request does not match with own " 1563 "address"); 1564 return -1; 1565 } 1566 1567 if (wpa_ft_rrb_rx_request(wpa_auth, frame->ap_address, 1568 sta_addr, pos, end - pos) < 0) 1569 return -1; 1570 } else if (frame->packet_type == FT_PACKET_RESPONSE) { 1571 u16 status_code; 1572 1573 if (end - pos < 2) { 1574 wpa_printf(MSG_DEBUG, "FT: Not enough room for status " 1575 "code in RRB Response"); 1576 return -1; 1577 } 1578 status_code = WPA_GET_LE16(pos); 1579 pos += 2; 1580 1581 wpa_printf(MSG_DEBUG, "FT: FT Packet Type - Response " 1582 "(status_code=%d)", status_code); 1583 1584 if (wpa_ft_action_send(wpa_auth, sta_addr, start, alen) < 0) 1585 return -1; 1586 } else { 1587 wpa_printf(MSG_DEBUG, "FT: RRB discarded frame with unknown " 1588 "packet_type %d", frame->packet_type); 1589 return -1; 1590 } 1591 1592 return 0; 1593} 1594 1595 1596static void wpa_ft_generate_pmk_r1(struct wpa_authenticator *wpa_auth, 1597 struct wpa_ft_pmk_r0_sa *pmk_r0, 1598 struct ft_remote_r1kh *r1kh, 1599 const u8 *s1kh_id, int pairwise) 1600{ 1601 struct ft_r0kh_r1kh_push_frame frame, f; 1602 struct os_time now; 1603 1604 os_memset(&frame, 0, sizeof(frame)); 1605 frame.frame_type = RSN_REMOTE_FRAME_TYPE_FT_RRB; 1606 frame.packet_type = FT_PACKET_R0KH_R1KH_PUSH; 1607 frame.data_length = host_to_le16(FT_R0KH_R1KH_PUSH_DATA_LEN); 1608 os_memcpy(frame.ap_address, wpa_auth->addr, ETH_ALEN); 1609 1610 /* aes_wrap() does not support inplace encryption, so use a temporary 1611 * buffer for the data. */ 1612 os_memcpy(f.r1kh_id, r1kh->id, FT_R1KH_ID_LEN); 1613 os_memcpy(f.s1kh_id, s1kh_id, ETH_ALEN); 1614 os_memcpy(f.pmk_r0_name, pmk_r0->pmk_r0_name, WPA_PMK_NAME_LEN); 1615 wpa_derive_pmk_r1(pmk_r0->pmk_r0, pmk_r0->pmk_r0_name, r1kh->id, 1616 s1kh_id, f.pmk_r1, f.pmk_r1_name); 1617 wpa_printf(MSG_DEBUG, "FT: R1KH-ID " MACSTR, MAC2STR(r1kh->id)); 1618 wpa_hexdump_key(MSG_DEBUG, "FT: PMK-R1", f.pmk_r1, PMK_LEN); 1619 wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name", f.pmk_r1_name, 1620 WPA_PMK_NAME_LEN); 1621 os_get_time(&now); 1622 WPA_PUT_LE32(f.timestamp, now.sec); 1623 f.pairwise = host_to_le16(pairwise); 1624 if (aes_wrap(r1kh->key, (FT_R0KH_R1KH_PUSH_DATA_LEN + 7) / 8, 1625 f.timestamp, frame.timestamp) < 0) 1626 return; 1627 1628 wpa_ft_rrb_send(wpa_auth, r1kh->addr, (u8 *) &frame, sizeof(frame)); 1629} 1630 1631 1632void wpa_ft_push_pmk_r1(struct wpa_authenticator *wpa_auth, const u8 *addr) 1633{ 1634 struct wpa_ft_pmk_r0_sa *r0; 1635 struct ft_remote_r1kh *r1kh; 1636 1637 if (!wpa_auth->conf.pmk_r1_push) 1638 return; 1639 1640 r0 = wpa_auth->ft_pmk_cache->pmk_r0; 1641 while (r0) { 1642 if (os_memcmp(r0->spa, addr, ETH_ALEN) == 0) 1643 break; 1644 r0 = r0->next; 1645 } 1646 1647 if (r0 == NULL || r0->pmk_r1_pushed) 1648 return; 1649 r0->pmk_r1_pushed = 1; 1650 1651 wpa_printf(MSG_DEBUG, "FT: Deriving and pushing PMK-R1 keys to R1KHs " 1652 "for STA " MACSTR, MAC2STR(addr)); 1653 1654 r1kh = wpa_auth->conf.r1kh_list; 1655 while (r1kh) { 1656 wpa_ft_generate_pmk_r1(wpa_auth, r0, r1kh, addr, r0->pairwise); 1657 r1kh = r1kh->next; 1658 } 1659} 1660 1661#endif /* CONFIG_IEEE80211R */ 1662