/* Minimal WPA2-PSK supplicant: see wpa.h. * * EAPOL-Key frame offsets (from the EAPOL header): * 0 version, 1 type (3 = Key), 2..3 body length (BE) * 4 descriptor type (2 = RSN), 5..6 key info (BE), 7..8 key length * 9..16 replay counter, 17..48 nonce, 49..64 IV, 65..72 RSC, * 73..80 reserved, 81..96 MIC, 97..98 key data length, 99.. key data */ #include "wpa.h" #include "wpa_crypto.h" #define KI_VER_MSK 0x0007 #define KI_PAIRWISE 0x0008 #define KI_INSTALL 0x0040 #define KI_ACK 0x0080 #define KI_MIC 0x0100 #define KI_SECURE 0x0200 #define KI_ENC_DATA 0x1000 #define OFF_INFO 5 #define OFF_REPLAY 9 #define OFF_NONCE 17 #define OFF_RSC 65 #define OFF_MIC 81 #define OFF_DLEN 97 #define OFF_DATA 99 static void cpy(unsigned char *d, const unsigned char *s, unsigned int n) { while (n--) *d++ = *s++; } static void zero(unsigned char *d, unsigned int n) { while (n--) *d++ = 0; } static int cmp(const unsigned char *a, const unsigned char *b, unsigned int n) { unsigned int i; for (i = 0; i < n; i++) if (a[i] != b[i]) return a[i] < b[i] ? -1 : 1; return 0; } static unsigned int be16(const unsigned char *p) { return (p[0] << 8) | p[1]; } void wpa_pmk(const char *pass, const unsigned char *ssid, unsigned int ssid_len, unsigned char pmk[32]) { unsigned int n = 0; while (pass[n]) n++; pbkdf2_sha1((const unsigned char *)pass, n, ssid, ssid_len, 4096, pmk, 32); } unsigned int wpa_rsn_ie(unsigned char out[22]) { static const unsigned char ie[22] = { 48, 20, 1, 0, 0x00, 0x0f, 0xac, 4, /* group: CCMP */ 1, 0, 0x00, 0x0f, 0xac, 4, /* pairwise: CCMP */ 1, 0, 0x00, 0x0f, 0xac, 2, /* AKM: PSK */ 0, 0, /* RSN capabilities */ }; cpy(out, ie, 22); return 22; } void wpa_init(struct wpa_sm *sm, const unsigned char pmk[32], const unsigned char aa[6], const unsigned char spa[6], const unsigned char *ie, unsigned int ie_len, const unsigned char *ap_ie, unsigned int ap_ie_len) { zero((unsigned char *)sm, sizeof(*sm)); cpy(sm->pmk, pmk, 32); cpy(sm->aa, aa, 6); cpy(sm->spa, spa, 6); if (ie_len > sizeof(sm->ie)) ie_len = sizeof(sm->ie); cpy(sm->ie, ie, ie_len); sm->ie_len = ie_len; if (ap_ie_len > sizeof(sm->ap_ie)) ap_ie_len = sizeof(sm->ap_ie); cpy(sm->ap_ie, ap_ie, ap_ie_len); sm->ap_ie_len = ap_ie_len; } static void derive_ptk(struct wpa_sm *sm) { unsigned char b[6 + 6 + 32 + 32]; int am = cmp(sm->aa, sm->spa, 6) < 0; int an = cmp(sm->anonce, sm->snonce, 32) < 0; cpy(b, am ? sm->aa : sm->spa, 6); cpy(b + 6, am ? sm->spa : sm->aa, 6); cpy(b + 12, an ? sm->anonce : sm->snonce, 32); cpy(b + 44, an ? sm->snonce : sm->anonce, 32); wpa_prf(sm->pmk, 32, "Pairwise key expansion", b, sizeof(b), sm->ptk, 48); } /* HMAC-SHA1-128 over the frame with the MIC field zeroed: * [0, OFF_MIC) | 16 zero bytes | [OFF_MIC + 16, len). */ static void calc_mic(const unsigned char *kck, const unsigned char *f, unsigned int len, unsigned char mic[16]) { unsigned char tmp[1024], h[20]; if (len > sizeof(tmp)) len = sizeof(tmp); cpy(tmp, f, len); zero(tmp + OFF_MIC, 16); hmac_sha1(kck, 16, tmp, len, h); cpy(mic, h, 16); } static int check_mic(struct wpa_sm *sm, const unsigned char *f, unsigned int len) { unsigned char mic[16]; calc_mic(WPA_KCK(sm), f, len, mic); return cmp(mic, f + OFF_MIC, 16) == 0; } /* Build a reply EAPOL-Key frame; key data optional. */ static unsigned int build(struct wpa_sm *sm, const unsigned char *rx, unsigned int info, const unsigned char *nonce, const unsigned char *data, unsigned int dlen, unsigned char *out) { unsigned int body = 95 + dlen, len = 4 + body; zero(out, len); out[0] = rx[0] ? rx[0] : 1; /* mirror the AP's EAPOL version */ out[1] = 3; out[2] = body >> 8; out[3] = body; out[4] = 2; /* RSN key descriptor */ out[OFF_INFO] = info >> 8; out[OFF_INFO + 1] = info; cpy(out + OFF_REPLAY, rx + OFF_REPLAY, 8); if (nonce) cpy(out + OFF_NONCE, nonce, 32); out[OFF_DLEN] = dlen >> 8; out[OFF_DLEN + 1] = dlen; if (dlen) cpy(out + OFF_DATA, data, dlen); calc_mic(WPA_KCK(sm), out, len, out + OFF_MIC); return len; } /* Walk the decrypted key data for the GTK KDE (and the RSN IE in msg 3). */ static int parse_kde(struct wpa_sm *sm, const unsigned char *d, unsigned int n, int want_ie) { unsigned int o = 0; int gtk = 0, ie_ok = !want_ie || !sm->ap_ie_len; while (o + 2 <= n) { unsigned int id = d[o], l = d[o + 1]; if (id == 0xdd && l == 0) break; /* padding */ if (o + 2 + l > n) break; if (id == 48 && want_ie && sm->ap_ie_len) { /* Downgrade check: same RSN IE as the beacon. */ ie_ok = l + 2 == sm->ap_ie_len && cmp(d + o, sm->ap_ie, l + 2) == 0; } else if (id == 0xdd && l >= 6 + 16 && d[o + 2] == 0x00 && d[o + 3] == 0x0f && d[o + 4] == 0xac && d[o + 5] == 1) { unsigned int glen = l - 6; if (glen > sizeof(sm->gtk)) return -1; sm->gtk_idx = d[o + 6] & 3; cpy(sm->gtk, d + o + 8, glen); sm->gtk_len = glen; gtk = 1; } o += 2 + l; } if (!ie_ok) { sm->error = "RSN IE mismatch (downgrade?)"; return -1; } if (!gtk) { sm->error = "no GTK in key data"; return -1; } return 0; } static int decrypt_data(struct wpa_sm *sm, const unsigned char *f, unsigned int dlen, unsigned char *out) { if (dlen < 24 || dlen % 8 || dlen > 512 || aes_unwrap(WPA_KEK(sm), f + OFF_DATA, dlen, out) < 0) { sm->error = "key data unwrap failed"; return -1; } return (int)dlen - 8; } int wpa_rx(struct wpa_sm *sm, const unsigned char *f, unsigned int len, unsigned char *reply, unsigned int *rlen, void (*rng)(unsigned char *out, unsigned int n)) { unsigned int info, dlen, flen; unsigned char plain[512]; int n; *rlen = 0; if (len < OFF_DATA || f[1] != 3 || f[4] != 2) return WPA_NONE; flen = 4 + be16(f + 2); if (flen > len) return WPA_NONE; len = flen; info = be16(f + OFF_INFO); dlen = be16(f + OFF_DLEN); if ((info & KI_VER_MSK) != 2 || OFF_DATA + dlen > len) { sm->error = "unsupported key descriptor"; return WPA_ERR; } if (!(info & KI_ACK)) return WPA_NONE; if (sm->have_replay && cmp(f + OFF_REPLAY, sm->replay, 8) <= 0 && (info & KI_MIC)) { sm->error = "replayed EAPOL-Key"; return WPA_ERR; } if ((info & KI_PAIRWISE) && !(info & KI_MIC)) { /* Message 1: ANonce. New SNonce, derive the PTK, answer with * message 2 carrying our RSN IE. */ cpy(sm->anonce, f + OFF_NONCE, 32); if (!sm->have_snonce) { rng(sm->snonce, 32); sm->have_snonce = 1; } derive_ptk(sm); *rlen = build(sm, f, 2 | KI_PAIRWISE | KI_MIC, sm->snonce, sm->ie, sm->ie_len, reply); return WPA_REPLY; } if (!check_mic(sm, f, len)) { sm->error = "EAPOL-Key MIC mismatch (wrong passphrase?)"; return WPA_ERR; } if (info & KI_PAIRWISE) { /* Message 3: same ANonce, install, encrypted GTK. */ if (!(info & KI_INSTALL) || !(info & KI_ENC_DATA) || cmp(f + OFF_NONCE, sm->anonce, 32) != 0) { sm->error = "unexpected message 3"; return WPA_ERR; } n = decrypt_data(sm, f, dlen, plain); if (n < 0 || parse_kde(sm, plain, (unsigned int)n, 1) < 0) return WPA_ERR; cpy(sm->gtk_rsc, f + OFF_RSC, 8); cpy(sm->replay, f + OFF_REPLAY, 8); sm->have_replay = 1; sm->ptk_ok = 1; *rlen = build(sm, f, 2 | KI_PAIRWISE | KI_MIC | KI_SECURE, 0, 0, 0, reply); return WPA_PTK; } /* Group key message 1 (rekey). */ if (!sm->ptk_ok || !(info & KI_ENC_DATA)) { sm->error = "unexpected group key message"; return WPA_ERR; } n = decrypt_data(sm, f, dlen, plain); if (n < 0 || parse_kde(sm, plain, (unsigned int)n, 0) < 0) return WPA_ERR; cpy(sm->gtk_rsc, f + OFF_RSC, 8); cpy(sm->replay, f + OFF_REPLAY, 8); sm->have_replay = 1; *rlen = build(sm, f, 2 | KI_MIC | KI_SECURE, 0, 0, 0, reply); return WPA_GTK; }