Home | History | Annotate | Download | only in radius
      1 /*
      2  * RADIUS message processing
      3  * Copyright (c) 2002-2009, 2011-2012, Jouni Malinen <j (at) w1.fi>
      4  *
      5  * This software may be distributed under the terms of the BSD license.
      6  * See README for more details.
      7  */
      8 
      9 #include "utils/includes.h"
     10 
     11 #include "utils/common.h"
     12 #include "utils/wpabuf.h"
     13 #include "crypto/md5.h"
     14 #include "crypto/crypto.h"
     15 #include "radius.h"
     16 
     17 
     18 /**
     19  * struct radius_msg - RADIUS message structure for new and parsed messages
     20  */
     21 struct radius_msg {
     22 	/**
     23 	 * buf - Allocated buffer for RADIUS message
     24 	 */
     25 	struct wpabuf *buf;
     26 
     27 	/**
     28 	 * hdr - Pointer to the RADIUS header in buf
     29 	 */
     30 	struct radius_hdr *hdr;
     31 
     32 	/**
     33 	 * attr_pos - Array of indexes to attributes
     34 	 *
     35 	 * The values are number of bytes from buf to the beginning of
     36 	 * struct radius_attr_hdr.
     37 	 */
     38 	size_t *attr_pos;
     39 
     40 	/**
     41 	 * attr_size - Total size of the attribute pointer array
     42 	 */
     43 	size_t attr_size;
     44 
     45 	/**
     46 	 * attr_used - Total number of attributes in the array
     47 	 */
     48 	size_t attr_used;
     49 };
     50 
     51 
     52 struct radius_hdr * radius_msg_get_hdr(struct radius_msg *msg)
     53 {
     54 	return msg->hdr;
     55 }
     56 
     57 
     58 struct wpabuf * radius_msg_get_buf(struct radius_msg *msg)
     59 {
     60 	return msg->buf;
     61 }
     62 
     63 
     64 static struct radius_attr_hdr *
     65 radius_get_attr_hdr(struct radius_msg *msg, int idx)
     66 {
     67 	return (struct radius_attr_hdr *)
     68 		(wpabuf_mhead_u8(msg->buf) + msg->attr_pos[idx]);
     69 }
     70 
     71 
     72 static void radius_msg_set_hdr(struct radius_msg *msg, u8 code, u8 identifier)
     73 {
     74 	msg->hdr->code = code;
     75 	msg->hdr->identifier = identifier;
     76 }
     77 
     78 
     79 static int radius_msg_initialize(struct radius_msg *msg)
     80 {
     81 	msg->attr_pos = os_calloc(RADIUS_DEFAULT_ATTR_COUNT,
     82 				  sizeof(*msg->attr_pos));
     83 	if (msg->attr_pos == NULL)
     84 		return -1;
     85 
     86 	msg->attr_size = RADIUS_DEFAULT_ATTR_COUNT;
     87 	msg->attr_used = 0;
     88 
     89 	return 0;
     90 }
     91 
     92 
     93 /**
     94  * radius_msg_new - Create a new RADIUS message
     95  * @code: Code for RADIUS header
     96  * @identifier: Identifier for RADIUS header
     97  * Returns: Context for RADIUS message or %NULL on failure
     98  *
     99  * The caller is responsible for freeing the returned data with
    100  * radius_msg_free().
    101  */
    102 struct radius_msg * radius_msg_new(u8 code, u8 identifier)
    103 {
    104 	struct radius_msg *msg;
    105 
    106 	msg = os_zalloc(sizeof(*msg));
    107 	if (msg == NULL)
    108 		return NULL;
    109 
    110 	msg->buf = wpabuf_alloc(RADIUS_DEFAULT_MSG_SIZE);
    111 	if (msg->buf == NULL || radius_msg_initialize(msg)) {
    112 		radius_msg_free(msg);
    113 		return NULL;
    114 	}
    115 	msg->hdr = wpabuf_put(msg->buf, sizeof(struct radius_hdr));
    116 
    117 	radius_msg_set_hdr(msg, code, identifier);
    118 
    119 	return msg;
    120 }
    121 
    122 
    123 /**
    124  * radius_msg_free - Free a RADIUS message
    125  * @msg: RADIUS message from radius_msg_new() or radius_msg_parse()
    126  */
    127 void radius_msg_free(struct radius_msg *msg)
    128 {
    129 	if (msg == NULL)
    130 		return;
    131 
    132 	wpabuf_free(msg->buf);
    133 	os_free(msg->attr_pos);
    134 	os_free(msg);
    135 }
    136 
    137 
    138 static const char *radius_code_string(u8 code)
    139 {
    140 	switch (code) {
    141 	case RADIUS_CODE_ACCESS_REQUEST: return "Access-Request";
    142 	case RADIUS_CODE_ACCESS_ACCEPT: return "Access-Accept";
    143 	case RADIUS_CODE_ACCESS_REJECT: return "Access-Reject";
    144 	case RADIUS_CODE_ACCOUNTING_REQUEST: return "Accounting-Request";
    145 	case RADIUS_CODE_ACCOUNTING_RESPONSE: return "Accounting-Response";
    146 	case RADIUS_CODE_ACCESS_CHALLENGE: return "Access-Challenge";
    147 	case RADIUS_CODE_STATUS_SERVER: return "Status-Server";
    148 	case RADIUS_CODE_STATUS_CLIENT: return "Status-Client";
    149 	case RADIUS_CODE_RESERVED: return "Reserved";
    150 	case RADIUS_CODE_DISCONNECT_REQUEST: return "Disconnect-Request";
    151 	case RADIUS_CODE_DISCONNECT_ACK: return "Disconnect-ACK";
    152 	case RADIUS_CODE_DISCONNECT_NAK: return "Disconnect-NAK";
    153 	case RADIUS_CODE_COA_REQUEST: return "CoA-Request";
    154 	case RADIUS_CODE_COA_ACK: return "CoA-ACK";
    155 	case RADIUS_CODE_COA_NAK: return "CoA-NAK";
    156 	default: return "?Unknown?";
    157 	}
    158 }
    159 
    160 
    161 struct radius_attr_type {
    162 	u8 type;
    163 	char *name;
    164 	enum {
    165 		RADIUS_ATTR_UNDIST, RADIUS_ATTR_TEXT, RADIUS_ATTR_IP,
    166 		RADIUS_ATTR_HEXDUMP, RADIUS_ATTR_INT32, RADIUS_ATTR_IPV6
    167 	} data_type;
    168 };
    169 
    170 static struct radius_attr_type radius_attrs[] =
    171 {
    172 	{ RADIUS_ATTR_USER_NAME, "User-Name", RADIUS_ATTR_TEXT },
    173 	{ RADIUS_ATTR_USER_PASSWORD, "User-Password", RADIUS_ATTR_UNDIST },
    174 	{ RADIUS_ATTR_NAS_IP_ADDRESS, "NAS-IP-Address", RADIUS_ATTR_IP },
    175 	{ RADIUS_ATTR_NAS_PORT, "NAS-Port", RADIUS_ATTR_INT32 },
    176 	{ RADIUS_ATTR_FRAMED_MTU, "Framed-MTU", RADIUS_ATTR_INT32 },
    177 	{ RADIUS_ATTR_REPLY_MESSAGE, "Reply-Message", RADIUS_ATTR_TEXT },
    178 	{ RADIUS_ATTR_STATE, "State", RADIUS_ATTR_UNDIST },
    179 	{ RADIUS_ATTR_CLASS, "Class", RADIUS_ATTR_UNDIST },
    180 	{ RADIUS_ATTR_VENDOR_SPECIFIC, "Vendor-Specific", RADIUS_ATTR_UNDIST },
    181 	{ RADIUS_ATTR_SESSION_TIMEOUT, "Session-Timeout", RADIUS_ATTR_INT32 },
    182 	{ RADIUS_ATTR_IDLE_TIMEOUT, "Idle-Timeout", RADIUS_ATTR_INT32 },
    183 	{ RADIUS_ATTR_TERMINATION_ACTION, "Termination-Action",
    184 	  RADIUS_ATTR_INT32 },
    185 	{ RADIUS_ATTR_CALLED_STATION_ID, "Called-Station-Id",
    186 	  RADIUS_ATTR_TEXT },
    187 	{ RADIUS_ATTR_CALLING_STATION_ID, "Calling-Station-Id",
    188 	  RADIUS_ATTR_TEXT },
    189 	{ RADIUS_ATTR_NAS_IDENTIFIER, "NAS-Identifier", RADIUS_ATTR_TEXT },
    190 	{ RADIUS_ATTR_PROXY_STATE, "Proxy-State", RADIUS_ATTR_UNDIST },
    191 	{ RADIUS_ATTR_ACCT_STATUS_TYPE, "Acct-Status-Type",
    192 	  RADIUS_ATTR_INT32 },
    193 	{ RADIUS_ATTR_ACCT_DELAY_TIME, "Acct-Delay-Time", RADIUS_ATTR_INT32 },
    194 	{ RADIUS_ATTR_ACCT_INPUT_OCTETS, "Acct-Input-Octets",
    195 	  RADIUS_ATTR_INT32 },
    196 	{ RADIUS_ATTR_ACCT_OUTPUT_OCTETS, "Acct-Output-Octets",
    197 	  RADIUS_ATTR_INT32 },
    198 	{ RADIUS_ATTR_ACCT_SESSION_ID, "Acct-Session-Id", RADIUS_ATTR_TEXT },
    199 	{ RADIUS_ATTR_ACCT_AUTHENTIC, "Acct-Authentic", RADIUS_ATTR_INT32 },
    200 	{ RADIUS_ATTR_ACCT_SESSION_TIME, "Acct-Session-Time",
    201 	  RADIUS_ATTR_INT32 },
    202 	{ RADIUS_ATTR_ACCT_INPUT_PACKETS, "Acct-Input-Packets",
    203 	  RADIUS_ATTR_INT32 },
    204 	{ RADIUS_ATTR_ACCT_OUTPUT_PACKETS, "Acct-Output-Packets",
    205 	  RADIUS_ATTR_INT32 },
    206 	{ RADIUS_ATTR_ACCT_TERMINATE_CAUSE, "Acct-Terminate-Cause",
    207 	  RADIUS_ATTR_INT32 },
    208 	{ RADIUS_ATTR_ACCT_MULTI_SESSION_ID, "Acct-Multi-Session-Id",
    209 	  RADIUS_ATTR_TEXT },
    210 	{ RADIUS_ATTR_ACCT_LINK_COUNT, "Acct-Link-Count", RADIUS_ATTR_INT32 },
    211 	{ RADIUS_ATTR_ACCT_INPUT_GIGAWORDS, "Acct-Input-Gigawords",
    212 	  RADIUS_ATTR_INT32 },
    213 	{ RADIUS_ATTR_ACCT_OUTPUT_GIGAWORDS, "Acct-Output-Gigawords",
    214 	  RADIUS_ATTR_INT32 },
    215 	{ RADIUS_ATTR_EVENT_TIMESTAMP, "Event-Timestamp",
    216 	  RADIUS_ATTR_INT32 },
    217 	{ RADIUS_ATTR_NAS_PORT_TYPE, "NAS-Port-Type", RADIUS_ATTR_INT32 },
    218 	{ RADIUS_ATTR_TUNNEL_TYPE, "Tunnel-Type", RADIUS_ATTR_HEXDUMP },
    219 	{ RADIUS_ATTR_TUNNEL_MEDIUM_TYPE, "Tunnel-Medium-Type",
    220 	  RADIUS_ATTR_HEXDUMP },
    221 	{ RADIUS_ATTR_TUNNEL_PASSWORD, "Tunnel-Password",
    222 	  RADIUS_ATTR_UNDIST },
    223 	{ RADIUS_ATTR_CONNECT_INFO, "Connect-Info", RADIUS_ATTR_TEXT },
    224 	{ RADIUS_ATTR_EAP_MESSAGE, "EAP-Message", RADIUS_ATTR_UNDIST },
    225 	{ RADIUS_ATTR_MESSAGE_AUTHENTICATOR, "Message-Authenticator",
    226 	  RADIUS_ATTR_UNDIST },
    227 	{ RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID, "Tunnel-Private-Group-Id",
    228 	  RADIUS_ATTR_HEXDUMP },
    229 	{ RADIUS_ATTR_ACCT_INTERIM_INTERVAL, "Acct-Interim-Interval",
    230 	  RADIUS_ATTR_INT32 },
    231 	{ RADIUS_ATTR_CHARGEABLE_USER_IDENTITY, "Chargeable-User-Identity",
    232 	  RADIUS_ATTR_TEXT },
    233 	{ RADIUS_ATTR_NAS_IPV6_ADDRESS, "NAS-IPv6-Address", RADIUS_ATTR_IPV6 },
    234 	{ RADIUS_ATTR_ERROR_CAUSE, "Error-Cause", RADIUS_ATTR_INT32 }
    235 };
    236 #define RADIUS_ATTRS (sizeof(radius_attrs) / sizeof(radius_attrs[0]))
    237 
    238 
    239 static struct radius_attr_type *radius_get_attr_type(u8 type)
    240 {
    241 	size_t i;
    242 
    243 	for (i = 0; i < RADIUS_ATTRS; i++) {
    244 		if (type == radius_attrs[i].type)
    245 			return &radius_attrs[i];
    246 	}
    247 
    248 	return NULL;
    249 }
    250 
    251 
    252 static void print_char(char c)
    253 {
    254 	if (c >= 32 && c < 127)
    255 		printf("%c", c);
    256 	else
    257 		printf("<%02x>", c);
    258 }
    259 
    260 
    261 static void radius_msg_dump_attr(struct radius_attr_hdr *hdr)
    262 {
    263 	struct radius_attr_type *attr;
    264 	int i, len;
    265 	unsigned char *pos;
    266 
    267 	attr = radius_get_attr_type(hdr->type);
    268 
    269 	printf("   Attribute %d (%s) length=%d\n",
    270 	       hdr->type, attr ? attr->name : "?Unknown?", hdr->length);
    271 
    272 	if (attr == NULL || hdr->length < sizeof(struct radius_attr_hdr))
    273 		return;
    274 
    275 	len = hdr->length - sizeof(struct radius_attr_hdr);
    276 	pos = (unsigned char *) (hdr + 1);
    277 
    278 	switch (attr->data_type) {
    279 	case RADIUS_ATTR_TEXT:
    280 		printf("      Value: '");
    281 		for (i = 0; i < len; i++)
    282 			print_char(pos[i]);
    283 		printf("'\n");
    284 		break;
    285 
    286 	case RADIUS_ATTR_IP:
    287 		if (len == 4) {
    288 			struct in_addr addr;
    289 			os_memcpy(&addr, pos, 4);
    290 			printf("      Value: %s\n", inet_ntoa(addr));
    291 		} else
    292 			printf("      Invalid IP address length %d\n", len);
    293 		break;
    294 
    295 #ifdef CONFIG_IPV6
    296 	case RADIUS_ATTR_IPV6:
    297 		if (len == 16) {
    298 			char buf[128];
    299 			const char *atxt;
    300 			struct in6_addr *addr = (struct in6_addr *) pos;
    301 			atxt = inet_ntop(AF_INET6, addr, buf, sizeof(buf));
    302 			printf("      Value: %s\n", atxt ? atxt : "?");
    303 		} else
    304 			printf("      Invalid IPv6 address length %d\n", len);
    305 		break;
    306 #endif /* CONFIG_IPV6 */
    307 
    308 	case RADIUS_ATTR_HEXDUMP:
    309 	case RADIUS_ATTR_UNDIST:
    310 		printf("      Value:");
    311 		for (i = 0; i < len; i++)
    312 			printf(" %02x", pos[i]);
    313 		printf("\n");
    314 		break;
    315 
    316 	case RADIUS_ATTR_INT32:
    317 		if (len == 4)
    318 			printf("      Value: %u\n", WPA_GET_BE32(pos));
    319 		else
    320 			printf("      Invalid INT32 length %d\n", len);
    321 		break;
    322 
    323 	default:
    324 		break;
    325 	}
    326 }
    327 
    328 
    329 void radius_msg_dump(struct radius_msg *msg)
    330 {
    331 	size_t i;
    332 
    333 	printf("RADIUS message: code=%d (%s) identifier=%d length=%d\n",
    334 	       msg->hdr->code, radius_code_string(msg->hdr->code),
    335 	       msg->hdr->identifier, be_to_host16(msg->hdr->length));
    336 
    337 	for (i = 0; i < msg->attr_used; i++) {
    338 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
    339 		radius_msg_dump_attr(attr);
    340 	}
    341 }
    342 
    343 
    344 int radius_msg_finish(struct radius_msg *msg, const u8 *secret,
    345 		      size_t secret_len)
    346 {
    347 	if (secret) {
    348 		u8 auth[MD5_MAC_LEN];
    349 		struct radius_attr_hdr *attr;
    350 
    351 		os_memset(auth, 0, MD5_MAC_LEN);
    352 		attr = radius_msg_add_attr(msg,
    353 					   RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    354 					   auth, MD5_MAC_LEN);
    355 		if (attr == NULL) {
    356 			wpa_printf(MSG_WARNING, "RADIUS: Could not add "
    357 				   "Message-Authenticator");
    358 			return -1;
    359 		}
    360 		msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    361 		hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    362 			 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    363 	} else
    364 		msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    365 
    366 	if (wpabuf_len(msg->buf) > 0xffff) {
    367 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    368 			   (unsigned long) wpabuf_len(msg->buf));
    369 		return -1;
    370 	}
    371 	return 0;
    372 }
    373 
    374 
    375 int radius_msg_finish_srv(struct radius_msg *msg, const u8 *secret,
    376 			  size_t secret_len, const u8 *req_authenticator)
    377 {
    378 	u8 auth[MD5_MAC_LEN];
    379 	struct radius_attr_hdr *attr;
    380 	const u8 *addr[4];
    381 	size_t len[4];
    382 
    383 	os_memset(auth, 0, MD5_MAC_LEN);
    384 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    385 				   auth, MD5_MAC_LEN);
    386 	if (attr == NULL) {
    387 		printf("WARNING: Could not add Message-Authenticator\n");
    388 		return -1;
    389 	}
    390 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    391 	os_memcpy(msg->hdr->authenticator, req_authenticator,
    392 		  sizeof(msg->hdr->authenticator));
    393 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    394 		 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    395 
    396 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    397 	addr[0] = (u8 *) msg->hdr;
    398 	len[0] = 1 + 1 + 2;
    399 	addr[1] = req_authenticator;
    400 	len[1] = MD5_MAC_LEN;
    401 	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
    402 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    403 	addr[3] = secret;
    404 	len[3] = secret_len;
    405 	md5_vector(4, addr, len, msg->hdr->authenticator);
    406 
    407 	if (wpabuf_len(msg->buf) > 0xffff) {
    408 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    409 			   (unsigned long) wpabuf_len(msg->buf));
    410 		return -1;
    411 	}
    412 	return 0;
    413 }
    414 
    415 
    416 int radius_msg_finish_das_resp(struct radius_msg *msg, const u8 *secret,
    417 			       size_t secret_len,
    418 			       const struct radius_hdr *req_hdr)
    419 {
    420 	const u8 *addr[2];
    421 	size_t len[2];
    422 	u8 auth[MD5_MAC_LEN];
    423 	struct radius_attr_hdr *attr;
    424 
    425 	os_memset(auth, 0, MD5_MAC_LEN);
    426 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    427 				   auth, MD5_MAC_LEN);
    428 	if (attr == NULL) {
    429 		wpa_printf(MSG_WARNING, "Could not add Message-Authenticator");
    430 		return -1;
    431 	}
    432 
    433 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    434 	os_memcpy(msg->hdr->authenticator, req_hdr->authenticator, 16);
    435 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    436 		 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    437 
    438 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    439 	addr[0] = wpabuf_head_u8(msg->buf);
    440 	len[0] = wpabuf_len(msg->buf);
    441 	addr[1] = secret;
    442 	len[1] = secret_len;
    443 	if (md5_vector(2, addr, len, msg->hdr->authenticator) < 0)
    444 		return -1;
    445 
    446 	if (wpabuf_len(msg->buf) > 0xffff) {
    447 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    448 			   (unsigned long) wpabuf_len(msg->buf));
    449 		return -1;
    450 	}
    451 	return 0;
    452 }
    453 
    454 
    455 void radius_msg_finish_acct(struct radius_msg *msg, const u8 *secret,
    456 			    size_t secret_len)
    457 {
    458 	const u8 *addr[2];
    459 	size_t len[2];
    460 
    461 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    462 	os_memset(msg->hdr->authenticator, 0, MD5_MAC_LEN);
    463 	addr[0] = wpabuf_head(msg->buf);
    464 	len[0] = wpabuf_len(msg->buf);
    465 	addr[1] = secret;
    466 	len[1] = secret_len;
    467 	md5_vector(2, addr, len, msg->hdr->authenticator);
    468 
    469 	if (wpabuf_len(msg->buf) > 0xffff) {
    470 		wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
    471 			   (unsigned long) wpabuf_len(msg->buf));
    472 	}
    473 }
    474 
    475 
    476 int radius_msg_verify_acct_req(struct radius_msg *msg, const u8 *secret,
    477 			       size_t secret_len)
    478 {
    479 	const u8 *addr[4];
    480 	size_t len[4];
    481 	u8 zero[MD5_MAC_LEN];
    482 	u8 hash[MD5_MAC_LEN];
    483 
    484 	os_memset(zero, 0, sizeof(zero));
    485 	addr[0] = (u8 *) msg->hdr;
    486 	len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
    487 	addr[1] = zero;
    488 	len[1] = MD5_MAC_LEN;
    489 	addr[2] = (u8 *) (msg->hdr + 1);
    490 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    491 	addr[3] = secret;
    492 	len[3] = secret_len;
    493 	md5_vector(4, addr, len, hash);
    494 	return os_memcmp(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0;
    495 }
    496 
    497 
    498 int radius_msg_verify_das_req(struct radius_msg *msg, const u8 *secret,
    499 			      size_t secret_len)
    500 {
    501 	const u8 *addr[4];
    502 	size_t len[4];
    503 	u8 zero[MD5_MAC_LEN];
    504 	u8 hash[MD5_MAC_LEN];
    505 	u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
    506 	u8 orig_authenticator[16];
    507 
    508 	struct radius_attr_hdr *attr = NULL, *tmp;
    509 	size_t i;
    510 
    511 	os_memset(zero, 0, sizeof(zero));
    512 	addr[0] = (u8 *) msg->hdr;
    513 	len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
    514 	addr[1] = zero;
    515 	len[1] = MD5_MAC_LEN;
    516 	addr[2] = (u8 *) (msg->hdr + 1);
    517 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    518 	addr[3] = secret;
    519 	len[3] = secret_len;
    520 	md5_vector(4, addr, len, hash);
    521 	if (os_memcmp(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0)
    522 		return 1;
    523 
    524 	for (i = 0; i < msg->attr_used; i++) {
    525 		tmp = radius_get_attr_hdr(msg, i);
    526 		if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
    527 			if (attr != NULL) {
    528 				wpa_printf(MSG_WARNING, "Multiple "
    529 					   "Message-Authenticator attributes "
    530 					   "in RADIUS message");
    531 				return 1;
    532 			}
    533 			attr = tmp;
    534 		}
    535 	}
    536 
    537 	if (attr == NULL) {
    538 		/* Message-Authenticator is MAY; not required */
    539 		return 0;
    540 	}
    541 
    542 	os_memcpy(orig, attr + 1, MD5_MAC_LEN);
    543 	os_memset(attr + 1, 0, MD5_MAC_LEN);
    544 	os_memcpy(orig_authenticator, msg->hdr->authenticator,
    545 		  sizeof(orig_authenticator));
    546 	os_memset(msg->hdr->authenticator, 0,
    547 		  sizeof(msg->hdr->authenticator));
    548 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    549 		 wpabuf_len(msg->buf), auth);
    550 	os_memcpy(attr + 1, orig, MD5_MAC_LEN);
    551 	os_memcpy(msg->hdr->authenticator, orig_authenticator,
    552 		  sizeof(orig_authenticator));
    553 
    554 	return os_memcmp(orig, auth, MD5_MAC_LEN) != 0;
    555 }
    556 
    557 
    558 static int radius_msg_add_attr_to_array(struct radius_msg *msg,
    559 					struct radius_attr_hdr *attr)
    560 {
    561 	if (msg->attr_used >= msg->attr_size) {
    562 		size_t *nattr_pos;
    563 		int nlen = msg->attr_size * 2;
    564 
    565 		nattr_pos = os_realloc_array(msg->attr_pos, nlen,
    566 					     sizeof(*msg->attr_pos));
    567 		if (nattr_pos == NULL)
    568 			return -1;
    569 
    570 		msg->attr_pos = nattr_pos;
    571 		msg->attr_size = nlen;
    572 	}
    573 
    574 	msg->attr_pos[msg->attr_used++] =
    575 		(unsigned char *) attr - wpabuf_head_u8(msg->buf);
    576 
    577 	return 0;
    578 }
    579 
    580 
    581 struct radius_attr_hdr *radius_msg_add_attr(struct radius_msg *msg, u8 type,
    582 					    const u8 *data, size_t data_len)
    583 {
    584 	size_t buf_needed;
    585 	struct radius_attr_hdr *attr;
    586 
    587 	if (data_len > RADIUS_MAX_ATTR_LEN) {
    588 		printf("radius_msg_add_attr: too long attribute (%lu bytes)\n",
    589 		       (unsigned long) data_len);
    590 		return NULL;
    591 	}
    592 
    593 	buf_needed = sizeof(*attr) + data_len;
    594 
    595 	if (wpabuf_tailroom(msg->buf) < buf_needed) {
    596 		/* allocate more space for message buffer */
    597 		if (wpabuf_resize(&msg->buf, buf_needed) < 0)
    598 			return NULL;
    599 		msg->hdr = wpabuf_mhead(msg->buf);
    600 	}
    601 
    602 	attr = wpabuf_put(msg->buf, sizeof(struct radius_attr_hdr));
    603 	attr->type = type;
    604 	attr->length = sizeof(*attr) + data_len;
    605 	wpabuf_put_data(msg->buf, data, data_len);
    606 
    607 	if (radius_msg_add_attr_to_array(msg, attr))
    608 		return NULL;
    609 
    610 	return attr;
    611 }
    612 
    613 
    614 /**
    615  * radius_msg_parse - Parse a RADIUS message
    616  * @data: RADIUS message to be parsed
    617  * @len: Length of data buffer in octets
    618  * Returns: Parsed RADIUS message or %NULL on failure
    619  *
    620  * This parses a RADIUS message and makes a copy of its data. The caller is
    621  * responsible for freeing the returned data with radius_msg_free().
    622  */
    623 struct radius_msg * radius_msg_parse(const u8 *data, size_t len)
    624 {
    625 	struct radius_msg *msg;
    626 	struct radius_hdr *hdr;
    627 	struct radius_attr_hdr *attr;
    628 	size_t msg_len;
    629 	unsigned char *pos, *end;
    630 
    631 	if (data == NULL || len < sizeof(*hdr))
    632 		return NULL;
    633 
    634 	hdr = (struct radius_hdr *) data;
    635 
    636 	msg_len = be_to_host16(hdr->length);
    637 	if (msg_len < sizeof(*hdr) || msg_len > len) {
    638 		wpa_printf(MSG_INFO, "RADIUS: Invalid message length");
    639 		return NULL;
    640 	}
    641 
    642 	if (msg_len < len) {
    643 		wpa_printf(MSG_DEBUG, "RADIUS: Ignored %lu extra bytes after "
    644 			   "RADIUS message", (unsigned long) len - msg_len);
    645 	}
    646 
    647 	msg = os_zalloc(sizeof(*msg));
    648 	if (msg == NULL)
    649 		return NULL;
    650 
    651 	msg->buf = wpabuf_alloc_copy(data, msg_len);
    652 	if (msg->buf == NULL || radius_msg_initialize(msg)) {
    653 		radius_msg_free(msg);
    654 		return NULL;
    655 	}
    656 	msg->hdr = wpabuf_mhead(msg->buf);
    657 
    658 	/* parse attributes */
    659 	pos = wpabuf_mhead_u8(msg->buf) + sizeof(struct radius_hdr);
    660 	end = wpabuf_mhead_u8(msg->buf) + wpabuf_len(msg->buf);
    661 	while (pos < end) {
    662 		if ((size_t) (end - pos) < sizeof(*attr))
    663 			goto fail;
    664 
    665 		attr = (struct radius_attr_hdr *) pos;
    666 
    667 		if (pos + attr->length > end || attr->length < sizeof(*attr))
    668 			goto fail;
    669 
    670 		/* TODO: check that attr->length is suitable for attr->type */
    671 
    672 		if (radius_msg_add_attr_to_array(msg, attr))
    673 			goto fail;
    674 
    675 		pos += attr->length;
    676 	}
    677 
    678 	return msg;
    679 
    680  fail:
    681 	radius_msg_free(msg);
    682 	return NULL;
    683 }
    684 
    685 
    686 int radius_msg_add_eap(struct radius_msg *msg, const u8 *data, size_t data_len)
    687 {
    688 	const u8 *pos = data;
    689 	size_t left = data_len;
    690 
    691 	while (left > 0) {
    692 		int len;
    693 		if (left > RADIUS_MAX_ATTR_LEN)
    694 			len = RADIUS_MAX_ATTR_LEN;
    695 		else
    696 			len = left;
    697 
    698 		if (!radius_msg_add_attr(msg, RADIUS_ATTR_EAP_MESSAGE,
    699 					 pos, len))
    700 			return 0;
    701 
    702 		pos += len;
    703 		left -= len;
    704 	}
    705 
    706 	return 1;
    707 }
    708 
    709 
    710 struct wpabuf * radius_msg_get_eap(struct radius_msg *msg)
    711 {
    712 	struct wpabuf *eap;
    713 	size_t len, i;
    714 	struct radius_attr_hdr *attr;
    715 
    716 	if (msg == NULL)
    717 		return NULL;
    718 
    719 	len = 0;
    720 	for (i = 0; i < msg->attr_used; i++) {
    721 		attr = radius_get_attr_hdr(msg, i);
    722 		if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
    723 		    attr->length > sizeof(struct radius_attr_hdr))
    724 			len += attr->length - sizeof(struct radius_attr_hdr);
    725 	}
    726 
    727 	if (len == 0)
    728 		return NULL;
    729 
    730 	eap = wpabuf_alloc(len);
    731 	if (eap == NULL)
    732 		return NULL;
    733 
    734 	for (i = 0; i < msg->attr_used; i++) {
    735 		attr = radius_get_attr_hdr(msg, i);
    736 		if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
    737 		    attr->length > sizeof(struct radius_attr_hdr)) {
    738 			int flen = attr->length - sizeof(*attr);
    739 			wpabuf_put_data(eap, attr + 1, flen);
    740 		}
    741 	}
    742 
    743 	return eap;
    744 }
    745 
    746 
    747 int radius_msg_verify_msg_auth(struct radius_msg *msg, const u8 *secret,
    748 			       size_t secret_len, const u8 *req_auth)
    749 {
    750 	u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
    751 	u8 orig_authenticator[16];
    752 	struct radius_attr_hdr *attr = NULL, *tmp;
    753 	size_t i;
    754 
    755 	for (i = 0; i < msg->attr_used; i++) {
    756 		tmp = radius_get_attr_hdr(msg, i);
    757 		if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
    758 			if (attr != NULL) {
    759 				printf("Multiple Message-Authenticator "
    760 				       "attributes in RADIUS message\n");
    761 				return 1;
    762 			}
    763 			attr = tmp;
    764 		}
    765 	}
    766 
    767 	if (attr == NULL) {
    768 		printf("No Message-Authenticator attribute found\n");
    769 		return 1;
    770 	}
    771 
    772 	os_memcpy(orig, attr + 1, MD5_MAC_LEN);
    773 	os_memset(attr + 1, 0, MD5_MAC_LEN);
    774 	if (req_auth) {
    775 		os_memcpy(orig_authenticator, msg->hdr->authenticator,
    776 			  sizeof(orig_authenticator));
    777 		os_memcpy(msg->hdr->authenticator, req_auth,
    778 			  sizeof(msg->hdr->authenticator));
    779 	}
    780 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    781 		 wpabuf_len(msg->buf), auth);
    782 	os_memcpy(attr + 1, orig, MD5_MAC_LEN);
    783 	if (req_auth) {
    784 		os_memcpy(msg->hdr->authenticator, orig_authenticator,
    785 			  sizeof(orig_authenticator));
    786 	}
    787 
    788 	if (os_memcmp(orig, auth, MD5_MAC_LEN) != 0) {
    789 		printf("Invalid Message-Authenticator!\n");
    790 		return 1;
    791 	}
    792 
    793 	return 0;
    794 }
    795 
    796 
    797 int radius_msg_verify(struct radius_msg *msg, const u8 *secret,
    798 		      size_t secret_len, struct radius_msg *sent_msg, int auth)
    799 {
    800 	const u8 *addr[4];
    801 	size_t len[4];
    802 	u8 hash[MD5_MAC_LEN];
    803 
    804 	if (sent_msg == NULL) {
    805 		printf("No matching Access-Request message found\n");
    806 		return 1;
    807 	}
    808 
    809 	if (auth &&
    810 	    radius_msg_verify_msg_auth(msg, secret, secret_len,
    811 				       sent_msg->hdr->authenticator)) {
    812 		return 1;
    813 	}
    814 
    815 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    816 	addr[0] = (u8 *) msg->hdr;
    817 	len[0] = 1 + 1 + 2;
    818 	addr[1] = sent_msg->hdr->authenticator;
    819 	len[1] = MD5_MAC_LEN;
    820 	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
    821 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    822 	addr[3] = secret;
    823 	len[3] = secret_len;
    824 	md5_vector(4, addr, len, hash);
    825 	if (os_memcmp(hash, msg->hdr->authenticator, MD5_MAC_LEN) != 0) {
    826 		printf("Response Authenticator invalid!\n");
    827 		return 1;
    828 	}
    829 
    830 	return 0;
    831 }
    832 
    833 
    834 int radius_msg_copy_attr(struct radius_msg *dst, struct radius_msg *src,
    835 			 u8 type)
    836 {
    837 	struct radius_attr_hdr *attr;
    838 	size_t i;
    839 	int count = 0;
    840 
    841 	for (i = 0; i < src->attr_used; i++) {
    842 		attr = radius_get_attr_hdr(src, i);
    843 		if (attr->type == type && attr->length >= sizeof(*attr)) {
    844 			if (!radius_msg_add_attr(dst, type, (u8 *) (attr + 1),
    845 						 attr->length - sizeof(*attr)))
    846 				return -1;
    847 			count++;
    848 		}
    849 	}
    850 
    851 	return count;
    852 }
    853 
    854 
    855 /* Create Request Authenticator. The value should be unique over the lifetime
    856  * of the shared secret between authenticator and authentication server.
    857  * Use one-way MD5 hash calculated from current timestamp and some data given
    858  * by the caller. */
    859 void radius_msg_make_authenticator(struct radius_msg *msg,
    860 				   const u8 *data, size_t len)
    861 {
    862 	struct os_time tv;
    863 	long int l;
    864 	const u8 *addr[3];
    865 	size_t elen[3];
    866 
    867 	os_get_time(&tv);
    868 	l = os_random();
    869 	addr[0] = (u8 *) &tv;
    870 	elen[0] = sizeof(tv);
    871 	addr[1] = data;
    872 	elen[1] = len;
    873 	addr[2] = (u8 *) &l;
    874 	elen[2] = sizeof(l);
    875 	md5_vector(3, addr, elen, msg->hdr->authenticator);
    876 }
    877 
    878 
    879 /* Get Vendor-specific RADIUS Attribute from a parsed RADIUS message.
    880  * Returns the Attribute payload and sets alen to indicate the length of the
    881  * payload if a vendor attribute with subtype is found, otherwise returns NULL.
    882  * The returned payload is allocated with os_malloc() and caller must free it
    883  * by calling os_free().
    884  */
    885 static u8 *radius_msg_get_vendor_attr(struct radius_msg *msg, u32 vendor,
    886 				      u8 subtype, size_t *alen)
    887 {
    888 	u8 *data, *pos;
    889 	size_t i, len;
    890 
    891 	if (msg == NULL)
    892 		return NULL;
    893 
    894 	for (i = 0; i < msg->attr_used; i++) {
    895 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
    896 		size_t left;
    897 		u32 vendor_id;
    898 		struct radius_attr_vendor *vhdr;
    899 
    900 		if (attr->type != RADIUS_ATTR_VENDOR_SPECIFIC ||
    901 		    attr->length < sizeof(*attr))
    902 			continue;
    903 
    904 		left = attr->length - sizeof(*attr);
    905 		if (left < 4)
    906 			continue;
    907 
    908 		pos = (u8 *) (attr + 1);
    909 
    910 		os_memcpy(&vendor_id, pos, 4);
    911 		pos += 4;
    912 		left -= 4;
    913 
    914 		if (ntohl(vendor_id) != vendor)
    915 			continue;
    916 
    917 		while (left >= sizeof(*vhdr)) {
    918 			vhdr = (struct radius_attr_vendor *) pos;
    919 			if (vhdr->vendor_length > left ||
    920 			    vhdr->vendor_length < sizeof(*vhdr)) {
    921 				left = 0;
    922 				break;
    923 			}
    924 			if (vhdr->vendor_type != subtype) {
    925 				pos += vhdr->vendor_length;
    926 				left -= vhdr->vendor_length;
    927 				continue;
    928 			}
    929 
    930 			len = vhdr->vendor_length - sizeof(*vhdr);
    931 			data = os_malloc(len);
    932 			if (data == NULL)
    933 				return NULL;
    934 			os_memcpy(data, pos + sizeof(*vhdr), len);
    935 			if (alen)
    936 				*alen = len;
    937 			return data;
    938 		}
    939 	}
    940 
    941 	return NULL;
    942 }
    943 
    944 
    945 static u8 * decrypt_ms_key(const u8 *key, size_t len,
    946 			   const u8 *req_authenticator,
    947 			   const u8 *secret, size_t secret_len, size_t *reslen)
    948 {
    949 	u8 *plain, *ppos, *res;
    950 	const u8 *pos;
    951 	size_t left, plen;
    952 	u8 hash[MD5_MAC_LEN];
    953 	int i, first = 1;
    954 	const u8 *addr[3];
    955 	size_t elen[3];
    956 
    957 	/* key: 16-bit salt followed by encrypted key info */
    958 
    959 	if (len < 2 + 16)
    960 		return NULL;
    961 
    962 	pos = key + 2;
    963 	left = len - 2;
    964 	if (left % 16) {
    965 		printf("Invalid ms key len %lu\n", (unsigned long) left);
    966 		return NULL;
    967 	}
    968 
    969 	plen = left;
    970 	ppos = plain = os_malloc(plen);
    971 	if (plain == NULL)
    972 		return NULL;
    973 	plain[0] = 0;
    974 
    975 	while (left > 0) {
    976 		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
    977 		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
    978 
    979 		addr[0] = secret;
    980 		elen[0] = secret_len;
    981 		if (first) {
    982 			addr[1] = req_authenticator;
    983 			elen[1] = MD5_MAC_LEN;
    984 			addr[2] = key;
    985 			elen[2] = 2; /* Salt */
    986 		} else {
    987 			addr[1] = pos - MD5_MAC_LEN;
    988 			elen[1] = MD5_MAC_LEN;
    989 		}
    990 		md5_vector(first ? 3 : 2, addr, elen, hash);
    991 		first = 0;
    992 
    993 		for (i = 0; i < MD5_MAC_LEN; i++)
    994 			*ppos++ = *pos++ ^ hash[i];
    995 		left -= MD5_MAC_LEN;
    996 	}
    997 
    998 	if (plain[0] == 0 || plain[0] > plen - 1) {
    999 		printf("Failed to decrypt MPPE key\n");
   1000 		os_free(plain);
   1001 		return NULL;
   1002 	}
   1003 
   1004 	res = os_malloc(plain[0]);
   1005 	if (res == NULL) {
   1006 		os_free(plain);
   1007 		return NULL;
   1008 	}
   1009 	os_memcpy(res, plain + 1, plain[0]);
   1010 	if (reslen)
   1011 		*reslen = plain[0];
   1012 	os_free(plain);
   1013 	return res;
   1014 }
   1015 
   1016 
   1017 static void encrypt_ms_key(const u8 *key, size_t key_len, u16 salt,
   1018 			   const u8 *req_authenticator,
   1019 			   const u8 *secret, size_t secret_len,
   1020 			   u8 *ebuf, size_t *elen)
   1021 {
   1022 	int i, len, first = 1;
   1023 	u8 hash[MD5_MAC_LEN], saltbuf[2], *pos;
   1024 	const u8 *addr[3];
   1025 	size_t _len[3];
   1026 
   1027 	WPA_PUT_BE16(saltbuf, salt);
   1028 
   1029 	len = 1 + key_len;
   1030 	if (len & 0x0f) {
   1031 		len = (len & 0xf0) + 16;
   1032 	}
   1033 	os_memset(ebuf, 0, len);
   1034 	ebuf[0] = key_len;
   1035 	os_memcpy(ebuf + 1, key, key_len);
   1036 
   1037 	*elen = len;
   1038 
   1039 	pos = ebuf;
   1040 	while (len > 0) {
   1041 		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
   1042 		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
   1043 		addr[0] = secret;
   1044 		_len[0] = secret_len;
   1045 		if (first) {
   1046 			addr[1] = req_authenticator;
   1047 			_len[1] = MD5_MAC_LEN;
   1048 			addr[2] = saltbuf;
   1049 			_len[2] = sizeof(saltbuf);
   1050 		} else {
   1051 			addr[1] = pos - MD5_MAC_LEN;
   1052 			_len[1] = MD5_MAC_LEN;
   1053 		}
   1054 		md5_vector(first ? 3 : 2, addr, _len, hash);
   1055 		first = 0;
   1056 
   1057 		for (i = 0; i < MD5_MAC_LEN; i++)
   1058 			*pos++ ^= hash[i];
   1059 
   1060 		len -= MD5_MAC_LEN;
   1061 	}
   1062 }
   1063 
   1064 
   1065 struct radius_ms_mppe_keys *
   1066 radius_msg_get_ms_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
   1067 		       const u8 *secret, size_t secret_len)
   1068 {
   1069 	u8 *key;
   1070 	size_t keylen;
   1071 	struct radius_ms_mppe_keys *keys;
   1072 
   1073 	if (msg == NULL || sent_msg == NULL)
   1074 		return NULL;
   1075 
   1076 	keys = os_zalloc(sizeof(*keys));
   1077 	if (keys == NULL)
   1078 		return NULL;
   1079 
   1080 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
   1081 					 RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY,
   1082 					 &keylen);
   1083 	if (key) {
   1084 		keys->send = decrypt_ms_key(key, keylen,
   1085 					    sent_msg->hdr->authenticator,
   1086 					    secret, secret_len,
   1087 					    &keys->send_len);
   1088 		os_free(key);
   1089 	}
   1090 
   1091 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
   1092 					 RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY,
   1093 					 &keylen);
   1094 	if (key) {
   1095 		keys->recv = decrypt_ms_key(key, keylen,
   1096 					    sent_msg->hdr->authenticator,
   1097 					    secret, secret_len,
   1098 					    &keys->recv_len);
   1099 		os_free(key);
   1100 	}
   1101 
   1102 	return keys;
   1103 }
   1104 
   1105 
   1106 struct radius_ms_mppe_keys *
   1107 radius_msg_get_cisco_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
   1108 			  const u8 *secret, size_t secret_len)
   1109 {
   1110 	u8 *key;
   1111 	size_t keylen;
   1112 	struct radius_ms_mppe_keys *keys;
   1113 
   1114 	if (msg == NULL || sent_msg == NULL)
   1115 		return NULL;
   1116 
   1117 	keys = os_zalloc(sizeof(*keys));
   1118 	if (keys == NULL)
   1119 		return NULL;
   1120 
   1121 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_CISCO,
   1122 					 RADIUS_CISCO_AV_PAIR, &keylen);
   1123 	if (key && keylen == 51 &&
   1124 	    os_memcmp(key, "leap:session-key=", 17) == 0) {
   1125 		keys->recv = decrypt_ms_key(key + 17, keylen - 17,
   1126 					    sent_msg->hdr->authenticator,
   1127 					    secret, secret_len,
   1128 					    &keys->recv_len);
   1129 	}
   1130 	os_free(key);
   1131 
   1132 	return keys;
   1133 }
   1134 
   1135 
   1136 int radius_msg_add_mppe_keys(struct radius_msg *msg,
   1137 			     const u8 *req_authenticator,
   1138 			     const u8 *secret, size_t secret_len,
   1139 			     const u8 *send_key, size_t send_key_len,
   1140 			     const u8 *recv_key, size_t recv_key_len)
   1141 {
   1142 	struct radius_attr_hdr *attr;
   1143 	u32 vendor_id = htonl(RADIUS_VENDOR_ID_MICROSOFT);
   1144 	u8 *buf;
   1145 	struct radius_attr_vendor *vhdr;
   1146 	u8 *pos;
   1147 	size_t elen;
   1148 	int hlen;
   1149 	u16 salt;
   1150 
   1151 	hlen = sizeof(vendor_id) + sizeof(*vhdr) + 2;
   1152 
   1153 	/* MS-MPPE-Send-Key */
   1154 	buf = os_malloc(hlen + send_key_len + 16);
   1155 	if (buf == NULL) {
   1156 		return 0;
   1157 	}
   1158 	pos = buf;
   1159 	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
   1160 	pos += sizeof(vendor_id);
   1161 	vhdr = (struct radius_attr_vendor *) pos;
   1162 	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY;
   1163 	pos = (u8 *) (vhdr + 1);
   1164 	salt = os_random() | 0x8000;
   1165 	WPA_PUT_BE16(pos, salt);
   1166 	pos += 2;
   1167 	encrypt_ms_key(send_key, send_key_len, salt, req_authenticator, secret,
   1168 		       secret_len, pos, &elen);
   1169 	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
   1170 
   1171 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
   1172 				   buf, hlen + elen);
   1173 	os_free(buf);
   1174 	if (attr == NULL) {
   1175 		return 0;
   1176 	}
   1177 
   1178 	/* MS-MPPE-Recv-Key */
   1179 	buf = os_malloc(hlen + send_key_len + 16);
   1180 	if (buf == NULL) {
   1181 		return 0;
   1182 	}
   1183 	pos = buf;
   1184 	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
   1185 	pos += sizeof(vendor_id);
   1186 	vhdr = (struct radius_attr_vendor *) pos;
   1187 	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY;
   1188 	pos = (u8 *) (vhdr + 1);
   1189 	salt ^= 1;
   1190 	WPA_PUT_BE16(pos, salt);
   1191 	pos += 2;
   1192 	encrypt_ms_key(recv_key, recv_key_len, salt, req_authenticator, secret,
   1193 		       secret_len, pos, &elen);
   1194 	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
   1195 
   1196 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
   1197 				   buf, hlen + elen);
   1198 	os_free(buf);
   1199 	if (attr == NULL) {
   1200 		return 0;
   1201 	}
   1202 
   1203 	return 1;
   1204 }
   1205 
   1206 
   1207 /* Add User-Password attribute to a RADIUS message and encrypt it as specified
   1208  * in RFC 2865, Chap. 5.2 */
   1209 struct radius_attr_hdr *
   1210 radius_msg_add_attr_user_password(struct radius_msg *msg,
   1211 				  const u8 *data, size_t data_len,
   1212 				  const u8 *secret, size_t secret_len)
   1213 {
   1214 	u8 buf[128];
   1215 	size_t padlen, i, buf_len, pos;
   1216 	const u8 *addr[2];
   1217 	size_t len[2];
   1218 	u8 hash[16];
   1219 
   1220 	if (data_len > 128)
   1221 		return NULL;
   1222 
   1223 	os_memcpy(buf, data, data_len);
   1224 	buf_len = data_len;
   1225 
   1226 	padlen = data_len % 16;
   1227 	if (padlen && data_len < sizeof(buf)) {
   1228 		padlen = 16 - padlen;
   1229 		os_memset(buf + data_len, 0, padlen);
   1230 		buf_len += padlen;
   1231 	}
   1232 
   1233 	addr[0] = secret;
   1234 	len[0] = secret_len;
   1235 	addr[1] = msg->hdr->authenticator;
   1236 	len[1] = 16;
   1237 	md5_vector(2, addr, len, hash);
   1238 
   1239 	for (i = 0; i < 16; i++)
   1240 		buf[i] ^= hash[i];
   1241 	pos = 16;
   1242 
   1243 	while (pos < buf_len) {
   1244 		addr[0] = secret;
   1245 		len[0] = secret_len;
   1246 		addr[1] = &buf[pos - 16];
   1247 		len[1] = 16;
   1248 		md5_vector(2, addr, len, hash);
   1249 
   1250 		for (i = 0; i < 16; i++)
   1251 			buf[pos + i] ^= hash[i];
   1252 
   1253 		pos += 16;
   1254 	}
   1255 
   1256 	return radius_msg_add_attr(msg, RADIUS_ATTR_USER_PASSWORD,
   1257 				   buf, buf_len);
   1258 }
   1259 
   1260 
   1261 int radius_msg_get_attr(struct radius_msg *msg, u8 type, u8 *buf, size_t len)
   1262 {
   1263 	struct radius_attr_hdr *attr = NULL, *tmp;
   1264 	size_t i, dlen;
   1265 
   1266 	for (i = 0; i < msg->attr_used; i++) {
   1267 		tmp = radius_get_attr_hdr(msg, i);
   1268 		if (tmp->type == type) {
   1269 			attr = tmp;
   1270 			break;
   1271 		}
   1272 	}
   1273 
   1274 	if (!attr || attr->length < sizeof(*attr))
   1275 		return -1;
   1276 
   1277 	dlen = attr->length - sizeof(*attr);
   1278 	if (buf)
   1279 		os_memcpy(buf, (attr + 1), dlen > len ? len : dlen);
   1280 	return dlen;
   1281 }
   1282 
   1283 
   1284 int radius_msg_get_attr_ptr(struct radius_msg *msg, u8 type, u8 **buf,
   1285 			    size_t *len, const u8 *start)
   1286 {
   1287 	size_t i;
   1288 	struct radius_attr_hdr *attr = NULL, *tmp;
   1289 
   1290 	for (i = 0; i < msg->attr_used; i++) {
   1291 		tmp = radius_get_attr_hdr(msg, i);
   1292 		if (tmp->type == type &&
   1293 		    (start == NULL || (u8 *) tmp > start)) {
   1294 			attr = tmp;
   1295 			break;
   1296 		}
   1297 	}
   1298 
   1299 	if (!attr || attr->length < sizeof(*attr))
   1300 		return -1;
   1301 
   1302 	*buf = (u8 *) (attr + 1);
   1303 	*len = attr->length - sizeof(*attr);
   1304 	return 0;
   1305 }
   1306 
   1307 
   1308 int radius_msg_count_attr(struct radius_msg *msg, u8 type, int min_len)
   1309 {
   1310 	size_t i;
   1311 	int count;
   1312 
   1313 	for (count = 0, i = 0; i < msg->attr_used; i++) {
   1314 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
   1315 		if (attr->type == type &&
   1316 		    attr->length >= sizeof(struct radius_attr_hdr) + min_len)
   1317 			count++;
   1318 	}
   1319 
   1320 	return count;
   1321 }
   1322 
   1323 
   1324 struct radius_tunnel_attrs {
   1325 	int tag_used;
   1326 	int type; /* Tunnel-Type */
   1327 	int medium_type; /* Tunnel-Medium-Type */
   1328 	int vlanid;
   1329 };
   1330 
   1331 
   1332 /**
   1333  * radius_msg_get_vlanid - Parse RADIUS attributes for VLAN tunnel information
   1334  * @msg: RADIUS message
   1335  * Returns: VLAN ID for the first tunnel configuration of -1 if none is found
   1336  */
   1337 int radius_msg_get_vlanid(struct radius_msg *msg)
   1338 {
   1339 	struct radius_tunnel_attrs tunnel[RADIUS_TUNNEL_TAGS], *tun;
   1340 	size_t i;
   1341 	struct radius_attr_hdr *attr = NULL;
   1342 	const u8 *data;
   1343 	char buf[10];
   1344 	size_t dlen;
   1345 
   1346 	os_memset(&tunnel, 0, sizeof(tunnel));
   1347 
   1348 	for (i = 0; i < msg->attr_used; i++) {
   1349 		attr = radius_get_attr_hdr(msg, i);
   1350 		if (attr->length < sizeof(*attr))
   1351 			return -1;
   1352 		data = (const u8 *) (attr + 1);
   1353 		dlen = attr->length - sizeof(*attr);
   1354 		if (attr->length < 3)
   1355 			continue;
   1356 		if (data[0] >= RADIUS_TUNNEL_TAGS)
   1357 			tun = &tunnel[0];
   1358 		else
   1359 			tun = &tunnel[data[0]];
   1360 
   1361 		switch (attr->type) {
   1362 		case RADIUS_ATTR_TUNNEL_TYPE:
   1363 			if (attr->length != 6)
   1364 				break;
   1365 			tun->tag_used++;
   1366 			tun->type = WPA_GET_BE24(data + 1);
   1367 			break;
   1368 		case RADIUS_ATTR_TUNNEL_MEDIUM_TYPE:
   1369 			if (attr->length != 6)
   1370 				break;
   1371 			tun->tag_used++;
   1372 			tun->medium_type = WPA_GET_BE24(data + 1);
   1373 			break;
   1374 		case RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID:
   1375 			if (data[0] < RADIUS_TUNNEL_TAGS) {
   1376 				data++;
   1377 				dlen--;
   1378 			}
   1379 			if (dlen >= sizeof(buf))
   1380 				break;
   1381 			os_memcpy(buf, data, dlen);
   1382 			buf[dlen] = '\0';
   1383 			tun->tag_used++;
   1384 			tun->vlanid = atoi(buf);
   1385 			break;
   1386 		}
   1387 	}
   1388 
   1389 	for (i = 0; i < RADIUS_TUNNEL_TAGS; i++) {
   1390 		tun = &tunnel[i];
   1391 		if (tun->tag_used &&
   1392 		    tun->type == RADIUS_TUNNEL_TYPE_VLAN &&
   1393 		    tun->medium_type == RADIUS_TUNNEL_MEDIUM_TYPE_802 &&
   1394 		    tun->vlanid > 0)
   1395 			return tun->vlanid;
   1396 	}
   1397 
   1398 	return -1;
   1399 }
   1400 
   1401 
   1402 /**
   1403  * radius_msg_get_tunnel_password - Parse RADIUS attribute Tunnel-Password
   1404  * @msg: Received RADIUS message
   1405  * @keylen: Length of returned password
   1406  * @secret: RADIUS shared secret
   1407  * @secret_len: Length of secret
   1408  * @sent_msg: Sent RADIUS message
   1409  * @n: Number of password attribute to return (starting with 0)
   1410  * Returns: Pointer to n-th password (free with os_free) or %NULL
   1411  */
   1412 char * radius_msg_get_tunnel_password(struct radius_msg *msg, int *keylen,
   1413 				      const u8 *secret, size_t secret_len,
   1414 				      struct radius_msg *sent_msg, size_t n)
   1415 {
   1416 	u8 *buf = NULL;
   1417 	size_t buflen;
   1418 	const u8 *salt;
   1419 	u8 *str;
   1420 	const u8 *addr[3];
   1421 	size_t len[3];
   1422 	u8 hash[16];
   1423 	u8 *pos;
   1424 	size_t i, j = 0;
   1425 	struct radius_attr_hdr *attr;
   1426 	const u8 *data;
   1427 	size_t dlen;
   1428 	const u8 *fdata = NULL; /* points to found item */
   1429 	size_t fdlen = -1;
   1430 	char *ret = NULL;
   1431 
   1432 	/* find n-th valid Tunnel-Password attribute */
   1433 	for (i = 0; i < msg->attr_used; i++) {
   1434 		attr = radius_get_attr_hdr(msg, i);
   1435 		if (attr == NULL ||
   1436 		    attr->type != RADIUS_ATTR_TUNNEL_PASSWORD) {
   1437 			continue;
   1438 		}
   1439 		if (attr->length <= 5)
   1440 			continue;
   1441 		data = (const u8 *) (attr + 1);
   1442 		dlen = attr->length - sizeof(*attr);
   1443 		if (dlen <= 3 || dlen % 16 != 3)
   1444 			continue;
   1445 		j++;
   1446 		if (j <= n)
   1447 			continue;
   1448 
   1449 		fdata = data;
   1450 		fdlen = dlen;
   1451 		break;
   1452 	}
   1453 	if (fdata == NULL)
   1454 		goto out;
   1455 
   1456 	/* alloc writable memory for decryption */
   1457 	buf = os_malloc(fdlen);
   1458 	if (buf == NULL)
   1459 		goto out;
   1460 	os_memcpy(buf, fdata, fdlen);
   1461 	buflen = fdlen;
   1462 
   1463 	/* init pointers */
   1464 	salt = buf + 1;
   1465 	str = buf + 3;
   1466 
   1467 	/* decrypt blocks */
   1468 	pos = buf + buflen - 16; /* last block */
   1469 	while (pos >= str + 16) { /* all but the first block */
   1470 		addr[0] = secret;
   1471 		len[0] = secret_len;
   1472 		addr[1] = pos - 16;
   1473 		len[1] = 16;
   1474 		md5_vector(2, addr, len, hash);
   1475 
   1476 		for (i = 0; i < 16; i++)
   1477 			pos[i] ^= hash[i];
   1478 
   1479 		pos -= 16;
   1480 	}
   1481 
   1482 	/* decrypt first block */
   1483 	if (str != pos)
   1484 		goto out;
   1485 	addr[0] = secret;
   1486 	len[0] = secret_len;
   1487 	addr[1] = sent_msg->hdr->authenticator;
   1488 	len[1] = 16;
   1489 	addr[2] = salt;
   1490 	len[2] = 2;
   1491 	md5_vector(3, addr, len, hash);
   1492 
   1493 	for (i = 0; i < 16; i++)
   1494 		pos[i] ^= hash[i];
   1495 
   1496 	/* derive plaintext length from first subfield */
   1497 	*keylen = (unsigned char) str[0];
   1498 	if ((u8 *) (str + *keylen) >= (u8 *) (buf + buflen)) {
   1499 		/* decryption error - invalid key length */
   1500 		goto out;
   1501 	}
   1502 	if (*keylen == 0) {
   1503 		/* empty password */
   1504 		goto out;
   1505 	}
   1506 
   1507 	/* copy passphrase into new buffer */
   1508 	ret = os_malloc(*keylen);
   1509 	if (ret)
   1510 		os_memcpy(ret, str + 1, *keylen);
   1511 
   1512 out:
   1513 	/* return new buffer */
   1514 	os_free(buf);
   1515 	return ret;
   1516 }
   1517 
   1518 
   1519 void radius_free_class(struct radius_class_data *c)
   1520 {
   1521 	size_t i;
   1522 	if (c == NULL)
   1523 		return;
   1524 	for (i = 0; i < c->count; i++)
   1525 		os_free(c->attr[i].data);
   1526 	os_free(c->attr);
   1527 	c->attr = NULL;
   1528 	c->count = 0;
   1529 }
   1530 
   1531 
   1532 int radius_copy_class(struct radius_class_data *dst,
   1533 		      const struct radius_class_data *src)
   1534 {
   1535 	size_t i;
   1536 
   1537 	if (src->attr == NULL)
   1538 		return 0;
   1539 
   1540 	dst->attr = os_calloc(src->count, sizeof(struct radius_attr_data));
   1541 	if (dst->attr == NULL)
   1542 		return -1;
   1543 
   1544 	dst->count = 0;
   1545 
   1546 	for (i = 0; i < src->count; i++) {
   1547 		dst->attr[i].data = os_malloc(src->attr[i].len);
   1548 		if (dst->attr[i].data == NULL)
   1549 			break;
   1550 		dst->count++;
   1551 		os_memcpy(dst->attr[i].data, src->attr[i].data,
   1552 			  src->attr[i].len);
   1553 		dst->attr[i].len = src->attr[i].len;
   1554 	}
   1555 
   1556 	return 0;
   1557 }
   1558 
   1559 
   1560 u8 radius_msg_find_unlisted_attr(struct radius_msg *msg, u8 *attrs)
   1561 {
   1562 	size_t i, j;
   1563 	struct radius_attr_hdr *attr;
   1564 
   1565 	for (i = 0; i < msg->attr_used; i++) {
   1566 		attr = radius_get_attr_hdr(msg, i);
   1567 
   1568 		for (j = 0; attrs[j]; j++) {
   1569 			if (attr->type == attrs[j])
   1570 				break;
   1571 		}
   1572 
   1573 		if (attrs[j] == 0)
   1574 			return attr->type; /* unlisted attr */
   1575 	}
   1576 
   1577 	return 0;
   1578 }
   1579