Remove WPA per-VLAN groups when no more stations remain
[mech_eap.git] / src / ap / wpa_auth.c
1 /*
2  * IEEE 802.11 RSN / WPA Authenticator
3  * Copyright (c) 2004-2015, Jouni Malinen <j@w1.fi>
4  *
5  * This software may be distributed under the terms of the BSD license.
6  * See README for more details.
7  */
8
9 #include "utils/includes.h"
10
11 #include "utils/common.h"
12 #include "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 }