Update LINT:
[dragonfly.git] / contrib / wpa_supplicant-0.5.8 / eap_psk.c
blobe07b25b026a9289b4dea6cfbb1e0a8ebd3716547
1 /*
2 * EAP peer method: EAP-PSK (RFC 4764)
3 * Copyright (c) 2004-2007, Jouni Malinen <j@w1.fi>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * Alternatively, this software may be distributed under the terms of BSD
10 * license.
12 * See README and COPYING for more details.
14 * Note: EAP-PSK is an EAP authentication method and as such, completely
15 * different from WPA-PSK. This file is not needed for WPA-PSK functionality.
18 #include "includes.h"
20 #include "common.h"
21 #include "eap_i.h"
22 #include "config_ssid.h"
23 #include "md5.h"
24 #include "aes_wrap.h"
25 #include "eap_psk_common.h"
28 struct eap_psk_data {
29 enum { PSK_INIT, PSK_MAC_SENT, PSK_DONE } state;
30 u8 rand_p[EAP_PSK_RAND_LEN];
31 u8 ak[EAP_PSK_AK_LEN], kdk[EAP_PSK_KDK_LEN], tek[EAP_PSK_TEK_LEN];
32 u8 *id_s, *id_p;
33 size_t id_s_len, id_p_len;
34 u8 msk[EAP_MSK_LEN];
35 u8 emsk[EAP_EMSK_LEN];
39 static void * eap_psk_init(struct eap_sm *sm)
41 struct wpa_ssid *config = eap_get_config(sm);
42 struct eap_psk_data *data;
44 if (config == NULL || !config->eappsk) {
45 wpa_printf(MSG_INFO, "EAP-PSK: pre-shared key not configured");
46 return NULL;
49 data = os_zalloc(sizeof(*data));
50 if (data == NULL)
51 return NULL;
52 eap_psk_key_setup(config->eappsk, data->ak, data->kdk);
53 wpa_hexdump_key(MSG_DEBUG, "EAP-PSK: AK", data->ak, EAP_PSK_AK_LEN);
54 wpa_hexdump_key(MSG_DEBUG, "EAP-PSK: KDK", data->kdk, EAP_PSK_KDK_LEN);
55 data->state = PSK_INIT;
57 if (config->nai) {
58 data->id_p = os_malloc(config->nai_len);
59 if (data->id_p)
60 os_memcpy(data->id_p, config->nai, config->nai_len);
61 data->id_p_len = config->nai_len;
63 if (data->id_p == NULL) {
64 wpa_printf(MSG_INFO, "EAP-PSK: could not get own identity");
65 os_free(data);
66 return NULL;
69 return data;
73 static void eap_psk_deinit(struct eap_sm *sm, void *priv)
75 struct eap_psk_data *data = priv;
76 os_free(data->id_s);
77 os_free(data->id_p);
78 os_free(data);
82 static u8 * eap_psk_process_1(struct eap_psk_data *data,
83 struct eap_method_ret *ret,
84 const u8 *reqData, size_t reqDataLen,
85 size_t *respDataLen)
87 const struct eap_psk_hdr_1 *hdr1;
88 struct eap_psk_hdr_2 *hdr2;
89 u8 *resp, *buf, *pos;
90 size_t buflen;
92 wpa_printf(MSG_DEBUG, "EAP-PSK: in INIT state");
94 hdr1 = (const struct eap_psk_hdr_1 *) reqData;
95 if (reqDataLen < sizeof(*hdr1) ||
96 be_to_host16(hdr1->length) < sizeof(*hdr1) ||
97 be_to_host16(hdr1->length) > reqDataLen) {
98 wpa_printf(MSG_INFO, "EAP-PSK: Invalid first message "
99 "length (%lu %d; expected %lu or more)",
100 (unsigned long) reqDataLen,
101 be_to_host16(hdr1->length),
102 (unsigned long) sizeof(*hdr1));
103 ret->ignore = TRUE;
104 return NULL;
106 wpa_printf(MSG_DEBUG, "EAP-PSK: Flags=0x%x", hdr1->flags);
107 if (EAP_PSK_FLAGS_GET_T(hdr1->flags) != 0) {
108 wpa_printf(MSG_INFO, "EAP-PSK: Unexpected T=%d (expected 0)",
109 EAP_PSK_FLAGS_GET_T(hdr1->flags));
110 ret->methodState = METHOD_DONE;
111 ret->decision = DECISION_FAIL;
112 return NULL;
114 wpa_hexdump(MSG_DEBUG, "EAP-PSK: RAND_S", hdr1->rand_s,
115 EAP_PSK_RAND_LEN);
116 os_free(data->id_s);
117 data->id_s_len = be_to_host16(hdr1->length) - sizeof(*hdr1);
118 data->id_s = os_malloc(data->id_s_len);
119 if (data->id_s == NULL) {
120 wpa_printf(MSG_ERROR, "EAP-PSK: Failed to allocate memory for "
121 "ID_S (len=%lu)", (unsigned long) data->id_s_len);
122 ret->ignore = TRUE;
123 return NULL;
125 os_memcpy(data->id_s, (u8 *) (hdr1 + 1), data->id_s_len);
126 wpa_hexdump_ascii(MSG_DEBUG, "EAP-PSK: ID_S",
127 data->id_s, data->id_s_len);
129 if (hostapd_get_rand(data->rand_p, EAP_PSK_RAND_LEN)) {
130 wpa_printf(MSG_ERROR, "EAP-PSK: Failed to get random data");
131 ret->ignore = TRUE;
132 return NULL;
135 *respDataLen = sizeof(*hdr2) + data->id_p_len;
136 resp = os_malloc(*respDataLen);
137 if (resp == NULL)
138 return NULL;
139 hdr2 = (struct eap_psk_hdr_2 *) resp;
140 hdr2->code = EAP_CODE_RESPONSE;
141 hdr2->identifier = hdr1->identifier;
142 hdr2->length = host_to_be16(*respDataLen);
143 hdr2->type = EAP_TYPE_PSK;
144 hdr2->flags = EAP_PSK_FLAGS_SET_T(1); /* T=1 */
145 os_memcpy(hdr2->rand_s, hdr1->rand_s, EAP_PSK_RAND_LEN);
146 os_memcpy(hdr2->rand_p, data->rand_p, EAP_PSK_RAND_LEN);
147 os_memcpy((u8 *) (hdr2 + 1), data->id_p, data->id_p_len);
148 /* MAC_P = OMAC1-AES-128(AK, ID_P||ID_S||RAND_S||RAND_P) */
149 buflen = data->id_p_len + data->id_s_len + 2 * EAP_PSK_RAND_LEN;
150 buf = os_malloc(buflen);
151 if (buf == NULL) {
152 os_free(resp);
153 return NULL;
155 os_memcpy(buf, data->id_p, data->id_p_len);
156 pos = buf + data->id_p_len;
157 os_memcpy(pos, data->id_s, data->id_s_len);
158 pos += data->id_s_len;
159 os_memcpy(pos, hdr1->rand_s, EAP_PSK_RAND_LEN);
160 pos += EAP_PSK_RAND_LEN;
161 os_memcpy(pos, data->rand_p, EAP_PSK_RAND_LEN);
162 omac1_aes_128(data->ak, buf, buflen, hdr2->mac_p);
163 os_free(buf);
164 wpa_hexdump(MSG_DEBUG, "EAP-PSK: RAND_P", hdr2->rand_p,
165 EAP_PSK_RAND_LEN);
166 wpa_hexdump(MSG_DEBUG, "EAP-PSK: MAC_P", hdr2->mac_p, EAP_PSK_MAC_LEN);
167 wpa_hexdump_ascii(MSG_DEBUG, "EAP-PSK: ID_P",
168 (u8 *) (hdr2 + 1), data->id_p_len);
170 data->state = PSK_MAC_SENT;
172 return resp;
176 static u8 * eap_psk_process_3(struct eap_psk_data *data,
177 struct eap_method_ret *ret,
178 const u8 *reqData, size_t reqDataLen,
179 size_t *respDataLen)
181 const struct eap_psk_hdr_3 *hdr3;
182 struct eap_psk_hdr_4 *hdr4;
183 u8 *resp, *buf, *rpchannel, nonce[16], *decrypted;
184 const u8 *pchannel, *tag, *msg;
185 u8 mac[EAP_PSK_MAC_LEN];
186 size_t buflen, left, data_len;
187 int failed = 0;
189 wpa_printf(MSG_DEBUG, "EAP-PSK: in MAC_SENT state");
191 hdr3 = (const struct eap_psk_hdr_3 *) reqData;
192 left = be_to_host16(hdr3->length);
193 if (left < sizeof(*hdr3) || reqDataLen < left) {
194 wpa_printf(MSG_INFO, "EAP-PSK: Invalid third message "
195 "length (%lu %d; expected %lu)",
196 (unsigned long) reqDataLen,
197 be_to_host16(hdr3->length),
198 (unsigned long) sizeof(*hdr3));
199 ret->ignore = TRUE;
200 return NULL;
202 left -= sizeof(*hdr3);
203 pchannel = (const u8 *) (hdr3 + 1);
204 wpa_printf(MSG_DEBUG, "EAP-PSK: Flags=0x%x", hdr3->flags);
205 if (EAP_PSK_FLAGS_GET_T(hdr3->flags) != 2) {
206 wpa_printf(MSG_INFO, "EAP-PSK: Unexpected T=%d (expected 2)",
207 EAP_PSK_FLAGS_GET_T(hdr3->flags));
208 ret->methodState = METHOD_DONE;
209 ret->decision = DECISION_FAIL;
210 return NULL;
212 wpa_hexdump(MSG_DEBUG, "EAP-PSK: RAND_S", hdr3->rand_s,
213 EAP_PSK_RAND_LEN);
214 wpa_hexdump(MSG_DEBUG, "EAP-PSK: MAC_S", hdr3->mac_s, EAP_PSK_MAC_LEN);
215 wpa_hexdump(MSG_DEBUG, "EAP-PSK: PCHANNEL", pchannel, left);
217 if (left < 4 + 16 + 1) {
218 wpa_printf(MSG_INFO, "EAP-PSK: Too short PCHANNEL data in "
219 "third message (len=%lu, expected 21)",
220 (unsigned long) left);
221 ret->ignore = TRUE;
222 return NULL;
225 /* MAC_S = OMAC1-AES-128(AK, ID_S||RAND_P) */
226 buflen = data->id_s_len + EAP_PSK_RAND_LEN;
227 buf = os_malloc(buflen);
228 if (buf == NULL)
229 return NULL;
230 os_memcpy(buf, data->id_s, data->id_s_len);
231 os_memcpy(buf + data->id_s_len, data->rand_p, EAP_PSK_RAND_LEN);
232 omac1_aes_128(data->ak, buf, buflen, mac);
233 os_free(buf);
234 if (os_memcmp(mac, hdr3->mac_s, EAP_PSK_MAC_LEN) != 0) {
235 wpa_printf(MSG_WARNING, "EAP-PSK: Invalid MAC_S in third "
236 "message");
237 ret->methodState = METHOD_DONE;
238 ret->decision = DECISION_FAIL;
239 return NULL;
241 wpa_printf(MSG_DEBUG, "EAP-PSK: MAC_S verified successfully");
243 eap_psk_derive_keys(data->kdk, data->rand_p, data->tek,
244 data->msk, data->emsk);
245 wpa_hexdump_key(MSG_DEBUG, "EAP-PSK: TEK", data->tek, EAP_PSK_TEK_LEN);
246 wpa_hexdump_key(MSG_DEBUG, "EAP-PSK: MSK", data->msk, EAP_MSK_LEN);
247 wpa_hexdump_key(MSG_DEBUG, "EAP-PSK: EMSK", data->emsk, EAP_EMSK_LEN);
249 os_memset(nonce, 0, 12);
250 os_memcpy(nonce + 12, pchannel, 4);
251 pchannel += 4;
252 left -= 4;
254 tag = pchannel;
255 pchannel += 16;
256 left -= 16;
258 msg = pchannel;
260 wpa_hexdump(MSG_MSGDUMP, "EAP-PSK: PCHANNEL - nonce",
261 nonce, sizeof(nonce));
262 wpa_hexdump(MSG_MSGDUMP, "EAP-PSK: PCHANNEL - hdr", reqData, 5);
263 wpa_hexdump(MSG_MSGDUMP, "EAP-PSK: PCHANNEL - cipher msg", msg, left);
265 decrypted = os_malloc(left);
266 if (decrypted == NULL) {
267 ret->methodState = METHOD_DONE;
268 ret->decision = DECISION_FAIL;
269 return NULL;
271 os_memcpy(decrypted, msg, left);
273 if (aes_128_eax_decrypt(data->tek, nonce, sizeof(nonce),
274 reqData, 22, decrypted, left, tag)) {
275 wpa_printf(MSG_WARNING, "EAP-PSK: PCHANNEL decryption failed");
276 os_free(decrypted);
277 return NULL;
279 wpa_hexdump(MSG_DEBUG, "EAP-PSK: Decrypted PCHANNEL message",
280 decrypted, left);
282 /* Verify R flag */
283 switch (decrypted[0] >> 6) {
284 case EAP_PSK_R_FLAG_CONT:
285 wpa_printf(MSG_DEBUG, "EAP-PSK: R flag - CONT - unsupported");
286 failed = 1;
287 break;
288 case EAP_PSK_R_FLAG_DONE_SUCCESS:
289 wpa_printf(MSG_DEBUG, "EAP-PSK: R flag - DONE_SUCCESS");
290 break;
291 case EAP_PSK_R_FLAG_DONE_FAILURE:
292 wpa_printf(MSG_DEBUG, "EAP-PSK: R flag - DONE_FAILURE");
293 wpa_printf(MSG_INFO, "EAP-PSK: Authentication server rejected "
294 "authentication");
295 failed = 1;
296 break;
299 *respDataLen = sizeof(*hdr4) + 4 + 16 + 1;
300 resp = os_malloc(*respDataLen + 1);
301 if (resp == NULL) {
302 os_free(decrypted);
303 return NULL;
305 hdr4 = (struct eap_psk_hdr_4 *) resp;
306 hdr4->code = EAP_CODE_RESPONSE;
307 hdr4->identifier = hdr3->identifier;
308 hdr4->length = host_to_be16(*respDataLen);
309 hdr4->type = EAP_TYPE_PSK;
310 hdr4->flags = EAP_PSK_FLAGS_SET_T(3); /* T=3 */
311 os_memcpy(hdr4->rand_s, hdr3->rand_s, EAP_PSK_RAND_LEN);
312 rpchannel = (u8 *) (hdr4 + 1);
314 /* nonce++ */
315 inc_byte_array(nonce, sizeof(nonce));
316 os_memcpy(rpchannel, nonce + 12, 4);
318 data_len = 1;
319 if (decrypted[0] & EAP_PSK_E_FLAG) {
320 wpa_printf(MSG_DEBUG, "EAP-PSK: Unsupported E (Ext) flag");
321 failed = 1;
322 rpchannel[4 + 16] = (EAP_PSK_R_FLAG_DONE_FAILURE << 6) |
323 EAP_PSK_E_FLAG;
324 if (left > 1) {
325 /* Add empty EXT_Payload with same EXT_Type */
326 (*respDataLen)++;
327 hdr4->length = host_to_be16(*respDataLen);
328 rpchannel[4 + 16 + 1] = decrypted[1];
329 data_len++;
331 } else if (failed)
332 rpchannel[4 + 16] = EAP_PSK_R_FLAG_DONE_FAILURE << 6;
333 else
334 rpchannel[4 + 16] = EAP_PSK_R_FLAG_DONE_SUCCESS << 6;
336 wpa_hexdump(MSG_DEBUG, "EAP-PSK: reply message (plaintext)",
337 rpchannel + 4 + 16, data_len);
338 aes_128_eax_encrypt(data->tek, nonce, sizeof(nonce), resp, 22,
339 rpchannel + 4 + 16, data_len, rpchannel + 4);
340 wpa_hexdump(MSG_DEBUG, "EAP-PSK: reply message (PCHANNEL)",
341 rpchannel, 4 + 16 + data_len);
343 wpa_printf(MSG_DEBUG, "EAP-PSK: Completed %ssuccessfully",
344 failed ? "un" : "");
345 data->state = PSK_DONE;
346 ret->methodState = METHOD_DONE;
347 ret->decision = failed ? DECISION_FAIL : DECISION_UNCOND_SUCC;
349 os_free(decrypted);
351 return resp;
355 static u8 * eap_psk_process(struct eap_sm *sm, void *priv,
356 struct eap_method_ret *ret,
357 const u8 *reqData, size_t reqDataLen,
358 size_t *respDataLen)
360 struct eap_psk_data *data = priv;
361 const u8 *pos;
362 u8 *resp = NULL;
363 size_t len;
365 pos = eap_hdr_validate(EAP_VENDOR_IETF, EAP_TYPE_PSK,
366 reqData, reqDataLen, &len);
367 if (pos == NULL) {
368 ret->ignore = TRUE;
369 return NULL;
371 len += sizeof(struct eap_hdr) + 1;
373 ret->ignore = FALSE;
374 ret->methodState = METHOD_MAY_CONT;
375 ret->decision = DECISION_FAIL;
376 ret->allowNotifications = TRUE;
378 switch (data->state) {
379 case PSK_INIT:
380 resp = eap_psk_process_1(data, ret, reqData, len,
381 respDataLen);
382 break;
383 case PSK_MAC_SENT:
384 resp = eap_psk_process_3(data, ret, reqData, len,
385 respDataLen);
386 break;
387 case PSK_DONE:
388 wpa_printf(MSG_DEBUG, "EAP-PSK: in DONE state - ignore "
389 "unexpected message");
390 ret->ignore = TRUE;
391 return NULL;
394 if (ret->methodState == METHOD_DONE) {
395 ret->allowNotifications = FALSE;
398 return resp;
402 static Boolean eap_psk_isKeyAvailable(struct eap_sm *sm, void *priv)
404 struct eap_psk_data *data = priv;
405 return data->state == PSK_DONE;
409 static u8 * eap_psk_getKey(struct eap_sm *sm, void *priv, size_t *len)
411 struct eap_psk_data *data = priv;
412 u8 *key;
414 if (data->state != PSK_DONE)
415 return NULL;
417 key = os_malloc(EAP_MSK_LEN);
418 if (key == NULL)
419 return NULL;
421 *len = EAP_MSK_LEN;
422 os_memcpy(key, data->msk, EAP_MSK_LEN);
424 return key;
428 static u8 * eap_psk_get_emsk(struct eap_sm *sm, void *priv, size_t *len)
430 struct eap_psk_data *data = priv;
431 u8 *key;
433 if (data->state != PSK_DONE)
434 return NULL;
436 key = os_malloc(EAP_EMSK_LEN);
437 if (key == NULL)
438 return NULL;
440 *len = EAP_EMSK_LEN;
441 os_memcpy(key, data->emsk, EAP_EMSK_LEN);
443 return key;
447 int eap_peer_psk_register(void)
449 struct eap_method *eap;
450 int ret;
452 eap = eap_peer_method_alloc(EAP_PEER_METHOD_INTERFACE_VERSION,
453 EAP_VENDOR_IETF, EAP_TYPE_PSK, "PSK");
454 if (eap == NULL)
455 return -1;
457 eap->init = eap_psk_init;
458 eap->deinit = eap_psk_deinit;
459 eap->process = eap_psk_process;
460 eap->isKeyAvailable = eap_psk_isKeyAvailable;
461 eap->getKey = eap_psk_getKey;
462 eap->get_emsk = eap_psk_get_emsk;
464 ret = eap_peer_method_register(eap);
465 if (ret)
466 eap_peer_method_free(eap);
467 return ret;