18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/*
28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / Test method for vendor specific (expanded) EAP type
38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2005-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 "eap_i.h"
138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define EAP_VENDOR_ID EAP_VENDOR_HOSTAP
168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define EAP_VENDOR_TYPE 0xfcfbfaf9
178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct eap_vendor_test_data {
208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	enum { INIT, CONFIRM, SUCCESS, FAILURE } state;
218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt};
228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * eap_vendor_test_state_txt(int state)
258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	switch (state) {
278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case INIT:
288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return "INIT";
298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case CONFIRM:
308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return "CONFIRM";
318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case SUCCESS:
328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return "SUCCESS";
338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case FAILURE:
348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return "FAILURE";
358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	default:
368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return "?";
378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_vendor_test_state(struct eap_vendor_test_data *data,
428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				  int state)
438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "EAP-VENDOR-TEST: %s -> %s",
458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   eap_vendor_test_state_txt(data->state),
468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   eap_vendor_test_state_txt(state));
478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data->state = state;
488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * eap_vendor_test_init(struct eap_sm *sm)
528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data;
548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data = os_zalloc(sizeof(*data));
568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (data == NULL)
578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data->state = INIT;
598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return data;
618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_vendor_test_reset(struct eap_sm *sm, void *priv)
658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(data);
688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpabuf * eap_vendor_test_buildReq(struct eap_sm *sm, void *priv,
728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt						u8 id)
738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wpabuf *req;
768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	req = eap_msg_alloc(EAP_VENDOR_ID, EAP_VENDOR_TYPE, 1,
788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			    EAP_CODE_REQUEST, id);
798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (req == NULL) {
808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_ERROR, "EAP-VENDOR-TEST: Failed to allocate "
818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "memory for request");
828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_put_u8(req, data->state == INIT ? 1 : 3);
868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return req;
888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_vendor_test_check(struct eap_sm *sm, void *priv,
928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				     struct wpabuf *respData)
938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *pos;
958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t len;
968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	pos = eap_hdr_validate(EAP_VENDOR_ID, EAP_VENDOR_TYPE, respData, &len);
988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (pos == NULL || len < 1) {
998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_INFO, "EAP-VENDOR-TEST: Invalid frame");
1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return TRUE;
1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return FALSE;
1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void eap_vendor_test_process(struct eap_sm *sm, void *priv,
1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    struct wpabuf *respData)
1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *pos;
1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t len;
1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	pos = eap_hdr_validate(EAP_VENDOR_ID, EAP_VENDOR_TYPE, respData, &len);
1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (pos == NULL || len < 1)
1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (data->state == INIT) {
1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (*pos == 2)
1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			eap_vendor_test_state(data, CONFIRM);
1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else
1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			eap_vendor_test_state(data, FAILURE);
1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (data->state == CONFIRM) {
1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (*pos == 4)
1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			eap_vendor_test_state(data, SUCCESS);
1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else
1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			eap_vendor_test_state(data, FAILURE);
1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else
1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		eap_vendor_test_state(data, FAILURE);
1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_vendor_test_isDone(struct eap_sm *sm, void *priv)
1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return data->state == SUCCESS;
1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic u8 * eap_vendor_test_getKey(struct eap_sm *sm, void *priv, size_t *len)
1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	u8 *key;
1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const int key_len = 64;
1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (data->state != SUCCESS)
1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	key = os_malloc(key_len);
1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (key == NULL)
1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memset(key, 0x11, key_len / 2);
1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memset(key + key_len / 2, 0x22, key_len / 2);
1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	*len = key_len;
1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return key;
1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic Boolean eap_vendor_test_isSuccess(struct eap_sm *sm, void *priv)
1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_vendor_test_data *data = priv;
1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return data->state == SUCCESS;
1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint eap_server_vendor_test_register(void)
1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct eap_method *eap;
1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int ret;
1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap = eap_server_method_alloc(EAP_SERVER_METHOD_INTERFACE_VERSION,
1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				      EAP_VENDOR_ID, EAP_VENDOR_TYPE,
1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				      "VENDOR-TEST");
1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (eap == NULL)
1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->init = eap_vendor_test_init;
1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->reset = eap_vendor_test_reset;
1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->buildReq = eap_vendor_test_buildReq;
1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->check = eap_vendor_test_check;
1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->process = eap_vendor_test_process;
1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->isDone = eap_vendor_test_isDone;
1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->getKey = eap_vendor_test_getKey;
1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eap->isSuccess = eap_vendor_test_isSuccess;
1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ret = eap_server_method_register(eap);
1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ret)
1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		eap_server_method_free(eap);
1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return ret;
1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
193