www.project-moonshot.org Git - mech_eap.orig/blob - libeap/src/rsn_supp/wpa_ft.c

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