18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / EAP-GPSK (RFC 5433) server 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2006-2007, Jouni Malinen <j@w1.fi> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 5c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * This software may be distributed under the terms of the BSD license. 6c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * See README for more details. 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "crypto/random.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eap_server/eap_i.h" 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eap_common/eap_gpsk_common.h" 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct eap_gpsk_data { 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum { GPSK_1, GPSK_3, SUCCESS, FAILURE } state; 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rand_server[EAP_GPSK_RAND_LEN]; 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 rand_peer[EAP_GPSK_RAND_LEN]; 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 msk[EAP_MSK_LEN]; 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 emsk[EAP_EMSK_LEN]; 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 sk[EAP_GPSK_MAX_SK_LEN]; 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t sk_len; 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 pk[EAP_GPSK_MAX_PK_LEN]; 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t pk_len; 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *id_peer; 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t id_peer_len; 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MAX_NUM_CSUITES 2 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_csuite csuite_list[MAX_NUM_CSUITES]; 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t csuite_count; 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int vendor; /* CSuite/Vendor */ 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int specifier; /* CSuite/Specifier */ 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * eap_gpsk_state_txt(int state) 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (state) { 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case GPSK_1: 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GPSK-1"; 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case GPSK_3: 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GPSK-3"; 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case SUCCESS: 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SUCCESS"; 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case FAILURE: 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "FAILURE"; 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "?"; 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_gpsk_state(struct eap_gpsk_data *data, int state) 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: %s -> %s", 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state_txt(data->state), 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state_txt(state)); 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->state = state; 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * eap_gpsk_init(struct eap_sm *sm) 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data; 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data = os_zalloc(sizeof(*data)); 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data == NULL) 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->state = GPSK_1; 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count = 0; 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_supported_ciphersuite(EAP_GPSK_VENDOR_IETF, 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_CIPHER_AES)) { 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE32(data->csuite_list[data->csuite_count].vendor, 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_VENDOR_IETF); 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE16(data->csuite_list[data->csuite_count].specifier, 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_CIPHER_AES); 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count++; 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_supported_ciphersuite(EAP_GPSK_VENDOR_IETF, 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_CIPHER_SHA256)) { 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE32(data->csuite_list[data->csuite_count].vendor, 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_VENDOR_IETF); 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE16(data->csuite_list[data->csuite_count].specifier, 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_GPSK_CIPHER_SHA256); 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count++; 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return data; 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_gpsk_reset(struct eap_sm *sm, void *priv) 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(data->id_peer); 98c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt bin_clear_free(data, sizeof(*data)); 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpabuf * eap_gpsk_build_gpsk_1(struct eap_sm *sm, 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data, u8 id) 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *req; 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Request/GPSK-1"); 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (random_get_bytes(data->rand_server, EAP_GPSK_RAND_LEN)) { 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "EAP-GPSK: Failed to get random data"); 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "EAP-GPSK: RAND_Server", 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rand_server, EAP_GPSK_RAND_LEN); 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11834af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt len = 1 + 2 + sm->server_id_len + EAP_GPSK_RAND_LEN + 2 + 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count * sizeof(struct eap_gpsk_csuite); 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt req = eap_msg_alloc(EAP_VENDOR_IETF, EAP_TYPE_GPSK, len, 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_CODE_REQUEST, id); 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (req == NULL) { 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "EAP-GPSK: Failed to allocate memory " 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for request/GPSK-1"); 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(req, EAP_GPSK_OPCODE_GPSK_1); 13034af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt wpabuf_put_be16(req, sm->server_id_len); 13134af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt wpabuf_put_data(req, sm->server_id, sm->server_id_len); 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(req, data->rand_server, EAP_GPSK_RAND_LEN); 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(req, 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count * sizeof(struct eap_gpsk_csuite)); 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(req, data->csuite_list, 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->csuite_count * sizeof(struct eap_gpsk_csuite)); 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return req; 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpabuf * eap_gpsk_build_gpsk_3(struct eap_sm *sm, 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data, u8 id) 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *pos, *start; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len, miclen; 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_csuite *csuite; 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *req; 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Request/GPSK-3"); 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt miclen = eap_gpsk_mic_len(data->vendor, data->specifier); 15334af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt len = 1 + 2 * EAP_GPSK_RAND_LEN + 2 + sm->server_id_len + 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct eap_gpsk_csuite) + 2 + miclen; 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt req = eap_msg_alloc(EAP_VENDOR_IETF, EAP_TYPE_GPSK, len, 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_CODE_REQUEST, id); 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (req == NULL) { 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "EAP-GPSK: Failed to allocate memory " 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for request/GPSK-3"); 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_u8(req, EAP_GPSK_OPCODE_GPSK_3); 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt start = wpabuf_put(req, 0); 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(req, data->rand_peer, EAP_GPSK_RAND_LEN); 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(req, data->rand_server, EAP_GPSK_RAND_LEN); 16934af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt wpabuf_put_be16(req, sm->server_id_len); 17034af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt wpabuf_put_data(req, sm->server_id, sm->server_id_len); 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt csuite = wpabuf_put(req, sizeof(*csuite)); 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE32(csuite->vendor, data->vendor); 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_PUT_BE16(csuite->specifier, data->specifier); 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* no PD_Payload_2 */ 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_be16(req, 0); 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = wpabuf_put(req, miclen); 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_compute_mic(data->sk, data->sk_len, data->vendor, 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->specifier, start, pos - start, pos) < 0) 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(req); 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return req; 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpabuf * eap_gpsk_buildReq(struct eap_sm *sm, void *priv, u8 id) 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (data->state) { 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case GPSK_1: 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return eap_gpsk_build_gpsk_1(sm, data, id); 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case GPSK_3: 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return eap_gpsk_build_gpsk_3(sm, data, id); 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Unknown state %d in buildReq", 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->state); 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_gpsk_check(struct eap_sm *sm, void *priv, 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *respData) 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos; 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = eap_hdr_validate(EAP_VENDOR_IETF, EAP_TYPE_GPSK, respData, &len); 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL || len < 1) { 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "EAP-GPSK: Invalid frame"); 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return TRUE; 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Received frame: opcode=%d", *pos); 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state == GPSK_1 && *pos == EAP_GPSK_OPCODE_GPSK_2) 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return FALSE; 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state == GPSK_3 && *pos == EAP_GPSK_OPCODE_GPSK_4) 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return FALSE; 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "EAP-GPSK: Unexpected opcode=%d in state=%d", 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos, data->state); 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return TRUE; 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_gpsk_process_gpsk_2(struct eap_sm *sm, 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data, 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *payload, size_t payloadlen) 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos, *end; 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 alen; 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct eap_gpsk_csuite *csuite; 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i, miclen; 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic[EAP_GPSK_MAX_MIC_LEN]; 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state != GPSK_1) 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Received Response/GPSK-2"); 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = payload; 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = payload + payloadlen; 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < 2) { 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ID_Peer length"); 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = WPA_GET_BE16(pos); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < alen) { 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ID_Peer"); 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(data->id_peer); 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->id_peer = os_malloc(alen); 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->id_peer == NULL) { 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Not enough memory to store " 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%d-octet ID_Peer", alen); 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data->id_peer, pos, alen); 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->id_peer_len = alen; 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "EAP-GPSK: ID_Peer", 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->id_peer, data->id_peer_len); 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += alen; 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < 2) { 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ID_Server length"); 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = WPA_GET_BE16(pos); 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < alen) { 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ID_Server"); 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 29634af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt if (alen != sm->server_id_len || 29734af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt os_memcmp(pos, sm->server_id, alen) != 0) { 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: ID_Server in GPSK-1 and " 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "GPSK-2 did not match"); 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += alen; 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < EAP_GPSK_RAND_LEN) { 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "RAND_Peer"); 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(data->rand_peer, pos, EAP_GPSK_RAND_LEN); 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: RAND_Peer", 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rand_peer, EAP_GPSK_RAND_LEN); 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += EAP_GPSK_RAND_LEN; 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < EAP_GPSK_RAND_LEN) { 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "RAND_Server"); 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(data->rand_server, pos, EAP_GPSK_RAND_LEN) != 0) { 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: RAND_Server in GPSK-1 and " 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "GPSK-2 did not match"); 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: RAND_Server in GPSK-1", 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rand_server, EAP_GPSK_RAND_LEN); 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: RAND_Server in GPSK-2", 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos, EAP_GPSK_RAND_LEN); 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += EAP_GPSK_RAND_LEN; 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < 2) { 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "CSuite_List length"); 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = WPA_GET_BE16(pos); 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < alen) { 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "CSuite_List"); 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alen != data->csuite_count * sizeof(struct eap_gpsk_csuite) || 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(pos, data->csuite_list, alen) != 0) { 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: CSuite_List in GPSK-1 and " 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "GPSK-2 did not match"); 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += alen; 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < (int) sizeof(*csuite)) { 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "CSuite_Sel"); 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt csuite = (const struct eap_gpsk_csuite *) pos; 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < data->csuite_count; i++) { 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(csuite, &data->csuite_list[i], sizeof(*csuite)) 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt == 0) 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (i == data->csuite_count) { 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Peer selected unsupported " 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ciphersuite %d:%d", 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_GET_BE32(csuite->vendor), 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_GET_BE16(csuite->specifier)); 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->vendor = WPA_GET_BE32(csuite->vendor); 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->specifier = WPA_GET_BE16(csuite->specifier); 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: CSuite_Sel %d:%d", 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->vendor, data->specifier); 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += sizeof(*csuite); 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < 2) { 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "PD_Payload_1 length"); 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = WPA_GET_BE16(pos); 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < alen) { 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "PD_Payload_1"); 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: PD_Payload_1", pos, alen); 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += alen; 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sm->user == NULL || sm->user->password == NULL) { 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "EAP-GPSK: No PSK/password configured " 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "for the user"); 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_derive_keys(sm->user->password, sm->user->password_len, 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->vendor, data->specifier, 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rand_peer, data->rand_server, 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->id_peer, data->id_peer_len, 41134af306c42b7ccf956508e7cd23f0ba90606e360Dmitry Shmidt sm->server_id, sm->server_id_len, 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->msk, data->emsk, 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->sk, &data->sk_len, 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->pk, &data->pk_len) < 0) { 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Failed to derive keys"); 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt miclen = eap_gpsk_mic_len(data->vendor, data->specifier); 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < (int) miclen) { 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Message too short for MIC " 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(left=%lu miclen=%lu)", 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) (end - pos), 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) miclen); 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_compute_mic(data->sk, data->sk_len, data->vendor, 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->specifier, payload, pos - payload, mic) 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt < 0) { 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Failed to compute MIC"); 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 436c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt if (os_memcmp_const(mic, pos, miclen) != 0) { 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "EAP-GPSK: Incorrect MIC in GPSK-2"); 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: Received MIC", pos, miclen); 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: Computed MIC", mic, miclen); 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += miclen; 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos != end) { 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Ignored %lu bytes of extra " 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "data in the end of GPSK-2", 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) (end - pos)); 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, GPSK_3); 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_gpsk_process_gpsk_4(struct eap_sm *sm, 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data, 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *payload, size_t payloadlen) 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos, *end; 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 alen; 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t miclen; 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 mic[EAP_GPSK_MAX_MIC_LEN]; 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state != GPSK_3) 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Received Response/GPSK-4"); 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = payload; 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = payload + payloadlen; 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < 2) { 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "PD_Payload_1 length"); 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = WPA_GET_BE16(pos); 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2; 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < alen) { 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Too short message for " 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "PD_Payload_1"); 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: PD_Payload_1", pos, alen); 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += alen; 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt miclen = eap_gpsk_mic_len(data->vendor, data->specifier); 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end - pos < (int) miclen) { 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Message too short for MIC " 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(left=%lu miclen=%lu)", 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) (end - pos), 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) miclen); 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap_gpsk_compute_mic(data->sk, data->sk_len, data->vendor, 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->specifier, payload, pos - payload, mic) 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt < 0) { 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Failed to compute MIC"); 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 505c28170251eb54dbf64a9074a07fee377587425b2Dmitry Shmidt if (os_memcmp_const(mic, pos, miclen) != 0) { 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "EAP-GPSK: Incorrect MIC in GPSK-4"); 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: Received MIC", pos, miclen); 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "EAP-GPSK: Computed MIC", mic, miclen); 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, FAILURE); 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += miclen; 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos != end) { 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "EAP-GPSK: Ignored %lu bytes of extra " 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "data in the end of GPSK-4", 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) (end - pos)); 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_state(data, SUCCESS); 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_gpsk_process(struct eap_sm *sm, void *priv, 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *respData) 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *pos; 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = eap_hdr_validate(EAP_VENDOR_IETF, EAP_TYPE_GPSK, respData, &len); 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL || len < 1) 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (*pos) { 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case EAP_GPSK_OPCODE_GPSK_2: 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_process_gpsk_2(sm, data, pos + 1, len - 1); 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case EAP_GPSK_OPCODE_GPSK_4: 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_gpsk_process_gpsk_4(sm, data, pos + 1, len - 1); 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_gpsk_isDone(struct eap_sm *sm, void *priv) 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return data->state == SUCCESS || data->state == FAILURE; 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * eap_gpsk_getKey(struct eap_sm *sm, void *priv, size_t *len) 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *key; 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state != SUCCESS) 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = os_malloc(EAP_MSK_LEN); 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key == NULL) 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(key, data->msk, EAP_MSK_LEN); 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len = EAP_MSK_LEN; 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return key; 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * eap_gpsk_get_emsk(struct eap_sm *sm, void *priv, size_t *len) 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *key; 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data->state != SUCCESS) 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = os_malloc(EAP_EMSK_LEN); 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key == NULL) 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(key, data->emsk, EAP_EMSK_LEN); 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *len = EAP_EMSK_LEN; 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return key; 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_gpsk_isSuccess(struct eap_sm *sm, void *priv) 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_gpsk_data *data = priv; 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return data->state == SUCCESS; 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint eap_server_gpsk_register(void) 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct eap_method *eap; 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap = eap_server_method_alloc(EAP_SERVER_METHOD_INTERFACE_VERSION, 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EAP_VENDOR_IETF, EAP_TYPE_GPSK, "GPSK"); 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (eap == NULL) 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->init = eap_gpsk_init; 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->reset = eap_gpsk_reset; 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->buildReq = eap_gpsk_buildReq; 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->check = eap_gpsk_check; 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->process = eap_gpsk_process; 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->isDone = eap_gpsk_isDone; 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->getKey = eap_gpsk_getKey; 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->isSuccess = eap_gpsk_isSuccess; 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap->get_emsk = eap_gpsk_get_emsk; 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = eap_server_method_register(eap); 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret) 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eap_server_method_free(eap); 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 621