wpa.c 7.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298
  1. /* Minimal WPA2-PSK supplicant: see wpa.h.
  2. *
  3. * EAPOL-Key frame offsets (from the EAPOL header):
  4. * 0 version, 1 type (3 = Key), 2..3 body length (BE)
  5. * 4 descriptor type (2 = RSN), 5..6 key info (BE), 7..8 key length
  6. * 9..16 replay counter, 17..48 nonce, 49..64 IV, 65..72 RSC,
  7. * 73..80 reserved, 81..96 MIC, 97..98 key data length, 99.. key data */
  8. #include "wpa.h"
  9. #include "wpa_crypto.h"
  10. #define KI_VER_MSK 0x0007
  11. #define KI_PAIRWISE 0x0008
  12. #define KI_INSTALL 0x0040
  13. #define KI_ACK 0x0080
  14. #define KI_MIC 0x0100
  15. #define KI_SECURE 0x0200
  16. #define KI_ENC_DATA 0x1000
  17. #define OFF_INFO 5
  18. #define OFF_REPLAY 9
  19. #define OFF_NONCE 17
  20. #define OFF_RSC 65
  21. #define OFF_MIC 81
  22. #define OFF_DLEN 97
  23. #define OFF_DATA 99
  24. static void cpy(unsigned char *d, const unsigned char *s, unsigned int n)
  25. {
  26. while (n--)
  27. *d++ = *s++;
  28. }
  29. static void zero(unsigned char *d, unsigned int n)
  30. {
  31. while (n--)
  32. *d++ = 0;
  33. }
  34. static int cmp(const unsigned char *a, const unsigned char *b, unsigned int n)
  35. {
  36. unsigned int i;
  37. for (i = 0; i < n; i++)
  38. if (a[i] != b[i])
  39. return a[i] < b[i] ? -1 : 1;
  40. return 0;
  41. }
  42. static unsigned int be16(const unsigned char *p)
  43. {
  44. return (p[0] << 8) | p[1];
  45. }
  46. void wpa_pmk(const char *pass, const unsigned char *ssid, unsigned int ssid_len,
  47. unsigned char pmk[32])
  48. {
  49. unsigned int n = 0;
  50. while (pass[n])
  51. n++;
  52. pbkdf2_sha1((const unsigned char *)pass, n, ssid, ssid_len, 4096,
  53. pmk, 32);
  54. }
  55. unsigned int wpa_rsn_ie(unsigned char out[22])
  56. {
  57. static const unsigned char ie[22] = {
  58. 48, 20, 1, 0,
  59. 0x00, 0x0f, 0xac, 4, /* group: CCMP */
  60. 1, 0, 0x00, 0x0f, 0xac, 4, /* pairwise: CCMP */
  61. 1, 0, 0x00, 0x0f, 0xac, 2, /* AKM: PSK */
  62. 0, 0, /* RSN capabilities */
  63. };
  64. cpy(out, ie, 22);
  65. return 22;
  66. }
  67. void wpa_init(struct wpa_sm *sm, const unsigned char pmk[32],
  68. const unsigned char aa[6], const unsigned char spa[6],
  69. const unsigned char *ie, unsigned int ie_len,
  70. const unsigned char *ap_ie, unsigned int ap_ie_len)
  71. {
  72. zero((unsigned char *)sm, sizeof(*sm));
  73. cpy(sm->pmk, pmk, 32);
  74. cpy(sm->aa, aa, 6);
  75. cpy(sm->spa, spa, 6);
  76. if (ie_len > sizeof(sm->ie))
  77. ie_len = sizeof(sm->ie);
  78. cpy(sm->ie, ie, ie_len);
  79. sm->ie_len = ie_len;
  80. if (ap_ie_len > sizeof(sm->ap_ie))
  81. ap_ie_len = sizeof(sm->ap_ie);
  82. cpy(sm->ap_ie, ap_ie, ap_ie_len);
  83. sm->ap_ie_len = ap_ie_len;
  84. }
  85. static void derive_ptk(struct wpa_sm *sm)
  86. {
  87. unsigned char b[6 + 6 + 32 + 32];
  88. int am = cmp(sm->aa, sm->spa, 6) < 0;
  89. int an = cmp(sm->anonce, sm->snonce, 32) < 0;
  90. cpy(b, am ? sm->aa : sm->spa, 6);
  91. cpy(b + 6, am ? sm->spa : sm->aa, 6);
  92. cpy(b + 12, an ? sm->anonce : sm->snonce, 32);
  93. cpy(b + 44, an ? sm->snonce : sm->anonce, 32);
  94. wpa_prf(sm->pmk, 32, "Pairwise key expansion", b, sizeof(b),
  95. sm->ptk, 48);
  96. }
  97. /* HMAC-SHA1-128 over the frame with the MIC field zeroed:
  98. * [0, OFF_MIC) | 16 zero bytes | [OFF_MIC + 16, len). */
  99. static void calc_mic(const unsigned char *kck, const unsigned char *f,
  100. unsigned int len, unsigned char mic[16])
  101. {
  102. unsigned char tmp[1024], h[20];
  103. if (len > sizeof(tmp))
  104. len = sizeof(tmp);
  105. cpy(tmp, f, len);
  106. zero(tmp + OFF_MIC, 16);
  107. hmac_sha1(kck, 16, tmp, len, h);
  108. cpy(mic, h, 16);
  109. }
  110. static int check_mic(struct wpa_sm *sm, const unsigned char *f,
  111. unsigned int len)
  112. {
  113. unsigned char mic[16];
  114. calc_mic(WPA_KCK(sm), f, len, mic);
  115. return cmp(mic, f + OFF_MIC, 16) == 0;
  116. }
  117. /* Build a reply EAPOL-Key frame; key data optional. */
  118. static unsigned int build(struct wpa_sm *sm, const unsigned char *rx,
  119. unsigned int info, const unsigned char *nonce,
  120. const unsigned char *data, unsigned int dlen,
  121. unsigned char *out)
  122. {
  123. unsigned int body = 95 + dlen, len = 4 + body;
  124. zero(out, len);
  125. out[0] = rx[0] ? rx[0] : 1; /* mirror the AP's EAPOL version */
  126. out[1] = 3;
  127. out[2] = body >> 8;
  128. out[3] = body;
  129. out[4] = 2; /* RSN key descriptor */
  130. out[OFF_INFO] = info >> 8;
  131. out[OFF_INFO + 1] = info;
  132. cpy(out + OFF_REPLAY, rx + OFF_REPLAY, 8);
  133. if (nonce)
  134. cpy(out + OFF_NONCE, nonce, 32);
  135. out[OFF_DLEN] = dlen >> 8;
  136. out[OFF_DLEN + 1] = dlen;
  137. if (dlen)
  138. cpy(out + OFF_DATA, data, dlen);
  139. calc_mic(WPA_KCK(sm), out, len, out + OFF_MIC);
  140. return len;
  141. }
  142. /* Walk the decrypted key data for the GTK KDE (and the RSN IE in msg 3). */
  143. static int parse_kde(struct wpa_sm *sm, const unsigned char *d,
  144. unsigned int n, int want_ie)
  145. {
  146. unsigned int o = 0;
  147. int gtk = 0, ie_ok = !want_ie || !sm->ap_ie_len;
  148. while (o + 2 <= n) {
  149. unsigned int id = d[o], l = d[o + 1];
  150. if (id == 0xdd && l == 0)
  151. break; /* padding */
  152. if (o + 2 + l > n)
  153. break;
  154. if (id == 48 && want_ie && sm->ap_ie_len) {
  155. /* Downgrade check: same RSN IE as the beacon. */
  156. ie_ok = l + 2 == sm->ap_ie_len &&
  157. cmp(d + o, sm->ap_ie, l + 2) == 0;
  158. } else if (id == 0xdd && l >= 6 + 16 && d[o + 2] == 0x00 &&
  159. d[o + 3] == 0x0f && d[o + 4] == 0xac &&
  160. d[o + 5] == 1) {
  161. unsigned int glen = l - 6;
  162. if (glen > sizeof(sm->gtk))
  163. return -1;
  164. sm->gtk_idx = d[o + 6] & 3;
  165. cpy(sm->gtk, d + o + 8, glen);
  166. sm->gtk_len = glen;
  167. gtk = 1;
  168. }
  169. o += 2 + l;
  170. }
  171. if (!ie_ok) {
  172. sm->error = "RSN IE mismatch (downgrade?)";
  173. return -1;
  174. }
  175. if (!gtk) {
  176. sm->error = "no GTK in key data";
  177. return -1;
  178. }
  179. return 0;
  180. }
  181. static int decrypt_data(struct wpa_sm *sm, const unsigned char *f,
  182. unsigned int dlen, unsigned char *out)
  183. {
  184. if (dlen < 24 || dlen % 8 || dlen > 512 ||
  185. aes_unwrap(WPA_KEK(sm), f + OFF_DATA, dlen, out) < 0) {
  186. sm->error = "key data unwrap failed";
  187. return -1;
  188. }
  189. return (int)dlen - 8;
  190. }
  191. int wpa_rx(struct wpa_sm *sm, const unsigned char *f, unsigned int len,
  192. unsigned char *reply, unsigned int *rlen,
  193. void (*rng)(unsigned char *out, unsigned int n))
  194. {
  195. unsigned int info, dlen, flen;
  196. unsigned char plain[512];
  197. int n;
  198. *rlen = 0;
  199. if (len < OFF_DATA || f[1] != 3 || f[4] != 2)
  200. return WPA_NONE;
  201. flen = 4 + be16(f + 2);
  202. if (flen > len)
  203. return WPA_NONE;
  204. len = flen;
  205. info = be16(f + OFF_INFO);
  206. dlen = be16(f + OFF_DLEN);
  207. if ((info & KI_VER_MSK) != 2 || OFF_DATA + dlen > len) {
  208. sm->error = "unsupported key descriptor";
  209. return WPA_ERR;
  210. }
  211. if (!(info & KI_ACK))
  212. return WPA_NONE;
  213. if (sm->have_replay && cmp(f + OFF_REPLAY, sm->replay, 8) <= 0 &&
  214. (info & KI_MIC)) {
  215. sm->error = "replayed EAPOL-Key";
  216. return WPA_ERR;
  217. }
  218. if ((info & KI_PAIRWISE) && !(info & KI_MIC)) {
  219. /* Message 1: ANonce. New SNonce, derive the PTK, answer with
  220. * message 2 carrying our RSN IE. */
  221. cpy(sm->anonce, f + OFF_NONCE, 32);
  222. if (!sm->have_snonce) {
  223. rng(sm->snonce, 32);
  224. sm->have_snonce = 1;
  225. }
  226. derive_ptk(sm);
  227. *rlen = build(sm, f, 2 | KI_PAIRWISE | KI_MIC, sm->snonce,
  228. sm->ie, sm->ie_len, reply);
  229. return WPA_REPLY;
  230. }
  231. if (!check_mic(sm, f, len)) {
  232. sm->error = "EAPOL-Key MIC mismatch (wrong passphrase?)";
  233. return WPA_ERR;
  234. }
  235. if (info & KI_PAIRWISE) {
  236. /* Message 3: same ANonce, install, encrypted GTK. */
  237. if (!(info & KI_INSTALL) || !(info & KI_ENC_DATA) ||
  238. cmp(f + OFF_NONCE, sm->anonce, 32) != 0) {
  239. sm->error = "unexpected message 3";
  240. return WPA_ERR;
  241. }
  242. n = decrypt_data(sm, f, dlen, plain);
  243. if (n < 0 || parse_kde(sm, plain, (unsigned int)n, 1) < 0)
  244. return WPA_ERR;
  245. cpy(sm->gtk_rsc, f + OFF_RSC, 8);
  246. cpy(sm->replay, f + OFF_REPLAY, 8);
  247. sm->have_replay = 1;
  248. sm->ptk_ok = 1;
  249. *rlen = build(sm, f, 2 | KI_PAIRWISE | KI_MIC | KI_SECURE, 0,
  250. 0, 0, reply);
  251. return WPA_PTK;
  252. }
  253. /* Group key message 1 (rekey). */
  254. if (!sm->ptk_ok || !(info & KI_ENC_DATA)) {
  255. sm->error = "unexpected group key message";
  256. return WPA_ERR;
  257. }
  258. n = decrypt_data(sm, f, dlen, plain);
  259. if (n < 0 || parse_kde(sm, plain, (unsigned int)n, 0) < 0)
  260. return WPA_ERR;
  261. cpy(sm->gtk_rsc, f + OFF_RSC, 8);
  262. cpy(sm->replay, f + OFF_REPLAY, 8);
  263. sm->have_replay = 1;
  264. *rlen = build(sm, f, 2 | KI_MIC | KI_SECURE, 0, 0, 0, reply);
  265. return WPA_GTK;
  266. }