freebsd-dev/contrib/wpa_supplicant/eap_tlv.c
2005-06-05 20:52:14 +00:00

177 lines
4.2 KiB
C

/*
* WPA Supplicant / EAP-TLV (draft-josefsson-pppext-eap-tls-eap-07.txt)
* Copyright (c) 2004-2005, Jouni Malinen <jkmaline@cc.hut.fi>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* Alternatively, this software may be distributed under the terms of BSD
* license.
*
* See README and COPYING for more details.
*/
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include "common.h"
#include "wpa_supplicant.h"
#include "eap_i.h"
#include "eap_tlv.h"
u8 * eap_tlv_build_nak(int id, int nak_type, size_t *resp_len)
{
struct eap_hdr *hdr;
u8 *pos;
*resp_len = sizeof(struct eap_hdr) + 1 + 10;
hdr = malloc(*resp_len);
if (hdr == NULL)
return NULL;
hdr->code = EAP_CODE_RESPONSE;
hdr->identifier = id;
hdr->length = host_to_be16(*resp_len);
pos = (u8 *) (hdr + 1);
*pos++ = EAP_TYPE_TLV;
*pos++ = 0x80; /* Mandatory */
*pos++ = EAP_TLV_NAK_TLV;
/* Length */
*pos++ = 0;
*pos++ = 6;
/* Vendor-Id */
*pos++ = 0;
*pos++ = 0;
*pos++ = 0;
*pos++ = 0;
/* NAK-Type */
*pos++ = nak_type >> 8;
*pos++ = nak_type & 0xff;
return (u8 *) hdr;
}
u8 * eap_tlv_build_result(int id, int status, size_t *resp_len)
{
struct eap_hdr *hdr;
u8 *pos;
*resp_len = sizeof(struct eap_hdr) + 1 + 6;
hdr = malloc(*resp_len);
if (hdr == NULL)
return NULL;
hdr->code = EAP_CODE_RESPONSE;
hdr->identifier = id;
hdr->length = host_to_be16(*resp_len);
pos = (u8 *) (hdr + 1);
*pos++ = EAP_TYPE_TLV;
*pos++ = 0x80; /* Mandatory */
*pos++ = EAP_TLV_RESULT_TLV;
/* Length */
*pos++ = 0;
*pos++ = 2;
/* Status */
*pos++ = status >> 8;
*pos++ = status & 0xff;
return (u8 *) hdr;
}
int eap_tlv_process(struct eap_sm *sm, struct eap_method_ret *ret,
struct eap_hdr *hdr, u8 **resp, size_t *resp_len)
{
size_t left;
u8 *pos;
u8 *result_tlv = NULL;
size_t result_tlv_len = 0;
int tlv_type, mandatory, tlv_len;
/* Parse TLVs */
left = be_to_host16(hdr->length) - sizeof(struct eap_hdr) - 1;
pos = (u8 *) (hdr + 1);
pos++;
wpa_hexdump(MSG_DEBUG, "EAP-TLV: Received TLVs", pos, left);
while (left >= 4) {
mandatory = !!(pos[0] & 0x80);
tlv_type = pos[0] & 0x3f;
tlv_type = (tlv_type << 8) | pos[1];
tlv_len = ((int) pos[2] << 8) | pos[3];
pos += 4;
left -= 4;
if (tlv_len > left) {
wpa_printf(MSG_DEBUG, "EAP-TLV: TLV underrun "
"(tlv_len=%d left=%lu)", tlv_len,
(unsigned long) left);
return -1;
}
switch (tlv_type) {
case EAP_TLV_RESULT_TLV:
result_tlv = pos;
result_tlv_len = tlv_len;
break;
default:
wpa_printf(MSG_DEBUG, "EAP-TLV: Unsupported TLV Type "
"%d%s", tlv_type,
mandatory ? " (mandatory)" : "");
if (mandatory) {
/* NAK TLV and ignore all TLVs in this packet.
*/
*resp = eap_tlv_build_nak(hdr->identifier,
tlv_type, resp_len);
return *resp == NULL ? -1 : 0;
}
/* Ignore this TLV, but process other TLVs */
break;
}
pos += tlv_len;
left -= tlv_len;
}
if (left) {
wpa_printf(MSG_DEBUG, "EAP-TLV: Last TLV too short in "
"Request (left=%lu)", (unsigned long) left);
return -1;
}
/* Process supported TLVs */
if (result_tlv) {
int status, resp_status;
wpa_hexdump(MSG_DEBUG, "EAP-TLV: Result TLV",
result_tlv, result_tlv_len);
if (result_tlv_len < 2) {
wpa_printf(MSG_INFO, "EAP-TLV: Too short Result TLV "
"(len=%lu)",
(unsigned long) result_tlv_len);
return -1;
}
status = ((int) result_tlv[0] << 8) | result_tlv[1];
if (status == EAP_TLV_RESULT_SUCCESS) {
wpa_printf(MSG_INFO, "EAP-TLV: TLV Result - Success "
"- EAP-TLV/Phase2 Completed");
resp_status = EAP_TLV_RESULT_SUCCESS;
ret->decision = DECISION_UNCOND_SUCC;
} else if (status == EAP_TLV_RESULT_FAILURE) {
wpa_printf(MSG_INFO, "EAP-TLV: TLV Result - Failure");
resp_status = EAP_TLV_RESULT_FAILURE;
ret->decision = DECISION_FAIL;
} else {
wpa_printf(MSG_INFO, "EAP-TLV: Unknown TLV Result "
"Status %d", status);
resp_status = EAP_TLV_RESULT_FAILURE;
ret->decision = DECISION_FAIL;
}
ret->methodState = METHOD_DONE;
*resp = eap_tlv_build_result(hdr->identifier, resp_status,
resp_len);
}
return 0;
}