Home | History | Annotate | Download | only in ap
      1 /*
      2  * IEEE 802.11 RSN / WPA Authenticator
      3  * Copyright (c) 2004-2015, Jouni Malinen <j (at) w1.fi>
      4  *
      5  * This software may be distributed under the terms of the BSD license.
      6  * See README for more details.
      7  */
      8 
      9 #include "utils/includes.h"
     10 
     11 #include "utils/common.h"
     12 #include "utils/eloop.h"
     13 #include "utils/state_machine.h"
     14 #include "utils/bitfield.h"
     15 #include "common/ieee802_11_defs.h"
     16 #include "crypto/aes_wrap.h"
     17 #include "crypto/crypto.h"
     18 #include "crypto/sha1.h"
     19 #include "crypto/sha256.h"
     20 #include "crypto/random.h"
     21 #include "eapol_auth/eapol_auth_sm.h"
     22 #include "ap_config.h"
     23 #include "ieee802_11.h"
     24 #include "wpa_auth.h"
     25 #include "pmksa_cache_auth.h"
     26 #include "wpa_auth_i.h"
     27 #include "wpa_auth_ie.h"
     28 
     29 #define STATE_MACHINE_DATA struct wpa_state_machine
     30 #define STATE_MACHINE_DEBUG_PREFIX "WPA"
     31 #define STATE_MACHINE_ADDR sm->addr
     32 
     33 
     34 static void wpa_send_eapol_timeout(void *eloop_ctx, void *timeout_ctx);
     35 static int wpa_sm_step(struct wpa_state_machine *sm);
     36 static int wpa_verify_key_mic(int akmp, struct wpa_ptk *PTK, u8 *data,
     37 			      size_t data_len);
     38 static void wpa_sm_call_step(void *eloop_ctx, void *timeout_ctx);
     39 static void wpa_group_sm_step(struct wpa_authenticator *wpa_auth,
     40 			      struct wpa_group *group);
     41 static void wpa_request_new_ptk(struct wpa_state_machine *sm);
     42 static int wpa_gtk_update(struct wpa_authenticator *wpa_auth,
     43 			  struct wpa_group *group);
     44 static int wpa_group_config_group_keys(struct wpa_authenticator *wpa_auth,
     45 				       struct wpa_group *group);
     46 static int wpa_derive_ptk(struct wpa_state_machine *sm, const u8 *snonce,
     47 			  const u8 *pmk, struct wpa_ptk *ptk);
     48 static void wpa_group_free(struct wpa_authenticator *wpa_auth,
     49 			   struct wpa_group *group);
     50 static void wpa_group_get(struct wpa_authenticator *wpa_auth,
     51 			  struct wpa_group *group);
     52 static void wpa_group_put(struct wpa_authenticator *wpa_auth,
     53 			  struct wpa_group *group);
     54 
     55 static const u32 dot11RSNAConfigGroupUpdateCount = 4;
     56 static const u32 dot11RSNAConfigPairwiseUpdateCount = 4;
     57 static const u32 eapol_key_timeout_first = 100; /* ms */
     58 static const u32 eapol_key_timeout_subseq = 1000; /* ms */
     59 static const u32 eapol_key_timeout_first_group = 500; /* ms */
     60 
     61 /* TODO: make these configurable */
     62 static const int dot11RSNAConfigPMKLifetime = 43200;
     63 static const int dot11RSNAConfigPMKReauthThreshold = 70;
     64 static const int dot11RSNAConfigSATimeout = 60;
     65 
     66 
     67 static inline int wpa_auth_mic_failure_report(
     68 	struct wpa_authenticator *wpa_auth, const u8 *addr)
     69 {
     70 	if (wpa_auth->cb.mic_failure_report)
     71 		return wpa_auth->cb.mic_failure_report(wpa_auth->cb.ctx, addr);
     72 	return 0;
     73 }
     74 
     75 
     76 static inline void wpa_auth_psk_failure_report(
     77 	struct wpa_authenticator *wpa_auth, const u8 *addr)
     78 {
     79 	if (wpa_auth->cb.psk_failure_report)
     80 		wpa_auth->cb.psk_failure_report(wpa_auth->cb.ctx, addr);
     81 }
     82 
     83 
     84 static inline void wpa_auth_set_eapol(struct wpa_authenticator *wpa_auth,
     85 				      const u8 *addr, wpa_eapol_variable var,
     86 				      int value)
     87 {
     88 	if (wpa_auth->cb.set_eapol)
     89 		wpa_auth->cb.set_eapol(wpa_auth->cb.ctx, addr, var, value);
     90 }
     91 
     92 
     93 static inline int wpa_auth_get_eapol(struct wpa_authenticator *wpa_auth,
     94 				     const u8 *addr, wpa_eapol_variable var)
     95 {
     96 	if (wpa_auth->cb.get_eapol == NULL)
     97 		return -1;
     98 	return wpa_auth->cb.get_eapol(wpa_auth->cb.ctx, addr, var);
     99 }
    100 
    101 
    102 static inline const u8 * wpa_auth_get_psk(struct wpa_authenticator *wpa_auth,
    103 					  const u8 *addr,
    104 					  const u8 *p2p_dev_addr,
    105 					  const u8 *prev_psk)
    106 {
    107 	if (wpa_auth->cb.get_psk == NULL)
    108 		return NULL;
    109 	return wpa_auth->cb.get_psk(wpa_auth->cb.ctx, addr, p2p_dev_addr,
    110 				    prev_psk);
    111 }
    112 
    113 
    114 static inline int wpa_auth_get_msk(struct wpa_authenticator *wpa_auth,
    115 				   const u8 *addr, u8 *msk, size_t *len)
    116 {
    117 	if (wpa_auth->cb.get_msk == NULL)
    118 		return -1;
    119 	return wpa_auth->cb.get_msk(wpa_auth->cb.ctx, addr, msk, len);
    120 }
    121 
    122 
    123 static inline int wpa_auth_set_key(struct wpa_authenticator *wpa_auth,
    124 				   int vlan_id,
    125 				   enum wpa_alg alg, const u8 *addr, int idx,
    126 				   u8 *key, size_t key_len)
    127 {
    128 	if (wpa_auth->cb.set_key == NULL)
    129 		return -1;
    130 	return wpa_auth->cb.set_key(wpa_auth->cb.ctx, vlan_id, alg, addr, idx,
    131 				    key, key_len);
    132 }
    133 
    134 
    135 static inline int wpa_auth_get_seqnum(struct wpa_authenticator *wpa_auth,
    136 				      const u8 *addr, int idx, u8 *seq)
    137 {
    138 	if (wpa_auth->cb.get_seqnum == NULL)
    139 		return -1;
    140 	return wpa_auth->cb.get_seqnum(wpa_auth->cb.ctx, addr, idx, seq);
    141 }
    142 
    143 
    144 static inline int
    145 wpa_auth_send_eapol(struct wpa_authenticator *wpa_auth, const u8 *addr,
    146 		    const u8 *data, size_t data_len, int encrypt)
    147 {
    148 	if (wpa_auth->cb.send_eapol == NULL)
    149 		return -1;
    150 	return wpa_auth->cb.send_eapol(wpa_auth->cb.ctx, addr, data, data_len,
    151 				       encrypt);
    152 }
    153 
    154 
    155 #ifdef CONFIG_MESH
    156 static inline int wpa_auth_start_ampe(struct wpa_authenticator *wpa_auth,
    157 				      const u8 *addr)
    158 {
    159 	if (wpa_auth->cb.start_ampe == NULL)
    160 		return -1;
    161 	return wpa_auth->cb.start_ampe(wpa_auth->cb.ctx, addr);
    162 }
    163 #endif /* CONFIG_MESH */
    164 
    165 
    166 int wpa_auth_for_each_sta(struct wpa_authenticator *wpa_auth,
    167 			  int (*cb)(struct wpa_state_machine *sm, void *ctx),
    168 			  void *cb_ctx)
    169 {
    170 	if (wpa_auth->cb.for_each_sta == NULL)
    171 		return 0;
    172 	return wpa_auth->cb.for_each_sta(wpa_auth->cb.ctx, cb, cb_ctx);
    173 }
    174 
    175 
    176 int wpa_auth_for_each_auth(struct wpa_authenticator *wpa_auth,
    177 			   int (*cb)(struct wpa_authenticator *a, void *ctx),
    178 			   void *cb_ctx)
    179 {
    180 	if (wpa_auth->cb.for_each_auth == NULL)
    181 		return 0;
    182 	return wpa_auth->cb.for_each_auth(wpa_auth->cb.ctx, cb, cb_ctx);
    183 }
    184 
    185 
    186 void wpa_auth_logger(struct wpa_authenticator *wpa_auth, const u8 *addr,
    187 		     logger_level level, const char *txt)
    188 {
    189 	if (wpa_auth->cb.logger == NULL)
    190 		return;
    191 	wpa_auth->cb.logger(wpa_auth->cb.ctx, addr, level, txt);
    192 }
    193 
    194 
    195 void wpa_auth_vlogger(struct wpa_authenticator *wpa_auth, const u8 *addr,
    196 		      logger_level level, const char *fmt, ...)
    197 {
    198 	char *format;
    199 	int maxlen;
    200 	va_list ap;
    201 
    202 	if (wpa_auth->cb.logger == NULL)
    203 		return;
    204 
    205 	maxlen = os_strlen(fmt) + 100;
    206 	format = os_malloc(maxlen);
    207 	if (!format)
    208 		return;
    209 
    210 	va_start(ap, fmt);
    211 	vsnprintf(format, maxlen, fmt, ap);
    212 	va_end(ap);
    213 
    214 	wpa_auth_logger(wpa_auth, addr, level, format);
    215 
    216 	os_free(format);
    217 }
    218 
    219 
    220 static void wpa_sta_disconnect(struct wpa_authenticator *wpa_auth,
    221 			       const u8 *addr)
    222 {
    223 	if (wpa_auth->cb.disconnect == NULL)
    224 		return;
    225 	wpa_printf(MSG_DEBUG, "wpa_sta_disconnect STA " MACSTR, MAC2STR(addr));
    226 	wpa_auth->cb.disconnect(wpa_auth->cb.ctx, addr,
    227 				WLAN_REASON_PREV_AUTH_NOT_VALID);
    228 }
    229 
    230 
    231 static int wpa_use_aes_cmac(struct wpa_state_machine *sm)
    232 {
    233 	int ret = 0;
    234 #ifdef CONFIG_IEEE80211R
    235 	if (wpa_key_mgmt_ft(sm->wpa_key_mgmt))
    236 		ret = 1;
    237 #endif /* CONFIG_IEEE80211R */
    238 #ifdef CONFIG_IEEE80211W
    239 	if (wpa_key_mgmt_sha256(sm->wpa_key_mgmt))
    240 		ret = 1;
    241 #endif /* CONFIG_IEEE80211W */
    242 	if (sm->wpa_key_mgmt == WPA_KEY_MGMT_OSEN)
    243 		ret = 1;
    244 	return ret;
    245 }
    246 
    247 
    248 static void wpa_rekey_gmk(void *eloop_ctx, void *timeout_ctx)
    249 {
    250 	struct wpa_authenticator *wpa_auth = eloop_ctx;
    251 
    252 	if (random_get_bytes(wpa_auth->group->GMK, WPA_GMK_LEN)) {
    253 		wpa_printf(MSG_ERROR, "Failed to get random data for WPA "
    254 			   "initialization.");
    255 	} else {
    256 		wpa_auth_logger(wpa_auth, NULL, LOGGER_DEBUG, "GMK rekeyd");
    257 		wpa_hexdump_key(MSG_DEBUG, "GMK",
    258 				wpa_auth->group->GMK, WPA_GMK_LEN);
    259 	}
    260 
    261 	if (wpa_auth->conf.wpa_gmk_rekey) {
    262 		eloop_register_timeout(wpa_auth->conf.wpa_gmk_rekey, 0,
    263 				       wpa_rekey_gmk, wpa_auth, NULL);
    264 	}
    265 }
    266 
    267 
    268 static void wpa_rekey_gtk(void *eloop_ctx, void *timeout_ctx)
    269 {
    270 	struct wpa_authenticator *wpa_auth = eloop_ctx;
    271 	struct wpa_group *group, *next;
    272 
    273 	wpa_auth_logger(wpa_auth, NULL, LOGGER_DEBUG, "rekeying GTK");
    274 	group = wpa_auth->group;
    275 	while (group) {
    276 		wpa_group_get(wpa_auth, group);
    277 
    278 		group->GTKReKey = TRUE;
    279 		do {
    280 			group->changed = FALSE;
    281 			wpa_group_sm_step(wpa_auth, group);
    282 		} while (group->changed);
    283 
    284 		next = group->next;
    285 		wpa_group_put(wpa_auth, group);
    286 		group = next;
    287 	}
    288 
    289 	if (wpa_auth->conf.wpa_group_rekey) {
    290 		eloop_register_timeout(wpa_auth->conf.wpa_group_rekey,
    291 				       0, wpa_rekey_gtk, wpa_auth, NULL);
    292 	}
    293 }
    294 
    295 
    296 static void wpa_rekey_ptk(void *eloop_ctx, void *timeout_ctx)
    297 {
    298 	struct wpa_authenticator *wpa_auth = eloop_ctx;
    299 	struct wpa_state_machine *sm = timeout_ctx;
    300 
    301 	wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG, "rekeying PTK");
    302 	wpa_request_new_ptk(sm);
    303 	wpa_sm_step(sm);
    304 }
    305 
    306 
    307 static int wpa_auth_pmksa_clear_cb(struct wpa_state_machine *sm, void *ctx)
    308 {
    309 	if (sm->pmksa == ctx)
    310 		sm->pmksa = NULL;
    311 	return 0;
    312 }
    313 
    314 
    315 static void wpa_auth_pmksa_free_cb(struct rsn_pmksa_cache_entry *entry,
    316 				   void *ctx)
    317 {
    318 	struct wpa_authenticator *wpa_auth = ctx;
    319 	wpa_auth_for_each_sta(wpa_auth, wpa_auth_pmksa_clear_cb, entry);
    320 }
    321 
    322 
    323 static int wpa_group_init_gmk_and_counter(struct wpa_authenticator *wpa_auth,
    324 					  struct wpa_group *group)
    325 {
    326 	u8 buf[ETH_ALEN + 8 + sizeof(unsigned long)];
    327 	u8 rkey[32];
    328 	unsigned long ptr;
    329 
    330 	if (random_get_bytes(group->GMK, WPA_GMK_LEN) < 0)
    331 		return -1;
    332 	wpa_hexdump_key(MSG_DEBUG, "GMK", group->GMK, WPA_GMK_LEN);
    333 
    334 	/*
    335 	 * Counter = PRF-256(Random number, "Init Counter",
    336 	 *                   Local MAC Address || Time)
    337 	 */
    338 	os_memcpy(buf, wpa_auth->addr, ETH_ALEN);
    339 	wpa_get_ntp_timestamp(buf + ETH_ALEN);
    340 	ptr = (unsigned long) group;
    341 	os_memcpy(buf + ETH_ALEN + 8, &ptr, sizeof(ptr));
    342 	if (random_get_bytes(rkey, sizeof(rkey)) < 0)
    343 		return -1;
    344 
    345 	if (sha1_prf(rkey, sizeof(rkey), "Init Counter", buf, sizeof(buf),
    346 		     group->Counter, WPA_NONCE_LEN) < 0)
    347 		return -1;
    348 	wpa_hexdump_key(MSG_DEBUG, "Key Counter",
    349 			group->Counter, WPA_NONCE_LEN);
    350 
    351 	return 0;
    352 }
    353 
    354 
    355 static struct wpa_group * wpa_group_init(struct wpa_authenticator *wpa_auth,
    356 					 int vlan_id, int delay_init)
    357 {
    358 	struct wpa_group *group;
    359 
    360 	group = os_zalloc(sizeof(struct wpa_group));
    361 	if (group == NULL)
    362 		return NULL;
    363 
    364 	group->GTKAuthenticator = TRUE;
    365 	group->vlan_id = vlan_id;
    366 	group->GTK_len = wpa_cipher_key_len(wpa_auth->conf.wpa_group);
    367 
    368 	if (random_pool_ready() != 1) {
    369 		wpa_printf(MSG_INFO, "WPA: Not enough entropy in random pool "
    370 			   "for secure operations - update keys later when "
    371 			   "the first station connects");
    372 	}
    373 
    374 	/*
    375 	 * Set initial GMK/Counter value here. The actual values that will be
    376 	 * used in negotiations will be set once the first station tries to
    377 	 * connect. This allows more time for collecting additional randomness
    378 	 * on embedded devices.
    379 	 */
    380 	if (wpa_group_init_gmk_and_counter(wpa_auth, group) < 0) {
    381 		wpa_printf(MSG_ERROR, "Failed to get random data for WPA "
    382 			   "initialization.");
    383 		os_free(group);
    384 		return NULL;
    385 	}
    386 
    387 	group->GInit = TRUE;
    388 	if (delay_init) {
    389 		wpa_printf(MSG_DEBUG, "WPA: Delay group state machine start "
    390 			   "until Beacon frames have been configured");
    391 		/* Initialization is completed in wpa_init_keys(). */
    392 	} else {
    393 		wpa_group_sm_step(wpa_auth, group);
    394 		group->GInit = FALSE;
    395 		wpa_group_sm_step(wpa_auth, group);
    396 	}
    397 
    398 	return group;
    399 }
    400 
    401 
    402 /**
    403  * wpa_init - Initialize WPA authenticator
    404  * @addr: Authenticator address
    405  * @conf: Configuration for WPA authenticator
    406  * @cb: Callback functions for WPA authenticator
    407  * Returns: Pointer to WPA authenticator data or %NULL on failure
    408  */
    409 struct wpa_authenticator * wpa_init(const u8 *addr,
    410 				    struct wpa_auth_config *conf,
    411 				    struct wpa_auth_callbacks *cb)
    412 {
    413 	struct wpa_authenticator *wpa_auth;
    414 
    415 	wpa_auth = os_zalloc(sizeof(struct wpa_authenticator));
    416 	if (wpa_auth == NULL)
    417 		return NULL;
    418 	os_memcpy(wpa_auth->addr, addr, ETH_ALEN);
    419 	os_memcpy(&wpa_auth->conf, conf, sizeof(*conf));
    420 	os_memcpy(&wpa_auth->cb, cb, sizeof(*cb));
    421 
    422 	if (wpa_auth_gen_wpa_ie(wpa_auth)) {
    423 		wpa_printf(MSG_ERROR, "Could not generate WPA IE.");
    424 		os_free(wpa_auth);
    425 		return NULL;
    426 	}
    427 
    428 	wpa_auth->group = wpa_group_init(wpa_auth, 0, 1);
    429 	if (wpa_auth->group == NULL) {
    430 		os_free(wpa_auth->wpa_ie);
    431 		os_free(wpa_auth);
    432 		return NULL;
    433 	}
    434 
    435 	wpa_auth->pmksa = pmksa_cache_auth_init(wpa_auth_pmksa_free_cb,
    436 						wpa_auth);
    437 	if (wpa_auth->pmksa == NULL) {
    438 		wpa_printf(MSG_ERROR, "PMKSA cache initialization failed.");
    439 		os_free(wpa_auth->group);
    440 		os_free(wpa_auth->wpa_ie);
    441 		os_free(wpa_auth);
    442 		return NULL;
    443 	}
    444 
    445 #ifdef CONFIG_IEEE80211R
    446 	wpa_auth->ft_pmk_cache = wpa_ft_pmk_cache_init();
    447 	if (wpa_auth->ft_pmk_cache == NULL) {
    448 		wpa_printf(MSG_ERROR, "FT PMK cache initialization failed.");
    449 		os_free(wpa_auth->group);
    450 		os_free(wpa_auth->wpa_ie);
    451 		pmksa_cache_auth_deinit(wpa_auth->pmksa);
    452 		os_free(wpa_auth);
    453 		return NULL;
    454 	}
    455 #endif /* CONFIG_IEEE80211R */
    456 
    457 	if (wpa_auth->conf.wpa_gmk_rekey) {
    458 		eloop_register_timeout(wpa_auth->conf.wpa_gmk_rekey, 0,
    459 				       wpa_rekey_gmk, wpa_auth, NULL);
    460 	}
    461 
    462 	if (wpa_auth->conf.wpa_group_rekey) {
    463 		eloop_register_timeout(wpa_auth->conf.wpa_group_rekey, 0,
    464 				       wpa_rekey_gtk, wpa_auth, NULL);
    465 	}
    466 
    467 #ifdef CONFIG_P2P
    468 	if (WPA_GET_BE32(conf->ip_addr_start)) {
    469 		int count = WPA_GET_BE32(conf->ip_addr_end) -
    470 			WPA_GET_BE32(conf->ip_addr_start) + 1;
    471 		if (count > 1000)
    472 			count = 1000;
    473 		if (count > 0)
    474 			wpa_auth->ip_pool = bitfield_alloc(count);
    475 	}
    476 #endif /* CONFIG_P2P */
    477 
    478 	return wpa_auth;
    479 }
    480 
    481 
    482 int wpa_init_keys(struct wpa_authenticator *wpa_auth)
    483 {
    484 	struct wpa_group *group = wpa_auth->group;
    485 
    486 	wpa_printf(MSG_DEBUG, "WPA: Start group state machine to set initial "
    487 		   "keys");
    488 	wpa_group_sm_step(wpa_auth, group);
    489 	group->GInit = FALSE;
    490 	wpa_group_sm_step(wpa_auth, group);
    491 	if (group->wpa_group_state == WPA_GROUP_FATAL_FAILURE)
    492 		return -1;
    493 	return 0;
    494 }
    495 
    496 
    497 /**
    498  * wpa_deinit - Deinitialize WPA authenticator
    499  * @wpa_auth: Pointer to WPA authenticator data from wpa_init()
    500  */
    501 void wpa_deinit(struct wpa_authenticator *wpa_auth)
    502 {
    503 	struct wpa_group *group, *prev;
    504 
    505 	eloop_cancel_timeout(wpa_rekey_gmk, wpa_auth, NULL);
    506 	eloop_cancel_timeout(wpa_rekey_gtk, wpa_auth, NULL);
    507 
    508 #ifdef CONFIG_PEERKEY
    509 	while (wpa_auth->stsl_negotiations)
    510 		wpa_stsl_remove(wpa_auth, wpa_auth->stsl_negotiations);
    511 #endif /* CONFIG_PEERKEY */
    512 
    513 	pmksa_cache_auth_deinit(wpa_auth->pmksa);
    514 
    515 #ifdef CONFIG_IEEE80211R
    516 	wpa_ft_pmk_cache_deinit(wpa_auth->ft_pmk_cache);
    517 	wpa_auth->ft_pmk_cache = NULL;
    518 #endif /* CONFIG_IEEE80211R */
    519 
    520 #ifdef CONFIG_P2P
    521 	bitfield_free(wpa_auth->ip_pool);
    522 #endif /* CONFIG_P2P */
    523 
    524 
    525 	os_free(wpa_auth->wpa_ie);
    526 
    527 	group = wpa_auth->group;
    528 	while (group) {
    529 		prev = group;
    530 		group = group->next;
    531 		os_free(prev);
    532 	}
    533 
    534 	os_free(wpa_auth);
    535 }
    536 
    537 
    538 /**
    539  * wpa_reconfig - Update WPA authenticator configuration
    540  * @wpa_auth: Pointer to WPA authenticator data from wpa_init()
    541  * @conf: Configuration for WPA authenticator
    542  */
    543 int wpa_reconfig(struct wpa_authenticator *wpa_auth,
    544 		 struct wpa_auth_config *conf)
    545 {
    546 	struct wpa_group *group;
    547 	if (wpa_auth == NULL)
    548 		return 0;
    549 
    550 	os_memcpy(&wpa_auth->conf, conf, sizeof(*conf));
    551 	if (wpa_auth_gen_wpa_ie(wpa_auth)) {
    552 		wpa_printf(MSG_ERROR, "Could not generate WPA IE.");
    553 		return -1;
    554 	}
    555 
    556 	/*
    557 	 * Reinitialize GTK to make sure it is suitable for the new
    558 	 * configuration.
    559 	 */
    560 	group = wpa_auth->group;
    561 	group->GTK_len = wpa_cipher_key_len(wpa_auth->conf.wpa_group);
    562 	group->GInit = TRUE;
    563 	wpa_group_sm_step(wpa_auth, group);
    564 	group->GInit = FALSE;
    565 	wpa_group_sm_step(wpa_auth, group);
    566 
    567 	return 0;
    568 }
    569 
    570 
    571 struct wpa_state_machine *
    572 wpa_auth_sta_init(struct wpa_authenticator *wpa_auth, const u8 *addr,
    573 		  const u8 *p2p_dev_addr)
    574 {
    575 	struct wpa_state_machine *sm;
    576 
    577 	if (wpa_auth->group->wpa_group_state == WPA_GROUP_FATAL_FAILURE)
    578 		return NULL;
    579 
    580 	sm = os_zalloc(sizeof(struct wpa_state_machine));
    581 	if (sm == NULL)
    582 		return NULL;
    583 	os_memcpy(sm->addr, addr, ETH_ALEN);
    584 	if (p2p_dev_addr)
    585 		os_memcpy(sm->p2p_dev_addr, p2p_dev_addr, ETH_ALEN);
    586 
    587 	sm->wpa_auth = wpa_auth;
    588 	sm->group = wpa_auth->group;
    589 	wpa_group_get(sm->wpa_auth, sm->group);
    590 
    591 	return sm;
    592 }
    593 
    594 
    595 int wpa_auth_sta_associated(struct wpa_authenticator *wpa_auth,
    596 			    struct wpa_state_machine *sm)
    597 {
    598 	if (wpa_auth == NULL || !wpa_auth->conf.wpa || sm == NULL)
    599 		return -1;
    600 
    601 #ifdef CONFIG_IEEE80211R
    602 	if (sm->ft_completed) {
    603 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG,
    604 				"FT authentication already completed - do not "
    605 				"start 4-way handshake");
    606 		/* Go to PTKINITDONE state to allow GTK rekeying */
    607 		sm->wpa_ptk_state = WPA_PTK_PTKINITDONE;
    608 		return 0;
    609 	}
    610 #endif /* CONFIG_IEEE80211R */
    611 
    612 	if (sm->started) {
    613 		os_memset(&sm->key_replay, 0, sizeof(sm->key_replay));
    614 		sm->ReAuthenticationRequest = TRUE;
    615 		return wpa_sm_step(sm);
    616 	}
    617 
    618 	wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG,
    619 			"start authentication");
    620 	sm->started = 1;
    621 
    622 	sm->Init = TRUE;
    623 	if (wpa_sm_step(sm) == 1)
    624 		return 1; /* should not really happen */
    625 	sm->Init = FALSE;
    626 	sm->AuthenticationRequest = TRUE;
    627 	return wpa_sm_step(sm);
    628 }
    629 
    630 
    631 void wpa_auth_sta_no_wpa(struct wpa_state_machine *sm)
    632 {
    633 	/* WPA/RSN was not used - clear WPA state. This is needed if the STA
    634 	 * reassociates back to the same AP while the previous entry for the
    635 	 * STA has not yet been removed. */
    636 	if (sm == NULL)
    637 		return;
    638 
    639 	sm->wpa_key_mgmt = 0;
    640 }
    641 
    642 
    643 static void wpa_free_sta_sm(struct wpa_state_machine *sm)
    644 {
    645 #ifdef CONFIG_P2P
    646 	if (WPA_GET_BE32(sm->ip_addr)) {
    647 		u32 start;
    648 		wpa_printf(MSG_DEBUG, "P2P: Free assigned IP "
    649 			   "address %u.%u.%u.%u from " MACSTR,
    650 			   sm->ip_addr[0], sm->ip_addr[1],
    651 			   sm->ip_addr[2], sm->ip_addr[3],
    652 			   MAC2STR(sm->addr));
    653 		start = WPA_GET_BE32(sm->wpa_auth->conf.ip_addr_start);
    654 		bitfield_clear(sm->wpa_auth->ip_pool,
    655 			       WPA_GET_BE32(sm->ip_addr) - start);
    656 	}
    657 #endif /* CONFIG_P2P */
    658 	if (sm->GUpdateStationKeys) {
    659 		sm->group->GKeyDoneStations--;
    660 		sm->GUpdateStationKeys = FALSE;
    661 	}
    662 #ifdef CONFIG_IEEE80211R
    663 	os_free(sm->assoc_resp_ftie);
    664 	wpabuf_free(sm->ft_pending_req_ies);
    665 #endif /* CONFIG_IEEE80211R */
    666 	os_free(sm->last_rx_eapol_key);
    667 	os_free(sm->wpa_ie);
    668 	wpa_group_put(sm->wpa_auth, sm->group);
    669 	os_free(sm);
    670 }
    671 
    672 
    673 void wpa_auth_sta_deinit(struct wpa_state_machine *sm)
    674 {
    675 	if (sm == NULL)
    676 		return;
    677 
    678 	if (sm->wpa_auth->conf.wpa_strict_rekey && sm->has_GTK) {
    679 		wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
    680 				"strict rekeying - force GTK rekey since STA "
    681 				"is leaving");
    682 		eloop_cancel_timeout(wpa_rekey_gtk, sm->wpa_auth, NULL);
    683 		eloop_register_timeout(0, 500000, wpa_rekey_gtk, sm->wpa_auth,
    684 				       NULL);
    685 	}
    686 
    687 	eloop_cancel_timeout(wpa_send_eapol_timeout, sm->wpa_auth, sm);
    688 	sm->pending_1_of_4_timeout = 0;
    689 	eloop_cancel_timeout(wpa_sm_call_step, sm, NULL);
    690 	eloop_cancel_timeout(wpa_rekey_ptk, sm->wpa_auth, sm);
    691 	if (sm->in_step_loop) {
    692 		/* Must not free state machine while wpa_sm_step() is running.
    693 		 * Freeing will be completed in the end of wpa_sm_step(). */
    694 		wpa_printf(MSG_DEBUG, "WPA: Registering pending STA state "
    695 			   "machine deinit for " MACSTR, MAC2STR(sm->addr));
    696 		sm->pending_deinit = 1;
    697 	} else
    698 		wpa_free_sta_sm(sm);
    699 }
    700 
    701 
    702 static void wpa_request_new_ptk(struct wpa_state_machine *sm)
    703 {
    704 	if (sm == NULL)
    705 		return;
    706 
    707 	sm->PTKRequest = TRUE;
    708 	sm->PTK_valid = 0;
    709 }
    710 
    711 
    712 static int wpa_replay_counter_valid(struct wpa_key_replay_counter *ctr,
    713 				    const u8 *replay_counter)
    714 {
    715 	int i;
    716 	for (i = 0; i < RSNA_MAX_EAPOL_RETRIES; i++) {
    717 		if (!ctr[i].valid)
    718 			break;
    719 		if (os_memcmp(replay_counter, ctr[i].counter,
    720 			      WPA_REPLAY_COUNTER_LEN) == 0)
    721 			return 1;
    722 	}
    723 	return 0;
    724 }
    725 
    726 
    727 static void wpa_replay_counter_mark_invalid(struct wpa_key_replay_counter *ctr,
    728 					    const u8 *replay_counter)
    729 {
    730 	int i;
    731 	for (i = 0; i < RSNA_MAX_EAPOL_RETRIES; i++) {
    732 		if (ctr[i].valid &&
    733 		    (replay_counter == NULL ||
    734 		     os_memcmp(replay_counter, ctr[i].counter,
    735 			       WPA_REPLAY_COUNTER_LEN) == 0))
    736 			ctr[i].valid = FALSE;
    737 	}
    738 }
    739 
    740 
    741 #ifdef CONFIG_IEEE80211R
    742 static int ft_check_msg_2_of_4(struct wpa_authenticator *wpa_auth,
    743 			       struct wpa_state_machine *sm,
    744 			       struct wpa_eapol_ie_parse *kde)
    745 {
    746 	struct wpa_ie_data ie;
    747 	struct rsn_mdie *mdie;
    748 
    749 	if (wpa_parse_wpa_ie_rsn(kde->rsn_ie, kde->rsn_ie_len, &ie) < 0 ||
    750 	    ie.num_pmkid != 1 || ie.pmkid == NULL) {
    751 		wpa_printf(MSG_DEBUG, "FT: No PMKR1Name in "
    752 			   "FT 4-way handshake message 2/4");
    753 		return -1;
    754 	}
    755 
    756 	os_memcpy(sm->sup_pmk_r1_name, ie.pmkid, PMKID_LEN);
    757 	wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name from Supplicant",
    758 		    sm->sup_pmk_r1_name, PMKID_LEN);
    759 
    760 	if (!kde->mdie || !kde->ftie) {
    761 		wpa_printf(MSG_DEBUG, "FT: No %s in FT 4-way handshake "
    762 			   "message 2/4", kde->mdie ? "FTIE" : "MDIE");
    763 		return -1;
    764 	}
    765 
    766 	mdie = (struct rsn_mdie *) (kde->mdie + 2);
    767 	if (kde->mdie[1] < sizeof(struct rsn_mdie) ||
    768 	    os_memcmp(wpa_auth->conf.mobility_domain, mdie->mobility_domain,
    769 		      MOBILITY_DOMAIN_ID_LEN) != 0) {
    770 		wpa_printf(MSG_DEBUG, "FT: MDIE mismatch");
    771 		return -1;
    772 	}
    773 
    774 	if (sm->assoc_resp_ftie &&
    775 	    (kde->ftie[1] != sm->assoc_resp_ftie[1] ||
    776 	     os_memcmp(kde->ftie, sm->assoc_resp_ftie,
    777 		       2 + sm->assoc_resp_ftie[1]) != 0)) {
    778 		wpa_printf(MSG_DEBUG, "FT: FTIE mismatch");
    779 		wpa_hexdump(MSG_DEBUG, "FT: FTIE in EAPOL-Key msg 2/4",
    780 			    kde->ftie, kde->ftie_len);
    781 		wpa_hexdump(MSG_DEBUG, "FT: FTIE in (Re)AssocResp",
    782 			    sm->assoc_resp_ftie, 2 + sm->assoc_resp_ftie[1]);
    783 		return -1;
    784 	}
    785 
    786 	return 0;
    787 }
    788 #endif /* CONFIG_IEEE80211R */
    789 
    790 
    791 static int wpa_receive_error_report(struct wpa_authenticator *wpa_auth,
    792 				    struct wpa_state_machine *sm, int group)
    793 {
    794 	/* Supplicant reported a Michael MIC error */
    795 	wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_INFO,
    796 			 "received EAPOL-Key Error Request "
    797 			 "(STA detected Michael MIC failure (group=%d))",
    798 			 group);
    799 
    800 	if (group && wpa_auth->conf.wpa_group != WPA_CIPHER_TKIP) {
    801 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
    802 				"ignore Michael MIC failure report since "
    803 				"group cipher is not TKIP");
    804 	} else if (!group && sm->pairwise != WPA_CIPHER_TKIP) {
    805 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
    806 				"ignore Michael MIC failure report since "
    807 				"pairwise cipher is not TKIP");
    808 	} else {
    809 		if (wpa_auth_mic_failure_report(wpa_auth, sm->addr) > 0)
    810 			return 1; /* STA entry was removed */
    811 		sm->dot11RSNAStatsTKIPRemoteMICFailures++;
    812 		wpa_auth->dot11RSNAStatsTKIPRemoteMICFailures++;
    813 	}
    814 
    815 	/*
    816 	 * Error report is not a request for a new key handshake, but since
    817 	 * Authenticator may do it, let's change the keys now anyway.
    818 	 */
    819 	wpa_request_new_ptk(sm);
    820 	return 0;
    821 }
    822 
    823 
    824 static int wpa_try_alt_snonce(struct wpa_state_machine *sm, u8 *data,
    825 			      size_t data_len)
    826 {
    827 	struct wpa_ptk PTK;
    828 	int ok = 0;
    829 	const u8 *pmk = NULL;
    830 
    831 	for (;;) {
    832 		if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)) {
    833 			pmk = wpa_auth_get_psk(sm->wpa_auth, sm->addr,
    834 					       sm->p2p_dev_addr, pmk);
    835 			if (pmk == NULL)
    836 				break;
    837 		} else
    838 			pmk = sm->PMK;
    839 
    840 		wpa_derive_ptk(sm, sm->alt_SNonce, pmk, &PTK);
    841 
    842 		if (wpa_verify_key_mic(sm->wpa_key_mgmt, &PTK, data, data_len)
    843 		    == 0) {
    844 			ok = 1;
    845 			break;
    846 		}
    847 
    848 		if (!wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt))
    849 			break;
    850 	}
    851 
    852 	if (!ok) {
    853 		wpa_printf(MSG_DEBUG,
    854 			   "WPA: Earlier SNonce did not result in matching MIC");
    855 		return -1;
    856 	}
    857 
    858 	wpa_printf(MSG_DEBUG,
    859 		   "WPA: Earlier SNonce resulted in matching MIC");
    860 	sm->alt_snonce_valid = 0;
    861 	os_memcpy(sm->SNonce, sm->alt_SNonce, WPA_NONCE_LEN);
    862 	os_memcpy(&sm->PTK, &PTK, sizeof(PTK));
    863 	sm->PTK_valid = TRUE;
    864 
    865 	return 0;
    866 }
    867 
    868 
    869 void wpa_receive(struct wpa_authenticator *wpa_auth,
    870 		 struct wpa_state_machine *sm,
    871 		 u8 *data, size_t data_len)
    872 {
    873 	struct ieee802_1x_hdr *hdr;
    874 	struct wpa_eapol_key *key;
    875 	struct wpa_eapol_key_192 *key192;
    876 	u16 key_info, key_data_length;
    877 	enum { PAIRWISE_2, PAIRWISE_4, GROUP_2, REQUEST,
    878 	       SMK_M1, SMK_M3, SMK_ERROR } msg;
    879 	char *msgtxt;
    880 	struct wpa_eapol_ie_parse kde;
    881 	int ft;
    882 	const u8 *eapol_key_ie, *key_data;
    883 	size_t eapol_key_ie_len, keyhdrlen, mic_len;
    884 
    885 	if (wpa_auth == NULL || !wpa_auth->conf.wpa || sm == NULL)
    886 		return;
    887 
    888 	mic_len = wpa_mic_len(sm->wpa_key_mgmt);
    889 	keyhdrlen = mic_len == 24 ? sizeof(*key192) : sizeof(*key);
    890 
    891 	if (data_len < sizeof(*hdr) + keyhdrlen)
    892 		return;
    893 
    894 	hdr = (struct ieee802_1x_hdr *) data;
    895 	key = (struct wpa_eapol_key *) (hdr + 1);
    896 	key192 = (struct wpa_eapol_key_192 *) (hdr + 1);
    897 	key_info = WPA_GET_BE16(key->key_info);
    898 	if (mic_len == 24) {
    899 		key_data = (const u8 *) (key192 + 1);
    900 		key_data_length = WPA_GET_BE16(key192->key_data_length);
    901 	} else {
    902 		key_data = (const u8 *) (key + 1);
    903 		key_data_length = WPA_GET_BE16(key->key_data_length);
    904 	}
    905 	wpa_printf(MSG_DEBUG, "WPA: Received EAPOL-Key from " MACSTR
    906 		   " key_info=0x%x type=%u key_data_length=%u",
    907 		   MAC2STR(sm->addr), key_info, key->type, key_data_length);
    908 	if (key_data_length > data_len - sizeof(*hdr) - keyhdrlen) {
    909 		wpa_printf(MSG_INFO, "WPA: Invalid EAPOL-Key frame - "
    910 			   "key_data overflow (%d > %lu)",
    911 			   key_data_length,
    912 			   (unsigned long) (data_len - sizeof(*hdr) -
    913 					    keyhdrlen));
    914 		return;
    915 	}
    916 
    917 	if (sm->wpa == WPA_VERSION_WPA2) {
    918 		if (key->type == EAPOL_KEY_TYPE_WPA) {
    919 			/*
    920 			 * Some deployed station implementations seem to send
    921 			 * msg 4/4 with incorrect type value in WPA2 mode.
    922 			 */
    923 			wpa_printf(MSG_DEBUG, "Workaround: Allow EAPOL-Key "
    924 				   "with unexpected WPA type in RSN mode");
    925 		} else if (key->type != EAPOL_KEY_TYPE_RSN) {
    926 			wpa_printf(MSG_DEBUG, "Ignore EAPOL-Key with "
    927 				   "unexpected type %d in RSN mode",
    928 				   key->type);
    929 			return;
    930 		}
    931 	} else {
    932 		if (key->type != EAPOL_KEY_TYPE_WPA) {
    933 			wpa_printf(MSG_DEBUG, "Ignore EAPOL-Key with "
    934 				   "unexpected type %d in WPA mode",
    935 				   key->type);
    936 			return;
    937 		}
    938 	}
    939 
    940 	wpa_hexdump(MSG_DEBUG, "WPA: Received Key Nonce", key->key_nonce,
    941 		    WPA_NONCE_LEN);
    942 	wpa_hexdump(MSG_DEBUG, "WPA: Received Replay Counter",
    943 		    key->replay_counter, WPA_REPLAY_COUNTER_LEN);
    944 
    945 	/* FIX: verify that the EAPOL-Key frame was encrypted if pairwise keys
    946 	 * are set */
    947 
    948 	if ((key_info & (WPA_KEY_INFO_SMK_MESSAGE | WPA_KEY_INFO_REQUEST)) ==
    949 	    (WPA_KEY_INFO_SMK_MESSAGE | WPA_KEY_INFO_REQUEST)) {
    950 		if (key_info & WPA_KEY_INFO_ERROR) {
    951 			msg = SMK_ERROR;
    952 			msgtxt = "SMK Error";
    953 		} else {
    954 			msg = SMK_M1;
    955 			msgtxt = "SMK M1";
    956 		}
    957 	} else if (key_info & WPA_KEY_INFO_SMK_MESSAGE) {
    958 		msg = SMK_M3;
    959 		msgtxt = "SMK M3";
    960 	} else if (key_info & WPA_KEY_INFO_REQUEST) {
    961 		msg = REQUEST;
    962 		msgtxt = "Request";
    963 	} else if (!(key_info & WPA_KEY_INFO_KEY_TYPE)) {
    964 		msg = GROUP_2;
    965 		msgtxt = "2/2 Group";
    966 	} else if (key_data_length == 0) {
    967 		msg = PAIRWISE_4;
    968 		msgtxt = "4/4 Pairwise";
    969 	} else {
    970 		msg = PAIRWISE_2;
    971 		msgtxt = "2/4 Pairwise";
    972 	}
    973 
    974 	/* TODO: key_info type validation for PeerKey */
    975 	if (msg == REQUEST || msg == PAIRWISE_2 || msg == PAIRWISE_4 ||
    976 	    msg == GROUP_2) {
    977 		u16 ver = key_info & WPA_KEY_INFO_TYPE_MASK;
    978 		if (sm->pairwise == WPA_CIPHER_CCMP ||
    979 		    sm->pairwise == WPA_CIPHER_GCMP) {
    980 			if (wpa_use_aes_cmac(sm) &&
    981 			    sm->wpa_key_mgmt != WPA_KEY_MGMT_OSEN &&
    982 			    !wpa_key_mgmt_suite_b(sm->wpa_key_mgmt) &&
    983 			    ver != WPA_KEY_INFO_TYPE_AES_128_CMAC) {
    984 				wpa_auth_logger(wpa_auth, sm->addr,
    985 						LOGGER_WARNING,
    986 						"advertised support for "
    987 						"AES-128-CMAC, but did not "
    988 						"use it");
    989 				return;
    990 			}
    991 
    992 			if (!wpa_use_aes_cmac(sm) &&
    993 			    ver != WPA_KEY_INFO_TYPE_HMAC_SHA1_AES) {
    994 				wpa_auth_logger(wpa_auth, sm->addr,
    995 						LOGGER_WARNING,
    996 						"did not use HMAC-SHA1-AES "
    997 						"with CCMP/GCMP");
    998 				return;
    999 			}
   1000 		}
   1001 
   1002 		if (wpa_key_mgmt_suite_b(sm->wpa_key_mgmt) &&
   1003 		    ver != WPA_KEY_INFO_TYPE_AKM_DEFINED) {
   1004 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_WARNING,
   1005 					"did not use EAPOL-Key descriptor version 0 as required for AKM-defined cases");
   1006 			return;
   1007 		}
   1008 	}
   1009 
   1010 	if (key_info & WPA_KEY_INFO_REQUEST) {
   1011 		if (sm->req_replay_counter_used &&
   1012 		    os_memcmp(key->replay_counter, sm->req_replay_counter,
   1013 			      WPA_REPLAY_COUNTER_LEN) <= 0) {
   1014 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_WARNING,
   1015 					"received EAPOL-Key request with "
   1016 					"replayed counter");
   1017 			return;
   1018 		}
   1019 	}
   1020 
   1021 	if (!(key_info & WPA_KEY_INFO_REQUEST) &&
   1022 	    !wpa_replay_counter_valid(sm->key_replay, key->replay_counter)) {
   1023 		int i;
   1024 
   1025 		if (msg == PAIRWISE_2 &&
   1026 		    wpa_replay_counter_valid(sm->prev_key_replay,
   1027 					     key->replay_counter) &&
   1028 		    sm->wpa_ptk_state == WPA_PTK_PTKINITNEGOTIATING &&
   1029 		    os_memcmp(sm->SNonce, key->key_nonce, WPA_NONCE_LEN) != 0)
   1030 		{
   1031 			/*
   1032 			 * Some supplicant implementations (e.g., Windows XP
   1033 			 * WZC) update SNonce for each EAPOL-Key 2/4. This
   1034 			 * breaks the workaround on accepting any of the
   1035 			 * pending requests, so allow the SNonce to be updated
   1036 			 * even if we have already sent out EAPOL-Key 3/4.
   1037 			 */
   1038 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1039 					 "Process SNonce update from STA "
   1040 					 "based on retransmitted EAPOL-Key "
   1041 					 "1/4");
   1042 			sm->update_snonce = 1;
   1043 			os_memcpy(sm->alt_SNonce, sm->SNonce, WPA_NONCE_LEN);
   1044 			sm->alt_snonce_valid = TRUE;
   1045 			os_memcpy(sm->alt_replay_counter,
   1046 				  sm->key_replay[0].counter,
   1047 				  WPA_REPLAY_COUNTER_LEN);
   1048 			goto continue_processing;
   1049 		}
   1050 
   1051 		if (msg == PAIRWISE_4 && sm->alt_snonce_valid &&
   1052 		    sm->wpa_ptk_state == WPA_PTK_PTKINITNEGOTIATING &&
   1053 		    os_memcmp(key->replay_counter, sm->alt_replay_counter,
   1054 			      WPA_REPLAY_COUNTER_LEN) == 0) {
   1055 			/*
   1056 			 * Supplicant may still be using the old SNonce since
   1057 			 * there was two EAPOL-Key 2/4 messages and they had
   1058 			 * different SNonce values.
   1059 			 */
   1060 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1061 					 "Try to process received EAPOL-Key 4/4 based on old Replay Counter and SNonce from an earlier EAPOL-Key 1/4");
   1062 			goto continue_processing;
   1063 		}
   1064 
   1065 		if (msg == PAIRWISE_2 &&
   1066 		    wpa_replay_counter_valid(sm->prev_key_replay,
   1067 					     key->replay_counter) &&
   1068 		    sm->wpa_ptk_state == WPA_PTK_PTKINITNEGOTIATING) {
   1069 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1070 					 "ignore retransmitted EAPOL-Key %s - "
   1071 					 "SNonce did not change", msgtxt);
   1072 		} else {
   1073 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1074 					 "received EAPOL-Key %s with "
   1075 					 "unexpected replay counter", msgtxt);
   1076 		}
   1077 		for (i = 0; i < RSNA_MAX_EAPOL_RETRIES; i++) {
   1078 			if (!sm->key_replay[i].valid)
   1079 				break;
   1080 			wpa_hexdump(MSG_DEBUG, "pending replay counter",
   1081 				    sm->key_replay[i].counter,
   1082 				    WPA_REPLAY_COUNTER_LEN);
   1083 		}
   1084 		wpa_hexdump(MSG_DEBUG, "received replay counter",
   1085 			    key->replay_counter, WPA_REPLAY_COUNTER_LEN);
   1086 		return;
   1087 	}
   1088 
   1089 continue_processing:
   1090 	switch (msg) {
   1091 	case PAIRWISE_2:
   1092 		if (sm->wpa_ptk_state != WPA_PTK_PTKSTART &&
   1093 		    sm->wpa_ptk_state != WPA_PTK_PTKCALCNEGOTIATING &&
   1094 		    (!sm->update_snonce ||
   1095 		     sm->wpa_ptk_state != WPA_PTK_PTKINITNEGOTIATING)) {
   1096 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_INFO,
   1097 					 "received EAPOL-Key msg 2/4 in "
   1098 					 "invalid state (%d) - dropped",
   1099 					 sm->wpa_ptk_state);
   1100 			return;
   1101 		}
   1102 		random_add_randomness(key->key_nonce, WPA_NONCE_LEN);
   1103 		if (sm->group->reject_4way_hs_for_entropy) {
   1104 			/*
   1105 			 * The system did not have enough entropy to generate
   1106 			 * strong random numbers. Reject the first 4-way
   1107 			 * handshake(s) and collect some entropy based on the
   1108 			 * information from it. Once enough entropy is
   1109 			 * available, the next atempt will trigger GMK/Key
   1110 			 * Counter update and the station will be allowed to
   1111 			 * continue.
   1112 			 */
   1113 			wpa_printf(MSG_DEBUG, "WPA: Reject 4-way handshake to "
   1114 				   "collect more entropy for random number "
   1115 				   "generation");
   1116 			random_mark_pool_ready();
   1117 			wpa_sta_disconnect(wpa_auth, sm->addr);
   1118 			return;
   1119 		}
   1120 		if (wpa_parse_kde_ies(key_data, key_data_length, &kde) < 0) {
   1121 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_INFO,
   1122 					 "received EAPOL-Key msg 2/4 with "
   1123 					 "invalid Key Data contents");
   1124 			return;
   1125 		}
   1126 		if (kde.rsn_ie) {
   1127 			eapol_key_ie = kde.rsn_ie;
   1128 			eapol_key_ie_len = kde.rsn_ie_len;
   1129 		} else if (kde.osen) {
   1130 			eapol_key_ie = kde.osen;
   1131 			eapol_key_ie_len = kde.osen_len;
   1132 		} else {
   1133 			eapol_key_ie = kde.wpa_ie;
   1134 			eapol_key_ie_len = kde.wpa_ie_len;
   1135 		}
   1136 		ft = sm->wpa == WPA_VERSION_WPA2 &&
   1137 			wpa_key_mgmt_ft(sm->wpa_key_mgmt);
   1138 		if (sm->wpa_ie == NULL ||
   1139 		    wpa_compare_rsn_ie(ft,
   1140 				       sm->wpa_ie, sm->wpa_ie_len,
   1141 				       eapol_key_ie, eapol_key_ie_len)) {
   1142 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1143 					"WPA IE from (Re)AssocReq did not "
   1144 					"match with msg 2/4");
   1145 			if (sm->wpa_ie) {
   1146 				wpa_hexdump(MSG_DEBUG, "WPA IE in AssocReq",
   1147 					    sm->wpa_ie, sm->wpa_ie_len);
   1148 			}
   1149 			wpa_hexdump(MSG_DEBUG, "WPA IE in msg 2/4",
   1150 				    eapol_key_ie, eapol_key_ie_len);
   1151 			/* MLME-DEAUTHENTICATE.request */
   1152 			wpa_sta_disconnect(wpa_auth, sm->addr);
   1153 			return;
   1154 		}
   1155 #ifdef CONFIG_IEEE80211R
   1156 		if (ft && ft_check_msg_2_of_4(wpa_auth, sm, &kde) < 0) {
   1157 			wpa_sta_disconnect(wpa_auth, sm->addr);
   1158 			return;
   1159 		}
   1160 #endif /* CONFIG_IEEE80211R */
   1161 #ifdef CONFIG_P2P
   1162 		if (kde.ip_addr_req && kde.ip_addr_req[0] &&
   1163 		    wpa_auth->ip_pool && WPA_GET_BE32(sm->ip_addr) == 0) {
   1164 			int idx;
   1165 			wpa_printf(MSG_DEBUG, "P2P: IP address requested in "
   1166 				   "EAPOL-Key exchange");
   1167 			idx = bitfield_get_first_zero(wpa_auth->ip_pool);
   1168 			if (idx >= 0) {
   1169 				u32 start = WPA_GET_BE32(wpa_auth->conf.
   1170 							 ip_addr_start);
   1171 				bitfield_set(wpa_auth->ip_pool, idx);
   1172 				WPA_PUT_BE32(sm->ip_addr, start + idx);
   1173 				wpa_printf(MSG_DEBUG, "P2P: Assigned IP "
   1174 					   "address %u.%u.%u.%u to " MACSTR,
   1175 					   sm->ip_addr[0], sm->ip_addr[1],
   1176 					   sm->ip_addr[2], sm->ip_addr[3],
   1177 					   MAC2STR(sm->addr));
   1178 			}
   1179 		}
   1180 #endif /* CONFIG_P2P */
   1181 		break;
   1182 	case PAIRWISE_4:
   1183 		if (sm->wpa_ptk_state != WPA_PTK_PTKINITNEGOTIATING ||
   1184 		    !sm->PTK_valid) {
   1185 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_INFO,
   1186 					 "received EAPOL-Key msg 4/4 in "
   1187 					 "invalid state (%d) - dropped",
   1188 					 sm->wpa_ptk_state);
   1189 			return;
   1190 		}
   1191 		break;
   1192 	case GROUP_2:
   1193 		if (sm->wpa_ptk_group_state != WPA_PTK_GROUP_REKEYNEGOTIATING
   1194 		    || !sm->PTK_valid) {
   1195 			wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_INFO,
   1196 					 "received EAPOL-Key msg 2/2 in "
   1197 					 "invalid state (%d) - dropped",
   1198 					 sm->wpa_ptk_group_state);
   1199 			return;
   1200 		}
   1201 		break;
   1202 #ifdef CONFIG_PEERKEY
   1203 	case SMK_M1:
   1204 	case SMK_M3:
   1205 	case SMK_ERROR:
   1206 		if (!wpa_auth->conf.peerkey) {
   1207 			wpa_printf(MSG_DEBUG, "RSN: SMK M1/M3/Error, but "
   1208 				   "PeerKey use disabled - ignoring message");
   1209 			return;
   1210 		}
   1211 		if (!sm->PTK_valid) {
   1212 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1213 					"received EAPOL-Key msg SMK in "
   1214 					"invalid state - dropped");
   1215 			return;
   1216 		}
   1217 		break;
   1218 #else /* CONFIG_PEERKEY */
   1219 	case SMK_M1:
   1220 	case SMK_M3:
   1221 	case SMK_ERROR:
   1222 		return; /* STSL disabled - ignore SMK messages */
   1223 #endif /* CONFIG_PEERKEY */
   1224 	case REQUEST:
   1225 		break;
   1226 	}
   1227 
   1228 	wpa_auth_vlogger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1229 			 "received EAPOL-Key frame (%s)", msgtxt);
   1230 
   1231 	if (key_info & WPA_KEY_INFO_ACK) {
   1232 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1233 				"received invalid EAPOL-Key: Key Ack set");
   1234 		return;
   1235 	}
   1236 
   1237 	if (!(key_info & WPA_KEY_INFO_MIC)) {
   1238 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1239 				"received invalid EAPOL-Key: Key MIC not set");
   1240 		return;
   1241 	}
   1242 
   1243 	sm->MICVerified = FALSE;
   1244 	if (sm->PTK_valid && !sm->update_snonce) {
   1245 		if (wpa_verify_key_mic(sm->wpa_key_mgmt, &sm->PTK, data,
   1246 				       data_len) &&
   1247 		    (msg != PAIRWISE_4 || !sm->alt_snonce_valid ||
   1248 		     wpa_try_alt_snonce(sm, data, data_len))) {
   1249 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1250 					"received EAPOL-Key with invalid MIC");
   1251 			return;
   1252 		}
   1253 		sm->MICVerified = TRUE;
   1254 		eloop_cancel_timeout(wpa_send_eapol_timeout, wpa_auth, sm);
   1255 		sm->pending_1_of_4_timeout = 0;
   1256 	}
   1257 
   1258 	if (key_info & WPA_KEY_INFO_REQUEST) {
   1259 		if (sm->MICVerified) {
   1260 			sm->req_replay_counter_used = 1;
   1261 			os_memcpy(sm->req_replay_counter, key->replay_counter,
   1262 				  WPA_REPLAY_COUNTER_LEN);
   1263 		} else {
   1264 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1265 					"received EAPOL-Key request with "
   1266 					"invalid MIC");
   1267 			return;
   1268 		}
   1269 
   1270 		/*
   1271 		 * TODO: should decrypt key data field if encryption was used;
   1272 		 * even though MAC address KDE is not normally encrypted,
   1273 		 * supplicant is allowed to encrypt it.
   1274 		 */
   1275 		if (msg == SMK_ERROR) {
   1276 #ifdef CONFIG_PEERKEY
   1277 			wpa_smk_error(wpa_auth, sm, key_data, key_data_length);
   1278 #endif /* CONFIG_PEERKEY */
   1279 			return;
   1280 		} else if (key_info & WPA_KEY_INFO_ERROR) {
   1281 			if (wpa_receive_error_report(
   1282 				    wpa_auth, sm,
   1283 				    !(key_info & WPA_KEY_INFO_KEY_TYPE)) > 0)
   1284 				return; /* STA entry was removed */
   1285 		} else if (key_info & WPA_KEY_INFO_KEY_TYPE) {
   1286 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1287 					"received EAPOL-Key Request for new "
   1288 					"4-Way Handshake");
   1289 			wpa_request_new_ptk(sm);
   1290 #ifdef CONFIG_PEERKEY
   1291 		} else if (msg == SMK_M1) {
   1292 			wpa_smk_m1(wpa_auth, sm, key, key_data,
   1293 				   key_data_length);
   1294 #endif /* CONFIG_PEERKEY */
   1295 		} else if (key_data_length > 0 &&
   1296 			   wpa_parse_kde_ies(key_data, key_data_length,
   1297 					     &kde) == 0 &&
   1298 			   kde.mac_addr) {
   1299 		} else {
   1300 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1301 					"received EAPOL-Key Request for GTK "
   1302 					"rekeying");
   1303 			eloop_cancel_timeout(wpa_rekey_gtk, wpa_auth, NULL);
   1304 			wpa_rekey_gtk(wpa_auth, NULL);
   1305 		}
   1306 	} else {
   1307 		/* Do not allow the same key replay counter to be reused. */
   1308 		wpa_replay_counter_mark_invalid(sm->key_replay,
   1309 						key->replay_counter);
   1310 
   1311 		if (msg == PAIRWISE_2) {
   1312 			/*
   1313 			 * Maintain a copy of the pending EAPOL-Key frames in
   1314 			 * case the EAPOL-Key frame was retransmitted. This is
   1315 			 * needed to allow EAPOL-Key msg 2/4 reply to another
   1316 			 * pending msg 1/4 to update the SNonce to work around
   1317 			 * unexpected supplicant behavior.
   1318 			 */
   1319 			os_memcpy(sm->prev_key_replay, sm->key_replay,
   1320 				  sizeof(sm->key_replay));
   1321 		} else {
   1322 			os_memset(sm->prev_key_replay, 0,
   1323 				  sizeof(sm->prev_key_replay));
   1324 		}
   1325 
   1326 		/*
   1327 		 * Make sure old valid counters are not accepted anymore and
   1328 		 * do not get copied again.
   1329 		 */
   1330 		wpa_replay_counter_mark_invalid(sm->key_replay, NULL);
   1331 	}
   1332 
   1333 #ifdef CONFIG_PEERKEY
   1334 	if (msg == SMK_M3) {
   1335 		wpa_smk_m3(wpa_auth, sm, key, key_data, key_data_length);
   1336 		return;
   1337 	}
   1338 #endif /* CONFIG_PEERKEY */
   1339 
   1340 	os_free(sm->last_rx_eapol_key);
   1341 	sm->last_rx_eapol_key = os_malloc(data_len);
   1342 	if (sm->last_rx_eapol_key == NULL)
   1343 		return;
   1344 	os_memcpy(sm->last_rx_eapol_key, data, data_len);
   1345 	sm->last_rx_eapol_key_len = data_len;
   1346 
   1347 	sm->rx_eapol_key_secure = !!(key_info & WPA_KEY_INFO_SECURE);
   1348 	sm->EAPOLKeyReceived = TRUE;
   1349 	sm->EAPOLKeyPairwise = !!(key_info & WPA_KEY_INFO_KEY_TYPE);
   1350 	sm->EAPOLKeyRequest = !!(key_info & WPA_KEY_INFO_REQUEST);
   1351 	os_memcpy(sm->SNonce, key->key_nonce, WPA_NONCE_LEN);
   1352 	wpa_sm_step(sm);
   1353 }
   1354 
   1355 
   1356 static int wpa_gmk_to_gtk(const u8 *gmk, const char *label, const u8 *addr,
   1357 			  const u8 *gnonce, u8 *gtk, size_t gtk_len)
   1358 {
   1359 	u8 data[ETH_ALEN + WPA_NONCE_LEN + 8 + 16];
   1360 	u8 *pos;
   1361 	int ret = 0;
   1362 
   1363 	/* GTK = PRF-X(GMK, "Group key expansion",
   1364 	 *	AA || GNonce || Time || random data)
   1365 	 * The example described in the IEEE 802.11 standard uses only AA and
   1366 	 * GNonce as inputs here. Add some more entropy since this derivation
   1367 	 * is done only at the Authenticator and as such, does not need to be
   1368 	 * exactly same.
   1369 	 */
   1370 	os_memcpy(data, addr, ETH_ALEN);
   1371 	os_memcpy(data + ETH_ALEN, gnonce, WPA_NONCE_LEN);
   1372 	pos = data + ETH_ALEN + WPA_NONCE_LEN;
   1373 	wpa_get_ntp_timestamp(pos);
   1374 	pos += 8;
   1375 	if (random_get_bytes(pos, 16) < 0)
   1376 		ret = -1;
   1377 
   1378 #ifdef CONFIG_IEEE80211W
   1379 	sha256_prf(gmk, WPA_GMK_LEN, label, data, sizeof(data), gtk, gtk_len);
   1380 #else /* CONFIG_IEEE80211W */
   1381 	if (sha1_prf(gmk, WPA_GMK_LEN, label, data, sizeof(data), gtk, gtk_len)
   1382 	    < 0)
   1383 		ret = -1;
   1384 #endif /* CONFIG_IEEE80211W */
   1385 
   1386 	return ret;
   1387 }
   1388 
   1389 
   1390 static void wpa_send_eapol_timeout(void *eloop_ctx, void *timeout_ctx)
   1391 {
   1392 	struct wpa_authenticator *wpa_auth = eloop_ctx;
   1393 	struct wpa_state_machine *sm = timeout_ctx;
   1394 
   1395 	sm->pending_1_of_4_timeout = 0;
   1396 	wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG, "EAPOL-Key timeout");
   1397 	sm->TimeoutEvt = TRUE;
   1398 	wpa_sm_step(sm);
   1399 }
   1400 
   1401 
   1402 void __wpa_send_eapol(struct wpa_authenticator *wpa_auth,
   1403 		      struct wpa_state_machine *sm, int key_info,
   1404 		      const u8 *key_rsc, const u8 *nonce,
   1405 		      const u8 *kde, size_t kde_len,
   1406 		      int keyidx, int encr, int force_version)
   1407 {
   1408 	struct ieee802_1x_hdr *hdr;
   1409 	struct wpa_eapol_key *key;
   1410 	struct wpa_eapol_key_192 *key192;
   1411 	size_t len, mic_len, keyhdrlen;
   1412 	int alg;
   1413 	int key_data_len, pad_len = 0;
   1414 	u8 *buf, *pos;
   1415 	int version, pairwise;
   1416 	int i;
   1417 	u8 *key_data;
   1418 
   1419 	mic_len = wpa_mic_len(sm->wpa_key_mgmt);
   1420 	keyhdrlen = mic_len == 24 ? sizeof(*key192) : sizeof(*key);
   1421 
   1422 	len = sizeof(struct ieee802_1x_hdr) + keyhdrlen;
   1423 
   1424 	if (force_version)
   1425 		version = force_version;
   1426 	else if (sm->wpa_key_mgmt == WPA_KEY_MGMT_OSEN ||
   1427 		 wpa_key_mgmt_suite_b(sm->wpa_key_mgmt))
   1428 		version = WPA_KEY_INFO_TYPE_AKM_DEFINED;
   1429 	else if (wpa_use_aes_cmac(sm))
   1430 		version = WPA_KEY_INFO_TYPE_AES_128_CMAC;
   1431 	else if (sm->pairwise != WPA_CIPHER_TKIP)
   1432 		version = WPA_KEY_INFO_TYPE_HMAC_SHA1_AES;
   1433 	else
   1434 		version = WPA_KEY_INFO_TYPE_HMAC_MD5_RC4;
   1435 
   1436 	pairwise = !!(key_info & WPA_KEY_INFO_KEY_TYPE);
   1437 
   1438 	wpa_printf(MSG_DEBUG, "WPA: Send EAPOL(version=%d secure=%d mic=%d "
   1439 		   "ack=%d install=%d pairwise=%d kde_len=%lu keyidx=%d "
   1440 		   "encr=%d)",
   1441 		   version,
   1442 		   (key_info & WPA_KEY_INFO_SECURE) ? 1 : 0,
   1443 		   (key_info & WPA_KEY_INFO_MIC) ? 1 : 0,
   1444 		   (key_info & WPA_KEY_INFO_ACK) ? 1 : 0,
   1445 		   (key_info & WPA_KEY_INFO_INSTALL) ? 1 : 0,
   1446 		   pairwise, (unsigned long) kde_len, keyidx, encr);
   1447 
   1448 	key_data_len = kde_len;
   1449 
   1450 	if ((version == WPA_KEY_INFO_TYPE_HMAC_SHA1_AES ||
   1451 	     sm->wpa_key_mgmt == WPA_KEY_MGMT_OSEN ||
   1452 	     wpa_key_mgmt_suite_b(sm->wpa_key_mgmt) ||
   1453 	     version == WPA_KEY_INFO_TYPE_AES_128_CMAC) && encr) {
   1454 		pad_len = key_data_len % 8;
   1455 		if (pad_len)
   1456 			pad_len = 8 - pad_len;
   1457 		key_data_len += pad_len + 8;
   1458 	}
   1459 
   1460 	len += key_data_len;
   1461 
   1462 	hdr = os_zalloc(len);
   1463 	if (hdr == NULL)
   1464 		return;
   1465 	hdr->version = wpa_auth->conf.eapol_version;
   1466 	hdr->type = IEEE802_1X_TYPE_EAPOL_KEY;
   1467 	hdr->length = host_to_be16(len  - sizeof(*hdr));
   1468 	key = (struct wpa_eapol_key *) (hdr + 1);
   1469 	key192 = (struct wpa_eapol_key_192 *) (hdr + 1);
   1470 	key_data = ((u8 *) (hdr + 1)) + keyhdrlen;
   1471 
   1472 	key->type = sm->wpa == WPA_VERSION_WPA2 ?
   1473 		EAPOL_KEY_TYPE_RSN : EAPOL_KEY_TYPE_WPA;
   1474 	key_info |= version;
   1475 	if (encr && sm->wpa == WPA_VERSION_WPA2)
   1476 		key_info |= WPA_KEY_INFO_ENCR_KEY_DATA;
   1477 	if (sm->wpa != WPA_VERSION_WPA2)
   1478 		key_info |= keyidx << WPA_KEY_INFO_KEY_INDEX_SHIFT;
   1479 	WPA_PUT_BE16(key->key_info, key_info);
   1480 
   1481 	alg = pairwise ? sm->pairwise : wpa_auth->conf.wpa_group;
   1482 	WPA_PUT_BE16(key->key_length, wpa_cipher_key_len(alg));
   1483 	if (key_info & WPA_KEY_INFO_SMK_MESSAGE)
   1484 		WPA_PUT_BE16(key->key_length, 0);
   1485 
   1486 	/* FIX: STSL: what to use as key_replay_counter? */
   1487 	for (i = RSNA_MAX_EAPOL_RETRIES - 1; i > 0; i--) {
   1488 		sm->key_replay[i].valid = sm->key_replay[i - 1].valid;
   1489 		os_memcpy(sm->key_replay[i].counter,
   1490 			  sm->key_replay[i - 1].counter,
   1491 			  WPA_REPLAY_COUNTER_LEN);
   1492 	}
   1493 	inc_byte_array(sm->key_replay[0].counter, WPA_REPLAY_COUNTER_LEN);
   1494 	os_memcpy(key->replay_counter, sm->key_replay[0].counter,
   1495 		  WPA_REPLAY_COUNTER_LEN);
   1496 	wpa_hexdump(MSG_DEBUG, "WPA: Replay Counter",
   1497 		    key->replay_counter, WPA_REPLAY_COUNTER_LEN);
   1498 	sm->key_replay[0].valid = TRUE;
   1499 
   1500 	if (nonce)
   1501 		os_memcpy(key->key_nonce, nonce, WPA_NONCE_LEN);
   1502 
   1503 	if (key_rsc)
   1504 		os_memcpy(key->key_rsc, key_rsc, WPA_KEY_RSC_LEN);
   1505 
   1506 	if (kde && !encr) {
   1507 		os_memcpy(key_data, kde, kde_len);
   1508 		if (mic_len == 24)
   1509 			WPA_PUT_BE16(key192->key_data_length, kde_len);
   1510 		else
   1511 			WPA_PUT_BE16(key->key_data_length, kde_len);
   1512 	} else if (encr && kde) {
   1513 		buf = os_zalloc(key_data_len);
   1514 		if (buf == NULL) {
   1515 			os_free(hdr);
   1516 			return;
   1517 		}
   1518 		pos = buf;
   1519 		os_memcpy(pos, kde, kde_len);
   1520 		pos += kde_len;
   1521 
   1522 		if (pad_len)
   1523 			*pos++ = 0xdd;
   1524 
   1525 		wpa_hexdump_key(MSG_DEBUG, "Plaintext EAPOL-Key Key Data",
   1526 				buf, key_data_len);
   1527 		if (version == WPA_KEY_INFO_TYPE_HMAC_SHA1_AES ||
   1528 		    sm->wpa_key_mgmt == WPA_KEY_MGMT_OSEN ||
   1529 		    wpa_key_mgmt_suite_b(sm->wpa_key_mgmt) ||
   1530 		    version == WPA_KEY_INFO_TYPE_AES_128_CMAC) {
   1531 			if (aes_wrap(sm->PTK.kek, sm->PTK.kek_len,
   1532 				     (key_data_len - 8) / 8, buf, key_data)) {
   1533 				os_free(hdr);
   1534 				os_free(buf);
   1535 				return;
   1536 			}
   1537 			if (mic_len == 24)
   1538 				WPA_PUT_BE16(key192->key_data_length,
   1539 					     key_data_len);
   1540 			else
   1541 				WPA_PUT_BE16(key->key_data_length,
   1542 					     key_data_len);
   1543 		} else if (sm->PTK.kek_len == 16) {
   1544 			u8 ek[32];
   1545 			os_memcpy(key->key_iv,
   1546 				  sm->group->Counter + WPA_NONCE_LEN - 16, 16);
   1547 			inc_byte_array(sm->group->Counter, WPA_NONCE_LEN);
   1548 			os_memcpy(ek, key->key_iv, 16);
   1549 			os_memcpy(ek + 16, sm->PTK.kek, sm->PTK.kek_len);
   1550 			os_memcpy(key_data, buf, key_data_len);
   1551 			rc4_skip(ek, 32, 256, key_data, key_data_len);
   1552 			if (mic_len == 24)
   1553 				WPA_PUT_BE16(key192->key_data_length,
   1554 					     key_data_len);
   1555 			else
   1556 				WPA_PUT_BE16(key->key_data_length,
   1557 					     key_data_len);
   1558 		} else {
   1559 			os_free(hdr);
   1560 			os_free(buf);
   1561 			return;
   1562 		}
   1563 		os_free(buf);
   1564 	}
   1565 
   1566 	if (key_info & WPA_KEY_INFO_MIC) {
   1567 		u8 *key_mic;
   1568 
   1569 		if (!sm->PTK_valid) {
   1570 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG,
   1571 					"PTK not valid when sending EAPOL-Key "
   1572 					"frame");
   1573 			os_free(hdr);
   1574 			return;
   1575 		}
   1576 
   1577 		key_mic = key192->key_mic; /* same offset for key and key192 */
   1578 		wpa_eapol_key_mic(sm->PTK.kck, sm->PTK.kck_len,
   1579 				  sm->wpa_key_mgmt, version,
   1580 				  (u8 *) hdr, len, key_mic);
   1581 #ifdef CONFIG_TESTING_OPTIONS
   1582 		if (!pairwise &&
   1583 		    wpa_auth->conf.corrupt_gtk_rekey_mic_probability > 0.0 &&
   1584 		    drand48() <
   1585 		    wpa_auth->conf.corrupt_gtk_rekey_mic_probability) {
   1586 			wpa_auth_logger(wpa_auth, sm->addr, LOGGER_INFO,
   1587 					"Corrupting group EAPOL-Key Key MIC");
   1588 			key_mic[0]++;
   1589 		}
   1590 #endif /* CONFIG_TESTING_OPTIONS */
   1591 	}
   1592 
   1593 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_inc_EapolFramesTx,
   1594 			   1);
   1595 	wpa_auth_send_eapol(wpa_auth, sm->addr, (u8 *) hdr, len,
   1596 			    sm->pairwise_set);
   1597 	os_free(hdr);
   1598 }
   1599 
   1600 
   1601 static void wpa_send_eapol(struct wpa_authenticator *wpa_auth,
   1602 			   struct wpa_state_machine *sm, int key_info,
   1603 			   const u8 *key_rsc, const u8 *nonce,
   1604 			   const u8 *kde, size_t kde_len,
   1605 			   int keyidx, int encr)
   1606 {
   1607 	int timeout_ms;
   1608 	int pairwise = key_info & WPA_KEY_INFO_KEY_TYPE;
   1609 	int ctr;
   1610 
   1611 	if (sm == NULL)
   1612 		return;
   1613 
   1614 	__wpa_send_eapol(wpa_auth, sm, key_info, key_rsc, nonce, kde, kde_len,
   1615 			 keyidx, encr, 0);
   1616 
   1617 	ctr = pairwise ? sm->TimeoutCtr : sm->GTimeoutCtr;
   1618 	if (ctr == 1 && wpa_auth->conf.tx_status)
   1619 		timeout_ms = pairwise ? eapol_key_timeout_first :
   1620 			eapol_key_timeout_first_group;
   1621 	else
   1622 		timeout_ms = eapol_key_timeout_subseq;
   1623 	if (pairwise && ctr == 1 && !(key_info & WPA_KEY_INFO_MIC))
   1624 		sm->pending_1_of_4_timeout = 1;
   1625 	wpa_printf(MSG_DEBUG, "WPA: Use EAPOL-Key timeout of %u ms (retry "
   1626 		   "counter %d)", timeout_ms, ctr);
   1627 	eloop_register_timeout(timeout_ms / 1000, (timeout_ms % 1000) * 1000,
   1628 			       wpa_send_eapol_timeout, wpa_auth, sm);
   1629 }
   1630 
   1631 
   1632 static int wpa_verify_key_mic(int akmp, struct wpa_ptk *PTK, u8 *data,
   1633 			      size_t data_len)
   1634 {
   1635 	struct ieee802_1x_hdr *hdr;
   1636 	struct wpa_eapol_key *key;
   1637 	struct wpa_eapol_key_192 *key192;
   1638 	u16 key_info;
   1639 	int ret = 0;
   1640 	u8 mic[WPA_EAPOL_KEY_MIC_MAX_LEN];
   1641 	size_t mic_len = wpa_mic_len(akmp);
   1642 
   1643 	if (data_len < sizeof(*hdr) + sizeof(*key))
   1644 		return -1;
   1645 
   1646 	hdr = (struct ieee802_1x_hdr *) data;
   1647 	key = (struct wpa_eapol_key *) (hdr + 1);
   1648 	key192 = (struct wpa_eapol_key_192 *) (hdr + 1);
   1649 	key_info = WPA_GET_BE16(key->key_info);
   1650 	os_memcpy(mic, key192->key_mic, mic_len);
   1651 	os_memset(key192->key_mic, 0, mic_len);
   1652 	if (wpa_eapol_key_mic(PTK->kck, PTK->kck_len, akmp,
   1653 			      key_info & WPA_KEY_INFO_TYPE_MASK,
   1654 			      data, data_len, key192->key_mic) ||
   1655 	    os_memcmp_const(mic, key192->key_mic, mic_len) != 0)
   1656 		ret = -1;
   1657 	os_memcpy(key192->key_mic, mic, mic_len);
   1658 	return ret;
   1659 }
   1660 
   1661 
   1662 void wpa_remove_ptk(struct wpa_state_machine *sm)
   1663 {
   1664 	sm->PTK_valid = FALSE;
   1665 	os_memset(&sm->PTK, 0, sizeof(sm->PTK));
   1666 	wpa_auth_set_key(sm->wpa_auth, 0, WPA_ALG_NONE, sm->addr, 0, NULL, 0);
   1667 	sm->pairwise_set = FALSE;
   1668 	eloop_cancel_timeout(wpa_rekey_ptk, sm->wpa_auth, sm);
   1669 }
   1670 
   1671 
   1672 int wpa_auth_sm_event(struct wpa_state_machine *sm, wpa_event event)
   1673 {
   1674 	int remove_ptk = 1;
   1675 
   1676 	if (sm == NULL)
   1677 		return -1;
   1678 
   1679 	wpa_auth_vlogger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   1680 			 "event %d notification", event);
   1681 
   1682 	switch (event) {
   1683 	case WPA_AUTH:
   1684 #ifdef CONFIG_MESH
   1685 		/* PTKs are derived through AMPE */
   1686 		if (wpa_auth_start_ampe(sm->wpa_auth, sm->addr)) {
   1687 			/* not mesh */
   1688 			break;
   1689 		}
   1690 		return 0;
   1691 #endif /* CONFIG_MESH */
   1692 	case WPA_ASSOC:
   1693 		break;
   1694 	case WPA_DEAUTH:
   1695 	case WPA_DISASSOC:
   1696 		sm->DeauthenticationRequest = TRUE;
   1697 		break;
   1698 	case WPA_REAUTH:
   1699 	case WPA_REAUTH_EAPOL:
   1700 		if (!sm->started) {
   1701 			/*
   1702 			 * When using WPS, we may end up here if the STA
   1703 			 * manages to re-associate without the previous STA
   1704 			 * entry getting removed. Consequently, we need to make
   1705 			 * sure that the WPA state machines gets initialized
   1706 			 * properly at this point.
   1707 			 */
   1708 			wpa_printf(MSG_DEBUG, "WPA state machine had not been "
   1709 				   "started - initialize now");
   1710 			sm->started = 1;
   1711 			sm->Init = TRUE;
   1712 			if (wpa_sm_step(sm) == 1)
   1713 				return 1; /* should not really happen */
   1714 			sm->Init = FALSE;
   1715 			sm->AuthenticationRequest = TRUE;
   1716 			break;
   1717 		}
   1718 		if (sm->GUpdateStationKeys) {
   1719 			/*
   1720 			 * Reauthentication cancels the pending group key
   1721 			 * update for this STA.
   1722 			 */
   1723 			sm->group->GKeyDoneStations--;
   1724 			sm->GUpdateStationKeys = FALSE;
   1725 			sm->PtkGroupInit = TRUE;
   1726 		}
   1727 		sm->ReAuthenticationRequest = TRUE;
   1728 		break;
   1729 	case WPA_ASSOC_FT:
   1730 #ifdef CONFIG_IEEE80211R
   1731 		wpa_printf(MSG_DEBUG, "FT: Retry PTK configuration "
   1732 			   "after association");
   1733 		wpa_ft_install_ptk(sm);
   1734 
   1735 		/* Using FT protocol, not WPA auth state machine */
   1736 		sm->ft_completed = 1;
   1737 		return 0;
   1738 #else /* CONFIG_IEEE80211R */
   1739 		break;
   1740 #endif /* CONFIG_IEEE80211R */
   1741 	}
   1742 
   1743 #ifdef CONFIG_IEEE80211R
   1744 	sm->ft_completed = 0;
   1745 #endif /* CONFIG_IEEE80211R */
   1746 
   1747 #ifdef CONFIG_IEEE80211W
   1748 	if (sm->mgmt_frame_prot && event == WPA_AUTH)
   1749 		remove_ptk = 0;
   1750 #endif /* CONFIG_IEEE80211W */
   1751 
   1752 	if (remove_ptk) {
   1753 		sm->PTK_valid = FALSE;
   1754 		os_memset(&sm->PTK, 0, sizeof(sm->PTK));
   1755 
   1756 		if (event != WPA_REAUTH_EAPOL)
   1757 			wpa_remove_ptk(sm);
   1758 	}
   1759 
   1760 	return wpa_sm_step(sm);
   1761 }
   1762 
   1763 
   1764 SM_STATE(WPA_PTK, INITIALIZE)
   1765 {
   1766 	SM_ENTRY_MA(WPA_PTK, INITIALIZE, wpa_ptk);
   1767 	if (sm->Init) {
   1768 		/* Init flag is not cleared here, so avoid busy
   1769 		 * loop by claiming nothing changed. */
   1770 		sm->changed = FALSE;
   1771 	}
   1772 
   1773 	sm->keycount = 0;
   1774 	if (sm->GUpdateStationKeys)
   1775 		sm->group->GKeyDoneStations--;
   1776 	sm->GUpdateStationKeys = FALSE;
   1777 	if (sm->wpa == WPA_VERSION_WPA)
   1778 		sm->PInitAKeys = FALSE;
   1779 	if (1 /* Unicast cipher supported AND (ESS OR ((IBSS or WDS) and
   1780 	       * Local AA > Remote AA)) */) {
   1781 		sm->Pair = TRUE;
   1782 	}
   1783 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_portEnabled, 0);
   1784 	wpa_remove_ptk(sm);
   1785 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_portValid, 0);
   1786 	sm->TimeoutCtr = 0;
   1787 	if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)) {
   1788 		wpa_auth_set_eapol(sm->wpa_auth, sm->addr,
   1789 				   WPA_EAPOL_authorized, 0);
   1790 	}
   1791 }
   1792 
   1793 
   1794 SM_STATE(WPA_PTK, DISCONNECT)
   1795 {
   1796 	SM_ENTRY_MA(WPA_PTK, DISCONNECT, wpa_ptk);
   1797 	sm->Disconnect = FALSE;
   1798 	wpa_sta_disconnect(sm->wpa_auth, sm->addr);
   1799 }
   1800 
   1801 
   1802 SM_STATE(WPA_PTK, DISCONNECTED)
   1803 {
   1804 	SM_ENTRY_MA(WPA_PTK, DISCONNECTED, wpa_ptk);
   1805 	sm->DeauthenticationRequest = FALSE;
   1806 }
   1807 
   1808 
   1809 SM_STATE(WPA_PTK, AUTHENTICATION)
   1810 {
   1811 	SM_ENTRY_MA(WPA_PTK, AUTHENTICATION, wpa_ptk);
   1812 	os_memset(&sm->PTK, 0, sizeof(sm->PTK));
   1813 	sm->PTK_valid = FALSE;
   1814 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_portControl_Auto,
   1815 			   1);
   1816 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_portEnabled, 1);
   1817 	sm->AuthenticationRequest = FALSE;
   1818 }
   1819 
   1820 
   1821 static void wpa_group_ensure_init(struct wpa_authenticator *wpa_auth,
   1822 				  struct wpa_group *group)
   1823 {
   1824 	if (group->first_sta_seen)
   1825 		return;
   1826 	/*
   1827 	 * System has run bit further than at the time hostapd was started
   1828 	 * potentially very early during boot up. This provides better chances
   1829 	 * of collecting more randomness on embedded systems. Re-initialize the
   1830 	 * GMK and Counter here to improve their strength if there was not
   1831 	 * enough entropy available immediately after system startup.
   1832 	 */
   1833 	wpa_printf(MSG_DEBUG, "WPA: Re-initialize GMK/Counter on first "
   1834 		   "station");
   1835 	if (random_pool_ready() != 1) {
   1836 		wpa_printf(MSG_INFO, "WPA: Not enough entropy in random pool "
   1837 			   "to proceed - reject first 4-way handshake");
   1838 		group->reject_4way_hs_for_entropy = TRUE;
   1839 	} else {
   1840 		group->first_sta_seen = TRUE;
   1841 		group->reject_4way_hs_for_entropy = FALSE;
   1842 	}
   1843 
   1844 	wpa_group_init_gmk_and_counter(wpa_auth, group);
   1845 	wpa_gtk_update(wpa_auth, group);
   1846 	wpa_group_config_group_keys(wpa_auth, group);
   1847 }
   1848 
   1849 
   1850 SM_STATE(WPA_PTK, AUTHENTICATION2)
   1851 {
   1852 	SM_ENTRY_MA(WPA_PTK, AUTHENTICATION2, wpa_ptk);
   1853 
   1854 	wpa_group_ensure_init(sm->wpa_auth, sm->group);
   1855 	sm->ReAuthenticationRequest = FALSE;
   1856 
   1857 	/*
   1858 	 * Definition of ANonce selection in IEEE Std 802.11i-2004 is somewhat
   1859 	 * ambiguous. The Authenticator state machine uses a counter that is
   1860 	 * incremented by one for each 4-way handshake. However, the security
   1861 	 * analysis of 4-way handshake points out that unpredictable nonces
   1862 	 * help in preventing precomputation attacks. Instead of the state
   1863 	 * machine definition, use an unpredictable nonce value here to provide
   1864 	 * stronger protection against potential precomputation attacks.
   1865 	 */
   1866 	if (random_get_bytes(sm->ANonce, WPA_NONCE_LEN)) {
   1867 		wpa_printf(MSG_ERROR, "WPA: Failed to get random data for "
   1868 			   "ANonce.");
   1869 		sm->Disconnect = TRUE;
   1870 		return;
   1871 	}
   1872 	wpa_hexdump(MSG_DEBUG, "WPA: Assign ANonce", sm->ANonce,
   1873 		    WPA_NONCE_LEN);
   1874 	/* IEEE 802.11i does not clear TimeoutCtr here, but this is more
   1875 	 * logical place than INITIALIZE since AUTHENTICATION2 can be
   1876 	 * re-entered on ReAuthenticationRequest without going through
   1877 	 * INITIALIZE. */
   1878 	sm->TimeoutCtr = 0;
   1879 }
   1880 
   1881 
   1882 SM_STATE(WPA_PTK, INITPMK)
   1883 {
   1884 	u8 msk[2 * PMK_LEN];
   1885 	size_t len = 2 * PMK_LEN;
   1886 
   1887 	SM_ENTRY_MA(WPA_PTK, INITPMK, wpa_ptk);
   1888 #ifdef CONFIG_IEEE80211R
   1889 	sm->xxkey_len = 0;
   1890 #endif /* CONFIG_IEEE80211R */
   1891 	if (sm->pmksa) {
   1892 		wpa_printf(MSG_DEBUG, "WPA: PMK from PMKSA cache");
   1893 		os_memcpy(sm->PMK, sm->pmksa->pmk, PMK_LEN);
   1894 	} else if (wpa_auth_get_msk(sm->wpa_auth, sm->addr, msk, &len) == 0) {
   1895 		wpa_printf(MSG_DEBUG, "WPA: PMK from EAPOL state machine "
   1896 			   "(len=%lu)", (unsigned long) len);
   1897 		os_memcpy(sm->PMK, msk, PMK_LEN);
   1898 #ifdef CONFIG_IEEE80211R
   1899 		if (len >= 2 * PMK_LEN) {
   1900 			os_memcpy(sm->xxkey, msk + PMK_LEN, PMK_LEN);
   1901 			sm->xxkey_len = PMK_LEN;
   1902 		}
   1903 #endif /* CONFIG_IEEE80211R */
   1904 	} else {
   1905 		wpa_printf(MSG_DEBUG, "WPA: Could not get PMK, get_msk: %p",
   1906 			   sm->wpa_auth->cb.get_msk);
   1907 		sm->Disconnect = TRUE;
   1908 		return;
   1909 	}
   1910 	os_memset(msk, 0, sizeof(msk));
   1911 
   1912 	sm->req_replay_counter_used = 0;
   1913 	/* IEEE 802.11i does not set keyRun to FALSE, but not doing this
   1914 	 * will break reauthentication since EAPOL state machines may not be
   1915 	 * get into AUTHENTICATING state that clears keyRun before WPA state
   1916 	 * machine enters AUTHENTICATION2 state and goes immediately to INITPMK
   1917 	 * state and takes PMK from the previously used AAA Key. This will
   1918 	 * eventually fail in 4-Way Handshake because Supplicant uses PMK
   1919 	 * derived from the new AAA Key. Setting keyRun = FALSE here seems to
   1920 	 * be good workaround for this issue. */
   1921 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_keyRun, 0);
   1922 }
   1923 
   1924 
   1925 SM_STATE(WPA_PTK, INITPSK)
   1926 {
   1927 	const u8 *psk;
   1928 	SM_ENTRY_MA(WPA_PTK, INITPSK, wpa_ptk);
   1929 	psk = wpa_auth_get_psk(sm->wpa_auth, sm->addr, sm->p2p_dev_addr, NULL);
   1930 	if (psk) {
   1931 		os_memcpy(sm->PMK, psk, PMK_LEN);
   1932 #ifdef CONFIG_IEEE80211R
   1933 		os_memcpy(sm->xxkey, psk, PMK_LEN);
   1934 		sm->xxkey_len = PMK_LEN;
   1935 #endif /* CONFIG_IEEE80211R */
   1936 	}
   1937 	sm->req_replay_counter_used = 0;
   1938 }
   1939 
   1940 
   1941 SM_STATE(WPA_PTK, PTKSTART)
   1942 {
   1943 	u8 buf[2 + RSN_SELECTOR_LEN + PMKID_LEN], *pmkid = NULL;
   1944 	size_t pmkid_len = 0;
   1945 
   1946 	SM_ENTRY_MA(WPA_PTK, PTKSTART, wpa_ptk);
   1947 	sm->PTKRequest = FALSE;
   1948 	sm->TimeoutEvt = FALSE;
   1949 	sm->alt_snonce_valid = FALSE;
   1950 
   1951 	sm->TimeoutCtr++;
   1952 	if (sm->TimeoutCtr > (int) dot11RSNAConfigPairwiseUpdateCount) {
   1953 		/* No point in sending the EAPOL-Key - we will disconnect
   1954 		 * immediately following this. */
   1955 		return;
   1956 	}
   1957 
   1958 	wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   1959 			"sending 1/4 msg of 4-Way Handshake");
   1960 	/*
   1961 	 * TODO: Could add PMKID even with WPA2-PSK, but only if there is only
   1962 	 * one possible PSK for this STA.
   1963 	 */
   1964 	if (sm->wpa == WPA_VERSION_WPA2 &&
   1965 	    wpa_key_mgmt_wpa_ieee8021x(sm->wpa_key_mgmt) &&
   1966 	    sm->wpa_key_mgmt != WPA_KEY_MGMT_OSEN) {
   1967 		pmkid = buf;
   1968 		pmkid_len = 2 + RSN_SELECTOR_LEN + PMKID_LEN;
   1969 		pmkid[0] = WLAN_EID_VENDOR_SPECIFIC;
   1970 		pmkid[1] = RSN_SELECTOR_LEN + PMKID_LEN;
   1971 		RSN_SELECTOR_PUT(&pmkid[2], RSN_KEY_DATA_PMKID);
   1972 		if (sm->pmksa) {
   1973 			os_memcpy(&pmkid[2 + RSN_SELECTOR_LEN],
   1974 				  sm->pmksa->pmkid, PMKID_LEN);
   1975 		} else if (wpa_key_mgmt_suite_b(sm->wpa_key_mgmt)) {
   1976 			/* No KCK available to derive PMKID */
   1977 			pmkid = NULL;
   1978 		} else {
   1979 			/*
   1980 			 * Calculate PMKID since no PMKSA cache entry was
   1981 			 * available with pre-calculated PMKID.
   1982 			 */
   1983 			rsn_pmkid(sm->PMK, PMK_LEN, sm->wpa_auth->addr,
   1984 				  sm->addr, &pmkid[2 + RSN_SELECTOR_LEN],
   1985 				  wpa_key_mgmt_sha256(sm->wpa_key_mgmt));
   1986 		}
   1987 	}
   1988 	wpa_send_eapol(sm->wpa_auth, sm,
   1989 		       WPA_KEY_INFO_ACK | WPA_KEY_INFO_KEY_TYPE, NULL,
   1990 		       sm->ANonce, pmkid, pmkid_len, 0, 0);
   1991 }
   1992 
   1993 
   1994 static int wpa_derive_ptk(struct wpa_state_machine *sm, const u8 *snonce,
   1995 			  const u8 *pmk, struct wpa_ptk *ptk)
   1996 {
   1997 #ifdef CONFIG_IEEE80211R
   1998 	if (wpa_key_mgmt_ft(sm->wpa_key_mgmt))
   1999 		return wpa_auth_derive_ptk_ft(sm, pmk, ptk);
   2000 #endif /* CONFIG_IEEE80211R */
   2001 
   2002 	return wpa_pmk_to_ptk(pmk, PMK_LEN, "Pairwise key expansion",
   2003 			      sm->wpa_auth->addr, sm->addr, sm->ANonce, snonce,
   2004 			      ptk, sm->wpa_key_mgmt, sm->pairwise);
   2005 }
   2006 
   2007 
   2008 SM_STATE(WPA_PTK, PTKCALCNEGOTIATING)
   2009 {
   2010 	struct wpa_ptk PTK;
   2011 	int ok = 0, psk_found = 0;
   2012 	const u8 *pmk = NULL;
   2013 
   2014 	SM_ENTRY_MA(WPA_PTK, PTKCALCNEGOTIATING, wpa_ptk);
   2015 	sm->EAPOLKeyReceived = FALSE;
   2016 	sm->update_snonce = FALSE;
   2017 
   2018 	/* WPA with IEEE 802.1X: use the derived PMK from EAP
   2019 	 * WPA-PSK: iterate through possible PSKs and select the one matching
   2020 	 * the packet */
   2021 	for (;;) {
   2022 		if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)) {
   2023 			pmk = wpa_auth_get_psk(sm->wpa_auth, sm->addr,
   2024 					       sm->p2p_dev_addr, pmk);
   2025 			if (pmk == NULL)
   2026 				break;
   2027 			psk_found = 1;
   2028 		} else
   2029 			pmk = sm->PMK;
   2030 
   2031 		wpa_derive_ptk(sm, sm->SNonce, pmk, &PTK);
   2032 
   2033 		if (wpa_verify_key_mic(sm->wpa_key_mgmt, &PTK,
   2034 				       sm->last_rx_eapol_key,
   2035 				       sm->last_rx_eapol_key_len) == 0) {
   2036 			ok = 1;
   2037 			break;
   2038 		}
   2039 
   2040 		if (!wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt))
   2041 			break;
   2042 	}
   2043 
   2044 	if (!ok) {
   2045 		wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2046 				"invalid MIC in msg 2/4 of 4-Way Handshake");
   2047 		if (psk_found)
   2048 			wpa_auth_psk_failure_report(sm->wpa_auth, sm->addr);
   2049 		return;
   2050 	}
   2051 
   2052 #ifdef CONFIG_IEEE80211R
   2053 	if (sm->wpa == WPA_VERSION_WPA2 && wpa_key_mgmt_ft(sm->wpa_key_mgmt)) {
   2054 		/*
   2055 		 * Verify that PMKR1Name from EAPOL-Key message 2/4 matches
   2056 		 * with the value we derived.
   2057 		 */
   2058 		if (os_memcmp_const(sm->sup_pmk_r1_name, sm->pmk_r1_name,
   2059 				    WPA_PMK_NAME_LEN) != 0) {
   2060 			wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2061 					"PMKR1Name mismatch in FT 4-way "
   2062 					"handshake");
   2063 			wpa_hexdump(MSG_DEBUG, "FT: PMKR1Name from "
   2064 				    "Supplicant",
   2065 				    sm->sup_pmk_r1_name, WPA_PMK_NAME_LEN);
   2066 			wpa_hexdump(MSG_DEBUG, "FT: Derived PMKR1Name",
   2067 				    sm->pmk_r1_name, WPA_PMK_NAME_LEN);
   2068 			return;
   2069 		}
   2070 	}
   2071 #endif /* CONFIG_IEEE80211R */
   2072 
   2073 	sm->pending_1_of_4_timeout = 0;
   2074 	eloop_cancel_timeout(wpa_send_eapol_timeout, sm->wpa_auth, sm);
   2075 
   2076 	if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)) {
   2077 		/* PSK may have changed from the previous choice, so update
   2078 		 * state machine data based on whatever PSK was selected here.
   2079 		 */
   2080 		os_memcpy(sm->PMK, pmk, PMK_LEN);
   2081 	}
   2082 
   2083 	sm->MICVerified = TRUE;
   2084 
   2085 	os_memcpy(&sm->PTK, &PTK, sizeof(PTK));
   2086 	sm->PTK_valid = TRUE;
   2087 }
   2088 
   2089 
   2090 SM_STATE(WPA_PTK, PTKCALCNEGOTIATING2)
   2091 {
   2092 	SM_ENTRY_MA(WPA_PTK, PTKCALCNEGOTIATING2, wpa_ptk);
   2093 	sm->TimeoutCtr = 0;
   2094 }
   2095 
   2096 
   2097 #ifdef CONFIG_IEEE80211W
   2098 
   2099 static int ieee80211w_kde_len(struct wpa_state_machine *sm)
   2100 {
   2101 	if (sm->mgmt_frame_prot) {
   2102 		size_t len;
   2103 		len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
   2104 		return 2 + RSN_SELECTOR_LEN + WPA_IGTK_KDE_PREFIX_LEN + len;
   2105 	}
   2106 
   2107 	return 0;
   2108 }
   2109 
   2110 
   2111 static u8 * ieee80211w_kde_add(struct wpa_state_machine *sm, u8 *pos)
   2112 {
   2113 	struct wpa_igtk_kde igtk;
   2114 	struct wpa_group *gsm = sm->group;
   2115 	u8 rsc[WPA_KEY_RSC_LEN];
   2116 	size_t len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
   2117 
   2118 	if (!sm->mgmt_frame_prot)
   2119 		return pos;
   2120 
   2121 	igtk.keyid[0] = gsm->GN_igtk;
   2122 	igtk.keyid[1] = 0;
   2123 	if (gsm->wpa_group_state != WPA_GROUP_SETKEYSDONE ||
   2124 	    wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_igtk, rsc) < 0)
   2125 		os_memset(igtk.pn, 0, sizeof(igtk.pn));
   2126 	else
   2127 		os_memcpy(igtk.pn, rsc, sizeof(igtk.pn));
   2128 	os_memcpy(igtk.igtk, gsm->IGTK[gsm->GN_igtk - 4], len);
   2129 	if (sm->wpa_auth->conf.disable_gtk) {
   2130 		/*
   2131 		 * Provide unique random IGTK to each STA to prevent use of
   2132 		 * IGTK in the BSS.
   2133 		 */
   2134 		if (random_get_bytes(igtk.igtk, len) < 0)
   2135 			return pos;
   2136 	}
   2137 	pos = wpa_add_kde(pos, RSN_KEY_DATA_IGTK,
   2138 			  (const u8 *) &igtk, WPA_IGTK_KDE_PREFIX_LEN + len,
   2139 			  NULL, 0);
   2140 
   2141 	return pos;
   2142 }
   2143 
   2144 #else /* CONFIG_IEEE80211W */
   2145 
   2146 static int ieee80211w_kde_len(struct wpa_state_machine *sm)
   2147 {
   2148 	return 0;
   2149 }
   2150 
   2151 
   2152 static u8 * ieee80211w_kde_add(struct wpa_state_machine *sm, u8 *pos)
   2153 {
   2154 	return pos;
   2155 }
   2156 
   2157 #endif /* CONFIG_IEEE80211W */
   2158 
   2159 
   2160 SM_STATE(WPA_PTK, PTKINITNEGOTIATING)
   2161 {
   2162 	u8 rsc[WPA_KEY_RSC_LEN], *_rsc, *gtk, *kde, *pos, dummy_gtk[32];
   2163 	size_t gtk_len, kde_len;
   2164 	struct wpa_group *gsm = sm->group;
   2165 	u8 *wpa_ie;
   2166 	int wpa_ie_len, secure, keyidx, encr = 0;
   2167 
   2168 	SM_ENTRY_MA(WPA_PTK, PTKINITNEGOTIATING, wpa_ptk);
   2169 	sm->TimeoutEvt = FALSE;
   2170 
   2171 	sm->TimeoutCtr++;
   2172 	if (sm->TimeoutCtr > (int) dot11RSNAConfigPairwiseUpdateCount) {
   2173 		/* No point in sending the EAPOL-Key - we will disconnect
   2174 		 * immediately following this. */
   2175 		return;
   2176 	}
   2177 
   2178 	/* Send EAPOL(1, 1, 1, Pair, P, RSC, ANonce, MIC(PTK), RSNIE, [MDIE],
   2179 	   GTK[GN], IGTK, [FTIE], [TIE * 2])
   2180 	 */
   2181 	os_memset(rsc, 0, WPA_KEY_RSC_LEN);
   2182 	wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN, rsc);
   2183 	/* If FT is used, wpa_auth->wpa_ie includes both RSNIE and MDIE */
   2184 	wpa_ie = sm->wpa_auth->wpa_ie;
   2185 	wpa_ie_len = sm->wpa_auth->wpa_ie_len;
   2186 	if (sm->wpa == WPA_VERSION_WPA &&
   2187 	    (sm->wpa_auth->conf.wpa & WPA_PROTO_RSN) &&
   2188 	    wpa_ie_len > wpa_ie[1] + 2 && wpa_ie[0] == WLAN_EID_RSN) {
   2189 		/* WPA-only STA, remove RSN IE and possible MDIE */
   2190 		wpa_ie = wpa_ie + wpa_ie[1] + 2;
   2191 		if (wpa_ie[0] == WLAN_EID_MOBILITY_DOMAIN)
   2192 			wpa_ie = wpa_ie + wpa_ie[1] + 2;
   2193 		wpa_ie_len = wpa_ie[1] + 2;
   2194 	}
   2195 	wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2196 			"sending 3/4 msg of 4-Way Handshake");
   2197 	if (sm->wpa == WPA_VERSION_WPA2) {
   2198 		/* WPA2 send GTK in the 4-way handshake */
   2199 		secure = 1;
   2200 		gtk = gsm->GTK[gsm->GN - 1];
   2201 		gtk_len = gsm->GTK_len;
   2202 		if (sm->wpa_auth->conf.disable_gtk) {
   2203 			/*
   2204 			 * Provide unique random GTK to each STA to prevent use
   2205 			 * of GTK in the BSS.
   2206 			 */
   2207 			if (random_get_bytes(dummy_gtk, gtk_len) < 0)
   2208 				return;
   2209 			gtk = dummy_gtk;
   2210 		}
   2211 		keyidx = gsm->GN;
   2212 		_rsc = rsc;
   2213 		encr = 1;
   2214 	} else {
   2215 		/* WPA does not include GTK in msg 3/4 */
   2216 		secure = 0;
   2217 		gtk = NULL;
   2218 		gtk_len = 0;
   2219 		keyidx = 0;
   2220 		_rsc = NULL;
   2221 		if (sm->rx_eapol_key_secure) {
   2222 			/*
   2223 			 * It looks like Windows 7 supplicant tries to use
   2224 			 * Secure bit in msg 2/4 after having reported Michael
   2225 			 * MIC failure and it then rejects the 4-way handshake
   2226 			 * if msg 3/4 does not set Secure bit. Work around this
   2227 			 * by setting the Secure bit here even in the case of
   2228 			 * WPA if the supplicant used it first.
   2229 			 */
   2230 			wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2231 					"STA used Secure bit in WPA msg 2/4 - "
   2232 					"set Secure for 3/4 as workaround");
   2233 			secure = 1;
   2234 		}
   2235 	}
   2236 
   2237 	kde_len = wpa_ie_len + ieee80211w_kde_len(sm);
   2238 	if (gtk)
   2239 		kde_len += 2 + RSN_SELECTOR_LEN + 2 + gtk_len;
   2240 #ifdef CONFIG_IEEE80211R
   2241 	if (wpa_key_mgmt_ft(sm->wpa_key_mgmt)) {
   2242 		kde_len += 2 + PMKID_LEN; /* PMKR1Name into RSN IE */
   2243 		kde_len += 300; /* FTIE + 2 * TIE */
   2244 	}
   2245 #endif /* CONFIG_IEEE80211R */
   2246 #ifdef CONFIG_P2P
   2247 	if (WPA_GET_BE32(sm->ip_addr) > 0)
   2248 		kde_len += 2 + RSN_SELECTOR_LEN + 3 * 4;
   2249 #endif /* CONFIG_P2P */
   2250 	kde = os_malloc(kde_len);
   2251 	if (kde == NULL)
   2252 		return;
   2253 
   2254 	pos = kde;
   2255 	os_memcpy(pos, wpa_ie, wpa_ie_len);
   2256 	pos += wpa_ie_len;
   2257 #ifdef CONFIG_IEEE80211R
   2258 	if (wpa_key_mgmt_ft(sm->wpa_key_mgmt)) {
   2259 		int res = wpa_insert_pmkid(kde, pos - kde, sm->pmk_r1_name);
   2260 		if (res < 0) {
   2261 			wpa_printf(MSG_ERROR, "FT: Failed to insert "
   2262 				   "PMKR1Name into RSN IE in EAPOL-Key data");
   2263 			os_free(kde);
   2264 			return;
   2265 		}
   2266 		pos += res;
   2267 	}
   2268 #endif /* CONFIG_IEEE80211R */
   2269 	if (gtk) {
   2270 		u8 hdr[2];
   2271 		hdr[0] = keyidx & 0x03;
   2272 		hdr[1] = 0;
   2273 		pos = wpa_add_kde(pos, RSN_KEY_DATA_GROUPKEY, hdr, 2,
   2274 				  gtk, gtk_len);
   2275 	}
   2276 	pos = ieee80211w_kde_add(sm, pos);
   2277 
   2278 #ifdef CONFIG_IEEE80211R
   2279 	if (wpa_key_mgmt_ft(sm->wpa_key_mgmt)) {
   2280 		int res;
   2281 		struct wpa_auth_config *conf;
   2282 
   2283 		conf = &sm->wpa_auth->conf;
   2284 		res = wpa_write_ftie(conf, conf->r0_key_holder,
   2285 				     conf->r0_key_holder_len,
   2286 				     NULL, NULL, pos, kde + kde_len - pos,
   2287 				     NULL, 0);
   2288 		if (res < 0) {
   2289 			wpa_printf(MSG_ERROR, "FT: Failed to insert FTIE "
   2290 				   "into EAPOL-Key Key Data");
   2291 			os_free(kde);
   2292 			return;
   2293 		}
   2294 		pos += res;
   2295 
   2296 		/* TIE[ReassociationDeadline] (TU) */
   2297 		*pos++ = WLAN_EID_TIMEOUT_INTERVAL;
   2298 		*pos++ = 5;
   2299 		*pos++ = WLAN_TIMEOUT_REASSOC_DEADLINE;
   2300 		WPA_PUT_LE32(pos, conf->reassociation_deadline);
   2301 		pos += 4;
   2302 
   2303 		/* TIE[KeyLifetime] (seconds) */
   2304 		*pos++ = WLAN_EID_TIMEOUT_INTERVAL;
   2305 		*pos++ = 5;
   2306 		*pos++ = WLAN_TIMEOUT_KEY_LIFETIME;
   2307 		WPA_PUT_LE32(pos, conf->r0_key_lifetime * 60);
   2308 		pos += 4;
   2309 	}
   2310 #endif /* CONFIG_IEEE80211R */
   2311 #ifdef CONFIG_P2P
   2312 	if (WPA_GET_BE32(sm->ip_addr) > 0) {
   2313 		u8 addr[3 * 4];
   2314 		os_memcpy(addr, sm->ip_addr, 4);
   2315 		os_memcpy(addr + 4, sm->wpa_auth->conf.ip_addr_mask, 4);
   2316 		os_memcpy(addr + 8, sm->wpa_auth->conf.ip_addr_go, 4);
   2317 		pos = wpa_add_kde(pos, WFA_KEY_DATA_IP_ADDR_ALLOC,
   2318 				  addr, sizeof(addr), NULL, 0);
   2319 	}
   2320 #endif /* CONFIG_P2P */
   2321 
   2322 	wpa_send_eapol(sm->wpa_auth, sm,
   2323 		       (secure ? WPA_KEY_INFO_SECURE : 0) | WPA_KEY_INFO_MIC |
   2324 		       WPA_KEY_INFO_ACK | WPA_KEY_INFO_INSTALL |
   2325 		       WPA_KEY_INFO_KEY_TYPE,
   2326 		       _rsc, sm->ANonce, kde, pos - kde, keyidx, encr);
   2327 	os_free(kde);
   2328 }
   2329 
   2330 
   2331 SM_STATE(WPA_PTK, PTKINITDONE)
   2332 {
   2333 	SM_ENTRY_MA(WPA_PTK, PTKINITDONE, wpa_ptk);
   2334 	sm->EAPOLKeyReceived = FALSE;
   2335 	if (sm->Pair) {
   2336 		enum wpa_alg alg = wpa_cipher_to_alg(sm->pairwise);
   2337 		int klen = wpa_cipher_key_len(sm->pairwise);
   2338 		if (wpa_auth_set_key(sm->wpa_auth, 0, alg, sm->addr, 0,
   2339 				     sm->PTK.tk, klen)) {
   2340 			wpa_sta_disconnect(sm->wpa_auth, sm->addr);
   2341 			return;
   2342 		}
   2343 		/* FIX: MLME-SetProtection.Request(TA, Tx_Rx) */
   2344 		sm->pairwise_set = TRUE;
   2345 
   2346 		if (sm->wpa_auth->conf.wpa_ptk_rekey) {
   2347 			eloop_cancel_timeout(wpa_rekey_ptk, sm->wpa_auth, sm);
   2348 			eloop_register_timeout(sm->wpa_auth->conf.
   2349 					       wpa_ptk_rekey, 0, wpa_rekey_ptk,
   2350 					       sm->wpa_auth, sm);
   2351 		}
   2352 
   2353 		if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)) {
   2354 			wpa_auth_set_eapol(sm->wpa_auth, sm->addr,
   2355 					   WPA_EAPOL_authorized, 1);
   2356 		}
   2357 	}
   2358 
   2359 	if (0 /* IBSS == TRUE */) {
   2360 		sm->keycount++;
   2361 		if (sm->keycount == 2) {
   2362 			wpa_auth_set_eapol(sm->wpa_auth, sm->addr,
   2363 					   WPA_EAPOL_portValid, 1);
   2364 		}
   2365 	} else {
   2366 		wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_portValid,
   2367 				   1);
   2368 	}
   2369 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_keyAvailable, 0);
   2370 	wpa_auth_set_eapol(sm->wpa_auth, sm->addr, WPA_EAPOL_keyDone, 1);
   2371 	if (sm->wpa == WPA_VERSION_WPA)
   2372 		sm->PInitAKeys = TRUE;
   2373 	else
   2374 		sm->has_GTK = TRUE;
   2375 	wpa_auth_vlogger(sm->wpa_auth, sm->addr, LOGGER_INFO,
   2376 			 "pairwise key handshake completed (%s)",
   2377 			 sm->wpa == WPA_VERSION_WPA ? "WPA" : "RSN");
   2378 
   2379 #ifdef CONFIG_IEEE80211R
   2380 	wpa_ft_push_pmk_r1(sm->wpa_auth, sm->addr);
   2381 #endif /* CONFIG_IEEE80211R */
   2382 }
   2383 
   2384 
   2385 SM_STEP(WPA_PTK)
   2386 {
   2387 	struct wpa_authenticator *wpa_auth = sm->wpa_auth;
   2388 
   2389 	if (sm->Init)
   2390 		SM_ENTER(WPA_PTK, INITIALIZE);
   2391 	else if (sm->Disconnect
   2392 		 /* || FIX: dot11RSNAConfigSALifetime timeout */) {
   2393 		wpa_auth_logger(wpa_auth, sm->addr, LOGGER_DEBUG,
   2394 				"WPA_PTK: sm->Disconnect");
   2395 		SM_ENTER(WPA_PTK, DISCONNECT);
   2396 	}
   2397 	else if (sm->DeauthenticationRequest)
   2398 		SM_ENTER(WPA_PTK, DISCONNECTED);
   2399 	else if (sm->AuthenticationRequest)
   2400 		SM_ENTER(WPA_PTK, AUTHENTICATION);
   2401 	else if (sm->ReAuthenticationRequest)
   2402 		SM_ENTER(WPA_PTK, AUTHENTICATION2);
   2403 	else if (sm->PTKRequest)
   2404 		SM_ENTER(WPA_PTK, PTKSTART);
   2405 	else switch (sm->wpa_ptk_state) {
   2406 	case WPA_PTK_INITIALIZE:
   2407 		break;
   2408 	case WPA_PTK_DISCONNECT:
   2409 		SM_ENTER(WPA_PTK, DISCONNECTED);
   2410 		break;
   2411 	case WPA_PTK_DISCONNECTED:
   2412 		SM_ENTER(WPA_PTK, INITIALIZE);
   2413 		break;
   2414 	case WPA_PTK_AUTHENTICATION:
   2415 		SM_ENTER(WPA_PTK, AUTHENTICATION2);
   2416 		break;
   2417 	case WPA_PTK_AUTHENTICATION2:
   2418 		if (wpa_key_mgmt_wpa_ieee8021x(sm->wpa_key_mgmt) &&
   2419 		    wpa_auth_get_eapol(sm->wpa_auth, sm->addr,
   2420 				       WPA_EAPOL_keyRun) > 0)
   2421 			SM_ENTER(WPA_PTK, INITPMK);
   2422 		else if (wpa_key_mgmt_wpa_psk(sm->wpa_key_mgmt)
   2423 			 /* FIX: && 802.1X::keyRun */)
   2424 			SM_ENTER(WPA_PTK, INITPSK);
   2425 		break;
   2426 	case WPA_PTK_INITPMK:
   2427 		if (wpa_auth_get_eapol(sm->wpa_auth, sm->addr,
   2428 				       WPA_EAPOL_keyAvailable) > 0)
   2429 			SM_ENTER(WPA_PTK, PTKSTART);
   2430 		else {
   2431 			wpa_auth->dot11RSNA4WayHandshakeFailures++;
   2432 			wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_INFO,
   2433 					"INITPMK - keyAvailable = false");
   2434 			SM_ENTER(WPA_PTK, DISCONNECT);
   2435 		}
   2436 		break;
   2437 	case WPA_PTK_INITPSK:
   2438 		if (wpa_auth_get_psk(sm->wpa_auth, sm->addr, sm->p2p_dev_addr,
   2439 				     NULL))
   2440 			SM_ENTER(WPA_PTK, PTKSTART);
   2441 		else {
   2442 			wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_INFO,
   2443 					"no PSK configured for the STA");
   2444 			wpa_auth->dot11RSNA4WayHandshakeFailures++;
   2445 			SM_ENTER(WPA_PTK, DISCONNECT);
   2446 		}
   2447 		break;
   2448 	case WPA_PTK_PTKSTART:
   2449 		if (sm->EAPOLKeyReceived && !sm->EAPOLKeyRequest &&
   2450 		    sm->EAPOLKeyPairwise)
   2451 			SM_ENTER(WPA_PTK, PTKCALCNEGOTIATING);
   2452 		else if (sm->TimeoutCtr >
   2453 			 (int) dot11RSNAConfigPairwiseUpdateCount) {
   2454 			wpa_auth->dot11RSNA4WayHandshakeFailures++;
   2455 			wpa_auth_vlogger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2456 					 "PTKSTART: Retry limit %d reached",
   2457 					 dot11RSNAConfigPairwiseUpdateCount);
   2458 			SM_ENTER(WPA_PTK, DISCONNECT);
   2459 		} else if (sm->TimeoutEvt)
   2460 			SM_ENTER(WPA_PTK, PTKSTART);
   2461 		break;
   2462 	case WPA_PTK_PTKCALCNEGOTIATING:
   2463 		if (sm->MICVerified)
   2464 			SM_ENTER(WPA_PTK, PTKCALCNEGOTIATING2);
   2465 		else if (sm->EAPOLKeyReceived && !sm->EAPOLKeyRequest &&
   2466 			 sm->EAPOLKeyPairwise)
   2467 			SM_ENTER(WPA_PTK, PTKCALCNEGOTIATING);
   2468 		else if (sm->TimeoutEvt)
   2469 			SM_ENTER(WPA_PTK, PTKSTART);
   2470 		break;
   2471 	case WPA_PTK_PTKCALCNEGOTIATING2:
   2472 		SM_ENTER(WPA_PTK, PTKINITNEGOTIATING);
   2473 		break;
   2474 	case WPA_PTK_PTKINITNEGOTIATING:
   2475 		if (sm->update_snonce)
   2476 			SM_ENTER(WPA_PTK, PTKCALCNEGOTIATING);
   2477 		else if (sm->EAPOLKeyReceived && !sm->EAPOLKeyRequest &&
   2478 			 sm->EAPOLKeyPairwise && sm->MICVerified)
   2479 			SM_ENTER(WPA_PTK, PTKINITDONE);
   2480 		else if (sm->TimeoutCtr >
   2481 			 (int) dot11RSNAConfigPairwiseUpdateCount) {
   2482 			wpa_auth->dot11RSNA4WayHandshakeFailures++;
   2483 			wpa_auth_vlogger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2484 					 "PTKINITNEGOTIATING: Retry limit %d "
   2485 					 "reached",
   2486 					 dot11RSNAConfigPairwiseUpdateCount);
   2487 			SM_ENTER(WPA_PTK, DISCONNECT);
   2488 		} else if (sm->TimeoutEvt)
   2489 			SM_ENTER(WPA_PTK, PTKINITNEGOTIATING);
   2490 		break;
   2491 	case WPA_PTK_PTKINITDONE:
   2492 		break;
   2493 	}
   2494 }
   2495 
   2496 
   2497 SM_STATE(WPA_PTK_GROUP, IDLE)
   2498 {
   2499 	SM_ENTRY_MA(WPA_PTK_GROUP, IDLE, wpa_ptk_group);
   2500 	if (sm->Init) {
   2501 		/* Init flag is not cleared here, so avoid busy
   2502 		 * loop by claiming nothing changed. */
   2503 		sm->changed = FALSE;
   2504 	}
   2505 	sm->GTimeoutCtr = 0;
   2506 }
   2507 
   2508 
   2509 SM_STATE(WPA_PTK_GROUP, REKEYNEGOTIATING)
   2510 {
   2511 	u8 rsc[WPA_KEY_RSC_LEN];
   2512 	struct wpa_group *gsm = sm->group;
   2513 	const u8 *kde;
   2514 	u8 *kde_buf = NULL, *pos, hdr[2];
   2515 	size_t kde_len;
   2516 	u8 *gtk, dummy_gtk[32];
   2517 
   2518 	SM_ENTRY_MA(WPA_PTK_GROUP, REKEYNEGOTIATING, wpa_ptk_group);
   2519 
   2520 	sm->GTimeoutCtr++;
   2521 	if (sm->GTimeoutCtr > (int) dot11RSNAConfigGroupUpdateCount) {
   2522 		/* No point in sending the EAPOL-Key - we will disconnect
   2523 		 * immediately following this. */
   2524 		return;
   2525 	}
   2526 
   2527 	if (sm->wpa == WPA_VERSION_WPA)
   2528 		sm->PInitAKeys = FALSE;
   2529 	sm->TimeoutEvt = FALSE;
   2530 	/* Send EAPOL(1, 1, 1, !Pair, G, RSC, GNonce, MIC(PTK), GTK[GN]) */
   2531 	os_memset(rsc, 0, WPA_KEY_RSC_LEN);
   2532 	if (gsm->wpa_group_state == WPA_GROUP_SETKEYSDONE)
   2533 		wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN, rsc);
   2534 	wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2535 			"sending 1/2 msg of Group Key Handshake");
   2536 
   2537 	gtk = gsm->GTK[gsm->GN - 1];
   2538 	if (sm->wpa_auth->conf.disable_gtk) {
   2539 		/*
   2540 		 * Provide unique random GTK to each STA to prevent use
   2541 		 * of GTK in the BSS.
   2542 		 */
   2543 		if (random_get_bytes(dummy_gtk, gsm->GTK_len) < 0)
   2544 			return;
   2545 		gtk = dummy_gtk;
   2546 	}
   2547 	if (sm->wpa == WPA_VERSION_WPA2) {
   2548 		kde_len = 2 + RSN_SELECTOR_LEN + 2 + gsm->GTK_len +
   2549 			ieee80211w_kde_len(sm);
   2550 		kde_buf = os_malloc(kde_len);
   2551 		if (kde_buf == NULL)
   2552 			return;
   2553 
   2554 		kde = pos = kde_buf;
   2555 		hdr[0] = gsm->GN & 0x03;
   2556 		hdr[1] = 0;
   2557 		pos = wpa_add_kde(pos, RSN_KEY_DATA_GROUPKEY, hdr, 2,
   2558 				  gtk, gsm->GTK_len);
   2559 		pos = ieee80211w_kde_add(sm, pos);
   2560 		kde_len = pos - kde;
   2561 	} else {
   2562 		kde = gtk;
   2563 		kde_len = gsm->GTK_len;
   2564 	}
   2565 
   2566 	wpa_send_eapol(sm->wpa_auth, sm,
   2567 		       WPA_KEY_INFO_SECURE | WPA_KEY_INFO_MIC |
   2568 		       WPA_KEY_INFO_ACK |
   2569 		       (!sm->Pair ? WPA_KEY_INFO_INSTALL : 0),
   2570 		       rsc, gsm->GNonce, kde, kde_len, gsm->GN, 1);
   2571 
   2572 	os_free(kde_buf);
   2573 }
   2574 
   2575 
   2576 SM_STATE(WPA_PTK_GROUP, REKEYESTABLISHED)
   2577 {
   2578 	SM_ENTRY_MA(WPA_PTK_GROUP, REKEYESTABLISHED, wpa_ptk_group);
   2579 	sm->EAPOLKeyReceived = FALSE;
   2580 	if (sm->GUpdateStationKeys)
   2581 		sm->group->GKeyDoneStations--;
   2582 	sm->GUpdateStationKeys = FALSE;
   2583 	sm->GTimeoutCtr = 0;
   2584 	/* FIX: MLME.SetProtection.Request(TA, Tx_Rx) */
   2585 	wpa_auth_vlogger(sm->wpa_auth, sm->addr, LOGGER_INFO,
   2586 			 "group key handshake completed (%s)",
   2587 			 sm->wpa == WPA_VERSION_WPA ? "WPA" : "RSN");
   2588 	sm->has_GTK = TRUE;
   2589 }
   2590 
   2591 
   2592 SM_STATE(WPA_PTK_GROUP, KEYERROR)
   2593 {
   2594 	SM_ENTRY_MA(WPA_PTK_GROUP, KEYERROR, wpa_ptk_group);
   2595 	if (sm->GUpdateStationKeys)
   2596 		sm->group->GKeyDoneStations--;
   2597 	sm->GUpdateStationKeys = FALSE;
   2598 	sm->Disconnect = TRUE;
   2599 }
   2600 
   2601 
   2602 SM_STEP(WPA_PTK_GROUP)
   2603 {
   2604 	if (sm->Init || sm->PtkGroupInit) {
   2605 		SM_ENTER(WPA_PTK_GROUP, IDLE);
   2606 		sm->PtkGroupInit = FALSE;
   2607 	} else switch (sm->wpa_ptk_group_state) {
   2608 	case WPA_PTK_GROUP_IDLE:
   2609 		if (sm->GUpdateStationKeys ||
   2610 		    (sm->wpa == WPA_VERSION_WPA && sm->PInitAKeys))
   2611 			SM_ENTER(WPA_PTK_GROUP, REKEYNEGOTIATING);
   2612 		break;
   2613 	case WPA_PTK_GROUP_REKEYNEGOTIATING:
   2614 		if (sm->EAPOLKeyReceived && !sm->EAPOLKeyRequest &&
   2615 		    !sm->EAPOLKeyPairwise && sm->MICVerified)
   2616 			SM_ENTER(WPA_PTK_GROUP, REKEYESTABLISHED);
   2617 		else if (sm->GTimeoutCtr >
   2618 			 (int) dot11RSNAConfigGroupUpdateCount)
   2619 			SM_ENTER(WPA_PTK_GROUP, KEYERROR);
   2620 		else if (sm->TimeoutEvt)
   2621 			SM_ENTER(WPA_PTK_GROUP, REKEYNEGOTIATING);
   2622 		break;
   2623 	case WPA_PTK_GROUP_KEYERROR:
   2624 		SM_ENTER(WPA_PTK_GROUP, IDLE);
   2625 		break;
   2626 	case WPA_PTK_GROUP_REKEYESTABLISHED:
   2627 		SM_ENTER(WPA_PTK_GROUP, IDLE);
   2628 		break;
   2629 	}
   2630 }
   2631 
   2632 
   2633 static int wpa_gtk_update(struct wpa_authenticator *wpa_auth,
   2634 			  struct wpa_group *group)
   2635 {
   2636 	int ret = 0;
   2637 
   2638 	os_memcpy(group->GNonce, group->Counter, WPA_NONCE_LEN);
   2639 	inc_byte_array(group->Counter, WPA_NONCE_LEN);
   2640 	if (wpa_gmk_to_gtk(group->GMK, "Group key expansion",
   2641 			   wpa_auth->addr, group->GNonce,
   2642 			   group->GTK[group->GN - 1], group->GTK_len) < 0)
   2643 		ret = -1;
   2644 	wpa_hexdump_key(MSG_DEBUG, "GTK",
   2645 			group->GTK[group->GN - 1], group->GTK_len);
   2646 
   2647 #ifdef CONFIG_IEEE80211W
   2648 	if (wpa_auth->conf.ieee80211w != NO_MGMT_FRAME_PROTECTION) {
   2649 		size_t len;
   2650 		len = wpa_cipher_key_len(wpa_auth->conf.group_mgmt_cipher);
   2651 		os_memcpy(group->GNonce, group->Counter, WPA_NONCE_LEN);
   2652 		inc_byte_array(group->Counter, WPA_NONCE_LEN);
   2653 		if (wpa_gmk_to_gtk(group->GMK, "IGTK key expansion",
   2654 				   wpa_auth->addr, group->GNonce,
   2655 				   group->IGTK[group->GN_igtk - 4], len) < 0)
   2656 			ret = -1;
   2657 		wpa_hexdump_key(MSG_DEBUG, "IGTK",
   2658 				group->IGTK[group->GN_igtk - 4], len);
   2659 	}
   2660 #endif /* CONFIG_IEEE80211W */
   2661 
   2662 	return ret;
   2663 }
   2664 
   2665 
   2666 static void wpa_group_gtk_init(struct wpa_authenticator *wpa_auth,
   2667 			       struct wpa_group *group)
   2668 {
   2669 	wpa_printf(MSG_DEBUG, "WPA: group state machine entering state "
   2670 		   "GTK_INIT (VLAN-ID %d)", group->vlan_id);
   2671 	group->changed = FALSE; /* GInit is not cleared here; avoid loop */
   2672 	group->wpa_group_state = WPA_GROUP_GTK_INIT;
   2673 
   2674 	/* GTK[0..N] = 0 */
   2675 	os_memset(group->GTK, 0, sizeof(group->GTK));
   2676 	group->GN = 1;
   2677 	group->GM = 2;
   2678 #ifdef CONFIG_IEEE80211W
   2679 	group->GN_igtk = 4;
   2680 	group->GM_igtk = 5;
   2681 #endif /* CONFIG_IEEE80211W */
   2682 	/* GTK[GN] = CalcGTK() */
   2683 	wpa_gtk_update(wpa_auth, group);
   2684 }
   2685 
   2686 
   2687 static int wpa_group_update_sta(struct wpa_state_machine *sm, void *ctx)
   2688 {
   2689 	if (ctx != NULL && ctx != sm->group)
   2690 		return 0;
   2691 
   2692 	if (sm->wpa_ptk_state != WPA_PTK_PTKINITDONE) {
   2693 		wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2694 				"Not in PTKINITDONE; skip Group Key update");
   2695 		sm->GUpdateStationKeys = FALSE;
   2696 		return 0;
   2697 	}
   2698 	if (sm->GUpdateStationKeys) {
   2699 		/*
   2700 		 * This should not really happen, so add a debug log entry.
   2701 		 * Since we clear the GKeyDoneStations before the loop, the
   2702 		 * station needs to be counted here anyway.
   2703 		 */
   2704 		wpa_auth_logger(sm->wpa_auth, sm->addr, LOGGER_DEBUG,
   2705 				"GUpdateStationKeys was already set when "
   2706 				"marking station for GTK rekeying");
   2707 	}
   2708 
   2709 	/* Do not rekey GTK/IGTK when STA is in WNM-Sleep Mode */
   2710 	if (sm->is_wnmsleep)
   2711 		return 0;
   2712 
   2713 	sm->group->GKeyDoneStations++;
   2714 	sm->GUpdateStationKeys = TRUE;
   2715 
   2716 	wpa_sm_step(sm);
   2717 	return 0;
   2718 }
   2719 
   2720 
   2721 #ifdef CONFIG_WNM
   2722 /* update GTK when exiting WNM-Sleep Mode */
   2723 void wpa_wnmsleep_rekey_gtk(struct wpa_state_machine *sm)
   2724 {
   2725 	if (sm == NULL || sm->is_wnmsleep)
   2726 		return;
   2727 
   2728 	wpa_group_update_sta(sm, NULL);
   2729 }
   2730 
   2731 
   2732 void wpa_set_wnmsleep(struct wpa_state_machine *sm, int flag)
   2733 {
   2734 	if (sm)
   2735 		sm->is_wnmsleep = !!flag;
   2736 }
   2737 
   2738 
   2739 int wpa_wnmsleep_gtk_subelem(struct wpa_state_machine *sm, u8 *pos)
   2740 {
   2741 	struct wpa_group *gsm = sm->group;
   2742 	u8 *start = pos;
   2743 
   2744 	/*
   2745 	 * GTK subelement:
   2746 	 * Sub-elem ID[1] | Length[1] | Key Info[2] | Key Length[1] | RSC[8] |
   2747 	 * Key[5..32]
   2748 	 */
   2749 	*pos++ = WNM_SLEEP_SUBELEM_GTK;
   2750 	*pos++ = 11 + gsm->GTK_len;
   2751 	/* Key ID in B0-B1 of Key Info */
   2752 	WPA_PUT_LE16(pos, gsm->GN & 0x03);
   2753 	pos += 2;
   2754 	*pos++ = gsm->GTK_len;
   2755 	if (wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN, pos) != 0)
   2756 		return 0;
   2757 	pos += 8;
   2758 	os_memcpy(pos, gsm->GTK[gsm->GN - 1], gsm->GTK_len);
   2759 	pos += gsm->GTK_len;
   2760 
   2761 	wpa_printf(MSG_DEBUG, "WNM: GTK Key ID %u in WNM-Sleep Mode exit",
   2762 		   gsm->GN);
   2763 	wpa_hexdump_key(MSG_DEBUG, "WNM: GTK in WNM-Sleep Mode exit",
   2764 			gsm->GTK[gsm->GN - 1], gsm->GTK_len);
   2765 
   2766 	return pos - start;
   2767 }
   2768 
   2769 
   2770 #ifdef CONFIG_IEEE80211W
   2771 int wpa_wnmsleep_igtk_subelem(struct wpa_state_machine *sm, u8 *pos)
   2772 {
   2773 	struct wpa_group *gsm = sm->group;
   2774 	u8 *start = pos;
   2775 	size_t len = wpa_cipher_key_len(sm->wpa_auth->conf.group_mgmt_cipher);
   2776 
   2777 	/*
   2778 	 * IGTK subelement:
   2779 	 * Sub-elem ID[1] | Length[1] | KeyID[2] | PN[6] | Key[16]
   2780 	 */
   2781 	*pos++ = WNM_SLEEP_SUBELEM_IGTK;
   2782 	*pos++ = 2 + 6 + len;
   2783 	WPA_PUT_LE16(pos, gsm->GN_igtk);
   2784 	pos += 2;
   2785 	if (wpa_auth_get_seqnum(sm->wpa_auth, NULL, gsm->GN_igtk, pos) != 0)
   2786 		return 0;
   2787 	pos += 6;
   2788 
   2789 	os_memcpy(pos, gsm->IGTK[gsm->GN_igtk - 4], len);
   2790 	pos += len;
   2791 
   2792 	wpa_printf(MSG_DEBUG, "WNM: IGTK Key ID %u in WNM-Sleep Mode exit",
   2793 		   gsm->GN_igtk);
   2794 	wpa_hexdump_key(MSG_DEBUG, "WNM: IGTK in WNM-Sleep Mode exit",
   2795 			gsm->IGTK[gsm->GN_igtk - 4], len);
   2796 
   2797 	return pos - start;
   2798 }
   2799 #endif /* CONFIG_IEEE80211W */
   2800 #endif /* CONFIG_WNM */
   2801 
   2802 
   2803 static void wpa_group_setkeys(struct wpa_authenticator *wpa_auth,
   2804 			      struct wpa_group *group)
   2805 {
   2806 	int tmp;
   2807 
   2808 	wpa_printf(MSG_DEBUG, "WPA: group state machine entering state "
   2809 		   "SETKEYS (VLAN-ID %d)", group->vlan_id);
   2810 	group->changed = TRUE;
   2811 	group->wpa_group_state = WPA_GROUP_SETKEYS;
   2812 	group->GTKReKey = FALSE;
   2813 	tmp = group->GM;
   2814 	group->GM = group->GN;
   2815 	group->GN = tmp;
   2816 #ifdef CONFIG_IEEE80211W
   2817 	tmp = group->GM_igtk;
   2818 	group->GM_igtk = group->GN_igtk;
   2819 	group->GN_igtk = tmp;
   2820 #endif /* CONFIG_IEEE80211W */
   2821 	/* "GKeyDoneStations = GNoStations" is done in more robust way by
   2822 	 * counting the STAs that are marked with GUpdateStationKeys instead of
   2823 	 * including all STAs that could be in not-yet-completed state. */
   2824 	wpa_gtk_update(wpa_auth, group);
   2825 
   2826 	if (group->GKeyDoneStations) {
   2827 		wpa_printf(MSG_DEBUG, "wpa_group_setkeys: Unexpected "
   2828 			   "GKeyDoneStations=%d when starting new GTK rekey",
   2829 			   group->GKeyDoneStations);
   2830 		group->GKeyDoneStations = 0;
   2831 	}
   2832 	wpa_auth_for_each_sta(wpa_auth, wpa_group_update_sta, group);
   2833 	wpa_printf(MSG_DEBUG, "wpa_group_setkeys: GKeyDoneStations=%d",
   2834 		   group->GKeyDoneStations);
   2835 }
   2836 
   2837 
   2838 static int wpa_group_config_group_keys(struct wpa_authenticator *wpa_auth,
   2839 				       struct wpa_group *group)
   2840 {
   2841 	int ret = 0;
   2842 
   2843 	if (wpa_auth_set_key(wpa_auth, group->vlan_id,
   2844 			     wpa_cipher_to_alg(wpa_auth->conf.wpa_group),
   2845 			     broadcast_ether_addr, group->GN,
   2846 			     group->GTK[group->GN - 1], group->GTK_len) < 0)
   2847 		ret = -1;
   2848 
   2849 #ifdef CONFIG_IEEE80211W
   2850 	if (wpa_auth->conf.ieee80211w != NO_MGMT_FRAME_PROTECTION) {
   2851 		enum wpa_alg alg;
   2852 		size_t len;
   2853 
   2854 		alg = wpa_cipher_to_alg(wpa_auth->conf.group_mgmt_cipher);
   2855 		len = wpa_cipher_key_len(wpa_auth->conf.group_mgmt_cipher);
   2856 
   2857 		if (ret == 0 &&
   2858 		    wpa_auth_set_key(wpa_auth, group->vlan_id, alg,
   2859 				     broadcast_ether_addr, group->GN_igtk,
   2860 				     group->IGTK[group->GN_igtk - 4], len) < 0)
   2861 			ret = -1;
   2862 	}
   2863 #endif /* CONFIG_IEEE80211W */
   2864 
   2865 	return ret;
   2866 }
   2867 
   2868 
   2869 static int wpa_group_disconnect_cb(struct wpa_state_machine *sm, void *ctx)
   2870 {
   2871 	if (sm->group == ctx) {
   2872 		wpa_printf(MSG_DEBUG, "WPA: Mark STA " MACSTR
   2873 			   " for discconnection due to fatal failure",
   2874 			   MAC2STR(sm->addr));
   2875 		sm->Disconnect = TRUE;
   2876 	}
   2877 
   2878 	return 0;
   2879 }
   2880 
   2881 
   2882 static void wpa_group_fatal_failure(struct wpa_authenticator *wpa_auth,
   2883 				    struct wpa_group *group)
   2884 {
   2885 	wpa_printf(MSG_DEBUG, "WPA: group state machine entering state FATAL_FAILURE");
   2886 	group->changed = TRUE;
   2887 	group->wpa_group_state = WPA_GROUP_FATAL_FAILURE;
   2888 	wpa_auth_for_each_sta(wpa_auth, wpa_group_disconnect_cb, group);
   2889 }
   2890 
   2891 
   2892 static int wpa_group_setkeysdone(struct wpa_authenticator *wpa_auth,
   2893 				 struct wpa_group *group)
   2894 {
   2895 	wpa_printf(MSG_DEBUG, "WPA: group state machine entering state "
   2896 		   "SETKEYSDONE (VLAN-ID %d)", group->vlan_id);
   2897 	group->changed = TRUE;
   2898 	group->wpa_group_state = WPA_GROUP_SETKEYSDONE;
   2899 
   2900 	if (wpa_group_config_group_keys(wpa_auth, group) < 0) {
   2901 		wpa_group_fatal_failure(wpa_auth, group);
   2902 		return -1;
   2903 	}
   2904 
   2905 	return 0;
   2906 }
   2907 
   2908 
   2909 static void wpa_group_sm_step(struct wpa_authenticator *wpa_auth,
   2910 			      struct wpa_group *group)
   2911 {
   2912 	if (group->GInit) {
   2913 		wpa_group_gtk_init(wpa_auth, group);
   2914 	} else if (group->wpa_group_state == WPA_GROUP_FATAL_FAILURE) {
   2915 		/* Do not allow group operations */
   2916 	} else if (group->wpa_group_state == WPA_GROUP_GTK_INIT &&
   2917 		   group->GTKAuthenticator) {
   2918 		wpa_group_setkeysdone(wpa_auth, group);
   2919 	} else if (group->wpa_group_state == WPA_GROUP_SETKEYSDONE &&
   2920 		   group->GTKReKey) {
   2921 		wpa_group_setkeys(wpa_auth, group);
   2922 	} else if (group->wpa_group_state == WPA_GROUP_SETKEYS) {
   2923 		if (group->GKeyDoneStations == 0)
   2924 			wpa_group_setkeysdone(wpa_auth, group);
   2925 		else if (group->GTKReKey)
   2926 			wpa_group_setkeys(wpa_auth, group);
   2927 	}
   2928 }
   2929 
   2930 
   2931 static int wpa_sm_step(struct wpa_state_machine *sm)
   2932 {
   2933 	if (sm == NULL)
   2934 		return 0;
   2935 
   2936 	if (sm->in_step_loop) {
   2937 		/* This should not happen, but if it does, make sure we do not
   2938 		 * end up freeing the state machine too early by exiting the
   2939 		 * recursive call. */
   2940 		wpa_printf(MSG_ERROR, "WPA: wpa_sm_step() called recursively");
   2941 		return 0;
   2942 	}
   2943 
   2944 	sm->in_step_loop = 1;
   2945 	do {
   2946 		if (sm->pending_deinit)
   2947 			break;
   2948 
   2949 		sm->changed = FALSE;
   2950 		sm->wpa_auth->group->changed = FALSE;
   2951 
   2952 		SM_STEP_RUN(WPA_PTK);
   2953 		if (sm->pending_deinit)
   2954 			break;
   2955 		SM_STEP_RUN(WPA_PTK_GROUP);
   2956 		if (sm->pending_deinit)
   2957 			break;
   2958 		wpa_group_sm_step(sm->wpa_auth, sm->group);
   2959 	} while (sm->changed || sm->wpa_auth->group->changed);
   2960 	sm->in_step_loop = 0;
   2961 
   2962 	if (sm->pending_deinit) {
   2963 		wpa_printf(MSG_DEBUG, "WPA: Completing pending STA state "
   2964 			   "machine deinit for " MACSTR, MAC2STR(sm->addr));
   2965 		wpa_free_sta_sm(sm);
   2966 		return 1;
   2967 	}
   2968 	return 0;
   2969 }
   2970 
   2971 
   2972 static void wpa_sm_call_step(void *eloop_ctx, void *timeout_ctx)
   2973 {
   2974 	struct wpa_state_machine *sm = eloop_ctx;
   2975 	wpa_sm_step(sm);
   2976 }
   2977 
   2978 
   2979 void wpa_auth_sm_notify(struct wpa_state_machine *sm)
   2980 {
   2981 	if (sm == NULL)
   2982 		return;
   2983 	eloop_register_timeout(0, 0, wpa_sm_call_step, sm, NULL);
   2984 }
   2985 
   2986 
   2987 void wpa_gtk_rekey(struct wpa_authenticator *wpa_auth)
   2988 {
   2989 	int tmp, i;
   2990 	struct wpa_group *group;
   2991 
   2992 	if (wpa_auth == NULL)
   2993 		return;
   2994 
   2995 	group = wpa_auth->group;
   2996 
   2997 	for (i = 0; i < 2; i++) {
   2998 		tmp = group->GM;
   2999 		group->GM = group->GN;
   3000 		group->GN = tmp;
   3001 #ifdef CONFIG_IEEE80211W
   3002 		tmp = group->GM_igtk;
   3003 		group->GM_igtk = group->GN_igtk;
   3004 		group->GN_igtk = tmp;
   3005 #endif /* CONFIG_IEEE80211W */
   3006 		wpa_gtk_update(wpa_auth, group);
   3007 		wpa_group_config_group_keys(wpa_auth, group);
   3008 	}
   3009 }
   3010 
   3011 
   3012 static const char * wpa_bool_txt(int val)
   3013 {
   3014 	return val ? "TRUE" : "FALSE";
   3015 }
   3016 
   3017 
   3018 #define RSN_SUITE "%02x-%02x-%02x-%d"
   3019 #define RSN_SUITE_ARG(s) \
   3020 ((s) >> 24) & 0xff, ((s) >> 16) & 0xff, ((s) >> 8) & 0xff, (s) & 0xff
   3021 
   3022 int wpa_get_mib(struct wpa_authenticator *wpa_auth, char *buf, size_t buflen)
   3023 {
   3024 	int len = 0, ret;
   3025 	char pmkid_txt[PMKID_LEN * 2 + 1];
   3026 #ifdef CONFIG_RSN_PREAUTH
   3027 	const int preauth = 1;
   3028 #else /* CONFIG_RSN_PREAUTH */
   3029 	const int preauth = 0;
   3030 #endif /* CONFIG_RSN_PREAUTH */
   3031 
   3032 	if (wpa_auth == NULL)
   3033 		return len;
   3034 
   3035 	ret = os_snprintf(buf + len, buflen - len,
   3036 			  "dot11RSNAOptionImplemented=TRUE\n"
   3037 			  "dot11RSNAPreauthenticationImplemented=%s\n"
   3038 			  "dot11RSNAEnabled=%s\n"
   3039 			  "dot11RSNAPreauthenticationEnabled=%s\n",
   3040 			  wpa_bool_txt(preauth),
   3041 			  wpa_bool_txt(wpa_auth->conf.wpa & WPA_PROTO_RSN),
   3042 			  wpa_bool_txt(wpa_auth->conf.rsn_preauth));
   3043 	if (os_snprintf_error(buflen - len, ret))
   3044 		return len;
   3045 	len += ret;
   3046 
   3047 	wpa_snprintf_hex(pmkid_txt, sizeof(pmkid_txt),
   3048 			 wpa_auth->dot11RSNAPMKIDUsed, PMKID_LEN);
   3049 
   3050 	ret = os_snprintf(
   3051 		buf + len, buflen - len,
   3052 		"dot11RSNAConfigVersion=%u\n"
   3053 		"dot11RSNAConfigPairwiseKeysSupported=9999\n"
   3054 		/* FIX: dot11RSNAConfigGroupCipher */
   3055 		/* FIX: dot11RSNAConfigGroupRekeyMethod */
   3056 		/* FIX: dot11RSNAConfigGroupRekeyTime */
   3057 		/* FIX: dot11RSNAConfigGroupRekeyPackets */
   3058 		"dot11RSNAConfigGroupRekeyStrict=%u\n"
   3059 		"dot11RSNAConfigGroupUpdateCount=%u\n"
   3060 		"dot11RSNAConfigPairwiseUpdateCount=%u\n"
   3061 		"dot11RSNAConfigGroupCipherSize=%u\n"
   3062 		"dot11RSNAConfigPMKLifetime=%u\n"
   3063 		"dot11RSNAConfigPMKReauthThreshold=%u\n"
   3064 		"dot11RSNAConfigNumberOfPTKSAReplayCounters=0\n"
   3065 		"dot11RSNAConfigSATimeout=%u\n"
   3066 		"dot11RSNAAuthenticationSuiteSelected=" RSN_SUITE "\n"
   3067 		"dot11RSNAPairwiseCipherSelected=" RSN_SUITE "\n"
   3068 		"dot11RSNAGroupCipherSelected=" RSN_SUITE "\n"
   3069 		"dot11RSNAPMKIDUsed=%s\n"
   3070 		"dot11RSNAAuthenticationSuiteRequested=" RSN_SUITE "\n"
   3071 		"dot11RSNAPairwiseCipherRequested=" RSN_SUITE "\n"
   3072 		"dot11RSNAGroupCipherRequested=" RSN_SUITE "\n"
   3073 		"dot11RSNATKIPCounterMeasuresInvoked=%u\n"
   3074 		"dot11RSNA4WayHandshakeFailures=%u\n"
   3075 		"dot11RSNAConfigNumberOfGTKSAReplayCounters=0\n",
   3076 		RSN_VERSION,
   3077 		!!wpa_auth->conf.wpa_strict_rekey,
   3078 		dot11RSNAConfigGroupUpdateCount,
   3079 		dot11RSNAConfigPairwiseUpdateCount,
   3080 		wpa_cipher_key_len(wpa_auth->conf.wpa_group) * 8,
   3081 		dot11RSNAConfigPMKLifetime,
   3082 		dot11RSNAConfigPMKReauthThreshold,
   3083 		dot11RSNAConfigSATimeout,
   3084 		RSN_SUITE_ARG(wpa_auth->dot11RSNAAuthenticationSuiteSelected),
   3085 		RSN_SUITE_ARG(wpa_auth->dot11RSNAPairwiseCipherSelected),
   3086 		RSN_SUITE_ARG(wpa_auth->dot11RSNAGroupCipherSelected),
   3087 		pmkid_txt,
   3088 		RSN_SUITE_ARG(wpa_auth->dot11RSNAAuthenticationSuiteRequested),
   3089 		RSN_SUITE_ARG(wpa_auth->dot11RSNAPairwiseCipherRequested),
   3090 		RSN_SUITE_ARG(wpa_auth->dot11RSNAGroupCipherRequested),
   3091 		wpa_auth->dot11RSNATKIPCounterMeasuresInvoked,
   3092 		wpa_auth->dot11RSNA4WayHandshakeFailures);
   3093 	if (os_snprintf_error(buflen - len, ret))
   3094 		return len;
   3095 	len += ret;
   3096 
   3097 	/* TODO: dot11RSNAConfigPairwiseCiphersTable */
   3098 	/* TODO: dot11RSNAConfigAuthenticationSuitesTable */
   3099 
   3100 	/* Private MIB */
   3101 	ret = os_snprintf(buf + len, buflen - len, "hostapdWPAGroupState=%d\n",
   3102 			  wpa_auth->group->wpa_group_state);
   3103 	if (os_snprintf_error(buflen - len, ret))
   3104 		return len;
   3105 	len += ret;
   3106 
   3107 	return len;
   3108 }
   3109 
   3110 
   3111 int wpa_get_mib_sta(struct wpa_state_machine *sm, char *buf, size_t buflen)
   3112 {
   3113 	int len = 0, ret;
   3114 	u32 pairwise = 0;
   3115 
   3116 	if (sm == NULL)
   3117 		return 0;
   3118 
   3119 	/* TODO: FF-FF-FF-FF-FF-FF entry for broadcast/multicast stats */
   3120 
   3121 	/* dot11RSNAStatsEntry */
   3122 
   3123 	pairwise = wpa_cipher_to_suite(sm->wpa == WPA_VERSION_WPA2 ?
   3124 				       WPA_PROTO_RSN : WPA_PROTO_WPA,
   3125 				       sm->pairwise);
   3126 	if (pairwise == 0)
   3127 		return 0;
   3128 
   3129 	ret = os_snprintf(
   3130 		buf + len, buflen - len,
   3131 		/* TODO: dot11RSNAStatsIndex */
   3132 		"dot11RSNAStatsSTAAddress=" MACSTR "\n"
   3133 		"dot11RSNAStatsVersion=1\n"
   3134 		"dot11RSNAStatsSelectedPairwiseCipher=" RSN_SUITE "\n"
   3135 		/* TODO: dot11RSNAStatsTKIPICVErrors */
   3136 		"dot11RSNAStatsTKIPLocalMICFailures=%u\n"
   3137 		"dot11RSNAStatsTKIPRemoteMICFailures=%u\n"
   3138 		/* TODO: dot11RSNAStatsCCMPReplays */
   3139 		/* TODO: dot11RSNAStatsCCMPDecryptErrors */
   3140 		/* TODO: dot11RSNAStatsTKIPReplays */,
   3141 		MAC2STR(sm->addr),
   3142 		RSN_SUITE_ARG(pairwise),
   3143 		sm->dot11RSNAStatsTKIPLocalMICFailures,
   3144 		sm->dot11RSNAStatsTKIPRemoteMICFailures);
   3145 	if (os_snprintf_error(buflen - len, ret))
   3146 		return len;
   3147 	len += ret;
   3148 
   3149 	/* Private MIB */
   3150 	ret = os_snprintf(buf + len, buflen - len,
   3151 			  "hostapdWPAPTKState=%d\n"
   3152 			  "hostapdWPAPTKGroupState=%d\n",
   3153 			  sm->wpa_ptk_state,
   3154 			  sm->wpa_ptk_group_state);
   3155 	if (os_snprintf_error(buflen - len, ret))
   3156 		return len;
   3157 	len += ret;
   3158 
   3159 	return len;
   3160 }
   3161 
   3162 
   3163 void wpa_auth_countermeasures_start(struct wpa_authenticator *wpa_auth)
   3164 {
   3165 	if (wpa_auth)
   3166 		wpa_auth->dot11RSNATKIPCounterMeasuresInvoked++;
   3167 }
   3168 
   3169 
   3170 int wpa_auth_pairwise_set(struct wpa_state_machine *sm)
   3171 {
   3172 	return sm && sm->pairwise_set;
   3173 }
   3174 
   3175 
   3176 int wpa_auth_get_pairwise(struct wpa_state_machine *sm)
   3177 {
   3178 	return sm->pairwise;
   3179 }
   3180 
   3181 
   3182 int wpa_auth_sta_key_mgmt(struct wpa_state_machine *sm)
   3183 {
   3184 	if (sm == NULL)
   3185 		return -1;
   3186 	return sm->wpa_key_mgmt;
   3187 }
   3188 
   3189 
   3190 int wpa_auth_sta_wpa_version(struct wpa_state_machine *sm)
   3191 {
   3192 	if (sm == NULL)
   3193 		return 0;
   3194 	return sm->wpa;
   3195 }
   3196 
   3197 
   3198 int wpa_auth_sta_clear_pmksa(struct wpa_state_machine *sm,
   3199 			     struct rsn_pmksa_cache_entry *entry)
   3200 {
   3201 	if (sm == NULL || sm->pmksa != entry)
   3202 		return -1;
   3203 	sm->pmksa = NULL;
   3204 	return 0;
   3205 }
   3206 
   3207 
   3208 struct rsn_pmksa_cache_entry *
   3209 wpa_auth_sta_get_pmksa(struct wpa_state_machine *sm)
   3210 {
   3211 	return sm ? sm->pmksa : NULL;
   3212 }
   3213 
   3214 
   3215 void wpa_auth_sta_local_mic_failure_report(struct wpa_state_machine *sm)
   3216 {
   3217 	if (sm)
   3218 		sm->dot11RSNAStatsTKIPLocalMICFailures++;
   3219 }
   3220 
   3221 
   3222 const u8 * wpa_auth_get_wpa_ie(struct wpa_authenticator *wpa_auth, size_t *len)
   3223 {
   3224 	if (wpa_auth == NULL)
   3225 		return NULL;
   3226 	*len = wpa_auth->wpa_ie_len;
   3227 	return wpa_auth->wpa_ie;
   3228 }
   3229 
   3230 
   3231 int wpa_auth_pmksa_add(struct wpa_state_machine *sm, const u8 *pmk,
   3232 		       int session_timeout, struct eapol_state_machine *eapol)
   3233 {
   3234 	if (sm == NULL || sm->wpa != WPA_VERSION_WPA2 ||
   3235 	    sm->wpa_auth->conf.disable_pmksa_caching)
   3236 		return -1;
   3237 
   3238 	if (pmksa_cache_auth_add(sm->wpa_auth->pmksa, pmk, PMK_LEN,
   3239 				 sm->PTK.kck, sm->PTK.kck_len,
   3240 				 sm->wpa_auth->addr, sm->addr, session_timeout,
   3241 				 eapol, sm->wpa_key_mgmt))
   3242 		return 0;
   3243 
   3244 	return -1;
   3245 }
   3246 
   3247 
   3248 int wpa_auth_pmksa_add_preauth(struct wpa_authenticator *wpa_auth,
   3249 			       const u8 *pmk, size_t len, const u8 *sta_addr,
   3250 			       int session_timeout,
   3251 			       struct eapol_state_machine *eapol)
   3252 {
   3253 	if (wpa_auth == NULL)
   3254 		return -1;
   3255 
   3256 	if (pmksa_cache_auth_add(wpa_auth->pmksa, pmk, len,
   3257 				 NULL, 0,
   3258 				 wpa_auth->addr,
   3259 				 sta_addr, session_timeout, eapol,
   3260 				 WPA_KEY_MGMT_IEEE8021X))
   3261 		return 0;
   3262 
   3263 	return -1;
   3264 }
   3265 
   3266 
   3267 int wpa_auth_pmksa_add_sae(struct wpa_authenticator *wpa_auth, const u8 *addr,
   3268 			   const u8 *pmk)
   3269 {
   3270 	if (wpa_auth->conf.disable_pmksa_caching)
   3271 		return -1;
   3272 
   3273 	if (pmksa_cache_auth_add(wpa_auth->pmksa, pmk, PMK_LEN,
   3274 				 NULL, 0,
   3275 				 wpa_auth->addr, addr, 0, NULL,
   3276 				 WPA_KEY_MGMT_SAE))
   3277 		return 0;
   3278 
   3279 	return -1;
   3280 }
   3281 
   3282 
   3283 void wpa_auth_pmksa_remove(struct wpa_authenticator *wpa_auth,
   3284 			   const u8 *sta_addr)
   3285 {
   3286 	struct rsn_pmksa_cache_entry *pmksa;
   3287 
   3288 	if (wpa_auth == NULL || wpa_auth->pmksa == NULL)
   3289 		return;
   3290 	pmksa = pmksa_cache_auth_get(wpa_auth->pmksa, sta_addr, NULL);
   3291 	if (pmksa) {
   3292 		wpa_printf(MSG_DEBUG, "WPA: Remove PMKSA cache entry for "
   3293 			   MACSTR " based on request", MAC2STR(sta_addr));
   3294 		pmksa_cache_free_entry(wpa_auth->pmksa, pmksa);
   3295 	}
   3296 }
   3297 
   3298 
   3299 /*
   3300  * Remove and free the group from wpa_authenticator. This is triggered by a
   3301  * callback to make sure nobody is currently iterating the group list while it
   3302  * gets modified.
   3303  */
   3304 static void wpa_group_free(struct wpa_authenticator *wpa_auth,
   3305 			   struct wpa_group *group)
   3306 {
   3307 	struct wpa_group *prev = wpa_auth->group;
   3308 
   3309 	wpa_printf(MSG_DEBUG, "WPA: Remove group state machine for VLAN-ID %d",
   3310 		   group->vlan_id);
   3311 
   3312 	while (prev) {
   3313 		if (prev->next == group) {
   3314 			/* This never frees the special first group as needed */
   3315 			prev->next = group->next;
   3316 			os_free(group);
   3317 			break;
   3318 		}
   3319 		prev = prev->next;
   3320 	}
   3321 
   3322 }
   3323 
   3324 
   3325 /* Increase the reference counter for group */
   3326 static void wpa_group_get(struct wpa_authenticator *wpa_auth,
   3327 			  struct wpa_group *group)
   3328 {
   3329 	/* Skip the special first group */
   3330 	if (wpa_auth->group == group)
   3331 		return;
   3332 
   3333 	group->references++;
   3334 }
   3335 
   3336 
   3337 /* Decrease the reference counter and maybe free the group */
   3338 static void wpa_group_put(struct wpa_authenticator *wpa_auth,
   3339 			  struct wpa_group *group)
   3340 {
   3341 	/* Skip the special first group */
   3342 	if (wpa_auth->group == group)
   3343 		return;
   3344 
   3345 	group->references--;
   3346 	if (group->references)
   3347 		return;
   3348 	wpa_group_free(wpa_auth, group);
   3349 }
   3350 
   3351 
   3352 /*
   3353  * Add a group that has its references counter set to zero. Caller needs to
   3354  * call wpa_group_get() on the return value to mark the entry in use.
   3355  */
   3356 static struct wpa_group *
   3357 wpa_auth_add_group(struct wpa_authenticator *wpa_auth, int vlan_id)
   3358 {
   3359 	struct wpa_group *group;
   3360 
   3361 	if (wpa_auth == NULL || wpa_auth->group == NULL)
   3362 		return NULL;
   3363 
   3364 	wpa_printf(MSG_DEBUG, "WPA: Add group state machine for VLAN-ID %d",
   3365 		   vlan_id);
   3366 	group = wpa_group_init(wpa_auth, vlan_id, 0);
   3367 	if (group == NULL)
   3368 		return NULL;
   3369 
   3370 	group->next = wpa_auth->group->next;
   3371 	wpa_auth->group->next = group;
   3372 
   3373 	return group;
   3374 }
   3375 
   3376 
   3377 int wpa_auth_sta_set_vlan(struct wpa_state_machine *sm, int vlan_id)
   3378 {
   3379 	struct wpa_group *group;
   3380 
   3381 	if (sm == NULL || sm->wpa_auth == NULL)
   3382 		return 0;
   3383 
   3384 	group = sm->wpa_auth->group;
   3385 	while (group) {
   3386 		if (group->vlan_id == vlan_id)
   3387 			break;
   3388 		group = group->next;
   3389 	}
   3390 
   3391 	if (group == NULL) {
   3392 		group = wpa_auth_add_group(sm->wpa_auth, vlan_id);
   3393 		if (group == NULL)
   3394 			return -1;
   3395 	}
   3396 
   3397 	if (sm->group == group)
   3398 		return 0;
   3399 
   3400 	if (group->wpa_group_state == WPA_GROUP_FATAL_FAILURE)
   3401 		return -1;
   3402 
   3403 	wpa_printf(MSG_DEBUG, "WPA: Moving STA " MACSTR " to use group state "
   3404 		   "machine for VLAN ID %d", MAC2STR(sm->addr), vlan_id);
   3405 
   3406 	wpa_group_get(sm->wpa_auth, group);
   3407 	wpa_group_put(sm->wpa_auth, sm->group);
   3408 	sm->group = group;
   3409 
   3410 	return 0;
   3411 }
   3412 
   3413 
   3414 void wpa_auth_eapol_key_tx_status(struct wpa_authenticator *wpa_auth,
   3415 				  struct wpa_state_machine *sm, int ack)
   3416 {
   3417 	if (wpa_auth == NULL || sm == NULL)
   3418 		return;
   3419 	wpa_printf(MSG_DEBUG, "WPA: EAPOL-Key TX status for STA " MACSTR
   3420 		   " ack=%d", MAC2STR(sm->addr), ack);
   3421 	if (sm->pending_1_of_4_timeout && ack) {
   3422 		/*
   3423 		 * Some deployed supplicant implementations update their SNonce
   3424 		 * for each EAPOL-Key 2/4 message even within the same 4-way
   3425 		 * handshake and then fail to use the first SNonce when
   3426 		 * deriving the PTK. This results in unsuccessful 4-way
   3427 		 * handshake whenever the relatively short initial timeout is
   3428 		 * reached and EAPOL-Key 1/4 is retransmitted. Try to work
   3429 		 * around this by increasing the timeout now that we know that
   3430 		 * the station has received the frame.
   3431 		 */
   3432 		int timeout_ms = eapol_key_timeout_subseq;
   3433 		wpa_printf(MSG_DEBUG, "WPA: Increase initial EAPOL-Key 1/4 "
   3434 			   "timeout by %u ms because of acknowledged frame",
   3435 			   timeout_ms);
   3436 		eloop_cancel_timeout(wpa_send_eapol_timeout, wpa_auth, sm);
   3437 		eloop_register_timeout(timeout_ms / 1000,
   3438 				       (timeout_ms % 1000) * 1000,
   3439 				       wpa_send_eapol_timeout, wpa_auth, sm);
   3440 	}
   3441 }
   3442 
   3443 
   3444 int wpa_auth_uses_sae(struct wpa_state_machine *sm)
   3445 {
   3446 	if (sm == NULL)
   3447 		return 0;
   3448 	return wpa_key_mgmt_sae(sm->wpa_key_mgmt);
   3449 }
   3450 
   3451 
   3452 int wpa_auth_uses_ft_sae(struct wpa_state_machine *sm)
   3453 {
   3454 	if (sm == NULL)
   3455 		return 0;
   3456 	return sm->wpa_key_mgmt == WPA_KEY_MGMT_FT_SAE;
   3457 }
   3458 
   3459 
   3460 #ifdef CONFIG_P2P
   3461 int wpa_auth_get_ip_addr(struct wpa_state_machine *sm, u8 *addr)
   3462 {
   3463 	if (sm == NULL || WPA_GET_BE32(sm->ip_addr) == 0)
   3464 		return -1;
   3465 	os_memcpy(addr, sm->ip_addr, 4);
   3466 	return 0;
   3467 }
   3468 #endif /* CONFIG_P2P */
   3469 
   3470 
   3471 int wpa_auth_radius_das_disconnect_pmksa(struct wpa_authenticator *wpa_auth,
   3472 					 struct radius_das_attrs *attr)
   3473 {
   3474 	return pmksa_cache_auth_radius_das_disconnect(wpa_auth->pmksa, attr);
   3475 }
   3476 
   3477 
   3478 void wpa_auth_reconfig_group_keys(struct wpa_authenticator *wpa_auth)
   3479 {
   3480 	struct wpa_group *group;
   3481 
   3482 	if (!wpa_auth)
   3483 		return;
   3484 	for (group = wpa_auth->group; group; group = group->next)
   3485 		wpa_group_config_group_keys(wpa_auth, group);
   3486 }
   3487