Home | History | Annotate | Download | only in radius
      1 /*
      2  * RADIUS message processing
      3  * Copyright (c) 2002-2009, 2011-2015, 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 const 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_SERVICE_TYPE, "Service-Type", RADIUS_ATTR_INT32 },
    177 	{ RADIUS_ATTR_FRAMED_IP_ADDRESS, "Framed-IP-Address", RADIUS_ATTR_IP },
    178 	{ RADIUS_ATTR_FRAMED_MTU, "Framed-MTU", RADIUS_ATTR_INT32 },
    179 	{ RADIUS_ATTR_REPLY_MESSAGE, "Reply-Message", RADIUS_ATTR_TEXT },
    180 	{ RADIUS_ATTR_STATE, "State", RADIUS_ATTR_UNDIST },
    181 	{ RADIUS_ATTR_CLASS, "Class", RADIUS_ATTR_UNDIST },
    182 	{ RADIUS_ATTR_VENDOR_SPECIFIC, "Vendor-Specific", RADIUS_ATTR_UNDIST },
    183 	{ RADIUS_ATTR_SESSION_TIMEOUT, "Session-Timeout", RADIUS_ATTR_INT32 },
    184 	{ RADIUS_ATTR_IDLE_TIMEOUT, "Idle-Timeout", RADIUS_ATTR_INT32 },
    185 	{ RADIUS_ATTR_TERMINATION_ACTION, "Termination-Action",
    186 	  RADIUS_ATTR_INT32 },
    187 	{ RADIUS_ATTR_CALLED_STATION_ID, "Called-Station-Id",
    188 	  RADIUS_ATTR_TEXT },
    189 	{ RADIUS_ATTR_CALLING_STATION_ID, "Calling-Station-Id",
    190 	  RADIUS_ATTR_TEXT },
    191 	{ RADIUS_ATTR_NAS_IDENTIFIER, "NAS-Identifier", RADIUS_ATTR_TEXT },
    192 	{ RADIUS_ATTR_PROXY_STATE, "Proxy-State", RADIUS_ATTR_UNDIST },
    193 	{ RADIUS_ATTR_ACCT_STATUS_TYPE, "Acct-Status-Type",
    194 	  RADIUS_ATTR_INT32 },
    195 	{ RADIUS_ATTR_ACCT_DELAY_TIME, "Acct-Delay-Time", RADIUS_ATTR_INT32 },
    196 	{ RADIUS_ATTR_ACCT_INPUT_OCTETS, "Acct-Input-Octets",
    197 	  RADIUS_ATTR_INT32 },
    198 	{ RADIUS_ATTR_ACCT_OUTPUT_OCTETS, "Acct-Output-Octets",
    199 	  RADIUS_ATTR_INT32 },
    200 	{ RADIUS_ATTR_ACCT_SESSION_ID, "Acct-Session-Id", RADIUS_ATTR_TEXT },
    201 	{ RADIUS_ATTR_ACCT_AUTHENTIC, "Acct-Authentic", RADIUS_ATTR_INT32 },
    202 	{ RADIUS_ATTR_ACCT_SESSION_TIME, "Acct-Session-Time",
    203 	  RADIUS_ATTR_INT32 },
    204 	{ RADIUS_ATTR_ACCT_INPUT_PACKETS, "Acct-Input-Packets",
    205 	  RADIUS_ATTR_INT32 },
    206 	{ RADIUS_ATTR_ACCT_OUTPUT_PACKETS, "Acct-Output-Packets",
    207 	  RADIUS_ATTR_INT32 },
    208 	{ RADIUS_ATTR_ACCT_TERMINATE_CAUSE, "Acct-Terminate-Cause",
    209 	  RADIUS_ATTR_INT32 },
    210 	{ RADIUS_ATTR_ACCT_MULTI_SESSION_ID, "Acct-Multi-Session-Id",
    211 	  RADIUS_ATTR_TEXT },
    212 	{ RADIUS_ATTR_ACCT_LINK_COUNT, "Acct-Link-Count", RADIUS_ATTR_INT32 },
    213 	{ RADIUS_ATTR_ACCT_INPUT_GIGAWORDS, "Acct-Input-Gigawords",
    214 	  RADIUS_ATTR_INT32 },
    215 	{ RADIUS_ATTR_ACCT_OUTPUT_GIGAWORDS, "Acct-Output-Gigawords",
    216 	  RADIUS_ATTR_INT32 },
    217 	{ RADIUS_ATTR_EVENT_TIMESTAMP, "Event-Timestamp",
    218 	  RADIUS_ATTR_INT32 },
    219 	{ RADIUS_ATTR_EGRESS_VLANID, "EGRESS-VLANID", RADIUS_ATTR_HEXDUMP },
    220 	{ RADIUS_ATTR_NAS_PORT_TYPE, "NAS-Port-Type", RADIUS_ATTR_INT32 },
    221 	{ RADIUS_ATTR_TUNNEL_TYPE, "Tunnel-Type", RADIUS_ATTR_HEXDUMP },
    222 	{ RADIUS_ATTR_TUNNEL_MEDIUM_TYPE, "Tunnel-Medium-Type",
    223 	  RADIUS_ATTR_HEXDUMP },
    224 	{ RADIUS_ATTR_TUNNEL_PASSWORD, "Tunnel-Password",
    225 	  RADIUS_ATTR_UNDIST },
    226 	{ RADIUS_ATTR_CONNECT_INFO, "Connect-Info", RADIUS_ATTR_TEXT },
    227 	{ RADIUS_ATTR_EAP_MESSAGE, "EAP-Message", RADIUS_ATTR_UNDIST },
    228 	{ RADIUS_ATTR_MESSAGE_AUTHENTICATOR, "Message-Authenticator",
    229 	  RADIUS_ATTR_UNDIST },
    230 	{ RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID, "Tunnel-Private-Group-Id",
    231 	  RADIUS_ATTR_HEXDUMP },
    232 	{ RADIUS_ATTR_ACCT_INTERIM_INTERVAL, "Acct-Interim-Interval",
    233 	  RADIUS_ATTR_INT32 },
    234 	{ RADIUS_ATTR_CHARGEABLE_USER_IDENTITY, "Chargeable-User-Identity",
    235 	  RADIUS_ATTR_TEXT },
    236 	{ RADIUS_ATTR_NAS_IPV6_ADDRESS, "NAS-IPv6-Address", RADIUS_ATTR_IPV6 },
    237 	{ RADIUS_ATTR_ERROR_CAUSE, "Error-Cause", RADIUS_ATTR_INT32 },
    238 	{ RADIUS_ATTR_EAP_KEY_NAME, "EAP-Key-Name", RADIUS_ATTR_HEXDUMP },
    239 	{ RADIUS_ATTR_OPERATOR_NAME, "Operator-Name", RADIUS_ATTR_TEXT },
    240 	{ RADIUS_ATTR_LOCATION_INFO, "Location-Information",
    241 	  RADIUS_ATTR_HEXDUMP },
    242 	{ RADIUS_ATTR_LOCATION_DATA, "Location-Data", RADIUS_ATTR_HEXDUMP },
    243 	{ RADIUS_ATTR_BASIC_LOCATION_POLICY_RULES,
    244 	  "Basic-Location-Policy-Rules", RADIUS_ATTR_HEXDUMP },
    245 	{ RADIUS_ATTR_EXTENDED_LOCATION_POLICY_RULES,
    246 	  "Extended-Location-Policy-Rules", RADIUS_ATTR_HEXDUMP },
    247 	{ RADIUS_ATTR_LOCATION_CAPABLE, "Location-Capable", RADIUS_ATTR_INT32 },
    248 	{ RADIUS_ATTR_REQUESTED_LOCATION_INFO, "Requested-Location-Info",
    249 	  RADIUS_ATTR_INT32 },
    250 	{ RADIUS_ATTR_MOBILITY_DOMAIN_ID, "Mobility-Domain-Id",
    251 	  RADIUS_ATTR_INT32 },
    252 	{ RADIUS_ATTR_WLAN_HESSID, "WLAN-HESSID", RADIUS_ATTR_TEXT },
    253 	{ RADIUS_ATTR_WLAN_PAIRWISE_CIPHER, "WLAN-Pairwise-Cipher",
    254 	  RADIUS_ATTR_HEXDUMP },
    255 	{ RADIUS_ATTR_WLAN_GROUP_CIPHER, "WLAN-Group-Cipher",
    256 	  RADIUS_ATTR_HEXDUMP },
    257 	{ RADIUS_ATTR_WLAN_AKM_SUITE, "WLAN-AKM-Suite",
    258 	  RADIUS_ATTR_HEXDUMP },
    259 	{ RADIUS_ATTR_WLAN_GROUP_MGMT_CIPHER, "WLAN-Group-Mgmt-Pairwise-Cipher",
    260 	  RADIUS_ATTR_HEXDUMP },
    261 };
    262 #define RADIUS_ATTRS ARRAY_SIZE(radius_attrs)
    263 
    264 
    265 static const struct radius_attr_type *radius_get_attr_type(u8 type)
    266 {
    267 	size_t i;
    268 
    269 	for (i = 0; i < RADIUS_ATTRS; i++) {
    270 		if (type == radius_attrs[i].type)
    271 			return &radius_attrs[i];
    272 	}
    273 
    274 	return NULL;
    275 }
    276 
    277 
    278 static void radius_msg_dump_attr(struct radius_attr_hdr *hdr)
    279 {
    280 	const struct radius_attr_type *attr;
    281 	int len;
    282 	unsigned char *pos;
    283 	char buf[1000];
    284 
    285 	attr = radius_get_attr_type(hdr->type);
    286 
    287 	wpa_printf(MSG_INFO, "   Attribute %d (%s) length=%d",
    288 		   hdr->type, attr ? attr->name : "?Unknown?", hdr->length);
    289 
    290 	if (attr == NULL || hdr->length < sizeof(struct radius_attr_hdr))
    291 		return;
    292 
    293 	len = hdr->length - sizeof(struct radius_attr_hdr);
    294 	pos = (unsigned char *) (hdr + 1);
    295 
    296 	switch (attr->data_type) {
    297 	case RADIUS_ATTR_TEXT:
    298 		printf_encode(buf, sizeof(buf), pos, len);
    299 		wpa_printf(MSG_INFO, "      Value: '%s'", buf);
    300 		break;
    301 
    302 	case RADIUS_ATTR_IP:
    303 		if (len == 4) {
    304 			struct in_addr addr;
    305 			os_memcpy(&addr, pos, 4);
    306 			wpa_printf(MSG_INFO, "      Value: %s",
    307 				   inet_ntoa(addr));
    308 		} else {
    309 			wpa_printf(MSG_INFO, "      Invalid IP address length %d",
    310 				   len);
    311 		}
    312 		break;
    313 
    314 #ifdef CONFIG_IPV6
    315 	case RADIUS_ATTR_IPV6:
    316 		if (len == 16) {
    317 			const char *atxt;
    318 			struct in6_addr *addr = (struct in6_addr *) pos;
    319 			atxt = inet_ntop(AF_INET6, addr, buf, sizeof(buf));
    320 			wpa_printf(MSG_INFO, "      Value: %s",
    321 				   atxt ? atxt : "?");
    322 		} else {
    323 			wpa_printf(MSG_INFO, "      Invalid IPv6 address length %d",
    324 				   len);
    325 		}
    326 		break;
    327 #endif /* CONFIG_IPV6 */
    328 
    329 	case RADIUS_ATTR_HEXDUMP:
    330 	case RADIUS_ATTR_UNDIST:
    331 		wpa_snprintf_hex(buf, sizeof(buf), pos, len);
    332 		wpa_printf(MSG_INFO, "      Value: %s", buf);
    333 		break;
    334 
    335 	case RADIUS_ATTR_INT32:
    336 		if (len == 4)
    337 			wpa_printf(MSG_INFO, "      Value: %u",
    338 				   WPA_GET_BE32(pos));
    339 		else
    340 			wpa_printf(MSG_INFO, "      Invalid INT32 length %d",
    341 				   len);
    342 		break;
    343 
    344 	default:
    345 		break;
    346 	}
    347 }
    348 
    349 
    350 void radius_msg_dump(struct radius_msg *msg)
    351 {
    352 	size_t i;
    353 
    354 	wpa_printf(MSG_INFO, "RADIUS message: code=%d (%s) identifier=%d length=%d",
    355 		   msg->hdr->code, radius_code_string(msg->hdr->code),
    356 		   msg->hdr->identifier, be_to_host16(msg->hdr->length));
    357 
    358 	for (i = 0; i < msg->attr_used; i++) {
    359 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
    360 		radius_msg_dump_attr(attr);
    361 	}
    362 }
    363 
    364 
    365 int radius_msg_finish(struct radius_msg *msg, const u8 *secret,
    366 		      size_t secret_len)
    367 {
    368 	if (secret) {
    369 		u8 auth[MD5_MAC_LEN];
    370 		struct radius_attr_hdr *attr;
    371 
    372 		os_memset(auth, 0, MD5_MAC_LEN);
    373 		attr = radius_msg_add_attr(msg,
    374 					   RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    375 					   auth, MD5_MAC_LEN);
    376 		if (attr == NULL) {
    377 			wpa_printf(MSG_WARNING, "RADIUS: Could not add "
    378 				   "Message-Authenticator");
    379 			return -1;
    380 		}
    381 		msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    382 		hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    383 			 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    384 	} else
    385 		msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    386 
    387 	if (wpabuf_len(msg->buf) > 0xffff) {
    388 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    389 			   (unsigned long) wpabuf_len(msg->buf));
    390 		return -1;
    391 	}
    392 	return 0;
    393 }
    394 
    395 
    396 int radius_msg_finish_srv(struct radius_msg *msg, const u8 *secret,
    397 			  size_t secret_len, const u8 *req_authenticator)
    398 {
    399 	u8 auth[MD5_MAC_LEN];
    400 	struct radius_attr_hdr *attr;
    401 	const u8 *addr[4];
    402 	size_t len[4];
    403 
    404 	os_memset(auth, 0, MD5_MAC_LEN);
    405 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    406 				   auth, MD5_MAC_LEN);
    407 	if (attr == NULL) {
    408 		wpa_printf(MSG_ERROR, "WARNING: Could not add Message-Authenticator");
    409 		return -1;
    410 	}
    411 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    412 	os_memcpy(msg->hdr->authenticator, req_authenticator,
    413 		  sizeof(msg->hdr->authenticator));
    414 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    415 		 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    416 
    417 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    418 	addr[0] = (u8 *) msg->hdr;
    419 	len[0] = 1 + 1 + 2;
    420 	addr[1] = req_authenticator;
    421 	len[1] = MD5_MAC_LEN;
    422 	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
    423 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    424 	addr[3] = secret;
    425 	len[3] = secret_len;
    426 	md5_vector(4, addr, len, msg->hdr->authenticator);
    427 
    428 	if (wpabuf_len(msg->buf) > 0xffff) {
    429 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    430 			   (unsigned long) wpabuf_len(msg->buf));
    431 		return -1;
    432 	}
    433 	return 0;
    434 }
    435 
    436 
    437 int radius_msg_finish_das_resp(struct radius_msg *msg, const u8 *secret,
    438 			       size_t secret_len,
    439 			       const struct radius_hdr *req_hdr)
    440 {
    441 	const u8 *addr[2];
    442 	size_t len[2];
    443 	u8 auth[MD5_MAC_LEN];
    444 	struct radius_attr_hdr *attr;
    445 
    446 	os_memset(auth, 0, MD5_MAC_LEN);
    447 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
    448 				   auth, MD5_MAC_LEN);
    449 	if (attr == NULL) {
    450 		wpa_printf(MSG_WARNING, "Could not add Message-Authenticator");
    451 		return -1;
    452 	}
    453 
    454 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    455 	os_memcpy(msg->hdr->authenticator, req_hdr->authenticator, 16);
    456 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    457 		 wpabuf_len(msg->buf), (u8 *) (attr + 1));
    458 
    459 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    460 	addr[0] = wpabuf_head_u8(msg->buf);
    461 	len[0] = wpabuf_len(msg->buf);
    462 	addr[1] = secret;
    463 	len[1] = secret_len;
    464 	if (md5_vector(2, addr, len, msg->hdr->authenticator) < 0)
    465 		return -1;
    466 
    467 	if (wpabuf_len(msg->buf) > 0xffff) {
    468 		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
    469 			   (unsigned long) wpabuf_len(msg->buf));
    470 		return -1;
    471 	}
    472 	return 0;
    473 }
    474 
    475 
    476 void radius_msg_finish_acct(struct radius_msg *msg, const u8 *secret,
    477 			    size_t secret_len)
    478 {
    479 	const u8 *addr[2];
    480 	size_t len[2];
    481 
    482 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    483 	os_memset(msg->hdr->authenticator, 0, MD5_MAC_LEN);
    484 	addr[0] = wpabuf_head(msg->buf);
    485 	len[0] = wpabuf_len(msg->buf);
    486 	addr[1] = secret;
    487 	len[1] = secret_len;
    488 	md5_vector(2, addr, len, msg->hdr->authenticator);
    489 
    490 	if (wpabuf_len(msg->buf) > 0xffff) {
    491 		wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
    492 			   (unsigned long) wpabuf_len(msg->buf));
    493 	}
    494 }
    495 
    496 
    497 void radius_msg_finish_acct_resp(struct radius_msg *msg, const u8 *secret,
    498 				 size_t secret_len, const u8 *req_authenticator)
    499 {
    500 	const u8 *addr[2];
    501 	size_t len[2];
    502 
    503 	msg->hdr->length = host_to_be16(wpabuf_len(msg->buf));
    504 	os_memcpy(msg->hdr->authenticator, req_authenticator, MD5_MAC_LEN);
    505 	addr[0] = wpabuf_head(msg->buf);
    506 	len[0] = wpabuf_len(msg->buf);
    507 	addr[1] = secret;
    508 	len[1] = secret_len;
    509 	md5_vector(2, addr, len, msg->hdr->authenticator);
    510 
    511 	if (wpabuf_len(msg->buf) > 0xffff) {
    512 		wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
    513 			   (unsigned long) wpabuf_len(msg->buf));
    514 	}
    515 }
    516 
    517 
    518 int radius_msg_verify_acct_req(struct radius_msg *msg, const u8 *secret,
    519 			       size_t secret_len)
    520 {
    521 	const u8 *addr[4];
    522 	size_t len[4];
    523 	u8 zero[MD5_MAC_LEN];
    524 	u8 hash[MD5_MAC_LEN];
    525 
    526 	os_memset(zero, 0, sizeof(zero));
    527 	addr[0] = (u8 *) msg->hdr;
    528 	len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
    529 	addr[1] = zero;
    530 	len[1] = MD5_MAC_LEN;
    531 	addr[2] = (u8 *) (msg->hdr + 1);
    532 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    533 	addr[3] = secret;
    534 	len[3] = secret_len;
    535 	md5_vector(4, addr, len, hash);
    536 	return os_memcmp_const(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0;
    537 }
    538 
    539 
    540 int radius_msg_verify_das_req(struct radius_msg *msg, const u8 *secret,
    541 			      size_t secret_len,
    542 			      int require_message_authenticator)
    543 {
    544 	const u8 *addr[4];
    545 	size_t len[4];
    546 	u8 zero[MD5_MAC_LEN];
    547 	u8 hash[MD5_MAC_LEN];
    548 	u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
    549 	u8 orig_authenticator[16];
    550 
    551 	struct radius_attr_hdr *attr = NULL, *tmp;
    552 	size_t i;
    553 
    554 	os_memset(zero, 0, sizeof(zero));
    555 	addr[0] = (u8 *) msg->hdr;
    556 	len[0] = sizeof(struct radius_hdr) - MD5_MAC_LEN;
    557 	addr[1] = zero;
    558 	len[1] = MD5_MAC_LEN;
    559 	addr[2] = (u8 *) (msg->hdr + 1);
    560 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    561 	addr[3] = secret;
    562 	len[3] = secret_len;
    563 	md5_vector(4, addr, len, hash);
    564 	if (os_memcmp_const(msg->hdr->authenticator, hash, MD5_MAC_LEN) != 0)
    565 		return 1;
    566 
    567 	for (i = 0; i < msg->attr_used; i++) {
    568 		tmp = radius_get_attr_hdr(msg, i);
    569 		if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
    570 			if (attr != NULL) {
    571 				wpa_printf(MSG_WARNING, "Multiple "
    572 					   "Message-Authenticator attributes "
    573 					   "in RADIUS message");
    574 				return 1;
    575 			}
    576 			attr = tmp;
    577 		}
    578 	}
    579 
    580 	if (attr == NULL) {
    581 		if (require_message_authenticator) {
    582 			wpa_printf(MSG_WARNING,
    583 				   "Missing Message-Authenticator attribute in RADIUS message");
    584 			return 1;
    585 		}
    586 		return 0;
    587 	}
    588 
    589 	os_memcpy(orig, attr + 1, MD5_MAC_LEN);
    590 	os_memset(attr + 1, 0, MD5_MAC_LEN);
    591 	os_memcpy(orig_authenticator, msg->hdr->authenticator,
    592 		  sizeof(orig_authenticator));
    593 	os_memset(msg->hdr->authenticator, 0,
    594 		  sizeof(msg->hdr->authenticator));
    595 	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    596 		 wpabuf_len(msg->buf), auth);
    597 	os_memcpy(attr + 1, orig, MD5_MAC_LEN);
    598 	os_memcpy(msg->hdr->authenticator, orig_authenticator,
    599 		  sizeof(orig_authenticator));
    600 
    601 	return os_memcmp_const(orig, auth, MD5_MAC_LEN) != 0;
    602 }
    603 
    604 
    605 static int radius_msg_add_attr_to_array(struct radius_msg *msg,
    606 					struct radius_attr_hdr *attr)
    607 {
    608 	if (msg->attr_used >= msg->attr_size) {
    609 		size_t *nattr_pos;
    610 		int nlen = msg->attr_size * 2;
    611 
    612 		nattr_pos = os_realloc_array(msg->attr_pos, nlen,
    613 					     sizeof(*msg->attr_pos));
    614 		if (nattr_pos == NULL)
    615 			return -1;
    616 
    617 		msg->attr_pos = nattr_pos;
    618 		msg->attr_size = nlen;
    619 	}
    620 
    621 	msg->attr_pos[msg->attr_used++] =
    622 		(unsigned char *) attr - wpabuf_head_u8(msg->buf);
    623 
    624 	return 0;
    625 }
    626 
    627 
    628 struct radius_attr_hdr *radius_msg_add_attr(struct radius_msg *msg, u8 type,
    629 					    const u8 *data, size_t data_len)
    630 {
    631 	size_t buf_needed;
    632 	struct radius_attr_hdr *attr;
    633 
    634 	if (data_len > RADIUS_MAX_ATTR_LEN) {
    635 		wpa_printf(MSG_ERROR, "radius_msg_add_attr: too long attribute (%lu bytes)",
    636 		       (unsigned long) data_len);
    637 		return NULL;
    638 	}
    639 
    640 	buf_needed = sizeof(*attr) + data_len;
    641 
    642 	if (wpabuf_tailroom(msg->buf) < buf_needed) {
    643 		/* allocate more space for message buffer */
    644 		if (wpabuf_resize(&msg->buf, buf_needed) < 0)
    645 			return NULL;
    646 		msg->hdr = wpabuf_mhead(msg->buf);
    647 	}
    648 
    649 	attr = wpabuf_put(msg->buf, sizeof(struct radius_attr_hdr));
    650 	attr->type = type;
    651 	attr->length = sizeof(*attr) + data_len;
    652 	wpabuf_put_data(msg->buf, data, data_len);
    653 
    654 	if (radius_msg_add_attr_to_array(msg, attr))
    655 		return NULL;
    656 
    657 	return attr;
    658 }
    659 
    660 
    661 /**
    662  * radius_msg_parse - Parse a RADIUS message
    663  * @data: RADIUS message to be parsed
    664  * @len: Length of data buffer in octets
    665  * Returns: Parsed RADIUS message or %NULL on failure
    666  *
    667  * This parses a RADIUS message and makes a copy of its data. The caller is
    668  * responsible for freeing the returned data with radius_msg_free().
    669  */
    670 struct radius_msg * radius_msg_parse(const u8 *data, size_t len)
    671 {
    672 	struct radius_msg *msg;
    673 	struct radius_hdr *hdr;
    674 	struct radius_attr_hdr *attr;
    675 	size_t msg_len;
    676 	unsigned char *pos, *end;
    677 
    678 	if (data == NULL || len < sizeof(*hdr))
    679 		return NULL;
    680 
    681 	hdr = (struct radius_hdr *) data;
    682 
    683 	msg_len = be_to_host16(hdr->length);
    684 	if (msg_len < sizeof(*hdr) || msg_len > len) {
    685 		wpa_printf(MSG_INFO, "RADIUS: Invalid message length");
    686 		return NULL;
    687 	}
    688 
    689 	if (msg_len < len) {
    690 		wpa_printf(MSG_DEBUG, "RADIUS: Ignored %lu extra bytes after "
    691 			   "RADIUS message", (unsigned long) len - msg_len);
    692 	}
    693 
    694 	msg = os_zalloc(sizeof(*msg));
    695 	if (msg == NULL)
    696 		return NULL;
    697 
    698 	msg->buf = wpabuf_alloc_copy(data, msg_len);
    699 	if (msg->buf == NULL || radius_msg_initialize(msg)) {
    700 		radius_msg_free(msg);
    701 		return NULL;
    702 	}
    703 	msg->hdr = wpabuf_mhead(msg->buf);
    704 
    705 	/* parse attributes */
    706 	pos = wpabuf_mhead_u8(msg->buf) + sizeof(struct radius_hdr);
    707 	end = wpabuf_mhead_u8(msg->buf) + wpabuf_len(msg->buf);
    708 	while (pos < end) {
    709 		if ((size_t) (end - pos) < sizeof(*attr))
    710 			goto fail;
    711 
    712 		attr = (struct radius_attr_hdr *) pos;
    713 
    714 		if (attr->length > end - pos || attr->length < sizeof(*attr))
    715 			goto fail;
    716 
    717 		/* TODO: check that attr->length is suitable for attr->type */
    718 
    719 		if (radius_msg_add_attr_to_array(msg, attr))
    720 			goto fail;
    721 
    722 		pos += attr->length;
    723 	}
    724 
    725 	return msg;
    726 
    727  fail:
    728 	radius_msg_free(msg);
    729 	return NULL;
    730 }
    731 
    732 
    733 int radius_msg_add_eap(struct radius_msg *msg, const u8 *data, size_t data_len)
    734 {
    735 	const u8 *pos = data;
    736 	size_t left = data_len;
    737 
    738 	while (left > 0) {
    739 		int len;
    740 		if (left > RADIUS_MAX_ATTR_LEN)
    741 			len = RADIUS_MAX_ATTR_LEN;
    742 		else
    743 			len = left;
    744 
    745 		if (!radius_msg_add_attr(msg, RADIUS_ATTR_EAP_MESSAGE,
    746 					 pos, len))
    747 			return 0;
    748 
    749 		pos += len;
    750 		left -= len;
    751 	}
    752 
    753 	return 1;
    754 }
    755 
    756 
    757 struct wpabuf * radius_msg_get_eap(struct radius_msg *msg)
    758 {
    759 	struct wpabuf *eap;
    760 	size_t len, i;
    761 	struct radius_attr_hdr *attr;
    762 
    763 	if (msg == NULL)
    764 		return NULL;
    765 
    766 	len = 0;
    767 	for (i = 0; i < msg->attr_used; i++) {
    768 		attr = radius_get_attr_hdr(msg, i);
    769 		if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
    770 		    attr->length > sizeof(struct radius_attr_hdr))
    771 			len += attr->length - sizeof(struct radius_attr_hdr);
    772 	}
    773 
    774 	if (len == 0)
    775 		return NULL;
    776 
    777 	eap = wpabuf_alloc(len);
    778 	if (eap == NULL)
    779 		return NULL;
    780 
    781 	for (i = 0; i < msg->attr_used; i++) {
    782 		attr = radius_get_attr_hdr(msg, i);
    783 		if (attr->type == RADIUS_ATTR_EAP_MESSAGE &&
    784 		    attr->length > sizeof(struct radius_attr_hdr)) {
    785 			int flen = attr->length - sizeof(*attr);
    786 			wpabuf_put_data(eap, attr + 1, flen);
    787 		}
    788 	}
    789 
    790 	return eap;
    791 }
    792 
    793 
    794 int radius_msg_verify_msg_auth(struct radius_msg *msg, const u8 *secret,
    795 			       size_t secret_len, const u8 *req_auth)
    796 {
    797 	u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
    798 	u8 orig_authenticator[16];
    799 	struct radius_attr_hdr *attr = NULL, *tmp;
    800 	size_t i;
    801 
    802 	for (i = 0; i < msg->attr_used; i++) {
    803 		tmp = radius_get_attr_hdr(msg, i);
    804 		if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
    805 			if (attr != NULL) {
    806 				wpa_printf(MSG_INFO, "Multiple Message-Authenticator attributes in RADIUS message");
    807 				return 1;
    808 			}
    809 			attr = tmp;
    810 		}
    811 	}
    812 
    813 	if (attr == NULL) {
    814 		wpa_printf(MSG_INFO, "No Message-Authenticator attribute found");
    815 		return 1;
    816 	}
    817 
    818 	os_memcpy(orig, attr + 1, MD5_MAC_LEN);
    819 	os_memset(attr + 1, 0, MD5_MAC_LEN);
    820 	if (req_auth) {
    821 		os_memcpy(orig_authenticator, msg->hdr->authenticator,
    822 			  sizeof(orig_authenticator));
    823 		os_memcpy(msg->hdr->authenticator, req_auth,
    824 			  sizeof(msg->hdr->authenticator));
    825 	}
    826 	if (hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
    827 		     wpabuf_len(msg->buf), auth) < 0)
    828 		return 1;
    829 	os_memcpy(attr + 1, orig, MD5_MAC_LEN);
    830 	if (req_auth) {
    831 		os_memcpy(msg->hdr->authenticator, orig_authenticator,
    832 			  sizeof(orig_authenticator));
    833 	}
    834 
    835 	if (os_memcmp_const(orig, auth, MD5_MAC_LEN) != 0) {
    836 		wpa_printf(MSG_INFO, "Invalid Message-Authenticator!");
    837 		return 1;
    838 	}
    839 
    840 	return 0;
    841 }
    842 
    843 
    844 int radius_msg_verify(struct radius_msg *msg, const u8 *secret,
    845 		      size_t secret_len, struct radius_msg *sent_msg, int auth)
    846 {
    847 	const u8 *addr[4];
    848 	size_t len[4];
    849 	u8 hash[MD5_MAC_LEN];
    850 
    851 	if (sent_msg == NULL) {
    852 		wpa_printf(MSG_INFO, "No matching Access-Request message found");
    853 		return 1;
    854 	}
    855 
    856 	if (auth &&
    857 	    radius_msg_verify_msg_auth(msg, secret, secret_len,
    858 				       sent_msg->hdr->authenticator)) {
    859 		return 1;
    860 	}
    861 
    862 	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
    863 	addr[0] = (u8 *) msg->hdr;
    864 	len[0] = 1 + 1 + 2;
    865 	addr[1] = sent_msg->hdr->authenticator;
    866 	len[1] = MD5_MAC_LEN;
    867 	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
    868 	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
    869 	addr[3] = secret;
    870 	len[3] = secret_len;
    871 	if (md5_vector(4, addr, len, hash) < 0 ||
    872 	    os_memcmp_const(hash, msg->hdr->authenticator, MD5_MAC_LEN) != 0) {
    873 		wpa_printf(MSG_INFO, "Response Authenticator invalid!");
    874 		return 1;
    875 	}
    876 
    877 	return 0;
    878 }
    879 
    880 
    881 int radius_msg_copy_attr(struct radius_msg *dst, struct radius_msg *src,
    882 			 u8 type)
    883 {
    884 	struct radius_attr_hdr *attr;
    885 	size_t i;
    886 	int count = 0;
    887 
    888 	for (i = 0; i < src->attr_used; i++) {
    889 		attr = radius_get_attr_hdr(src, i);
    890 		if (attr->type == type && attr->length >= sizeof(*attr)) {
    891 			if (!radius_msg_add_attr(dst, type, (u8 *) (attr + 1),
    892 						 attr->length - sizeof(*attr)))
    893 				return -1;
    894 			count++;
    895 		}
    896 	}
    897 
    898 	return count;
    899 }
    900 
    901 
    902 /* Create Request Authenticator. The value should be unique over the lifetime
    903  * of the shared secret between authenticator and authentication server.
    904  */
    905 int radius_msg_make_authenticator(struct radius_msg *msg)
    906 {
    907 	return os_get_random((u8 *) &msg->hdr->authenticator,
    908 			     sizeof(msg->hdr->authenticator));
    909 }
    910 
    911 
    912 /* Get Vendor-specific RADIUS Attribute from a parsed RADIUS message.
    913  * Returns the Attribute payload and sets alen to indicate the length of the
    914  * payload if a vendor attribute with subtype is found, otherwise returns NULL.
    915  * The returned payload is allocated with os_malloc() and caller must free it
    916  * by calling os_free().
    917  */
    918 static u8 *radius_msg_get_vendor_attr(struct radius_msg *msg, u32 vendor,
    919 				      u8 subtype, size_t *alen)
    920 {
    921 	u8 *data, *pos;
    922 	size_t i, len;
    923 
    924 	if (msg == NULL)
    925 		return NULL;
    926 
    927 	for (i = 0; i < msg->attr_used; i++) {
    928 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
    929 		size_t left;
    930 		u32 vendor_id;
    931 		struct radius_attr_vendor *vhdr;
    932 
    933 		if (attr->type != RADIUS_ATTR_VENDOR_SPECIFIC ||
    934 		    attr->length < sizeof(*attr))
    935 			continue;
    936 
    937 		left = attr->length - sizeof(*attr);
    938 		if (left < 4)
    939 			continue;
    940 
    941 		pos = (u8 *) (attr + 1);
    942 
    943 		os_memcpy(&vendor_id, pos, 4);
    944 		pos += 4;
    945 		left -= 4;
    946 
    947 		if (ntohl(vendor_id) != vendor)
    948 			continue;
    949 
    950 		while (left >= sizeof(*vhdr)) {
    951 			vhdr = (struct radius_attr_vendor *) pos;
    952 			if (vhdr->vendor_length > left ||
    953 			    vhdr->vendor_length < sizeof(*vhdr)) {
    954 				break;
    955 			}
    956 			if (vhdr->vendor_type != subtype) {
    957 				pos += vhdr->vendor_length;
    958 				left -= vhdr->vendor_length;
    959 				continue;
    960 			}
    961 
    962 			len = vhdr->vendor_length - sizeof(*vhdr);
    963 			data = os_malloc(len);
    964 			if (data == NULL)
    965 				return NULL;
    966 			os_memcpy(data, pos + sizeof(*vhdr), len);
    967 			if (alen)
    968 				*alen = len;
    969 			return data;
    970 		}
    971 	}
    972 
    973 	return NULL;
    974 }
    975 
    976 
    977 static u8 * decrypt_ms_key(const u8 *key, size_t len,
    978 			   const u8 *req_authenticator,
    979 			   const u8 *secret, size_t secret_len, size_t *reslen)
    980 {
    981 	u8 *plain, *ppos, *res;
    982 	const u8 *pos;
    983 	size_t left, plen;
    984 	u8 hash[MD5_MAC_LEN];
    985 	int i, first = 1;
    986 	const u8 *addr[3];
    987 	size_t elen[3];
    988 
    989 	/* key: 16-bit salt followed by encrypted key info */
    990 
    991 	if (len < 2 + 16) {
    992 		wpa_printf(MSG_DEBUG, "RADIUS: %s: Len is too small: %d",
    993 			   __func__, (int) len);
    994 		return NULL;
    995 	}
    996 
    997 	pos = key + 2;
    998 	left = len - 2;
    999 	if (left % 16) {
   1000 		wpa_printf(MSG_INFO, "RADIUS: Invalid ms key len %lu",
   1001 			   (unsigned long) left);
   1002 		return NULL;
   1003 	}
   1004 
   1005 	plen = left;
   1006 	ppos = plain = os_malloc(plen);
   1007 	if (plain == NULL)
   1008 		return NULL;
   1009 	plain[0] = 0;
   1010 
   1011 	while (left > 0) {
   1012 		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
   1013 		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
   1014 
   1015 		addr[0] = secret;
   1016 		elen[0] = secret_len;
   1017 		if (first) {
   1018 			addr[1] = req_authenticator;
   1019 			elen[1] = MD5_MAC_LEN;
   1020 			addr[2] = key;
   1021 			elen[2] = 2; /* Salt */
   1022 		} else {
   1023 			addr[1] = pos - MD5_MAC_LEN;
   1024 			elen[1] = MD5_MAC_LEN;
   1025 		}
   1026 		if (md5_vector(first ? 3 : 2, addr, elen, hash) < 0) {
   1027 			os_free(plain);
   1028 			return NULL;
   1029 		}
   1030 		first = 0;
   1031 
   1032 		for (i = 0; i < MD5_MAC_LEN; i++)
   1033 			*ppos++ = *pos++ ^ hash[i];
   1034 		left -= MD5_MAC_LEN;
   1035 	}
   1036 
   1037 	if (plain[0] == 0 || plain[0] > plen - 1) {
   1038 		wpa_printf(MSG_INFO, "RADIUS: Failed to decrypt MPPE key");
   1039 		os_free(plain);
   1040 		return NULL;
   1041 	}
   1042 
   1043 	res = os_malloc(plain[0]);
   1044 	if (res == NULL) {
   1045 		os_free(plain);
   1046 		return NULL;
   1047 	}
   1048 	os_memcpy(res, plain + 1, plain[0]);
   1049 	if (reslen)
   1050 		*reslen = plain[0];
   1051 	os_free(plain);
   1052 	return res;
   1053 }
   1054 
   1055 
   1056 static void encrypt_ms_key(const u8 *key, size_t key_len, u16 salt,
   1057 			   const u8 *req_authenticator,
   1058 			   const u8 *secret, size_t secret_len,
   1059 			   u8 *ebuf, size_t *elen)
   1060 {
   1061 	int i, len, first = 1;
   1062 	u8 hash[MD5_MAC_LEN], saltbuf[2], *pos;
   1063 	const u8 *addr[3];
   1064 	size_t _len[3];
   1065 
   1066 	WPA_PUT_BE16(saltbuf, salt);
   1067 
   1068 	len = 1 + key_len;
   1069 	if (len & 0x0f) {
   1070 		len = (len & 0xf0) + 16;
   1071 	}
   1072 	os_memset(ebuf, 0, len);
   1073 	ebuf[0] = key_len;
   1074 	os_memcpy(ebuf + 1, key, key_len);
   1075 
   1076 	*elen = len;
   1077 
   1078 	pos = ebuf;
   1079 	while (len > 0) {
   1080 		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
   1081 		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
   1082 		addr[0] = secret;
   1083 		_len[0] = secret_len;
   1084 		if (first) {
   1085 			addr[1] = req_authenticator;
   1086 			_len[1] = MD5_MAC_LEN;
   1087 			addr[2] = saltbuf;
   1088 			_len[2] = sizeof(saltbuf);
   1089 		} else {
   1090 			addr[1] = pos - MD5_MAC_LEN;
   1091 			_len[1] = MD5_MAC_LEN;
   1092 		}
   1093 		md5_vector(first ? 3 : 2, addr, _len, hash);
   1094 		first = 0;
   1095 
   1096 		for (i = 0; i < MD5_MAC_LEN; i++)
   1097 			*pos++ ^= hash[i];
   1098 
   1099 		len -= MD5_MAC_LEN;
   1100 	}
   1101 }
   1102 
   1103 
   1104 struct radius_ms_mppe_keys *
   1105 radius_msg_get_ms_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
   1106 		       const u8 *secret, size_t secret_len)
   1107 {
   1108 	u8 *key;
   1109 	size_t keylen;
   1110 	struct radius_ms_mppe_keys *keys;
   1111 
   1112 	if (msg == NULL || sent_msg == NULL)
   1113 		return NULL;
   1114 
   1115 	keys = os_zalloc(sizeof(*keys));
   1116 	if (keys == NULL)
   1117 		return NULL;
   1118 
   1119 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
   1120 					 RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY,
   1121 					 &keylen);
   1122 	if (key) {
   1123 		keys->send = decrypt_ms_key(key, keylen,
   1124 					    sent_msg->hdr->authenticator,
   1125 					    secret, secret_len,
   1126 					    &keys->send_len);
   1127 		if (!keys->send) {
   1128 			wpa_printf(MSG_DEBUG,
   1129 				   "RADIUS: Failed to decrypt send key");
   1130 		}
   1131 		os_free(key);
   1132 	}
   1133 
   1134 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
   1135 					 RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY,
   1136 					 &keylen);
   1137 	if (key) {
   1138 		keys->recv = decrypt_ms_key(key, keylen,
   1139 					    sent_msg->hdr->authenticator,
   1140 					    secret, secret_len,
   1141 					    &keys->recv_len);
   1142 		if (!keys->recv) {
   1143 			wpa_printf(MSG_DEBUG,
   1144 				   "RADIUS: Failed to decrypt recv key");
   1145 		}
   1146 		os_free(key);
   1147 	}
   1148 
   1149 	return keys;
   1150 }
   1151 
   1152 
   1153 struct radius_ms_mppe_keys *
   1154 radius_msg_get_cisco_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
   1155 			  const u8 *secret, size_t secret_len)
   1156 {
   1157 	u8 *key;
   1158 	size_t keylen;
   1159 	struct radius_ms_mppe_keys *keys;
   1160 
   1161 	if (msg == NULL || sent_msg == NULL)
   1162 		return NULL;
   1163 
   1164 	keys = os_zalloc(sizeof(*keys));
   1165 	if (keys == NULL)
   1166 		return NULL;
   1167 
   1168 	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_CISCO,
   1169 					 RADIUS_CISCO_AV_PAIR, &keylen);
   1170 	if (key && keylen == 51 &&
   1171 	    os_memcmp(key, "leap:session-key=", 17) == 0) {
   1172 		keys->recv = decrypt_ms_key(key + 17, keylen - 17,
   1173 					    sent_msg->hdr->authenticator,
   1174 					    secret, secret_len,
   1175 					    &keys->recv_len);
   1176 	}
   1177 	os_free(key);
   1178 
   1179 	return keys;
   1180 }
   1181 
   1182 
   1183 int radius_msg_add_mppe_keys(struct radius_msg *msg,
   1184 			     const u8 *req_authenticator,
   1185 			     const u8 *secret, size_t secret_len,
   1186 			     const u8 *send_key, size_t send_key_len,
   1187 			     const u8 *recv_key, size_t recv_key_len)
   1188 {
   1189 	struct radius_attr_hdr *attr;
   1190 	u32 vendor_id = htonl(RADIUS_VENDOR_ID_MICROSOFT);
   1191 	u8 *buf;
   1192 	struct radius_attr_vendor *vhdr;
   1193 	u8 *pos;
   1194 	size_t elen;
   1195 	int hlen;
   1196 	u16 salt;
   1197 
   1198 	hlen = sizeof(vendor_id) + sizeof(*vhdr) + 2;
   1199 
   1200 	/* MS-MPPE-Send-Key */
   1201 	buf = os_malloc(hlen + send_key_len + 16);
   1202 	if (buf == NULL) {
   1203 		return 0;
   1204 	}
   1205 	pos = buf;
   1206 	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
   1207 	pos += sizeof(vendor_id);
   1208 	vhdr = (struct radius_attr_vendor *) pos;
   1209 	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY;
   1210 	pos = (u8 *) (vhdr + 1);
   1211 	if (os_get_random((u8 *) &salt, sizeof(salt)) < 0) {
   1212 		os_free(buf);
   1213 		return 0;
   1214 	}
   1215 	salt |= 0x8000;
   1216 	WPA_PUT_BE16(pos, salt);
   1217 	pos += 2;
   1218 	encrypt_ms_key(send_key, send_key_len, salt, req_authenticator, secret,
   1219 		       secret_len, pos, &elen);
   1220 	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
   1221 
   1222 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
   1223 				   buf, hlen + elen);
   1224 	os_free(buf);
   1225 	if (attr == NULL) {
   1226 		return 0;
   1227 	}
   1228 
   1229 	/* MS-MPPE-Recv-Key */
   1230 	buf = os_malloc(hlen + recv_key_len + 16);
   1231 	if (buf == NULL) {
   1232 		return 0;
   1233 	}
   1234 	pos = buf;
   1235 	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
   1236 	pos += sizeof(vendor_id);
   1237 	vhdr = (struct radius_attr_vendor *) pos;
   1238 	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY;
   1239 	pos = (u8 *) (vhdr + 1);
   1240 	salt ^= 1;
   1241 	WPA_PUT_BE16(pos, salt);
   1242 	pos += 2;
   1243 	encrypt_ms_key(recv_key, recv_key_len, salt, req_authenticator, secret,
   1244 		       secret_len, pos, &elen);
   1245 	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
   1246 
   1247 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
   1248 				   buf, hlen + elen);
   1249 	os_free(buf);
   1250 	if (attr == NULL) {
   1251 		return 0;
   1252 	}
   1253 
   1254 	return 1;
   1255 }
   1256 
   1257 
   1258 int radius_msg_add_wfa(struct radius_msg *msg, u8 subtype, const u8 *data,
   1259 		       size_t len)
   1260 {
   1261 	struct radius_attr_hdr *attr;
   1262 	u8 *buf, *pos;
   1263 	size_t alen;
   1264 
   1265 	alen = 4 + 2 + len;
   1266 	buf = os_malloc(alen);
   1267 	if (buf == NULL)
   1268 		return 0;
   1269 	pos = buf;
   1270 	WPA_PUT_BE32(pos, RADIUS_VENDOR_ID_WFA);
   1271 	pos += 4;
   1272 	*pos++ = subtype;
   1273 	*pos++ = 2 + len;
   1274 	os_memcpy(pos, data, len);
   1275 	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
   1276 				   buf, alen);
   1277 	os_free(buf);
   1278 	if (attr == NULL)
   1279 		return 0;
   1280 
   1281 	return 1;
   1282 }
   1283 
   1284 
   1285 int radius_user_password_hide(struct radius_msg *msg,
   1286 			      const u8 *data, size_t data_len,
   1287 			      const u8 *secret, size_t secret_len,
   1288 			      u8 *buf, size_t buf_len)
   1289 {
   1290 	size_t padlen, i, pos;
   1291 	const u8 *addr[2];
   1292 	size_t len[2];
   1293 	u8 hash[16];
   1294 
   1295 	if (data_len + 16 > buf_len)
   1296 		return -1;
   1297 
   1298 	os_memcpy(buf, data, data_len);
   1299 
   1300 	padlen = data_len % 16;
   1301 	if (padlen && data_len < buf_len) {
   1302 		padlen = 16 - padlen;
   1303 		os_memset(buf + data_len, 0, padlen);
   1304 		buf_len = data_len + padlen;
   1305 	} else {
   1306 		buf_len = data_len;
   1307 	}
   1308 
   1309 	addr[0] = secret;
   1310 	len[0] = secret_len;
   1311 	addr[1] = msg->hdr->authenticator;
   1312 	len[1] = 16;
   1313 	md5_vector(2, addr, len, hash);
   1314 
   1315 	for (i = 0; i < 16; i++)
   1316 		buf[i] ^= hash[i];
   1317 	pos = 16;
   1318 
   1319 	while (pos < buf_len) {
   1320 		addr[0] = secret;
   1321 		len[0] = secret_len;
   1322 		addr[1] = &buf[pos - 16];
   1323 		len[1] = 16;
   1324 		md5_vector(2, addr, len, hash);
   1325 
   1326 		for (i = 0; i < 16; i++)
   1327 			buf[pos + i] ^= hash[i];
   1328 
   1329 		pos += 16;
   1330 	}
   1331 
   1332 	return buf_len;
   1333 }
   1334 
   1335 
   1336 /* Add User-Password attribute to a RADIUS message and encrypt it as specified
   1337  * in RFC 2865, Chap. 5.2 */
   1338 struct radius_attr_hdr *
   1339 radius_msg_add_attr_user_password(struct radius_msg *msg,
   1340 				  const u8 *data, size_t data_len,
   1341 				  const u8 *secret, size_t secret_len)
   1342 {
   1343 	u8 buf[128];
   1344 	int res;
   1345 
   1346 	res = radius_user_password_hide(msg, data, data_len,
   1347 					secret, secret_len, buf, sizeof(buf));
   1348 	if (res < 0)
   1349 		return NULL;
   1350 
   1351 	return radius_msg_add_attr(msg, RADIUS_ATTR_USER_PASSWORD,
   1352 				   buf, res);
   1353 }
   1354 
   1355 
   1356 int radius_msg_get_attr(struct radius_msg *msg, u8 type, u8 *buf, size_t len)
   1357 {
   1358 	struct radius_attr_hdr *attr = NULL, *tmp;
   1359 	size_t i, dlen;
   1360 
   1361 	for (i = 0; i < msg->attr_used; i++) {
   1362 		tmp = radius_get_attr_hdr(msg, i);
   1363 		if (tmp->type == type) {
   1364 			attr = tmp;
   1365 			break;
   1366 		}
   1367 	}
   1368 
   1369 	if (!attr || attr->length < sizeof(*attr))
   1370 		return -1;
   1371 
   1372 	dlen = attr->length - sizeof(*attr);
   1373 	if (buf)
   1374 		os_memcpy(buf, (attr + 1), dlen > len ? len : dlen);
   1375 	return dlen;
   1376 }
   1377 
   1378 
   1379 int radius_msg_get_attr_ptr(struct radius_msg *msg, u8 type, u8 **buf,
   1380 			    size_t *len, const u8 *start)
   1381 {
   1382 	size_t i;
   1383 	struct radius_attr_hdr *attr = NULL, *tmp;
   1384 
   1385 	for (i = 0; i < msg->attr_used; i++) {
   1386 		tmp = radius_get_attr_hdr(msg, i);
   1387 		if (tmp->type == type &&
   1388 		    (start == NULL || (u8 *) tmp > start)) {
   1389 			attr = tmp;
   1390 			break;
   1391 		}
   1392 	}
   1393 
   1394 	if (!attr || attr->length < sizeof(*attr))
   1395 		return -1;
   1396 
   1397 	*buf = (u8 *) (attr + 1);
   1398 	*len = attr->length - sizeof(*attr);
   1399 	return 0;
   1400 }
   1401 
   1402 
   1403 int radius_msg_count_attr(struct radius_msg *msg, u8 type, int min_len)
   1404 {
   1405 	size_t i;
   1406 	int count;
   1407 
   1408 	for (count = 0, i = 0; i < msg->attr_used; i++) {
   1409 		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
   1410 		if (attr->type == type &&
   1411 		    attr->length >= sizeof(struct radius_attr_hdr) + min_len)
   1412 			count++;
   1413 	}
   1414 
   1415 	return count;
   1416 }
   1417 
   1418 
   1419 struct radius_tunnel_attrs {
   1420 	int tag_used;
   1421 	int type; /* Tunnel-Type */
   1422 	int medium_type; /* Tunnel-Medium-Type */
   1423 	int vlanid;
   1424 };
   1425 
   1426 
   1427 static int cmp_int(const void *a, const void *b)
   1428 {
   1429 	int x, y;
   1430 
   1431 	x = *((int *) a);
   1432 	y = *((int *) b);
   1433 	return (x - y);
   1434 }
   1435 
   1436 
   1437 /**
   1438  * radius_msg_get_vlanid - Parse RADIUS attributes for VLAN tunnel information
   1439  * The k tagged vlans found are sorted by vlan_id and stored in the first k
   1440  * items of tagged.
   1441  *
   1442  * @msg: RADIUS message
   1443  * @untagged: Pointer to store untagged vid
   1444  * @numtagged: Size of tagged
   1445  * @tagged: Pointer to store tagged list
   1446  *
   1447  * Returns: 0 if neither tagged nor untagged configuration is found, 1 otherwise
   1448  */
   1449 int radius_msg_get_vlanid(struct radius_msg *msg, int *untagged, int numtagged,
   1450 			  int *tagged)
   1451 {
   1452 	struct radius_tunnel_attrs tunnel[RADIUS_TUNNEL_TAGS], *tun;
   1453 	size_t i;
   1454 	struct radius_attr_hdr *attr = NULL;
   1455 	const u8 *data;
   1456 	char buf[10];
   1457 	size_t dlen;
   1458 	int j, taggedidx = 0, vlan_id;
   1459 
   1460 	os_memset(&tunnel, 0, sizeof(tunnel));
   1461 	for (j = 0; j < numtagged; j++)
   1462 		tagged[j] = 0;
   1463 	*untagged = 0;
   1464 
   1465 	for (i = 0; i < msg->attr_used; i++) {
   1466 		attr = radius_get_attr_hdr(msg, i);
   1467 		if (attr->length < sizeof(*attr))
   1468 			return -1;
   1469 		data = (const u8 *) (attr + 1);
   1470 		dlen = attr->length - sizeof(*attr);
   1471 		if (attr->length < 3)
   1472 			continue;
   1473 		if (data[0] >= RADIUS_TUNNEL_TAGS)
   1474 			tun = &tunnel[0];
   1475 		else
   1476 			tun = &tunnel[data[0]];
   1477 
   1478 		switch (attr->type) {
   1479 		case RADIUS_ATTR_TUNNEL_TYPE:
   1480 			if (attr->length != 6)
   1481 				break;
   1482 			tun->tag_used++;
   1483 			tun->type = WPA_GET_BE24(data + 1);
   1484 			break;
   1485 		case RADIUS_ATTR_TUNNEL_MEDIUM_TYPE:
   1486 			if (attr->length != 6)
   1487 				break;
   1488 			tun->tag_used++;
   1489 			tun->medium_type = WPA_GET_BE24(data + 1);
   1490 			break;
   1491 		case RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID:
   1492 			if (data[0] < RADIUS_TUNNEL_TAGS) {
   1493 				data++;
   1494 				dlen--;
   1495 			}
   1496 			if (dlen >= sizeof(buf))
   1497 				break;
   1498 			os_memcpy(buf, data, dlen);
   1499 			buf[dlen] = '\0';
   1500 			vlan_id = atoi(buf);
   1501 			if (vlan_id <= 0)
   1502 				break;
   1503 			tun->tag_used++;
   1504 			tun->vlanid = vlan_id;
   1505 			break;
   1506 		case RADIUS_ATTR_EGRESS_VLANID: /* RFC 4675 */
   1507 			if (attr->length != 6)
   1508 				break;
   1509 			vlan_id = WPA_GET_BE24(data + 1);
   1510 			if (vlan_id <= 0)
   1511 				break;
   1512 			if (data[0] == 0x32)
   1513 				*untagged = vlan_id;
   1514 			else if (data[0] == 0x31 && tagged &&
   1515 				 taggedidx < numtagged)
   1516 				tagged[taggedidx++] = vlan_id;
   1517 			break;
   1518 		}
   1519 	}
   1520 
   1521 	/* Use tunnel with the lowest tag for untagged VLAN id */
   1522 	for (i = 0; i < RADIUS_TUNNEL_TAGS; i++) {
   1523 		tun = &tunnel[i];
   1524 		if (tun->tag_used &&
   1525 		    tun->type == RADIUS_TUNNEL_TYPE_VLAN &&
   1526 		    tun->medium_type == RADIUS_TUNNEL_MEDIUM_TYPE_802 &&
   1527 		    tun->vlanid > 0) {
   1528 			*untagged = tun->vlanid;
   1529 			break;
   1530 		}
   1531 	}
   1532 
   1533 	if (taggedidx)
   1534 		qsort(tagged, taggedidx, sizeof(int), cmp_int);
   1535 
   1536 	if (*untagged > 0 || taggedidx)
   1537 		return 1;
   1538 	return 0;
   1539 }
   1540 
   1541 
   1542 /**
   1543  * radius_msg_get_tunnel_password - Parse RADIUS attribute Tunnel-Password
   1544  * @msg: Received RADIUS message
   1545  * @keylen: Length of returned password
   1546  * @secret: RADIUS shared secret
   1547  * @secret_len: Length of secret
   1548  * @sent_msg: Sent RADIUS message
   1549  * @n: Number of password attribute to return (starting with 0)
   1550  * Returns: Pointer to n-th password (free with os_free) or %NULL
   1551  */
   1552 char * radius_msg_get_tunnel_password(struct radius_msg *msg, int *keylen,
   1553 				      const u8 *secret, size_t secret_len,
   1554 				      struct radius_msg *sent_msg, size_t n)
   1555 {
   1556 	u8 *buf = NULL;
   1557 	size_t buflen;
   1558 	const u8 *salt;
   1559 	u8 *str;
   1560 	const u8 *addr[3];
   1561 	size_t len[3];
   1562 	u8 hash[16];
   1563 	u8 *pos;
   1564 	size_t i, j = 0;
   1565 	struct radius_attr_hdr *attr;
   1566 	const u8 *data;
   1567 	size_t dlen;
   1568 	const u8 *fdata = NULL; /* points to found item */
   1569 	size_t fdlen = -1;
   1570 	char *ret = NULL;
   1571 
   1572 	/* find n-th valid Tunnel-Password attribute */
   1573 	for (i = 0; i < msg->attr_used; i++) {
   1574 		attr = radius_get_attr_hdr(msg, i);
   1575 		if (attr == NULL ||
   1576 		    attr->type != RADIUS_ATTR_TUNNEL_PASSWORD) {
   1577 			continue;
   1578 		}
   1579 		if (attr->length <= 5)
   1580 			continue;
   1581 		data = (const u8 *) (attr + 1);
   1582 		dlen = attr->length - sizeof(*attr);
   1583 		if (dlen <= 3 || dlen % 16 != 3)
   1584 			continue;
   1585 		j++;
   1586 		if (j <= n)
   1587 			continue;
   1588 
   1589 		fdata = data;
   1590 		fdlen = dlen;
   1591 		break;
   1592 	}
   1593 	if (fdata == NULL)
   1594 		goto out;
   1595 
   1596 	/* alloc writable memory for decryption */
   1597 	buf = os_malloc(fdlen);
   1598 	if (buf == NULL)
   1599 		goto out;
   1600 	os_memcpy(buf, fdata, fdlen);
   1601 	buflen = fdlen;
   1602 
   1603 	/* init pointers */
   1604 	salt = buf + 1;
   1605 	str = buf + 3;
   1606 
   1607 	/* decrypt blocks */
   1608 	pos = buf + buflen - 16; /* last block */
   1609 	while (pos >= str + 16) { /* all but the first block */
   1610 		addr[0] = secret;
   1611 		len[0] = secret_len;
   1612 		addr[1] = pos - 16;
   1613 		len[1] = 16;
   1614 		md5_vector(2, addr, len, hash);
   1615 
   1616 		for (i = 0; i < 16; i++)
   1617 			pos[i] ^= hash[i];
   1618 
   1619 		pos -= 16;
   1620 	}
   1621 
   1622 	/* decrypt first block */
   1623 	if (str != pos)
   1624 		goto out;
   1625 	addr[0] = secret;
   1626 	len[0] = secret_len;
   1627 	addr[1] = sent_msg->hdr->authenticator;
   1628 	len[1] = 16;
   1629 	addr[2] = salt;
   1630 	len[2] = 2;
   1631 	md5_vector(3, addr, len, hash);
   1632 
   1633 	for (i = 0; i < 16; i++)
   1634 		pos[i] ^= hash[i];
   1635 
   1636 	/* derive plaintext length from first subfield */
   1637 	*keylen = (unsigned char) str[0];
   1638 	if ((u8 *) (str + *keylen) >= (u8 *) (buf + buflen)) {
   1639 		/* decryption error - invalid key length */
   1640 		goto out;
   1641 	}
   1642 	if (*keylen == 0) {
   1643 		/* empty password */
   1644 		goto out;
   1645 	}
   1646 
   1647 	/* copy passphrase into new buffer */
   1648 	ret = os_malloc(*keylen);
   1649 	if (ret)
   1650 		os_memcpy(ret, str + 1, *keylen);
   1651 
   1652 out:
   1653 	/* return new buffer */
   1654 	os_free(buf);
   1655 	return ret;
   1656 }
   1657 
   1658 
   1659 void radius_free_class(struct radius_class_data *c)
   1660 {
   1661 	size_t i;
   1662 	if (c == NULL)
   1663 		return;
   1664 	for (i = 0; i < c->count; i++)
   1665 		os_free(c->attr[i].data);
   1666 	os_free(c->attr);
   1667 	c->attr = NULL;
   1668 	c->count = 0;
   1669 }
   1670 
   1671 
   1672 int radius_copy_class(struct radius_class_data *dst,
   1673 		      const struct radius_class_data *src)
   1674 {
   1675 	size_t i;
   1676 
   1677 	if (src->attr == NULL)
   1678 		return 0;
   1679 
   1680 	dst->attr = os_calloc(src->count, sizeof(struct radius_attr_data));
   1681 	if (dst->attr == NULL)
   1682 		return -1;
   1683 
   1684 	dst->count = 0;
   1685 
   1686 	for (i = 0; i < src->count; i++) {
   1687 		dst->attr[i].data = os_malloc(src->attr[i].len);
   1688 		if (dst->attr[i].data == NULL)
   1689 			break;
   1690 		dst->count++;
   1691 		os_memcpy(dst->attr[i].data, src->attr[i].data,
   1692 			  src->attr[i].len);
   1693 		dst->attr[i].len = src->attr[i].len;
   1694 	}
   1695 
   1696 	return 0;
   1697 }
   1698 
   1699 
   1700 u8 radius_msg_find_unlisted_attr(struct radius_msg *msg, u8 *attrs)
   1701 {
   1702 	size_t i, j;
   1703 	struct radius_attr_hdr *attr;
   1704 
   1705 	for (i = 0; i < msg->attr_used; i++) {
   1706 		attr = radius_get_attr_hdr(msg, i);
   1707 
   1708 		for (j = 0; attrs[j]; j++) {
   1709 			if (attr->type == attrs[j])
   1710 				break;
   1711 		}
   1712 
   1713 		if (attrs[j] == 0)
   1714 			return attr->type; /* unlisted attr */
   1715 	}
   1716 
   1717 	return 0;
   1718 }
   1719 
   1720 
   1721 int radius_gen_session_id(u8 *id, size_t len)
   1722 {
   1723 	/*
   1724 	 * Acct-Session-Id and Acct-Multi-Session-Id should be globally and
   1725 	 * temporarily unique. A high quality random number is required
   1726 	 * therefore. This could be be improved by switching to a GUID.
   1727 	 */
   1728 	return os_get_random(id, len);
   1729 }
   1730