xref: /freebsd/contrib/wpa/wpa_supplicant/eapol_test.c (revision 8df8b2d3e51d1b816201d8a1fe8bc29fe192e562)
1 /*
2  * WPA Supplicant - test code
3  * Copyright (c) 2003-2013, Jouni Malinen <j@w1.fi>
4  *
5  * This software may be distributed under the terms of the BSD license.
6  * See README for more details.
7  *
8  * IEEE 802.1X Supplicant test code (to be used in place of wpa_supplicant.c.
9  * Not used in production version.
10  */
11 
12 #include "includes.h"
13 #include <assert.h>
14 
15 #include "common.h"
16 #include "utils/ext_password.h"
17 #include "common/version.h"
18 #include "config.h"
19 #include "eapol_supp/eapol_supp_sm.h"
20 #include "eap_peer/eap.h"
21 #include "eap_server/eap_methods.h"
22 #include "eloop.h"
23 #include "utils/base64.h"
24 #include "rsn_supp/wpa.h"
25 #include "wpa_supplicant_i.h"
26 #include "radius/radius.h"
27 #include "radius/radius_client.h"
28 #include "common/wpa_ctrl.h"
29 #include "ctrl_iface.h"
30 #include "pcsc_funcs.h"
31 #include "wpas_glue.h"
32 
33 
34 const struct wpa_driver_ops *const wpa_drivers[] = { NULL };
35 
36 
37 struct extra_radius_attr {
38 	u8 type;
39 	char syntax;
40 	char *data;
41 	struct extra_radius_attr *next;
42 };
43 
44 struct eapol_test_data {
45 	struct wpa_supplicant *wpa_s;
46 
47 	int eapol_test_num_reauths;
48 	int no_mppe_keys;
49 	int num_mppe_ok, num_mppe_mismatch;
50 	int req_eap_key_name;
51 
52 	u8 radius_identifier;
53 	struct radius_msg *last_recv_radius;
54 	struct in_addr own_ip_addr;
55 	struct radius_client_data *radius;
56 	struct hostapd_radius_servers *radius_conf;
57 
58 	 /* last received EAP Response from Authentication Server */
59 	struct wpabuf *last_eap_radius;
60 
61 	u8 authenticator_pmk[PMK_LEN];
62 	size_t authenticator_pmk_len;
63 	u8 authenticator_eap_key_name[256];
64 	size_t authenticator_eap_key_name_len;
65 	int radius_access_accept_received;
66 	int radius_access_reject_received;
67 	int auth_timed_out;
68 
69 	u8 *eap_identity;
70 	size_t eap_identity_len;
71 
72 	char *connect_info;
73 	u8 own_addr[ETH_ALEN];
74 	struct extra_radius_attr *extra_attrs;
75 
76 	FILE *server_cert_file;
77 
78 	const char *pcsc_reader;
79 	const char *pcsc_pin;
80 
81 	unsigned int ctrl_iface:1;
82 	unsigned int id_req_sent:1;
83 };
84 
85 static struct eapol_test_data eapol_test;
86 
87 
88 static void send_eap_request_identity(void *eloop_ctx, void *timeout_ctx);
89 
90 
91 static void hostapd_logger_cb(void *ctx, const u8 *addr, unsigned int module,
92 			      int level, const char *txt, size_t len)
93 {
94 	if (addr)
95 		wpa_printf(MSG_DEBUG, "STA " MACSTR ": %s\n",
96 			   MAC2STR(addr), txt);
97 	else
98 		wpa_printf(MSG_DEBUG, "%s", txt);
99 }
100 
101 
102 static int add_extra_attr(struct radius_msg *msg,
103 			  struct extra_radius_attr *attr)
104 {
105 	size_t len;
106 	char *pos;
107 	u32 val;
108 	char buf[RADIUS_MAX_ATTR_LEN + 1];
109 
110 	switch (attr->syntax) {
111 	case 's':
112 		os_snprintf(buf, sizeof(buf), "%s", attr->data);
113 		len = os_strlen(buf);
114 		break;
115 	case 'n':
116 		buf[0] = '\0';
117 		len = 1;
118 		break;
119 	case 'x':
120 		pos = attr->data;
121 		if (pos[0] == '0' && pos[1] == 'x')
122 			pos += 2;
123 		len = os_strlen(pos);
124 		if ((len & 1) || (len / 2) > RADIUS_MAX_ATTR_LEN) {
125 			printf("Invalid extra attribute hexstring\n");
126 			return -1;
127 		}
128 		len /= 2;
129 		if (hexstr2bin(pos, (u8 *) buf, len) < 0) {
130 			printf("Invalid extra attribute hexstring\n");
131 			return -1;
132 		}
133 		break;
134 	case 'd':
135 		val = htonl(atoi(attr->data));
136 		os_memcpy(buf, &val, 4);
137 		len = 4;
138 		break;
139 	default:
140 		printf("Incorrect extra attribute syntax specification\n");
141 		return -1;
142 	}
143 
144 	if (!radius_msg_add_attr(msg, attr->type, (u8 *) buf, len)) {
145 		printf("Could not add attribute %d\n", attr->type);
146 		return -1;
147 	}
148 
149 	return 0;
150 }
151 
152 
153 static int add_extra_attrs(struct radius_msg *msg,
154 			   struct extra_radius_attr *attrs)
155 {
156 	struct extra_radius_attr *p;
157 	for (p = attrs; p; p = p->next) {
158 		if (add_extra_attr(msg, p) < 0)
159 			return -1;
160 	}
161 	return 0;
162 }
163 
164 
165 static struct extra_radius_attr *
166 find_extra_attr(struct extra_radius_attr *attrs, u8 type)
167 {
168 	struct extra_radius_attr *p;
169 	for (p = attrs; p; p = p->next) {
170 		if (p->type == type)
171 			return p;
172 	}
173 	return NULL;
174 }
175 
176 
177 static void ieee802_1x_encapsulate_radius(struct eapol_test_data *e,
178 					  const u8 *eap, size_t len)
179 {
180 	struct radius_msg *msg;
181 	char buf[RADIUS_MAX_ATTR_LEN + 1];
182 	const struct eap_hdr *hdr;
183 	const u8 *pos;
184 
185 	wpa_printf(MSG_DEBUG, "Encapsulating EAP message into a RADIUS "
186 		   "packet");
187 
188 	e->radius_identifier = radius_client_get_id(e->radius);
189 	msg = radius_msg_new(RADIUS_CODE_ACCESS_REQUEST,
190 			     e->radius_identifier);
191 	if (msg == NULL) {
192 		printf("Could not create net RADIUS packet\n");
193 		return;
194 	}
195 
196 	radius_msg_make_authenticator(msg);
197 
198 	hdr = (const struct eap_hdr *) eap;
199 	pos = (const u8 *) (hdr + 1);
200 	if (len > sizeof(*hdr) && hdr->code == EAP_CODE_RESPONSE &&
201 	    pos[0] == EAP_TYPE_IDENTITY) {
202 		pos++;
203 		os_free(e->eap_identity);
204 		e->eap_identity_len = len - sizeof(*hdr) - 1;
205 		e->eap_identity = os_malloc(e->eap_identity_len);
206 		if (e->eap_identity) {
207 			os_memcpy(e->eap_identity, pos, e->eap_identity_len);
208 			wpa_hexdump(MSG_DEBUG, "Learned identity from "
209 				    "EAP-Response-Identity",
210 				    e->eap_identity, e->eap_identity_len);
211 		}
212 	}
213 
214 	if (e->eap_identity &&
215 	    !radius_msg_add_attr(msg, RADIUS_ATTR_USER_NAME,
216 				 e->eap_identity, e->eap_identity_len)) {
217 		printf("Could not add User-Name\n");
218 		goto fail;
219 	}
220 
221 	if (e->req_eap_key_name &&
222 	    !radius_msg_add_attr(msg, RADIUS_ATTR_EAP_KEY_NAME, (u8 *) "\0",
223 				 1)) {
224 		printf("Could not add EAP-Key-Name\n");
225 		goto fail;
226 	}
227 
228 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_NAS_IP_ADDRESS) &&
229 	    !radius_msg_add_attr(msg, RADIUS_ATTR_NAS_IP_ADDRESS,
230 				 (u8 *) &e->own_ip_addr, 4)) {
231 		printf("Could not add NAS-IP-Address\n");
232 		goto fail;
233 	}
234 
235 	os_snprintf(buf, sizeof(buf), RADIUS_802_1X_ADDR_FORMAT,
236 		    MAC2STR(e->wpa_s->own_addr));
237 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_CALLING_STATION_ID)
238 	    &&
239 	    !radius_msg_add_attr(msg, RADIUS_ATTR_CALLING_STATION_ID,
240 				 (u8 *) buf, os_strlen(buf))) {
241 		printf("Could not add Calling-Station-Id\n");
242 		goto fail;
243 	}
244 
245 	/* TODO: should probably check MTU from driver config; 2304 is max for
246 	 * IEEE 802.11, but use 1400 to avoid problems with too large packets
247 	 */
248 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_FRAMED_MTU) &&
249 	    !radius_msg_add_attr_int32(msg, RADIUS_ATTR_FRAMED_MTU, 1400)) {
250 		printf("Could not add Framed-MTU\n");
251 		goto fail;
252 	}
253 
254 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_NAS_PORT_TYPE) &&
255 	    !radius_msg_add_attr_int32(msg, RADIUS_ATTR_NAS_PORT_TYPE,
256 				       RADIUS_NAS_PORT_TYPE_IEEE_802_11)) {
257 		printf("Could not add NAS-Port-Type\n");
258 		goto fail;
259 	}
260 
261 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_SERVICE_TYPE) &&
262 	    !radius_msg_add_attr_int32(msg, RADIUS_ATTR_SERVICE_TYPE,
263 				       RADIUS_SERVICE_TYPE_FRAMED)) {
264 		printf("Could not add Service-Type\n");
265 		goto fail;
266 	}
267 
268 	os_snprintf(buf, sizeof(buf), "%s", e->connect_info);
269 	if (!find_extra_attr(e->extra_attrs, RADIUS_ATTR_CONNECT_INFO) &&
270 	    !radius_msg_add_attr(msg, RADIUS_ATTR_CONNECT_INFO,
271 				 (u8 *) buf, os_strlen(buf))) {
272 		printf("Could not add Connect-Info\n");
273 		goto fail;
274 	}
275 
276 	if (add_extra_attrs(msg, e->extra_attrs) < 0)
277 		goto fail;
278 
279 	if (eap && !radius_msg_add_eap(msg, eap, len)) {
280 		printf("Could not add EAP-Message\n");
281 		goto fail;
282 	}
283 
284 	/* State attribute must be copied if and only if this packet is
285 	 * Access-Request reply to the previous Access-Challenge */
286 	if (e->last_recv_radius &&
287 	    radius_msg_get_hdr(e->last_recv_radius)->code ==
288 	    RADIUS_CODE_ACCESS_CHALLENGE) {
289 		int res = radius_msg_copy_attr(msg, e->last_recv_radius,
290 					       RADIUS_ATTR_STATE);
291 		if (res < 0) {
292 			printf("Could not copy State attribute from previous "
293 			       "Access-Challenge\n");
294 			goto fail;
295 		}
296 		if (res > 0) {
297 			wpa_printf(MSG_DEBUG, "  Copied RADIUS State "
298 				   "Attribute");
299 		}
300 	}
301 
302 	if (radius_client_send(e->radius, msg, RADIUS_AUTH, e->wpa_s->own_addr)
303 	    < 0)
304 		goto fail;
305 	return;
306 
307  fail:
308 	radius_msg_free(msg);
309 }
310 
311 
312 static int eapol_test_eapol_send(void *ctx, int type, const u8 *buf,
313 				 size_t len)
314 {
315 	printf("WPA: eapol_test_eapol_send(type=%d len=%lu)\n",
316 	       type, (unsigned long) len);
317 	if (type == IEEE802_1X_TYPE_EAP_PACKET) {
318 		wpa_hexdump(MSG_DEBUG, "TX EAP -> RADIUS", buf, len);
319 		ieee802_1x_encapsulate_radius(&eapol_test, buf, len);
320 	}
321 	return 0;
322 }
323 
324 
325 static void eapol_test_set_config_blob(void *ctx,
326 				       struct wpa_config_blob *blob)
327 {
328 	struct eapol_test_data *e = ctx;
329 	wpa_config_set_blob(e->wpa_s->conf, blob);
330 }
331 
332 
333 static const struct wpa_config_blob *
334 eapol_test_get_config_blob(void *ctx, const char *name)
335 {
336 	struct eapol_test_data *e = ctx;
337 	return wpa_config_get_blob(e->wpa_s->conf, name);
338 }
339 
340 
341 static void eapol_test_eapol_done_cb(void *ctx)
342 {
343 	struct eapol_test_data *e = ctx;
344 
345 	printf("WPA: EAPOL processing complete\n");
346 	wpa_supplicant_cancel_auth_timeout(e->wpa_s);
347 	wpa_supplicant_set_state(e->wpa_s, WPA_COMPLETED);
348 }
349 
350 
351 static void eapol_sm_reauth(void *eloop_ctx, void *timeout_ctx)
352 {
353 	struct eapol_test_data *e = eloop_ctx;
354 	printf("\n\n\n\n\neapol_test: Triggering EAP reauthentication\n\n");
355 	e->radius_access_accept_received = 0;
356 	send_eap_request_identity(e->wpa_s, NULL);
357 }
358 
359 
360 static int eapol_test_compare_pmk(struct eapol_test_data *e)
361 {
362 	u8 pmk[PMK_LEN];
363 	int ret = 1;
364 	const u8 *sess_id;
365 	size_t sess_id_len;
366 
367 	if (eapol_sm_get_key(e->wpa_s->eapol, pmk, PMK_LEN) == 0) {
368 		wpa_hexdump(MSG_DEBUG, "PMK from EAPOL", pmk, PMK_LEN);
369 		if (os_memcmp(pmk, e->authenticator_pmk, PMK_LEN) != 0) {
370 			printf("WARNING: PMK mismatch\n");
371 			wpa_hexdump(MSG_DEBUG, "PMK from AS",
372 				    e->authenticator_pmk, PMK_LEN);
373 		} else if (e->radius_access_accept_received)
374 			ret = 0;
375 	} else if (e->authenticator_pmk_len == 16 &&
376 		   eapol_sm_get_key(e->wpa_s->eapol, pmk, 16) == 0) {
377 		wpa_hexdump(MSG_DEBUG, "LEAP PMK from EAPOL", pmk, 16);
378 		if (os_memcmp(pmk, e->authenticator_pmk, 16) != 0) {
379 			printf("WARNING: PMK mismatch\n");
380 			wpa_hexdump(MSG_DEBUG, "PMK from AS",
381 				    e->authenticator_pmk, 16);
382 		} else if (e->radius_access_accept_received)
383 			ret = 0;
384 	} else if (e->radius_access_accept_received && e->no_mppe_keys) {
385 		/* No keying material expected */
386 		ret = 0;
387 	}
388 
389 	if (ret && !e->no_mppe_keys)
390 		e->num_mppe_mismatch++;
391 	else if (!e->no_mppe_keys)
392 		e->num_mppe_ok++;
393 
394 	sess_id = eapol_sm_get_session_id(e->wpa_s->eapol, &sess_id_len);
395 	if (!sess_id)
396 		return ret;
397 	if (e->authenticator_eap_key_name_len == 0) {
398 		wpa_printf(MSG_INFO, "No EAP-Key-Name received from server");
399 		return ret;
400 	}
401 
402 	if (e->authenticator_eap_key_name_len != sess_id_len ||
403 	    os_memcmp(e->authenticator_eap_key_name, sess_id, sess_id_len) != 0)
404 	{
405 		wpa_printf(MSG_INFO,
406 			   "Locally derived EAP Session-Id does not match EAP-Key-Name from server");
407 		wpa_hexdump(MSG_DEBUG, "EAP Session-Id", sess_id, sess_id_len);
408 		wpa_hexdump(MSG_DEBUG, "EAP-Key-Name from server",
409 			    e->authenticator_eap_key_name,
410 			    e->authenticator_eap_key_name_len);
411 	} else {
412 		wpa_printf(MSG_INFO,
413 			   "Locally derived EAP Session-Id matches EAP-Key-Name from server");
414 	}
415 
416 	return ret;
417 }
418 
419 
420 static void eapol_sm_cb(struct eapol_sm *eapol, enum eapol_supp_result result,
421 			void *ctx)
422 {
423 	struct eapol_test_data *e = ctx;
424 	printf("eapol_sm_cb: result=%d\n", result);
425 	e->id_req_sent = 0;
426 	if (e->ctrl_iface)
427 		return;
428 	e->eapol_test_num_reauths--;
429 	if (e->eapol_test_num_reauths < 0)
430 		eloop_terminate();
431 	else {
432 		eapol_test_compare_pmk(e);
433 		eloop_register_timeout(0, 100000, eapol_sm_reauth, e, NULL);
434 	}
435 }
436 
437 
438 static void eapol_test_write_cert(FILE *f, const char *subject,
439 				  const struct wpabuf *cert)
440 {
441 	unsigned char *encoded;
442 
443 	encoded = base64_encode(wpabuf_head(cert), wpabuf_len(cert), NULL);
444 	if (encoded == NULL)
445 		return;
446 	fprintf(f, "%s\n-----BEGIN CERTIFICATE-----\n%s"
447 		"-----END CERTIFICATE-----\n\n", subject, encoded);
448 	os_free(encoded);
449 }
450 
451 
452 #if defined(CONFIG_CTRL_IFACE) || !defined(CONFIG_NO_STDOUT_DEBUG)
453 static void eapol_test_eap_param_needed(void *ctx, enum wpa_ctrl_req_type field,
454 					const char *default_txt)
455 {
456 	struct eapol_test_data *e = ctx;
457 	struct wpa_supplicant *wpa_s = e->wpa_s;
458 	struct wpa_ssid *ssid = wpa_s->current_ssid;
459 	const char *field_name, *txt = NULL;
460 	char *buf;
461 	size_t buflen;
462 	int len;
463 
464 	if (ssid == NULL)
465 		return;
466 
467 	field_name = wpa_supplicant_ctrl_req_to_string(field, default_txt,
468 						       &txt);
469 	if (field_name == NULL) {
470 		wpa_printf(MSG_WARNING, "Unhandled EAP param %d needed",
471 			   field);
472 		return;
473 	}
474 
475 	buflen = 100 + os_strlen(txt) + ssid->ssid_len;
476 	buf = os_malloc(buflen);
477 	if (buf == NULL)
478 		return;
479 	len = os_snprintf(buf, buflen,
480 			  WPA_CTRL_REQ "%s-%d:%s needed for SSID ",
481 			  field_name, ssid->id, txt);
482 	if (os_snprintf_error(buflen, len)) {
483 		os_free(buf);
484 		return;
485 	}
486 	if (ssid->ssid && buflen > len + ssid->ssid_len) {
487 		os_memcpy(buf + len, ssid->ssid, ssid->ssid_len);
488 		len += ssid->ssid_len;
489 		buf[len] = '\0';
490 	}
491 	buf[buflen - 1] = '\0';
492 	wpa_msg(wpa_s, MSG_INFO, "%s", buf);
493 	os_free(buf);
494 }
495 #else /* CONFIG_CTRL_IFACE || !CONFIG_NO_STDOUT_DEBUG */
496 #define eapol_test_eap_param_needed NULL
497 #endif /* CONFIG_CTRL_IFACE || !CONFIG_NO_STDOUT_DEBUG */
498 
499 
500 static void eapol_test_cert_cb(void *ctx, int depth, const char *subject,
501 			       const char *altsubject[], int num_altsubject,
502 			       const char *cert_hash,
503 			       const struct wpabuf *cert)
504 {
505 	struct eapol_test_data *e = ctx;
506 
507 	wpa_msg(e->wpa_s, MSG_INFO, WPA_EVENT_EAP_PEER_CERT
508 		"depth=%d subject='%s'%s%s",
509 		depth, subject,
510 		cert_hash ? " hash=" : "",
511 		cert_hash ? cert_hash : "");
512 
513 	if (cert) {
514 		char *cert_hex;
515 		size_t len = wpabuf_len(cert) * 2 + 1;
516 		cert_hex = os_malloc(len);
517 		if (cert_hex) {
518 			wpa_snprintf_hex(cert_hex, len, wpabuf_head(cert),
519 					 wpabuf_len(cert));
520 			wpa_msg_ctrl(e->wpa_s, MSG_INFO,
521 				     WPA_EVENT_EAP_PEER_CERT
522 				     "depth=%d subject='%s' cert=%s",
523 				     depth, subject, cert_hex);
524 			os_free(cert_hex);
525 		}
526 
527 		if (e->server_cert_file)
528 			eapol_test_write_cert(e->server_cert_file,
529 					      subject, cert);
530 	}
531 
532 	if (altsubject) {
533 		int i;
534 
535 		for (i = 0; i < num_altsubject; i++)
536 			wpa_msg(e->wpa_s, MSG_INFO, WPA_EVENT_EAP_PEER_ALT
537 				"depth=%d %s", depth, altsubject[i]);
538 	}
539 }
540 
541 
542 static void eapol_test_set_anon_id(void *ctx, const u8 *id, size_t len)
543 {
544 	struct eapol_test_data *e = ctx;
545 	struct wpa_supplicant *wpa_s = e->wpa_s;
546 	char *str;
547 	int res;
548 
549 	wpa_hexdump_ascii(MSG_DEBUG, "EAP method updated anonymous_identity",
550 			  id, len);
551 
552 	if (wpa_s->current_ssid == NULL)
553 		return;
554 
555 	if (id == NULL) {
556 		if (wpa_config_set(wpa_s->current_ssid, "anonymous_identity",
557 				   "NULL", 0) < 0)
558 			return;
559 	} else {
560 		str = os_malloc(len * 2 + 1);
561 		if (str == NULL)
562 			return;
563 		wpa_snprintf_hex(str, len * 2 + 1, id, len);
564 		res = wpa_config_set(wpa_s->current_ssid, "anonymous_identity",
565 				     str, 0);
566 		os_free(str);
567 		if (res < 0)
568 			return;
569 	}
570 }
571 
572 
573 static enum wpa_states eapol_test_get_state(void *ctx)
574 {
575 	struct eapol_test_data *e = ctx;
576 	struct wpa_supplicant *wpa_s = e->wpa_s;
577 
578 	return wpa_s->wpa_state;
579 }
580 
581 
582 static int test_eapol(struct eapol_test_data *e, struct wpa_supplicant *wpa_s,
583 		      struct wpa_ssid *ssid)
584 {
585 	struct eapol_config eapol_conf;
586 	struct eapol_ctx *ctx;
587 	struct wpa_sm_ctx *wctx;
588 
589 	ctx = os_zalloc(sizeof(*ctx));
590 	if (ctx == NULL) {
591 		printf("Failed to allocate EAPOL context.\n");
592 		return -1;
593 	}
594 	ctx->ctx = e;
595 	ctx->msg_ctx = wpa_s;
596 	ctx->scard_ctx = wpa_s->scard;
597 	ctx->cb = eapol_sm_cb;
598 	ctx->cb_ctx = e;
599 	ctx->eapol_send_ctx = wpa_s;
600 	ctx->preauth = 0;
601 	ctx->eapol_done_cb = eapol_test_eapol_done_cb;
602 	ctx->eapol_send = eapol_test_eapol_send;
603 	ctx->set_config_blob = eapol_test_set_config_blob;
604 	ctx->get_config_blob = eapol_test_get_config_blob;
605 	ctx->opensc_engine_path = wpa_s->conf->opensc_engine_path;
606 	ctx->pkcs11_engine_path = wpa_s->conf->pkcs11_engine_path;
607 	ctx->pkcs11_module_path = wpa_s->conf->pkcs11_module_path;
608 	ctx->openssl_ciphers = wpa_s->conf->openssl_ciphers;
609 	ctx->eap_param_needed = eapol_test_eap_param_needed;
610 	ctx->cert_cb = eapol_test_cert_cb;
611 	ctx->cert_in_cb = 1;
612 	ctx->set_anon_id = eapol_test_set_anon_id;
613 
614 	wpa_s->eapol = eapol_sm_init(ctx);
615 	if (wpa_s->eapol == NULL) {
616 		os_free(ctx);
617 		printf("Failed to initialize EAPOL state machines.\n");
618 		return -1;
619 	}
620 
621 	wpa_s->key_mgmt = WPA_KEY_MGMT_IEEE8021X_NO_WPA;
622 	wctx = os_zalloc(sizeof(*wctx));
623 	if (wctx == NULL) {
624 		os_free(ctx);
625 		return -1;
626 	}
627 	wctx->ctx = e;
628 	wctx->msg_ctx = wpa_s;
629 	wctx->get_state = eapol_test_get_state;
630 	wpa_s->wpa = wpa_sm_init(wctx);
631 	if (!wpa_s->wpa) {
632 		os_free(ctx);
633 		os_free(wctx);
634 		return -1;
635 	}
636 
637 	if (!ssid)
638 		return 0;
639 
640 	wpa_s->current_ssid = ssid;
641 	os_memset(&eapol_conf, 0, sizeof(eapol_conf));
642 	eapol_conf.accept_802_1x_keys = 1;
643 	eapol_conf.required_keys = 0;
644 	eapol_conf.fast_reauth = wpa_s->conf->fast_reauth;
645 	eapol_conf.workaround = ssid->eap_workaround;
646 	eapol_conf.external_sim = wpa_s->conf->external_sim;
647 	eapol_sm_notify_config(wpa_s->eapol, &ssid->eap, &eapol_conf);
648 	eapol_sm_register_scard_ctx(wpa_s->eapol, wpa_s->scard);
649 
650 
651 	eapol_sm_notify_portValid(wpa_s->eapol, FALSE);
652 	/* 802.1X::portControl = Auto */
653 	eapol_sm_notify_portEnabled(wpa_s->eapol, TRUE);
654 
655 	return 0;
656 }
657 
658 
659 static void test_eapol_clean(struct eapol_test_data *e,
660 			     struct wpa_supplicant *wpa_s)
661 {
662 	struct extra_radius_attr *p, *prev;
663 
664 	wpa_sm_deinit(wpa_s->wpa);
665 	wpa_s->wpa = NULL;
666 	radius_client_deinit(e->radius);
667 	wpabuf_free(e->last_eap_radius);
668 	radius_msg_free(e->last_recv_radius);
669 	e->last_recv_radius = NULL;
670 	os_free(e->eap_identity);
671 	e->eap_identity = NULL;
672 	eapol_sm_deinit(wpa_s->eapol);
673 	wpa_s->eapol = NULL;
674 	if (e->radius_conf && e->radius_conf->auth_server) {
675 		os_free(e->radius_conf->auth_server->shared_secret);
676 		os_free(e->radius_conf->auth_server);
677 	}
678 	os_free(e->radius_conf);
679 	e->radius_conf = NULL;
680 	scard_deinit(wpa_s->scard);
681 	if (wpa_s->ctrl_iface) {
682 		wpa_supplicant_ctrl_iface_deinit(wpa_s->ctrl_iface);
683 		wpa_s->ctrl_iface = NULL;
684 	}
685 
686 	ext_password_deinit(wpa_s->ext_pw);
687 	wpa_s->ext_pw = NULL;
688 
689 	wpa_config_free(wpa_s->conf);
690 
691 	p = e->extra_attrs;
692 	while (p) {
693 		prev = p;
694 		p = p->next;
695 		os_free(prev);
696 	}
697 }
698 
699 
700 static void send_eap_request_identity(void *eloop_ctx, void *timeout_ctx)
701 {
702 	struct wpa_supplicant *wpa_s = eloop_ctx;
703 	u8 buf[100], *pos;
704 	struct ieee802_1x_hdr *hdr;
705 	struct eap_hdr *eap;
706 
707 	hdr = (struct ieee802_1x_hdr *) buf;
708 	hdr->version = EAPOL_VERSION;
709 	hdr->type = IEEE802_1X_TYPE_EAP_PACKET;
710 	hdr->length = htons(5);
711 
712 	eap = (struct eap_hdr *) (hdr + 1);
713 	eap->code = EAP_CODE_REQUEST;
714 	eap->identifier = 0;
715 	eap->length = htons(5);
716 	pos = (u8 *) (eap + 1);
717 	*pos = EAP_TYPE_IDENTITY;
718 
719 	printf("Sending fake EAP-Request-Identity\n");
720 	eapol_sm_rx_eapol(wpa_s->eapol, wpa_s->bssid, buf,
721 			  sizeof(*hdr) + 5);
722 }
723 
724 
725 static void eapol_test_timeout(void *eloop_ctx, void *timeout_ctx)
726 {
727 	struct eapol_test_data *e = eloop_ctx;
728 	printf("EAPOL test timed out\n");
729 	e->auth_timed_out = 1;
730 	eloop_terminate();
731 }
732 
733 
734 static char *eap_type_text(u8 type)
735 {
736 	switch (type) {
737 	case EAP_TYPE_IDENTITY: return "Identity";
738 	case EAP_TYPE_NOTIFICATION: return "Notification";
739 	case EAP_TYPE_NAK: return "Nak";
740 	case EAP_TYPE_TLS: return "TLS";
741 	case EAP_TYPE_TTLS: return "TTLS";
742 	case EAP_TYPE_PEAP: return "PEAP";
743 	case EAP_TYPE_SIM: return "SIM";
744 	case EAP_TYPE_GTC: return "GTC";
745 	case EAP_TYPE_MD5: return "MD5";
746 	case EAP_TYPE_OTP: return "OTP";
747 	case EAP_TYPE_FAST: return "FAST";
748 	case EAP_TYPE_SAKE: return "SAKE";
749 	case EAP_TYPE_PSK: return "PSK";
750 	default: return "Unknown";
751 	}
752 }
753 
754 
755 static void ieee802_1x_decapsulate_radius(struct eapol_test_data *e)
756 {
757 	struct wpabuf *eap;
758 	const struct eap_hdr *hdr;
759 	int eap_type = -1;
760 	char buf[64];
761 	struct radius_msg *msg;
762 
763 	if (e->last_recv_radius == NULL)
764 		return;
765 
766 	msg = e->last_recv_radius;
767 
768 	eap = radius_msg_get_eap(msg);
769 	if (eap == NULL) {
770 		/* draft-aboba-radius-rfc2869bis-20.txt, Chap. 2.6.3:
771 		 * RADIUS server SHOULD NOT send Access-Reject/no EAP-Message
772 		 * attribute */
773 		wpa_printf(MSG_DEBUG, "could not extract "
774 			       "EAP-Message from RADIUS message");
775 		wpabuf_free(e->last_eap_radius);
776 		e->last_eap_radius = NULL;
777 		return;
778 	}
779 
780 	if (wpabuf_len(eap) < sizeof(*hdr)) {
781 		wpa_printf(MSG_DEBUG, "too short EAP packet "
782 			       "received from authentication server");
783 		wpabuf_free(eap);
784 		return;
785 	}
786 
787 	if (wpabuf_len(eap) > sizeof(*hdr))
788 		eap_type = (wpabuf_head_u8(eap))[sizeof(*hdr)];
789 
790 	hdr = wpabuf_head(eap);
791 	switch (hdr->code) {
792 	case EAP_CODE_REQUEST:
793 		os_snprintf(buf, sizeof(buf), "EAP-Request-%s (%d)",
794 			    eap_type >= 0 ? eap_type_text(eap_type) : "??",
795 			    eap_type);
796 		break;
797 	case EAP_CODE_RESPONSE:
798 		os_snprintf(buf, sizeof(buf), "EAP Response-%s (%d)",
799 			    eap_type >= 0 ? eap_type_text(eap_type) : "??",
800 			    eap_type);
801 		break;
802 	case EAP_CODE_SUCCESS:
803 		os_strlcpy(buf, "EAP Success", sizeof(buf));
804 		/* LEAP uses EAP Success within an authentication, so must not
805 		 * stop here with eloop_terminate(); */
806 		break;
807 	case EAP_CODE_FAILURE:
808 		os_strlcpy(buf, "EAP Failure", sizeof(buf));
809 		if (e->ctrl_iface)
810 			break;
811 		eloop_terminate();
812 		break;
813 	default:
814 		os_strlcpy(buf, "unknown EAP code", sizeof(buf));
815 		wpa_hexdump_buf(MSG_DEBUG, "Decapsulated EAP packet", eap);
816 		break;
817 	}
818 	wpa_printf(MSG_DEBUG, "decapsulated EAP packet (code=%d "
819 		       "id=%d len=%d) from RADIUS server: %s",
820 		      hdr->code, hdr->identifier, ntohs(hdr->length), buf);
821 
822 	/* sta->eapol_sm->be_auth.idFromServer = hdr->identifier; */
823 
824 	wpabuf_free(e->last_eap_radius);
825 	e->last_eap_radius = eap;
826 
827 	{
828 		struct ieee802_1x_hdr *dot1x;
829 		dot1x = os_malloc(sizeof(*dot1x) + wpabuf_len(eap));
830 		assert(dot1x != NULL);
831 		dot1x->version = EAPOL_VERSION;
832 		dot1x->type = IEEE802_1X_TYPE_EAP_PACKET;
833 		dot1x->length = htons(wpabuf_len(eap));
834 		os_memcpy((u8 *) (dot1x + 1), wpabuf_head(eap),
835 			  wpabuf_len(eap));
836 		eapol_sm_rx_eapol(e->wpa_s->eapol, e->wpa_s->bssid,
837 				  (u8 *) dot1x,
838 				  sizeof(*dot1x) + wpabuf_len(eap));
839 		os_free(dot1x);
840 	}
841 }
842 
843 
844 static void ieee802_1x_get_keys(struct eapol_test_data *e,
845 				struct radius_msg *msg, struct radius_msg *req,
846 				const u8 *shared_secret,
847 				size_t shared_secret_len)
848 {
849 	struct radius_ms_mppe_keys *keys;
850 	u8 *buf;
851 	size_t len;
852 
853 	keys = radius_msg_get_ms_keys(msg, req, shared_secret,
854 				      shared_secret_len);
855 	if (keys && keys->send == NULL && keys->recv == NULL) {
856 		os_free(keys);
857 		keys = radius_msg_get_cisco_keys(msg, req, shared_secret,
858 						 shared_secret_len);
859 	}
860 
861 	if (keys) {
862 		if (keys->send) {
863 			wpa_hexdump(MSG_DEBUG, "MS-MPPE-Send-Key (sign)",
864 				    keys->send, keys->send_len);
865 		}
866 		if (keys->recv) {
867 			wpa_hexdump(MSG_DEBUG, "MS-MPPE-Recv-Key (crypt)",
868 				    keys->recv, keys->recv_len);
869 			e->authenticator_pmk_len =
870 				keys->recv_len > PMK_LEN ? PMK_LEN :
871 				keys->recv_len;
872 			os_memcpy(e->authenticator_pmk, keys->recv,
873 				  e->authenticator_pmk_len);
874 			if (e->authenticator_pmk_len == 16 && keys->send &&
875 			    keys->send_len == 16) {
876 				/* MS-CHAP-v2 derives 16 octet keys */
877 				wpa_printf(MSG_DEBUG, "Use MS-MPPE-Send-Key "
878 					   "to extend PMK to 32 octets");
879 				os_memcpy(e->authenticator_pmk +
880 					  e->authenticator_pmk_len,
881 					  keys->send, keys->send_len);
882 				e->authenticator_pmk_len += keys->send_len;
883 			}
884 		}
885 
886 		os_free(keys->send);
887 		os_free(keys->recv);
888 		os_free(keys);
889 	}
890 
891 	if (radius_msg_get_attr_ptr(msg, RADIUS_ATTR_EAP_KEY_NAME, &buf, &len,
892 				    NULL) == 0) {
893 		os_memcpy(e->authenticator_eap_key_name, buf, len);
894 		e->authenticator_eap_key_name_len = len;
895 	} else {
896 		e->authenticator_eap_key_name_len = 0;
897 	}
898 }
899 
900 
901 /* Process the RADIUS frames from Authentication Server */
902 static RadiusRxResult
903 ieee802_1x_receive_auth(struct radius_msg *msg, struct radius_msg *req,
904 			const u8 *shared_secret, size_t shared_secret_len,
905 			void *data)
906 {
907 	struct eapol_test_data *e = data;
908 	struct radius_hdr *hdr = radius_msg_get_hdr(msg);
909 
910 	/* RFC 2869, Ch. 5.13: valid Message-Authenticator attribute MUST be
911 	 * present when packet contains an EAP-Message attribute */
912 	if (hdr->code == RADIUS_CODE_ACCESS_REJECT &&
913 	    radius_msg_get_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR, NULL,
914 				0) < 0 &&
915 	    radius_msg_get_attr(msg, RADIUS_ATTR_EAP_MESSAGE, NULL, 0) < 0) {
916 		wpa_printf(MSG_DEBUG, "Allowing RADIUS "
917 			      "Access-Reject without Message-Authenticator "
918 			      "since it does not include EAP-Message\n");
919 	} else if (radius_msg_verify(msg, shared_secret, shared_secret_len,
920 				     req, 1)) {
921 		printf("Incoming RADIUS packet did not have correct "
922 		       "Message-Authenticator - dropped\n");
923 		return RADIUS_RX_UNKNOWN;
924 	}
925 
926 	if (hdr->code != RADIUS_CODE_ACCESS_ACCEPT &&
927 	    hdr->code != RADIUS_CODE_ACCESS_REJECT &&
928 	    hdr->code != RADIUS_CODE_ACCESS_CHALLENGE) {
929 		printf("Unknown RADIUS message code\n");
930 		return RADIUS_RX_UNKNOWN;
931 	}
932 
933 	e->radius_identifier = -1;
934 	wpa_printf(MSG_DEBUG, "RADIUS packet matching with station");
935 
936 	radius_msg_free(e->last_recv_radius);
937 	e->last_recv_radius = msg;
938 
939 	switch (hdr->code) {
940 	case RADIUS_CODE_ACCESS_ACCEPT:
941 		e->radius_access_accept_received = 1;
942 		ieee802_1x_get_keys(e, msg, req, shared_secret,
943 				    shared_secret_len);
944 		break;
945 	case RADIUS_CODE_ACCESS_REJECT:
946 		e->radius_access_reject_received = 1;
947 		break;
948 	}
949 
950 	ieee802_1x_decapsulate_radius(e);
951 
952 	if ((hdr->code == RADIUS_CODE_ACCESS_ACCEPT &&
953 	     e->eapol_test_num_reauths < 0) ||
954 	    hdr->code == RADIUS_CODE_ACCESS_REJECT) {
955 		if (!e->ctrl_iface)
956 			eloop_terminate();
957 	}
958 
959 	return RADIUS_RX_QUEUED;
960 }
961 
962 
963 static int driver_get_ssid(void *priv, u8 *ssid)
964 {
965 	ssid[0] = 0;
966 	return 0;
967 }
968 
969 
970 static int driver_get_bssid(void *priv, u8 *bssid)
971 {
972 	struct eapol_test_data *e = priv;
973 
974 	if (e->ctrl_iface && !e->id_req_sent) {
975 		eloop_register_timeout(0, 0, send_eap_request_identity,
976 				       e->wpa_s, NULL);
977 		e->id_req_sent = 1;
978 	}
979 
980 	os_memset(bssid, 0, ETH_ALEN);
981 	bssid[5] = 1;
982 	return 0;
983 }
984 
985 
986 static int driver_get_capa(void *priv, struct wpa_driver_capa *capa)
987 {
988 	os_memset(capa, 0, sizeof(*capa));
989 	capa->flags = WPA_DRIVER_FLAGS_WIRED;
990 	return 0;
991 }
992 
993 
994 struct wpa_driver_ops eapol_test_drv_ops = {
995 	.name = "test",
996 	.get_ssid = driver_get_ssid,
997 	.get_bssid = driver_get_bssid,
998 	.get_capa = driver_get_capa,
999 };
1000 
1001 static void wpa_init_conf(struct eapol_test_data *e,
1002 			  struct wpa_supplicant *wpa_s, const char *authsrv,
1003 			  int port, const char *secret,
1004 			  const char *cli_addr, const char *ifname)
1005 {
1006 	struct hostapd_radius_server *as;
1007 	int res;
1008 
1009 	wpa_s->driver = &eapol_test_drv_ops;
1010 	wpa_s->drv_priv = e;
1011 	wpa_s->bssid[5] = 1;
1012 	os_memcpy(wpa_s->own_addr, e->own_addr, ETH_ALEN);
1013 	e->own_ip_addr.s_addr = htonl((127 << 24) | 1);
1014 	os_strlcpy(wpa_s->ifname, ifname, sizeof(wpa_s->ifname));
1015 
1016 	e->radius_conf = os_zalloc(sizeof(struct hostapd_radius_servers));
1017 	assert(e->radius_conf != NULL);
1018 	e->radius_conf->num_auth_servers = 1;
1019 	as = os_zalloc(sizeof(struct hostapd_radius_server));
1020 	assert(as != NULL);
1021 #if defined(CONFIG_NATIVE_WINDOWS) || defined(CONFIG_ANSI_C_EXTRA)
1022 	{
1023 		int a[4];
1024 		u8 *pos;
1025 		sscanf(authsrv, "%d.%d.%d.%d", &a[0], &a[1], &a[2], &a[3]);
1026 		pos = (u8 *) &as->addr.u.v4;
1027 		*pos++ = a[0];
1028 		*pos++ = a[1];
1029 		*pos++ = a[2];
1030 		*pos++ = a[3];
1031 	}
1032 #else /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */
1033 	if (hostapd_parse_ip_addr(authsrv, &as->addr) < 0) {
1034 		wpa_printf(MSG_ERROR, "Invalid IP address '%s'",
1035 			   authsrv);
1036 		assert(0);
1037 	}
1038 #endif /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */
1039 	as->port = port;
1040 	as->shared_secret = (u8 *) os_strdup(secret);
1041 	as->shared_secret_len = os_strlen(secret);
1042 	e->radius_conf->auth_server = as;
1043 	e->radius_conf->auth_servers = as;
1044 	e->radius_conf->msg_dumps = 1;
1045 	if (cli_addr) {
1046 		if (hostapd_parse_ip_addr(cli_addr,
1047 					  &e->radius_conf->client_addr) == 0)
1048 			e->radius_conf->force_client_addr = 1;
1049 		else {
1050 			wpa_printf(MSG_ERROR, "Invalid IP address '%s'",
1051 				   cli_addr);
1052 			assert(0);
1053 		}
1054 	}
1055 
1056 	e->radius = radius_client_init(wpa_s, e->radius_conf);
1057 	assert(e->radius != NULL);
1058 
1059 	res = radius_client_register(e->radius, RADIUS_AUTH,
1060 				     ieee802_1x_receive_auth, e);
1061 	assert(res == 0);
1062 }
1063 
1064 
1065 static int scard_test(struct eapol_test_data *e)
1066 {
1067 	struct scard_data *scard;
1068 	size_t len;
1069 	char imsi[20];
1070 	unsigned char _rand[16];
1071 #ifdef PCSC_FUNCS
1072 	unsigned char sres[4];
1073 	unsigned char kc[8];
1074 #endif /* PCSC_FUNCS */
1075 #define num_triplets 5
1076 	unsigned char rand_[num_triplets][16];
1077 	unsigned char sres_[num_triplets][4];
1078 	unsigned char kc_[num_triplets][8];
1079 	int i, res;
1080 	size_t j;
1081 
1082 #define AKA_RAND_LEN 16
1083 #define AKA_AUTN_LEN 16
1084 #define AKA_AUTS_LEN 14
1085 #define RES_MAX_LEN 16
1086 #define IK_LEN 16
1087 #define CK_LEN 16
1088 	unsigned char aka_rand[AKA_RAND_LEN];
1089 	unsigned char aka_autn[AKA_AUTN_LEN];
1090 	unsigned char aka_auts[AKA_AUTS_LEN];
1091 	unsigned char aka_res[RES_MAX_LEN];
1092 	size_t aka_res_len;
1093 	unsigned char aka_ik[IK_LEN];
1094 	unsigned char aka_ck[CK_LEN];
1095 
1096 	scard = scard_init(e->pcsc_reader);
1097 	if (scard == NULL)
1098 		return -1;
1099 	if (scard_set_pin(scard, e->pcsc_pin)) {
1100 		wpa_printf(MSG_WARNING, "PIN validation failed");
1101 		scard_deinit(scard);
1102 		return -1;
1103 	}
1104 
1105 	len = sizeof(imsi);
1106 	if (scard_get_imsi(scard, imsi, &len))
1107 		goto failed;
1108 	wpa_hexdump_ascii(MSG_DEBUG, "SCARD: IMSI", (u8 *) imsi, len);
1109 	/* NOTE: Permanent Username: 1 | IMSI */
1110 
1111 	wpa_printf(MSG_DEBUG, "SCARD: MNC length %d",
1112 		   scard_get_mnc_len(scard));
1113 
1114 	os_memset(_rand, 0, sizeof(_rand));
1115 	if (scard_gsm_auth(scard, _rand, sres, kc))
1116 		goto failed;
1117 
1118 	os_memset(_rand, 0xff, sizeof(_rand));
1119 	if (scard_gsm_auth(scard, _rand, sres, kc))
1120 		goto failed;
1121 
1122 	for (i = 0; i < num_triplets; i++) {
1123 		os_memset(rand_[i], i, sizeof(rand_[i]));
1124 		if (scard_gsm_auth(scard, rand_[i], sres_[i], kc_[i]))
1125 			goto failed;
1126 	}
1127 
1128 	for (i = 0; i < num_triplets; i++) {
1129 		printf("1");
1130 		for (j = 0; j < len; j++)
1131 			printf("%c", imsi[j]);
1132 		printf(",");
1133 		for (j = 0; j < 16; j++)
1134 			printf("%02X", rand_[i][j]);
1135 		printf(",");
1136 		for (j = 0; j < 4; j++)
1137 			printf("%02X", sres_[i][j]);
1138 		printf(",");
1139 		for (j = 0; j < 8; j++)
1140 			printf("%02X", kc_[i][j]);
1141 		printf("\n");
1142 	}
1143 
1144 	wpa_printf(MSG_DEBUG, "Trying to use UMTS authentication");
1145 
1146 	/* seq 39 (0x28) */
1147 	os_memset(aka_rand, 0xaa, 16);
1148 	os_memcpy(aka_autn, "\x86\x71\x31\xcb\xa2\xfc\x61\xdf"
1149 		  "\xa3\xb3\x97\x9d\x07\x32\xa2\x12", 16);
1150 
1151 	res = scard_umts_auth(scard, aka_rand, aka_autn, aka_res, &aka_res_len,
1152 			      aka_ik, aka_ck, aka_auts);
1153 	if (res == 0) {
1154 		wpa_printf(MSG_DEBUG, "UMTS auth completed successfully");
1155 		wpa_hexdump(MSG_DEBUG, "RES", aka_res, aka_res_len);
1156 		wpa_hexdump(MSG_DEBUG, "IK", aka_ik, IK_LEN);
1157 		wpa_hexdump(MSG_DEBUG, "CK", aka_ck, CK_LEN);
1158 	} else if (res == -2) {
1159 		wpa_printf(MSG_DEBUG, "UMTS auth resulted in synchronization "
1160 			   "failure");
1161 		wpa_hexdump(MSG_DEBUG, "AUTS", aka_auts, AKA_AUTS_LEN);
1162 	} else {
1163 		wpa_printf(MSG_DEBUG, "UMTS auth failed");
1164 	}
1165 
1166 failed:
1167 	scard_deinit(scard);
1168 
1169 	return 0;
1170 #undef num_triplets
1171 }
1172 
1173 
1174 static int scard_get_triplets(struct eapol_test_data *e, int argc, char *argv[])
1175 {
1176 	struct scard_data *scard;
1177 	size_t len;
1178 	char imsi[20];
1179 	unsigned char _rand[16];
1180 	unsigned char sres[4];
1181 	unsigned char kc[8];
1182 	int num_triplets;
1183 	int i;
1184 	size_t j;
1185 
1186 	if (argc < 2 || ((num_triplets = atoi(argv[1])) <= 0)) {
1187 		printf("invalid parameters for sim command\n");
1188 		return -1;
1189 	}
1190 
1191 	if (argc <= 2 || os_strcmp(argv[2], "debug") != 0) {
1192 		/* disable debug output */
1193 		wpa_debug_level = 99;
1194 	}
1195 
1196 	scard = scard_init(e->pcsc_reader);
1197 	if (scard == NULL) {
1198 		printf("Failed to open smartcard connection\n");
1199 		return -1;
1200 	}
1201 	if (scard_set_pin(scard, argv[0])) {
1202 		wpa_printf(MSG_WARNING, "PIN validation failed");
1203 		scard_deinit(scard);
1204 		return -1;
1205 	}
1206 
1207 	len = sizeof(imsi);
1208 	if (scard_get_imsi(scard, imsi, &len)) {
1209 		scard_deinit(scard);
1210 		return -1;
1211 	}
1212 
1213 	for (i = 0; i < num_triplets; i++) {
1214 		os_memset(_rand, i, sizeof(_rand));
1215 		if (scard_gsm_auth(scard, _rand, sres, kc))
1216 			break;
1217 
1218 		/* IMSI:Kc:SRES:RAND */
1219 		for (j = 0; j < len; j++)
1220 			printf("%c", imsi[j]);
1221 		printf(":");
1222 		for (j = 0; j < 8; j++)
1223 			printf("%02X", kc[j]);
1224 		printf(":");
1225 		for (j = 0; j < 4; j++)
1226 			printf("%02X", sres[j]);
1227 		printf(":");
1228 		for (j = 0; j < 16; j++)
1229 			printf("%02X", _rand[j]);
1230 		printf("\n");
1231 	}
1232 
1233 	scard_deinit(scard);
1234 
1235 	return 0;
1236 }
1237 
1238 
1239 static void eapol_test_terminate(int sig, void *signal_ctx)
1240 {
1241 	struct wpa_supplicant *wpa_s = signal_ctx;
1242 	wpa_msg(wpa_s, MSG_INFO, "Signal %d received - terminating", sig);
1243 	eloop_terminate();
1244 }
1245 
1246 
1247 static void usage(void)
1248 {
1249 	printf("usage:\n"
1250 	       "eapol_test [-enWSv] -c<conf> [-a<AS IP>] [-p<AS port>] "
1251 	       "[-s<AS secret>]\\\n"
1252 	       "           [-r<count>] [-t<timeout>] [-C<Connect-Info>] \\\n"
1253 	       "           [-M<client MAC address>] [-o<server cert file] \\\n"
1254 	       "           [-N<attr spec>] [-R<PC/SC reader>] "
1255 	       "[-P<PC/SC PIN>] \\\n"
1256 	       "           [-A<client IP>] [-i<ifname>] [-T<ctrl_iface>]\n"
1257 	       "eapol_test scard\n"
1258 	       "eapol_test sim <PIN> <num triplets> [debug]\n"
1259 	       "\n");
1260 	printf("options:\n"
1261 	       "  -c<conf> = configuration file\n"
1262 	       "  -a<AS IP> = IP address of the authentication server, "
1263 	       "default 127.0.0.1\n"
1264 	       "  -p<AS port> = UDP port of the authentication server, "
1265 	       "default 1812\n"
1266 	       "  -s<AS secret> = shared secret with the authentication "
1267 	       "server, default 'radius'\n"
1268 	       "  -A<client IP> = IP address of the client, default: select "
1269 	       "automatically\n"
1270 	       "  -r<count> = number of re-authentications\n"
1271 	       "  -e = Request EAP-Key-Name\n"
1272 	       "  -W = wait for a control interface monitor before starting\n"
1273 	       "  -S = save configuration after authentication\n"
1274 	       "  -n = no MPPE keys expected\n"
1275 	       "  -v = show version\n"
1276 	       "  -t<timeout> = sets timeout in seconds (default: 30 s)\n"
1277 	       "  -C<Connect-Info> = RADIUS Connect-Info (default: "
1278 	       "CONNECT 11Mbps 802.11b)\n"
1279 	       "  -M<client MAC address> = Set own MAC address "
1280 	       "(Calling-Station-Id,\n"
1281 	       "                           default: 02:00:00:00:00:01)\n"
1282 	       "  -o<server cert file> = Write received server certificate\n"
1283 	       "                         chain to the specified file\n"
1284 	       "  -N<attr spec> = send arbitrary attribute specified by:\n"
1285 	       "                  attr_id:syntax:value or attr_id\n"
1286 	       "                  attr_id - number id of the attribute\n"
1287 	       "                  syntax - one of: s, d, x\n"
1288 	       "                     s = string\n"
1289 	       "                     d = integer\n"
1290 	       "                     x = octet string\n"
1291 	       "                  value - attribute value.\n"
1292 	       "       When only attr_id is specified, NULL will be used as "
1293 	       "value.\n"
1294 	       "       Multiple attributes can be specified by using the "
1295 	       "option several times.\n");
1296 }
1297 
1298 
1299 int main(int argc, char *argv[])
1300 {
1301 	struct wpa_global global;
1302 	struct wpa_supplicant wpa_s;
1303 	int c, ret = 1, wait_for_monitor = 0, save_config = 0;
1304 	char *as_addr = "127.0.0.1";
1305 	int as_port = 1812;
1306 	char *as_secret = "radius";
1307 	char *cli_addr = NULL;
1308 	char *conf = NULL;
1309 	int timeout = 30;
1310 	char *pos;
1311 	struct extra_radius_attr *p = NULL, *p1;
1312 	const char *ifname = "test";
1313 	const char *ctrl_iface = NULL;
1314 
1315 	if (os_program_init())
1316 		return -1;
1317 
1318 	hostapd_logger_register_cb(hostapd_logger_cb);
1319 
1320 	os_memset(&eapol_test, 0, sizeof(eapol_test));
1321 	eapol_test.connect_info = "CONNECT 11Mbps 802.11b";
1322 	os_memcpy(eapol_test.own_addr, "\x02\x00\x00\x00\x00\x01", ETH_ALEN);
1323 	eapol_test.pcsc_pin = "1234";
1324 
1325 	wpa_debug_level = 0;
1326 	wpa_debug_show_keys = 1;
1327 
1328 	for (;;) {
1329 		c = getopt(argc, argv, "a:A:c:C:ei:M:nN:o:p:P:r:R:s:St:T:vW");
1330 		if (c < 0)
1331 			break;
1332 		switch (c) {
1333 		case 'a':
1334 			as_addr = optarg;
1335 			break;
1336 		case 'A':
1337 			cli_addr = optarg;
1338 			break;
1339 		case 'c':
1340 			conf = optarg;
1341 			break;
1342 		case 'C':
1343 			eapol_test.connect_info = optarg;
1344 			break;
1345 		case 'e':
1346 			eapol_test.req_eap_key_name = 1;
1347 			break;
1348 		case 'i':
1349 			ifname = optarg;
1350 			break;
1351 		case 'M':
1352 			if (hwaddr_aton(optarg, eapol_test.own_addr)) {
1353 				usage();
1354 				return -1;
1355 			}
1356 			break;
1357 		case 'n':
1358 			eapol_test.no_mppe_keys++;
1359 			break;
1360 		case 'o':
1361 			if (eapol_test.server_cert_file)
1362 				fclose(eapol_test.server_cert_file);
1363 			eapol_test.server_cert_file = fopen(optarg, "w");
1364 			if (eapol_test.server_cert_file == NULL) {
1365 				printf("Could not open '%s' for writing\n",
1366 				       optarg);
1367 				return -1;
1368 			}
1369 			break;
1370 		case 'p':
1371 			as_port = atoi(optarg);
1372 			break;
1373 		case 'P':
1374 			eapol_test.pcsc_pin = optarg;
1375 			break;
1376 		case 'r':
1377 			eapol_test.eapol_test_num_reauths = atoi(optarg);
1378 			break;
1379 		case 'R':
1380 			eapol_test.pcsc_reader = optarg;
1381 			break;
1382 		case 's':
1383 			as_secret = optarg;
1384 			break;
1385 		case 'S':
1386 			save_config++;
1387 			break;
1388 		case 't':
1389 			timeout = atoi(optarg);
1390 			break;
1391 		case 'T':
1392 			ctrl_iface = optarg;
1393 			eapol_test.ctrl_iface = 1;
1394 			break;
1395 		case 'v':
1396 			printf("eapol_test v" VERSION_STR "\n");
1397 			return 0;
1398 		case 'W':
1399 			wait_for_monitor++;
1400 			break;
1401 		case 'N':
1402 			p1 = os_zalloc(sizeof(*p1));
1403 			if (p1 == NULL)
1404 				break;
1405 			if (!p)
1406 				eapol_test.extra_attrs = p1;
1407 			else
1408 				p->next = p1;
1409 			p = p1;
1410 
1411 			p->type = atoi(optarg);
1412 			pos = os_strchr(optarg, ':');
1413 			if (pos == NULL) {
1414 				p->syntax = 'n';
1415 				p->data = NULL;
1416 				break;
1417 			}
1418 
1419 			pos++;
1420 			if (pos[0] == '\0' || pos[1] != ':') {
1421 				printf("Incorrect format of attribute "
1422 				       "specification\n");
1423 				break;
1424 			}
1425 
1426 			p->syntax = pos[0];
1427 			p->data = pos + 2;
1428 			break;
1429 		default:
1430 			usage();
1431 			return -1;
1432 		}
1433 	}
1434 
1435 	if (argc > optind && os_strcmp(argv[optind], "scard") == 0) {
1436 		return scard_test(&eapol_test);
1437 	}
1438 
1439 	if (argc > optind && os_strcmp(argv[optind], "sim") == 0) {
1440 		return scard_get_triplets(&eapol_test, argc - optind - 1,
1441 					  &argv[optind + 1]);
1442 	}
1443 
1444 	if (conf == NULL && !ctrl_iface) {
1445 		usage();
1446 		printf("Configuration file is required.\n");
1447 		return -1;
1448 	}
1449 
1450 	if (eap_register_methods()) {
1451 		wpa_printf(MSG_ERROR, "Failed to register EAP methods");
1452 		return -1;
1453 	}
1454 
1455 	if (eloop_init()) {
1456 		wpa_printf(MSG_ERROR, "Failed to initialize event loop");
1457 		return -1;
1458 	}
1459 
1460 	os_memset(&global, 0, sizeof(global));
1461 	os_memset(&wpa_s, 0, sizeof(wpa_s));
1462 	wpa_s.global = &global;
1463 	eapol_test.wpa_s = &wpa_s;
1464 	dl_list_init(&wpa_s.bss);
1465 	dl_list_init(&wpa_s.bss_id);
1466 	if (conf)
1467 		wpa_s.conf = wpa_config_read(conf, NULL);
1468 	else
1469 		wpa_s.conf = wpa_config_alloc_empty(ctrl_iface, NULL);
1470 	if (wpa_s.conf == NULL) {
1471 		printf("Failed to parse configuration file '%s'.\n", conf);
1472 		return -1;
1473 	}
1474 	if (!ctrl_iface && wpa_s.conf->ssid == NULL) {
1475 		printf("No networks defined.\n");
1476 		return -1;
1477 	}
1478 
1479 	if (eapol_test.pcsc_reader) {
1480 		os_free(wpa_s.conf->pcsc_reader);
1481 		wpa_s.conf->pcsc_reader = os_strdup(eapol_test.pcsc_reader);
1482 	}
1483 
1484 	wpa_init_conf(&eapol_test, &wpa_s, as_addr, as_port, as_secret,
1485 		      cli_addr, ifname);
1486 	wpa_s.ctrl_iface = wpa_supplicant_ctrl_iface_init(&wpa_s);
1487 	if (wpa_s.ctrl_iface == NULL) {
1488 		printf("Failed to initialize control interface '%s'.\n"
1489 		       "You may have another eapol_test process already "
1490 		       "running or the file was\n"
1491 		       "left by an unclean termination of eapol_test in "
1492 		       "which case you will need\n"
1493 		       "to manually remove this file before starting "
1494 		       "eapol_test again.\n",
1495 		       wpa_s.conf->ctrl_interface);
1496 		return -1;
1497 	}
1498 	if (wpa_s.conf->ssid &&
1499 	    wpa_supplicant_scard_init(&wpa_s, wpa_s.conf->ssid))
1500 		return -1;
1501 
1502 	if (test_eapol(&eapol_test, &wpa_s, wpa_s.conf->ssid))
1503 		return -1;
1504 
1505 	if (wpas_init_ext_pw(&wpa_s) < 0)
1506 		return -1;
1507 
1508 	if (wait_for_monitor)
1509 		wpa_supplicant_ctrl_iface_wait(wpa_s.ctrl_iface);
1510 
1511 	if (!ctrl_iface) {
1512 		eloop_register_timeout(timeout, 0, eapol_test_timeout,
1513 				       &eapol_test, NULL);
1514 		eloop_register_timeout(0, 0, send_eap_request_identity, &wpa_s,
1515 				       NULL);
1516 	}
1517 	eloop_register_signal_terminate(eapol_test_terminate, &wpa_s);
1518 	eloop_register_signal_reconfig(eapol_test_terminate, &wpa_s);
1519 	eloop_run();
1520 
1521 	eloop_cancel_timeout(eapol_test_timeout, &eapol_test, NULL);
1522 	eloop_cancel_timeout(eapol_sm_reauth, &eapol_test, NULL);
1523 
1524 	if (eapol_test_compare_pmk(&eapol_test) == 0 ||
1525 	    eapol_test.no_mppe_keys)
1526 		ret = 0;
1527 	if (eapol_test.auth_timed_out)
1528 		ret = -2;
1529 	if (eapol_test.radius_access_reject_received)
1530 		ret = -3;
1531 
1532 	if (save_config)
1533 		wpa_config_write(conf, wpa_s.conf);
1534 
1535 	test_eapol_clean(&eapol_test, &wpa_s);
1536 
1537 	eap_peer_unregister_methods();
1538 #ifdef CONFIG_AP
1539 	eap_server_unregister_methods();
1540 #endif /* CONFIG_AP */
1541 
1542 	eloop_destroy();
1543 
1544 	if (eapol_test.server_cert_file)
1545 		fclose(eapol_test.server_cert_file);
1546 
1547 	printf("MPPE keys OK: %d  mismatch: %d\n",
1548 	       eapol_test.num_mppe_ok, eapol_test.num_mppe_mismatch);
1549 	if (eapol_test.num_mppe_mismatch)
1550 		ret = -4;
1551 	if (ret)
1552 		printf("FAILURE\n");
1553 	else
1554 		printf("SUCCESS\n");
1555 
1556 	os_program_deinit();
1557 
1558 	return ret;
1559 }
1560