/* * Copyright (C) 2012 Tobias Brunner * Copyright (C) 2005-2010 Martin Willi * Copyright (C) 2005 Jan Hutter * Hochschule fuer Technik Rapperswil * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. See . * * This program is distributed in the hope that it will be useful, but * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License * for more details. */ #include #include "eap_payload.h" #include #include #include typedef struct private_eap_payload_t private_eap_payload_t; /** * Private data of an eap_payload_t object. * */ struct private_eap_payload_t { /** * Public eap_payload_t interface. */ eap_payload_t public; /** * Next payload type. */ uint8_t next_payload; /** * Critical flag. */ bool critical; /** * Reserved bits */ bool reserved[7]; /** * Length of this payload. */ uint16_t payload_length; /** * EAP message data, if available */ chunk_t data; }; /** * Encoding rules to parse or generate a EAP payload. * * The defined offsets are the positions in a object of type * private_eap_payload_t. * */ static encoding_rule_t encodings[] = { /* 1 Byte next payload type, stored in the field next_payload */ { U_INT_8, offsetof(private_eap_payload_t, next_payload) }, /* the critical bit */ { FLAG, offsetof(private_eap_payload_t, critical) }, /* 7 Bit reserved bits, nowhere stored */ { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[0]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[1]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[2]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[3]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[4]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[5]) }, { RESERVED_BIT, offsetof(private_eap_payload_t, reserved[6]) }, /* Length of the whole payload*/ { PAYLOAD_LENGTH, offsetof(private_eap_payload_t, payload_length) }, /* chunt to data, starting at "code" */ { CHUNK_DATA, offsetof(private_eap_payload_t, data) }, }; /* 1 2 3 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ ! Next Payload !C! RESERVED ! Payload Length ! +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ ! Code ! Identifier ! Length ! +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ ! Type ! Type_Data... +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+- */ METHOD(payload_t, verify, status_t, private_eap_payload_t *this) { uint16_t length; uint8_t code; if (this->data.len < 4) { DBG1(DBG_ENC, "EAP payloads EAP message too short (%d)", this->data.len); return FAILED; } length = untoh16(this->data.ptr + 2); if (this->data.len != length) { DBG1(DBG_ENC, "EAP payload length (%d) does not match contained " "message length (%d)", this->data.len, length); return FAILED; } code = this->data.ptr[0]; switch (code) { case EAP_REQUEST: case EAP_RESPONSE: { if (this->data.len < 4) { DBG1(DBG_ENC, "EAP Request/Response does not have any data"); return FAILED; } break; } case EAP_SUCCESS: case EAP_FAILURE: { if (this->data.len != 4) { DBG1(DBG_ENC, "EAP Success/Failure has data"); return FAILED; } break; } default: return FAILED; } return SUCCESS; } METHOD(payload_t, get_encoding_rules, int, private_eap_payload_t *this, encoding_rule_t **rules) { *rules = encodings; return countof(encodings); } METHOD(payload_t, get_header_length, int, private_eap_payload_t *this) { return 4; } METHOD(payload_t, get_payload_type, payload_type_t, private_eap_payload_t *this) { return PLV2_EAP; } METHOD(payload_t, get_next_type, payload_type_t, private_eap_payload_t *this) { return (this->next_payload); } METHOD(payload_t, set_next_type, void, private_eap_payload_t *this, payload_type_t type) { this->next_payload = type; } METHOD(payload_t, get_length, size_t, private_eap_payload_t *this) { return this->payload_length; } METHOD(eap_payload_t, get_data, chunk_t, private_eap_payload_t *this) { return this->data; } METHOD(eap_payload_t, set_data, void, private_eap_payload_t *this, chunk_t data) { free(this->data.ptr); this->data = chunk_clone(data); this->payload_length = this->data.len + 4; } METHOD(eap_payload_t, get_code, eap_code_t, private_eap_payload_t *this) { if (this->data.len > 0) { return this->data.ptr[0]; } /* should not happen, as it is verified */ return 0; } METHOD(eap_payload_t, get_identifier, uint8_t, private_eap_payload_t *this) { if (this->data.len > 1) { return this->data.ptr[1]; } /* should not happen, as it is verified */ return 0; } /** * Get the current type at the given offset into this->data. * @return the new offset or 0 if failed */ static size_t extract_type(private_eap_payload_t *this, size_t offset, eap_type_t *type, uint32_t *vendor) { if (this->data.len > offset) { *vendor = 0; *type = this->data.ptr[offset]; if (*type != EAP_EXPANDED) { return offset + 1; } if (this->data.len >= offset + 8) { *vendor = untoh32(this->data.ptr + offset) & 0x00FFFFFF; *type = untoh32(this->data.ptr + offset + 4); return offset + 8; } } return 0; } METHOD(eap_payload_t, get_type, eap_type_t, private_eap_payload_t *this, uint32_t *vendor) { eap_type_t type; *vendor = 0; if (extract_type(this, 4, &type, vendor)) { return type; } return 0; } /** * Type enumerator */ typedef struct { /** public interface */ enumerator_t public; /** payload */ private_eap_payload_t *payload; /** current offset in the data */ size_t offset; } type_enumerator_t; METHOD(enumerator_t, enumerate_types, bool, type_enumerator_t *this, va_list args) { eap_type_t *type; uint32_t *vendor; VA_ARGS_VGET(args, type, vendor); this->offset = extract_type(this->payload, this->offset, type, vendor); return this->offset; } METHOD(eap_payload_t, get_types, enumerator_t*, private_eap_payload_t *this) { type_enumerator_t *enumerator; eap_type_t type; uint32_t vendor; size_t offset; offset = extract_type(this, 4, &type, &vendor); if (offset && type == EAP_NAK) { INIT(enumerator, .public = { .enumerate = enumerator_enumerate_default, .venumerate = _enumerate_types, .destroy = (void*)free, }, .payload = this, .offset = offset, ); return &enumerator->public; } return enumerator_create_empty(); } METHOD(eap_payload_t, is_expanded, bool, private_eap_payload_t *this) { return this->data.len > 4 ? this->data.ptr[4] == EAP_EXPANDED : FALSE; } METHOD2(payload_t, eap_payload_t, destroy, void, private_eap_payload_t *this) { chunk_free(&this->data); free(this); } /* * Described in header */ eap_payload_t *eap_payload_create() { private_eap_payload_t *this; INIT(this, .public = { .payload_interface = { .verify = _verify, .get_encoding_rules = _get_encoding_rules, .get_header_length = _get_header_length, .get_length = _get_length, .get_next_type = _get_next_type, .set_next_type = _set_next_type, .get_type = _get_payload_type, .destroy = _destroy, }, .get_data = _get_data, .set_data = _set_data, .get_code = _get_code, .get_identifier = _get_identifier, .get_type = _get_type, .get_types = _get_types, .is_expanded = _is_expanded, .destroy = _destroy, }, .next_payload = PL_NONE, .payload_length = get_header_length(this), ); return &this->public; } /* * Described in header */ eap_payload_t *eap_payload_create_data(chunk_t data) { eap_payload_t *this = eap_payload_create(); this->set_data(this, data); return this; } /* * Described in header */ eap_payload_t *eap_payload_create_data_own(chunk_t data) { eap_payload_t *this = eap_payload_create(); this->set_data(this, data); free(data.ptr); return this; } /* * Described in header */ eap_payload_t *eap_payload_create_code(eap_code_t code, uint8_t identifier) { chunk_t data; data = chunk_from_chars(code, identifier, 0, 0); htoun16(data.ptr + 2, data.len); return eap_payload_create_data(data); } /** * Write the given type either expanded or not */ static void write_type(bio_writer_t *writer, eap_type_t type, uint32_t vendor, bool expanded) { if (expanded) { writer->write_uint8(writer, EAP_EXPANDED); writer->write_uint24(writer, vendor); writer->write_uint32(writer, type); } else { writer->write_uint8(writer, type); } } /* * Described in header */ eap_payload_t *eap_payload_create_nak(uint8_t identifier, eap_type_t type, uint32_t vendor, bool expanded) { enumerator_t *enumerator; eap_type_t reg_type; uint32_t reg_vendor; bio_writer_t *writer; chunk_t data; bool added_any = FALSE, found_vendor = FALSE; eap_payload_t *payload; writer = bio_writer_create(12); writer->write_uint8(writer, EAP_RESPONSE); writer->write_uint8(writer, identifier); /* write zero length, we update it once we know the length */ writer->write_uint16(writer, 0); write_type(writer, EAP_NAK, 0, expanded); enumerator = charon->eap->create_enumerator(charon->eap, EAP_PEER); while (enumerator->enumerate(enumerator, ®_type, ®_vendor)) { if ((type && type != reg_type) || (type && vendor && vendor != reg_vendor)) { /* the preferred type is only sent if we actually find it */ continue; } if (!reg_vendor || expanded) { write_type(writer, reg_type, reg_vendor, expanded); added_any = TRUE; } else if (reg_vendor) { /* found vendor specific method, but this is not an expanded Nak */ found_vendor = TRUE; } } enumerator->destroy(enumerator); if (found_vendor) { /* request an expanded authentication type */ write_type(writer, EAP_EXPANDED, 0, expanded); added_any = TRUE; } if (!added_any) { /* no methods added */ write_type(writer, 0, 0, expanded); } /* set length */ data = writer->get_buf(writer); htoun16(data.ptr + offsetof(eap_packet_t, length), data.len); payload = eap_payload_create_data(data); writer->destroy(writer); return payload; }