radius.c revision 8d520ff1dc2da35cdca849e982051b86468016d8
1/*
2 * RADIUS message processing
3 * Copyright (c) 2002-2009, Jouni Malinen <j@w1.fi>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
8 *
9 * Alternatively, this software may be distributed under the terms of BSD
10 * license.
11 *
12 * See README and COPYING for more details.
13 */
14
15#include "utils/includes.h"
16
17#include "utils/common.h"
18#include "utils/wpabuf.h"
19#include "crypto/md5.h"
20#include "crypto/crypto.h"
21#include "radius.h"
22
23
24/**
25 * struct radius_msg - RADIUS message structure for new and parsed messages
26 */
27struct radius_msg {
28	/**
29	 * buf - Allocated buffer for RADIUS message
30	 */
31	struct wpabuf *buf;
32
33	/**
34	 * hdr - Pointer to the RADIUS header in buf
35	 */
36	struct radius_hdr *hdr;
37
38	/**
39	 * attr_pos - Array of indexes to attributes
40	 *
41	 * The values are number of bytes from buf to the beginning of
42	 * struct radius_attr_hdr.
43	 */
44	size_t *attr_pos;
45
46	/**
47	 * attr_size - Total size of the attribute pointer array
48	 */
49	size_t attr_size;
50
51	/**
52	 * attr_used - Total number of attributes in the array
53	 */
54	size_t attr_used;
55};
56
57
58struct radius_hdr * radius_msg_get_hdr(struct radius_msg *msg)
59{
60	return msg->hdr;
61}
62
63
64struct wpabuf * radius_msg_get_buf(struct radius_msg *msg)
65{
66	return msg->buf;
67}
68
69
70static struct radius_attr_hdr *
71radius_get_attr_hdr(struct radius_msg *msg, int idx)
72{
73	return (struct radius_attr_hdr *)
74		(wpabuf_mhead_u8(msg->buf) + msg->attr_pos[idx]);
75}
76
77
78static void radius_msg_set_hdr(struct radius_msg *msg, u8 code, u8 identifier)
79{
80	msg->hdr->code = code;
81	msg->hdr->identifier = identifier;
82}
83
84
85static int radius_msg_initialize(struct radius_msg *msg)
86{
87	msg->attr_pos =
88		os_zalloc(RADIUS_DEFAULT_ATTR_COUNT * sizeof(*msg->attr_pos));
89	if (msg->attr_pos == NULL)
90		return -1;
91
92	msg->attr_size = RADIUS_DEFAULT_ATTR_COUNT;
93	msg->attr_used = 0;
94
95	return 0;
96}
97
98
99/**
100 * radius_msg_new - Create a new RADIUS message
101 * @code: Code for RADIUS header
102 * @identifier: Identifier for RADIUS header
103 * Returns: Context for RADIUS message or %NULL on failure
104 *
105 * The caller is responsible for freeing the returned data with
106 * radius_msg_free().
107 */
108struct radius_msg * radius_msg_new(u8 code, u8 identifier)
109{
110	struct radius_msg *msg;
111
112	msg = os_zalloc(sizeof(*msg));
113	if (msg == NULL)
114		return NULL;
115
116	msg->buf = wpabuf_alloc(RADIUS_DEFAULT_MSG_SIZE);
117	if (msg->buf == NULL || radius_msg_initialize(msg)) {
118		radius_msg_free(msg);
119		return NULL;
120	}
121	msg->hdr = wpabuf_put(msg->buf, sizeof(struct radius_hdr));
122
123	radius_msg_set_hdr(msg, code, identifier);
124
125	return msg;
126}
127
128
129/**
130 * radius_msg_free - Free a RADIUS message
131 * @msg: RADIUS message from radius_msg_new() or radius_msg_parse()
132 */
133void radius_msg_free(struct radius_msg *msg)
134{
135	if (msg == NULL)
136		return;
137
138	wpabuf_free(msg->buf);
139	os_free(msg->attr_pos);
140	os_free(msg);
141}
142
143
144static const char *radius_code_string(u8 code)
145{
146	switch (code) {
147	case RADIUS_CODE_ACCESS_REQUEST: return "Access-Request";
148	case RADIUS_CODE_ACCESS_ACCEPT: return "Access-Accept";
149	case RADIUS_CODE_ACCESS_REJECT: return "Access-Reject";
150	case RADIUS_CODE_ACCOUNTING_REQUEST: return "Accounting-Request";
151	case RADIUS_CODE_ACCOUNTING_RESPONSE: return "Accounting-Response";
152	case RADIUS_CODE_ACCESS_CHALLENGE: return "Access-Challenge";
153	case RADIUS_CODE_STATUS_SERVER: return "Status-Server";
154	case RADIUS_CODE_STATUS_CLIENT: return "Status-Client";
155	case RADIUS_CODE_RESERVED: return "Reserved";
156	default: return "?Unknown?";
157	}
158}
159
160
161struct 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
170static 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_CONNECT_INFO, "Connect-Info", RADIUS_ATTR_TEXT },
222	{ RADIUS_ATTR_EAP_MESSAGE, "EAP-Message", RADIUS_ATTR_UNDIST },
223	{ RADIUS_ATTR_MESSAGE_AUTHENTICATOR, "Message-Authenticator",
224	  RADIUS_ATTR_UNDIST },
225	{ RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID, "Tunnel-Private-Group-Id",
226	  RADIUS_ATTR_HEXDUMP },
227	{ RADIUS_ATTR_ACCT_INTERIM_INTERVAL, "Acct-Interim-Interval",
228	  RADIUS_ATTR_INT32 },
229	{ RADIUS_ATTR_CHARGEABLE_USER_IDENTITY, "Chargable-User-Identity",
230	  RADIUS_ATTR_TEXT },
231	{ RADIUS_ATTR_NAS_IPV6_ADDRESS, "NAS-IPv6-Address", RADIUS_ATTR_IPV6 },
232};
233#define RADIUS_ATTRS (sizeof(radius_attrs) / sizeof(radius_attrs[0]))
234
235
236static struct radius_attr_type *radius_get_attr_type(u8 type)
237{
238	size_t i;
239
240	for (i = 0; i < RADIUS_ATTRS; i++) {
241		if (type == radius_attrs[i].type)
242			return &radius_attrs[i];
243	}
244
245	return NULL;
246}
247
248
249static void print_char(char c)
250{
251	if (c >= 32 && c < 127)
252		printf("%c", c);
253	else
254		printf("<%02x>", c);
255}
256
257
258static void radius_msg_dump_attr(struct radius_attr_hdr *hdr)
259{
260	struct radius_attr_type *attr;
261	int i, len;
262	unsigned char *pos;
263
264	attr = radius_get_attr_type(hdr->type);
265
266	printf("   Attribute %d (%s) length=%d\n",
267	       hdr->type, attr ? attr->name : "?Unknown?", hdr->length);
268
269	if (attr == NULL)
270		return;
271
272	len = hdr->length - sizeof(struct radius_attr_hdr);
273	pos = (unsigned char *) (hdr + 1);
274
275	switch (attr->data_type) {
276	case RADIUS_ATTR_TEXT:
277		printf("      Value: '");
278		for (i = 0; i < len; i++)
279			print_char(pos[i]);
280		printf("'\n");
281		break;
282
283	case RADIUS_ATTR_IP:
284		if (len == 4) {
285			struct in_addr addr;
286			os_memcpy(&addr, pos, 4);
287			printf("      Value: %s\n", inet_ntoa(addr));
288		} else
289			printf("      Invalid IP address length %d\n", len);
290		break;
291
292#ifdef CONFIG_IPV6
293	case RADIUS_ATTR_IPV6:
294		if (len == 16) {
295			char buf[128];
296			const char *atxt;
297			struct in6_addr *addr = (struct in6_addr *) pos;
298			atxt = inet_ntop(AF_INET6, addr, buf, sizeof(buf));
299			printf("      Value: %s\n", atxt ? atxt : "?");
300		} else
301			printf("      Invalid IPv6 address length %d\n", len);
302		break;
303#endif /* CONFIG_IPV6 */
304
305	case RADIUS_ATTR_HEXDUMP:
306	case RADIUS_ATTR_UNDIST:
307		printf("      Value:");
308		for (i = 0; i < len; i++)
309			printf(" %02x", pos[i]);
310		printf("\n");
311		break;
312
313	case RADIUS_ATTR_INT32:
314		if (len == 4)
315			printf("      Value: %u\n", WPA_GET_BE32(pos));
316		else
317			printf("      Invalid INT32 length %d\n", len);
318		break;
319
320	default:
321		break;
322	}
323}
324
325
326void radius_msg_dump(struct radius_msg *msg)
327{
328	size_t i;
329
330	printf("RADIUS message: code=%d (%s) identifier=%d length=%d\n",
331	       msg->hdr->code, radius_code_string(msg->hdr->code),
332	       msg->hdr->identifier, ntohs(msg->hdr->length));
333
334	for (i = 0; i < msg->attr_used; i++) {
335		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
336		radius_msg_dump_attr(attr);
337	}
338}
339
340
341int radius_msg_finish(struct radius_msg *msg, const u8 *secret,
342		      size_t secret_len)
343{
344	if (secret) {
345		u8 auth[MD5_MAC_LEN];
346		struct radius_attr_hdr *attr;
347
348		os_memset(auth, 0, MD5_MAC_LEN);
349		attr = radius_msg_add_attr(msg,
350					   RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
351					   auth, MD5_MAC_LEN);
352		if (attr == NULL) {
353			wpa_printf(MSG_WARNING, "RADIUS: Could not add "
354				   "Message-Authenticator");
355			return -1;
356		}
357		msg->hdr->length = htons(wpabuf_len(msg->buf));
358		hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
359			 wpabuf_len(msg->buf), (u8 *) (attr + 1));
360	} else
361		msg->hdr->length = htons(wpabuf_len(msg->buf));
362
363	if (wpabuf_len(msg->buf) > 0xffff) {
364		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
365			   (unsigned long) wpabuf_len(msg->buf));
366		return -1;
367	}
368	return 0;
369}
370
371
372int radius_msg_finish_srv(struct radius_msg *msg, const u8 *secret,
373			  size_t secret_len, const u8 *req_authenticator)
374{
375	u8 auth[MD5_MAC_LEN];
376	struct radius_attr_hdr *attr;
377	const u8 *addr[4];
378	size_t len[4];
379
380	os_memset(auth, 0, MD5_MAC_LEN);
381	attr = radius_msg_add_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR,
382				   auth, MD5_MAC_LEN);
383	if (attr == NULL) {
384		printf("WARNING: Could not add Message-Authenticator\n");
385		return -1;
386	}
387	msg->hdr->length = htons(wpabuf_len(msg->buf));
388	os_memcpy(msg->hdr->authenticator, req_authenticator,
389		  sizeof(msg->hdr->authenticator));
390	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
391		 wpabuf_len(msg->buf), (u8 *) (attr + 1));
392
393	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
394	addr[0] = (u8 *) msg->hdr;
395	len[0] = 1 + 1 + 2;
396	addr[1] = req_authenticator;
397	len[1] = MD5_MAC_LEN;
398	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
399	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
400	addr[3] = secret;
401	len[3] = secret_len;
402	md5_vector(4, addr, len, msg->hdr->authenticator);
403
404	if (wpabuf_len(msg->buf) > 0xffff) {
405		wpa_printf(MSG_WARNING, "RADIUS: Too long message (%lu)",
406			   (unsigned long) wpabuf_len(msg->buf));
407		return -1;
408	}
409	return 0;
410}
411
412
413void radius_msg_finish_acct(struct radius_msg *msg, const u8 *secret,
414			    size_t secret_len)
415{
416	const u8 *addr[2];
417	size_t len[2];
418
419	msg->hdr->length = htons(wpabuf_len(msg->buf));
420	os_memset(msg->hdr->authenticator, 0, MD5_MAC_LEN);
421	addr[0] = wpabuf_head(msg->buf);
422	len[0] = wpabuf_len(msg->buf);
423	addr[1] = secret;
424	len[1] = secret_len;
425	md5_vector(2, addr, len, msg->hdr->authenticator);
426
427	if (wpabuf_len(msg->buf) > 0xffff) {
428		wpa_printf(MSG_WARNING, "RADIUS: Too long messages (%lu)",
429			   (unsigned long) wpabuf_len(msg->buf));
430	}
431}
432
433
434static int radius_msg_add_attr_to_array(struct radius_msg *msg,
435					struct radius_attr_hdr *attr)
436{
437	if (msg->attr_used >= msg->attr_size) {
438		size_t *nattr_pos;
439		int nlen = msg->attr_size * 2;
440
441		nattr_pos = os_realloc(msg->attr_pos,
442				       nlen * sizeof(*msg->attr_pos));
443		if (nattr_pos == NULL)
444			return -1;
445
446		msg->attr_pos = nattr_pos;
447		msg->attr_size = nlen;
448	}
449
450	msg->attr_pos[msg->attr_used++] =
451		(unsigned char *) attr - wpabuf_head_u8(msg->buf);
452
453	return 0;
454}
455
456
457struct radius_attr_hdr *radius_msg_add_attr(struct radius_msg *msg, u8 type,
458					    const u8 *data, size_t data_len)
459{
460	size_t buf_needed;
461	struct radius_attr_hdr *attr;
462
463	if (data_len > RADIUS_MAX_ATTR_LEN) {
464		printf("radius_msg_add_attr: too long attribute (%lu bytes)\n",
465		       (unsigned long) data_len);
466		return NULL;
467	}
468
469	buf_needed = sizeof(*attr) + data_len;
470
471	if (wpabuf_tailroom(msg->buf) < buf_needed) {
472		/* allocate more space for message buffer */
473		if (wpabuf_resize(&msg->buf, buf_needed) < 0)
474			return NULL;
475		msg->hdr = wpabuf_mhead(msg->buf);
476	}
477
478	attr = wpabuf_put(msg->buf, sizeof(struct radius_attr_hdr));
479	attr->type = type;
480	attr->length = sizeof(*attr) + data_len;
481	wpabuf_put_data(msg->buf, data, data_len);
482
483	if (radius_msg_add_attr_to_array(msg, attr))
484		return NULL;
485
486	return attr;
487}
488
489
490/**
491 * radius_msg_parse - Parse a RADIUS message
492 * @data: RADIUS message to be parsed
493 * @len: Length of data buffer in octets
494 * Returns: Parsed RADIUS message or %NULL on failure
495 *
496 * This parses a RADIUS message and makes a copy of its data. The caller is
497 * responsible for freeing the returned data with radius_msg_free().
498 */
499struct radius_msg * radius_msg_parse(const u8 *data, size_t len)
500{
501	struct radius_msg *msg;
502	struct radius_hdr *hdr;
503	struct radius_attr_hdr *attr;
504	size_t msg_len;
505	unsigned char *pos, *end;
506
507	if (data == NULL || len < sizeof(*hdr))
508		return NULL;
509
510	hdr = (struct radius_hdr *) data;
511
512	msg_len = ntohs(hdr->length);
513	if (msg_len < sizeof(*hdr) || msg_len > len) {
514		wpa_printf(MSG_INFO, "RADIUS: Invalid message length");
515		return NULL;
516	}
517
518	if (msg_len < len) {
519		wpa_printf(MSG_DEBUG, "RADIUS: Ignored %lu extra bytes after "
520			   "RADIUS message", (unsigned long) len - msg_len);
521	}
522
523	msg = os_zalloc(sizeof(*msg));
524	if (msg == NULL)
525		return NULL;
526
527	msg->buf = wpabuf_alloc_copy(data, msg_len);
528	if (msg->buf == NULL || radius_msg_initialize(msg)) {
529		radius_msg_free(msg);
530		return NULL;
531	}
532	msg->hdr = wpabuf_mhead(msg->buf);
533
534	/* parse attributes */
535	pos = wpabuf_mhead_u8(msg->buf) + sizeof(struct radius_hdr);
536	end = wpabuf_mhead_u8(msg->buf) + wpabuf_len(msg->buf);
537	while (pos < end) {
538		if ((size_t) (end - pos) < sizeof(*attr))
539			goto fail;
540
541		attr = (struct radius_attr_hdr *) pos;
542
543		if (pos + attr->length > end || attr->length < sizeof(*attr))
544			goto fail;
545
546		/* TODO: check that attr->length is suitable for attr->type */
547
548		if (radius_msg_add_attr_to_array(msg, attr))
549			goto fail;
550
551		pos += attr->length;
552	}
553
554	return msg;
555
556 fail:
557	radius_msg_free(msg);
558	return NULL;
559}
560
561
562int radius_msg_add_eap(struct radius_msg *msg, const u8 *data, size_t data_len)
563{
564	const u8 *pos = data;
565	size_t left = data_len;
566
567	while (left > 0) {
568		int len;
569		if (left > RADIUS_MAX_ATTR_LEN)
570			len = RADIUS_MAX_ATTR_LEN;
571		else
572			len = left;
573
574		if (!radius_msg_add_attr(msg, RADIUS_ATTR_EAP_MESSAGE,
575					 pos, len))
576			return 0;
577
578		pos += len;
579		left -= len;
580	}
581
582	return 1;
583}
584
585
586u8 *radius_msg_get_eap(struct radius_msg *msg, size_t *eap_len)
587{
588	u8 *eap, *pos;
589	size_t len, i;
590	struct radius_attr_hdr *attr;
591
592	if (msg == NULL)
593		return NULL;
594
595	len = 0;
596	for (i = 0; i < msg->attr_used; i++) {
597		attr = radius_get_attr_hdr(msg, i);
598		if (attr->type == RADIUS_ATTR_EAP_MESSAGE)
599			len += attr->length - sizeof(struct radius_attr_hdr);
600	}
601
602	if (len == 0)
603		return NULL;
604
605	eap = os_malloc(len);
606	if (eap == NULL)
607		return NULL;
608
609	pos = eap;
610	for (i = 0; i < msg->attr_used; i++) {
611		attr = radius_get_attr_hdr(msg, i);
612		if (attr->type == RADIUS_ATTR_EAP_MESSAGE) {
613			int flen = attr->length - sizeof(*attr);
614			os_memcpy(pos, attr + 1, flen);
615			pos += flen;
616		}
617	}
618
619	if (eap_len)
620		*eap_len = len;
621
622	return eap;
623}
624
625
626int radius_msg_verify_msg_auth(struct radius_msg *msg, const u8 *secret,
627			       size_t secret_len, const u8 *req_auth)
628{
629	u8 auth[MD5_MAC_LEN], orig[MD5_MAC_LEN];
630	u8 orig_authenticator[16];
631	struct radius_attr_hdr *attr = NULL, *tmp;
632	size_t i;
633
634	for (i = 0; i < msg->attr_used; i++) {
635		tmp = radius_get_attr_hdr(msg, i);
636		if (tmp->type == RADIUS_ATTR_MESSAGE_AUTHENTICATOR) {
637			if (attr != NULL) {
638				printf("Multiple Message-Authenticator "
639				       "attributes in RADIUS message\n");
640				return 1;
641			}
642			attr = tmp;
643		}
644	}
645
646	if (attr == NULL) {
647		printf("No Message-Authenticator attribute found\n");
648		return 1;
649	}
650
651	os_memcpy(orig, attr + 1, MD5_MAC_LEN);
652	os_memset(attr + 1, 0, MD5_MAC_LEN);
653	if (req_auth) {
654		os_memcpy(orig_authenticator, msg->hdr->authenticator,
655			  sizeof(orig_authenticator));
656		os_memcpy(msg->hdr->authenticator, req_auth,
657			  sizeof(msg->hdr->authenticator));
658	}
659	hmac_md5(secret, secret_len, wpabuf_head(msg->buf),
660		 wpabuf_len(msg->buf), auth);
661	os_memcpy(attr + 1, orig, MD5_MAC_LEN);
662	if (req_auth) {
663		os_memcpy(msg->hdr->authenticator, orig_authenticator,
664			  sizeof(orig_authenticator));
665	}
666
667	if (os_memcmp(orig, auth, MD5_MAC_LEN) != 0) {
668		printf("Invalid Message-Authenticator!\n");
669		return 1;
670	}
671
672	return 0;
673}
674
675
676int radius_msg_verify(struct radius_msg *msg, const u8 *secret,
677		      size_t secret_len, struct radius_msg *sent_msg, int auth)
678{
679	const u8 *addr[4];
680	size_t len[4];
681	u8 hash[MD5_MAC_LEN];
682
683	if (sent_msg == NULL) {
684		printf("No matching Access-Request message found\n");
685		return 1;
686	}
687
688	if (auth &&
689	    radius_msg_verify_msg_auth(msg, secret, secret_len,
690				       sent_msg->hdr->authenticator)) {
691		return 1;
692	}
693
694	/* ResponseAuth = MD5(Code+ID+Length+RequestAuth+Attributes+Secret) */
695	addr[0] = (u8 *) msg->hdr;
696	len[0] = 1 + 1 + 2;
697	addr[1] = sent_msg->hdr->authenticator;
698	len[1] = MD5_MAC_LEN;
699	addr[2] = wpabuf_head_u8(msg->buf) + sizeof(struct radius_hdr);
700	len[2] = wpabuf_len(msg->buf) - sizeof(struct radius_hdr);
701	addr[3] = secret;
702	len[3] = secret_len;
703	md5_vector(4, addr, len, hash);
704	if (os_memcmp(hash, msg->hdr->authenticator, MD5_MAC_LEN) != 0) {
705		printf("Response Authenticator invalid!\n");
706		return 1;
707	}
708
709	return 0;
710}
711
712
713int radius_msg_copy_attr(struct radius_msg *dst, struct radius_msg *src,
714			 u8 type)
715{
716	struct radius_attr_hdr *attr;
717	size_t i;
718	int count = 0;
719
720	for (i = 0; i < src->attr_used; i++) {
721		attr = radius_get_attr_hdr(src, i);
722		if (attr->type == type) {
723			if (!radius_msg_add_attr(dst, type, (u8 *) (attr + 1),
724						 attr->length - sizeof(*attr)))
725				return -1;
726			count++;
727		}
728	}
729
730	return count;
731}
732
733
734/* Create Request Authenticator. The value should be unique over the lifetime
735 * of the shared secret between authenticator and authentication server.
736 * Use one-way MD5 hash calculated from current timestamp and some data given
737 * by the caller. */
738void radius_msg_make_authenticator(struct radius_msg *msg,
739				   const u8 *data, size_t len)
740{
741	struct os_time tv;
742	long int l;
743	const u8 *addr[3];
744	size_t elen[3];
745
746	os_get_time(&tv);
747	l = os_random();
748	addr[0] = (u8 *) &tv;
749	elen[0] = sizeof(tv);
750	addr[1] = data;
751	elen[1] = len;
752	addr[2] = (u8 *) &l;
753	elen[2] = sizeof(l);
754	md5_vector(3, addr, elen, msg->hdr->authenticator);
755}
756
757
758/* Get Vendor-specific RADIUS Attribute from a parsed RADIUS message.
759 * Returns the Attribute payload and sets alen to indicate the length of the
760 * payload if a vendor attribute with subtype is found, otherwise returns NULL.
761 * The returned payload is allocated with os_malloc() and caller must free it
762 * by calling os_free().
763 */
764static u8 *radius_msg_get_vendor_attr(struct radius_msg *msg, u32 vendor,
765				      u8 subtype, size_t *alen)
766{
767	u8 *data, *pos;
768	size_t i, len;
769
770	if (msg == NULL)
771		return NULL;
772
773	for (i = 0; i < msg->attr_used; i++) {
774		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
775		size_t left;
776		u32 vendor_id;
777		struct radius_attr_vendor *vhdr;
778
779		if (attr->type != RADIUS_ATTR_VENDOR_SPECIFIC)
780			continue;
781
782		left = attr->length - sizeof(*attr);
783		if (left < 4)
784			continue;
785
786		pos = (u8 *) (attr + 1);
787
788		os_memcpy(&vendor_id, pos, 4);
789		pos += 4;
790		left -= 4;
791
792		if (ntohl(vendor_id) != vendor)
793			continue;
794
795		while (left >= sizeof(*vhdr)) {
796			vhdr = (struct radius_attr_vendor *) pos;
797			if (vhdr->vendor_length > left ||
798			    vhdr->vendor_length < sizeof(*vhdr)) {
799				left = 0;
800				break;
801			}
802			if (vhdr->vendor_type != subtype) {
803				pos += vhdr->vendor_length;
804				left -= vhdr->vendor_length;
805				continue;
806			}
807
808			len = vhdr->vendor_length - sizeof(*vhdr);
809			data = os_malloc(len);
810			if (data == NULL)
811				return NULL;
812			os_memcpy(data, pos + sizeof(*vhdr), len);
813			if (alen)
814				*alen = len;
815			return data;
816		}
817	}
818
819	return NULL;
820}
821
822
823static u8 * decrypt_ms_key(const u8 *key, size_t len,
824			   const u8 *req_authenticator,
825			   const u8 *secret, size_t secret_len, size_t *reslen)
826{
827	u8 *plain, *ppos, *res;
828	const u8 *pos;
829	size_t left, plen;
830	u8 hash[MD5_MAC_LEN];
831	int i, first = 1;
832	const u8 *addr[3];
833	size_t elen[3];
834
835	/* key: 16-bit salt followed by encrypted key info */
836
837	if (len < 2 + 16)
838		return NULL;
839
840	pos = key + 2;
841	left = len - 2;
842	if (left % 16) {
843		printf("Invalid ms key len %lu\n", (unsigned long) left);
844		return NULL;
845	}
846
847	plen = left;
848	ppos = plain = os_malloc(plen);
849	if (plain == NULL)
850		return NULL;
851	plain[0] = 0;
852
853	while (left > 0) {
854		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
855		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
856
857		addr[0] = secret;
858		elen[0] = secret_len;
859		if (first) {
860			addr[1] = req_authenticator;
861			elen[1] = MD5_MAC_LEN;
862			addr[2] = key;
863			elen[2] = 2; /* Salt */
864		} else {
865			addr[1] = pos - MD5_MAC_LEN;
866			elen[1] = MD5_MAC_LEN;
867		}
868		md5_vector(first ? 3 : 2, addr, elen, hash);
869		first = 0;
870
871		for (i = 0; i < MD5_MAC_LEN; i++)
872			*ppos++ = *pos++ ^ hash[i];
873		left -= MD5_MAC_LEN;
874	}
875
876	if (plain[0] == 0 || plain[0] > plen - 1) {
877		printf("Failed to decrypt MPPE key\n");
878		os_free(plain);
879		return NULL;
880	}
881
882	res = os_malloc(plain[0]);
883	if (res == NULL) {
884		os_free(plain);
885		return NULL;
886	}
887	os_memcpy(res, plain + 1, plain[0]);
888	if (reslen)
889		*reslen = plain[0];
890	os_free(plain);
891	return res;
892}
893
894
895static void encrypt_ms_key(const u8 *key, size_t key_len, u16 salt,
896			   const u8 *req_authenticator,
897			   const u8 *secret, size_t secret_len,
898			   u8 *ebuf, size_t *elen)
899{
900	int i, len, first = 1;
901	u8 hash[MD5_MAC_LEN], saltbuf[2], *pos;
902	const u8 *addr[3];
903	size_t _len[3];
904
905	WPA_PUT_BE16(saltbuf, salt);
906
907	len = 1 + key_len;
908	if (len & 0x0f) {
909		len = (len & 0xf0) + 16;
910	}
911	os_memset(ebuf, 0, len);
912	ebuf[0] = key_len;
913	os_memcpy(ebuf + 1, key, key_len);
914
915	*elen = len;
916
917	pos = ebuf;
918	while (len > 0) {
919		/* b(1) = MD5(Secret + Request-Authenticator + Salt)
920		 * b(i) = MD5(Secret + c(i - 1)) for i > 1 */
921		addr[0] = secret;
922		_len[0] = secret_len;
923		if (first) {
924			addr[1] = req_authenticator;
925			_len[1] = MD5_MAC_LEN;
926			addr[2] = saltbuf;
927			_len[2] = sizeof(saltbuf);
928		} else {
929			addr[1] = pos - MD5_MAC_LEN;
930			_len[1] = MD5_MAC_LEN;
931		}
932		md5_vector(first ? 3 : 2, addr, _len, hash);
933		first = 0;
934
935		for (i = 0; i < MD5_MAC_LEN; i++)
936			*pos++ ^= hash[i];
937
938		len -= MD5_MAC_LEN;
939	}
940}
941
942
943struct radius_ms_mppe_keys *
944radius_msg_get_ms_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
945		       const u8 *secret, size_t secret_len)
946{
947	u8 *key;
948	size_t keylen;
949	struct radius_ms_mppe_keys *keys;
950
951	if (msg == NULL || sent_msg == NULL)
952		return NULL;
953
954	keys = os_zalloc(sizeof(*keys));
955	if (keys == NULL)
956		return NULL;
957
958	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
959					 RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY,
960					 &keylen);
961	if (key) {
962		keys->send = decrypt_ms_key(key, keylen,
963					    sent_msg->hdr->authenticator,
964					    secret, secret_len,
965					    &keys->send_len);
966		os_free(key);
967	}
968
969	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_MICROSOFT,
970					 RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY,
971					 &keylen);
972	if (key) {
973		keys->recv = decrypt_ms_key(key, keylen,
974					    sent_msg->hdr->authenticator,
975					    secret, secret_len,
976					    &keys->recv_len);
977		os_free(key);
978	}
979
980	return keys;
981}
982
983
984struct radius_ms_mppe_keys *
985radius_msg_get_cisco_keys(struct radius_msg *msg, struct radius_msg *sent_msg,
986			  const u8 *secret, size_t secret_len)
987{
988	u8 *key;
989	size_t keylen;
990	struct radius_ms_mppe_keys *keys;
991
992	if (msg == NULL || sent_msg == NULL)
993		return NULL;
994
995	keys = os_zalloc(sizeof(*keys));
996	if (keys == NULL)
997		return NULL;
998
999	key = radius_msg_get_vendor_attr(msg, RADIUS_VENDOR_ID_CISCO,
1000					 RADIUS_CISCO_AV_PAIR, &keylen);
1001	if (key && keylen == 51 &&
1002	    os_memcmp(key, "leap:session-key=", 17) == 0) {
1003		keys->recv = decrypt_ms_key(key + 17, keylen - 17,
1004					    sent_msg->hdr->authenticator,
1005					    secret, secret_len,
1006					    &keys->recv_len);
1007	}
1008	os_free(key);
1009
1010	return keys;
1011}
1012
1013
1014int radius_msg_add_mppe_keys(struct radius_msg *msg,
1015			     const u8 *req_authenticator,
1016			     const u8 *secret, size_t secret_len,
1017			     const u8 *send_key, size_t send_key_len,
1018			     const u8 *recv_key, size_t recv_key_len)
1019{
1020	struct radius_attr_hdr *attr;
1021	u32 vendor_id = htonl(RADIUS_VENDOR_ID_MICROSOFT);
1022	u8 *buf;
1023	struct radius_attr_vendor *vhdr;
1024	u8 *pos;
1025	size_t elen;
1026	int hlen;
1027	u16 salt;
1028
1029	hlen = sizeof(vendor_id) + sizeof(*vhdr) + 2;
1030
1031	/* MS-MPPE-Send-Key */
1032	buf = os_malloc(hlen + send_key_len + 16);
1033	if (buf == NULL) {
1034		return 0;
1035	}
1036	pos = buf;
1037	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
1038	pos += sizeof(vendor_id);
1039	vhdr = (struct radius_attr_vendor *) pos;
1040	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_SEND_KEY;
1041	pos = (u8 *) (vhdr + 1);
1042	salt = os_random() | 0x8000;
1043	WPA_PUT_BE16(pos, salt);
1044	pos += 2;
1045	encrypt_ms_key(send_key, send_key_len, salt, req_authenticator, secret,
1046		       secret_len, pos, &elen);
1047	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
1048
1049	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
1050				   buf, hlen + elen);
1051	os_free(buf);
1052	if (attr == NULL) {
1053		return 0;
1054	}
1055
1056	/* MS-MPPE-Recv-Key */
1057	buf = os_malloc(hlen + send_key_len + 16);
1058	if (buf == NULL) {
1059		return 0;
1060	}
1061	pos = buf;
1062	os_memcpy(pos, &vendor_id, sizeof(vendor_id));
1063	pos += sizeof(vendor_id);
1064	vhdr = (struct radius_attr_vendor *) pos;
1065	vhdr->vendor_type = RADIUS_VENDOR_ATTR_MS_MPPE_RECV_KEY;
1066	pos = (u8 *) (vhdr + 1);
1067	salt ^= 1;
1068	WPA_PUT_BE16(pos, salt);
1069	pos += 2;
1070	encrypt_ms_key(recv_key, recv_key_len, salt, req_authenticator, secret,
1071		       secret_len, pos, &elen);
1072	vhdr->vendor_length = hlen + elen - sizeof(vendor_id);
1073
1074	attr = radius_msg_add_attr(msg, RADIUS_ATTR_VENDOR_SPECIFIC,
1075				   buf, hlen + elen);
1076	os_free(buf);
1077	if (attr == NULL) {
1078		return 0;
1079	}
1080
1081	return 1;
1082}
1083
1084
1085/* Add User-Password attribute to a RADIUS message and encrypt it as specified
1086 * in RFC 2865, Chap. 5.2 */
1087struct radius_attr_hdr *
1088radius_msg_add_attr_user_password(struct radius_msg *msg,
1089				  const u8 *data, size_t data_len,
1090				  const u8 *secret, size_t secret_len)
1091{
1092	u8 buf[128];
1093	int padlen, i;
1094	size_t buf_len, pos;
1095	const u8 *addr[2];
1096	size_t len[2];
1097	u8 hash[16];
1098
1099	if (data_len > 128)
1100		return NULL;
1101
1102	os_memcpy(buf, data, data_len);
1103	buf_len = data_len;
1104
1105	padlen = data_len % 16;
1106	if (padlen) {
1107		padlen = 16 - padlen;
1108		os_memset(buf + data_len, 0, padlen);
1109		buf_len += padlen;
1110	}
1111
1112	addr[0] = secret;
1113	len[0] = secret_len;
1114	addr[1] = msg->hdr->authenticator;
1115	len[1] = 16;
1116	md5_vector(2, addr, len, hash);
1117
1118	for (i = 0; i < 16; i++)
1119		buf[i] ^= hash[i];
1120	pos = 16;
1121
1122	while (pos < buf_len) {
1123		addr[0] = secret;
1124		len[0] = secret_len;
1125		addr[1] = &buf[pos - 16];
1126		len[1] = 16;
1127		md5_vector(2, addr, len, hash);
1128
1129		for (i = 0; i < 16; i++)
1130			buf[pos + i] ^= hash[i];
1131
1132		pos += 16;
1133	}
1134
1135	return radius_msg_add_attr(msg, RADIUS_ATTR_USER_PASSWORD,
1136				   buf, buf_len);
1137}
1138
1139
1140int radius_msg_get_attr(struct radius_msg *msg, u8 type, u8 *buf, size_t len)
1141{
1142	struct radius_attr_hdr *attr = NULL, *tmp;
1143	size_t i, dlen;
1144
1145	for (i = 0; i < msg->attr_used; i++) {
1146		tmp = radius_get_attr_hdr(msg, i);
1147		if (tmp->type == type) {
1148			attr = tmp;
1149			break;
1150		}
1151	}
1152
1153	if (!attr)
1154		return -1;
1155
1156	dlen = attr->length - sizeof(*attr);
1157	if (buf)
1158		os_memcpy(buf, (attr + 1), dlen > len ? len : dlen);
1159	return dlen;
1160}
1161
1162
1163int radius_msg_get_attr_ptr(struct radius_msg *msg, u8 type, u8 **buf,
1164			    size_t *len, const u8 *start)
1165{
1166	size_t i;
1167	struct radius_attr_hdr *attr = NULL, *tmp;
1168
1169	for (i = 0; i < msg->attr_used; i++) {
1170		tmp = radius_get_attr_hdr(msg, i);
1171		if (tmp->type == type &&
1172		    (start == NULL || (u8 *) tmp > start)) {
1173			attr = tmp;
1174			break;
1175		}
1176	}
1177
1178	if (!attr)
1179		return -1;
1180
1181	*buf = (u8 *) (attr + 1);
1182	*len = attr->length - sizeof(*attr);
1183	return 0;
1184}
1185
1186
1187int radius_msg_count_attr(struct radius_msg *msg, u8 type, int min_len)
1188{
1189	size_t i;
1190	int count;
1191
1192	for (count = 0, i = 0; i < msg->attr_used; i++) {
1193		struct radius_attr_hdr *attr = radius_get_attr_hdr(msg, i);
1194		if (attr->type == type &&
1195		    attr->length >= sizeof(struct radius_attr_hdr) + min_len)
1196			count++;
1197	}
1198
1199	return count;
1200}
1201
1202
1203struct radius_tunnel_attrs {
1204	int tag_used;
1205	int type; /* Tunnel-Type */
1206	int medium_type; /* Tunnel-Medium-Type */
1207	int vlanid;
1208};
1209
1210
1211/**
1212 * radius_msg_get_vlanid - Parse RADIUS attributes for VLAN tunnel information
1213 * @msg: RADIUS message
1214 * Returns: VLAN ID for the first tunnel configuration of -1 if none is found
1215 */
1216int radius_msg_get_vlanid(struct radius_msg *msg)
1217{
1218	struct radius_tunnel_attrs tunnel[RADIUS_TUNNEL_TAGS], *tun;
1219	size_t i;
1220	struct radius_attr_hdr *attr = NULL;
1221	const u8 *data;
1222	char buf[10];
1223	size_t dlen;
1224
1225	os_memset(&tunnel, 0, sizeof(tunnel));
1226
1227	for (i = 0; i < msg->attr_used; i++) {
1228		attr = radius_get_attr_hdr(msg, i);
1229		data = (const u8 *) (attr + 1);
1230		dlen = attr->length - sizeof(*attr);
1231		if (attr->length < 3)
1232			continue;
1233		if (data[0] >= RADIUS_TUNNEL_TAGS)
1234			tun = &tunnel[0];
1235		else
1236			tun = &tunnel[data[0]];
1237
1238		switch (attr->type) {
1239		case RADIUS_ATTR_TUNNEL_TYPE:
1240			if (attr->length != 6)
1241				break;
1242			tun->tag_used++;
1243			tun->type = WPA_GET_BE24(data + 1);
1244			break;
1245		case RADIUS_ATTR_TUNNEL_MEDIUM_TYPE:
1246			if (attr->length != 6)
1247				break;
1248			tun->tag_used++;
1249			tun->medium_type = WPA_GET_BE24(data + 1);
1250			break;
1251		case RADIUS_ATTR_TUNNEL_PRIVATE_GROUP_ID:
1252			if (data[0] < RADIUS_TUNNEL_TAGS) {
1253				data++;
1254				dlen--;
1255			}
1256			if (dlen >= sizeof(buf))
1257				break;
1258			os_memcpy(buf, data, dlen);
1259			buf[dlen] = '\0';
1260			tun->tag_used++;
1261			tun->vlanid = atoi(buf);
1262			break;
1263		}
1264	}
1265
1266	for (i = 0; i < RADIUS_TUNNEL_TAGS; i++) {
1267		tun = &tunnel[i];
1268		if (tun->tag_used &&
1269		    tun->type == RADIUS_TUNNEL_TYPE_VLAN &&
1270		    tun->medium_type == RADIUS_TUNNEL_MEDIUM_TYPE_802 &&
1271		    tun->vlanid > 0)
1272			return tun->vlanid;
1273	}
1274
1275	return -1;
1276}
1277
1278
1279void radius_free_class(struct radius_class_data *c)
1280{
1281	size_t i;
1282	if (c == NULL)
1283		return;
1284	for (i = 0; i < c->count; i++)
1285		os_free(c->attr[i].data);
1286	os_free(c->attr);
1287	c->attr = NULL;
1288	c->count = 0;
1289}
1290
1291
1292int radius_copy_class(struct radius_class_data *dst,
1293		      const struct radius_class_data *src)
1294{
1295	size_t i;
1296
1297	if (src->attr == NULL)
1298		return 0;
1299
1300	dst->attr = os_zalloc(src->count * sizeof(struct radius_attr_data));
1301	if (dst->attr == NULL)
1302		return -1;
1303
1304	dst->count = 0;
1305
1306	for (i = 0; i < src->count; i++) {
1307		dst->attr[i].data = os_malloc(src->attr[i].len);
1308		if (dst->attr[i].data == NULL)
1309			break;
1310		dst->count++;
1311		os_memcpy(dst->attr[i].data, src->attr[i].data,
1312			  src->attr[i].len);
1313		dst->attr[i].len = src->attr[i].len;
1314	}
1315
1316	return 0;
1317}
1318