| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298 |
- /* 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;
- }
|