contrib/wpa/wpa_supplicant/eapol_test.c

   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         if (os_get_random((u8 *) &eap->identifier, sizeof(eap->identifier)) < 0)
 715                 eap->identifier = os_random() & 0xff;
 716         eap->length = htons(5);
 717         pos = (u8 *) (eap + 1);
 718         *pos = EAP_TYPE_IDENTITY;
 719
 720         printf("Sending fake EAP-Request-Identity\n");
 721         eapol_sm_rx_eapol(wpa_s->eapol, wpa_s->bssid, buf,
 722                           sizeof(*hdr) + 5);
 723 }
 724
 725
 726 static void eapol_test_timeout(void *eloop_ctx, void *timeout_ctx)
 727 {
 728         struct eapol_test_data *e = eloop_ctx;
 729         printf("EAPOL test timed out\n");
 730         e->auth_timed_out = 1;
 731         eloop_terminate();
 732 }
 733
 734
 735 static char *eap_type_text(u8 type)
 736 {
 737         switch (type) {
 738         case EAP_TYPE_IDENTITY: return "Identity";
 739         case EAP_TYPE_NOTIFICATION: return "Notification";
 740         case EAP_TYPE_NAK: return "Nak";
 741         case EAP_TYPE_TLS: return "TLS";
 742         case EAP_TYPE_TTLS: return "TTLS";
 743         case EAP_TYPE_PEAP: return "PEAP";
 744         case EAP_TYPE_SIM: return "SIM";
 745         case EAP_TYPE_GTC: return "GTC";
 746         case EAP_TYPE_MD5: return "MD5";
 747         case EAP_TYPE_OTP: return "OTP";
 748         case EAP_TYPE_FAST: return "FAST";
 749         case EAP_TYPE_SAKE: return "SAKE";
 750         case EAP_TYPE_PSK: return "PSK";
 751         default: return "Unknown";
 752         }
 753 }
 754
 755
 756 static void ieee802_1x_decapsulate_radius(struct eapol_test_data *e)
 757 {
 758         struct wpabuf *eap;
 759         const struct eap_hdr *hdr;
 760         int eap_type = -1;
 761         char buf[64];
 762         struct radius_msg *msg;
 763
 764         if (e->last_recv_radius == NULL)
 765                 return;
 766
 767         msg = e->last_recv_radius;
 768
 769         eap = radius_msg_get_eap(msg);
 770         if (eap == NULL) {
 771                 /* draft-aboba-radius-rfc2869bis-20.txt, Chap. 2.6.3:
 772                  * RADIUS server SHOULD NOT send Access-Reject/no EAP-Message
 773                  * attribute */
 774                 wpa_printf(MSG_DEBUG, "could not extract "
 775                                "EAP-Message from RADIUS message");
 776                 wpabuf_free(e->last_eap_radius);
 777                 e->last_eap_radius = NULL;
 778                 return;
 779         }
 780
 781         if (wpabuf_len(eap) < sizeof(*hdr)) {
 782                 wpa_printf(MSG_DEBUG, "too short EAP packet "
 783                                "received from authentication server");
 784                 wpabuf_free(eap);
 785                 return;
 786         }
 787
 788         if (wpabuf_len(eap) > sizeof(*hdr))
 789                 eap_type = (wpabuf_head_u8(eap))[sizeof(*hdr)];
 790
 791         hdr = wpabuf_head(eap);
 792         switch (hdr->code) {
 793         case EAP_CODE_REQUEST:
 794                 os_snprintf(buf, sizeof(buf), "EAP-Request-%s (%d)",
 795                             eap_type >= 0 ? eap_type_text(eap_type) : "??",
 796                             eap_type);
 797                 break;
 798         case EAP_CODE_RESPONSE:
 799                 os_snprintf(buf, sizeof(buf), "EAP Response-%s (%d)",
 800                             eap_type >= 0 ? eap_type_text(eap_type) : "??",
 801                             eap_type);
 802                 break;
 803         case EAP_CODE_SUCCESS:
 804                 os_strlcpy(buf, "EAP Success", sizeof(buf));
 805                 /* LEAP uses EAP Success within an authentication, so must not
 806                  * stop here with eloop_terminate(); */
 807                 break;
 808         case EAP_CODE_FAILURE:
 809                 os_strlcpy(buf, "EAP Failure", sizeof(buf));
 810                 if (e->ctrl_iface)
 811                         break;
 812                 eloop_terminate();
 813                 break;
 814         default:
 815                 os_strlcpy(buf, "unknown EAP code", sizeof(buf));
 816                 wpa_hexdump_buf(MSG_DEBUG, "Decapsulated EAP packet", eap);
 817                 break;
 818         }
 819         wpa_printf(MSG_DEBUG, "decapsulated EAP packet (code=%d "
 820                        "id=%d len=%d) from RADIUS server: %s",
 821                       hdr->code, hdr->identifier, ntohs(hdr->length), buf);
 822
 823         /* sta->eapol_sm->be_auth.idFromServer = hdr->identifier; */
 824
 825         wpabuf_free(e->last_eap_radius);
 826         e->last_eap_radius = eap;
 827
 828         {
 829                 struct ieee802_1x_hdr *dot1x;
 830                 dot1x = os_malloc(sizeof(*dot1x) + wpabuf_len(eap));
 831                 assert(dot1x != NULL);
 832                 dot1x->version = EAPOL_VERSION;
 833                 dot1x->type = IEEE802_1X_TYPE_EAP_PACKET;
 834                 dot1x->length = htons(wpabuf_len(eap));
 835                 os_memcpy((u8 *) (dot1x + 1), wpabuf_head(eap),
 836                           wpabuf_len(eap));
 837                 eapol_sm_rx_eapol(e->wpa_s->eapol, e->wpa_s->bssid,
 838                                   (u8 *) dot1x,
 839                                   sizeof(*dot1x) + wpabuf_len(eap));
 840                 os_free(dot1x);
 841         }
 842 }
 843
 844
 845 static void ieee802_1x_get_keys(struct eapol_test_data *e,
 846                                 struct radius_msg *msg, struct radius_msg *req,
 847                                 const u8 *shared_secret,
 848                                 size_t shared_secret_len)
 849 {
 850         struct radius_ms_mppe_keys *keys;
 851         u8 *buf;
 852         size_t len;
 853
 854         keys = radius_msg_get_ms_keys(msg, req, shared_secret,
 855                                       shared_secret_len);
 856         if (keys && keys->send == NULL && keys->recv == NULL) {
 857                 os_free(keys);
 858                 keys = radius_msg_get_cisco_keys(msg, req, shared_secret,
 859                                                  shared_secret_len);
 860         }
 861
 862         if (keys) {
 863                 if (keys->send) {
 864                         wpa_hexdump(MSG_DEBUG, "MS-MPPE-Send-Key (sign)",
 865                                     keys->send, keys->send_len);
 866                 }
 867                 if (keys->recv) {
 868                         wpa_hexdump(MSG_DEBUG, "MS-MPPE-Recv-Key (crypt)",
 869                                     keys->recv, keys->recv_len);
 870                         e->authenticator_pmk_len =
 871                                 keys->recv_len > PMK_LEN ? PMK_LEN :
 872                                 keys->recv_len;
 873                         os_memcpy(e->authenticator_pmk, keys->recv,
 874                                   e->authenticator_pmk_len);
 875                         if (e->authenticator_pmk_len == 16 && keys->send &&
 876                             keys->send_len == 16) {
 877                                 /* MS-CHAP-v2 derives 16 octet keys */
 878                                 wpa_printf(MSG_DEBUG, "Use MS-MPPE-Send-Key "
 879                                            "to extend PMK to 32 octets");
 880                                 os_memcpy(e->authenticator_pmk +
 881                                           e->authenticator_pmk_len,
 882                                           keys->send, keys->send_len);
 883                                 e->authenticator_pmk_len += keys->send_len;
 884                         }
 885                 }
 886
 887                 os_free(keys->send);
 888                 os_free(keys->recv);
 889                 os_free(keys);
 890         }
 891
 892         if (radius_msg_get_attr_ptr(msg, RADIUS_ATTR_EAP_KEY_NAME, &buf, &len,
 893                                     NULL) == 0) {
 894                 os_memcpy(e->authenticator_eap_key_name, buf, len);
 895                 e->authenticator_eap_key_name_len = len;
 896         } else {
 897                 e->authenticator_eap_key_name_len = 0;
 898         }
 899 }
 900
 901
 902 /* Process the RADIUS frames from Authentication Server */
 903 static RadiusRxResult
 904 ieee802_1x_receive_auth(struct radius_msg *msg, struct radius_msg *req,
 905                         const u8 *shared_secret, size_t shared_secret_len,
 906                         void *data)
 907 {
 908         struct eapol_test_data *e = data;
 909         struct radius_hdr *hdr = radius_msg_get_hdr(msg);
 910
 911         /* RFC 2869, Ch. 5.13: valid Message-Authenticator attribute MUST be
 912          * present when packet contains an EAP-Message attribute */
 913         if (hdr->code == RADIUS_CODE_ACCESS_REJECT &&
 914             radius_msg_get_attr(msg, RADIUS_ATTR_MESSAGE_AUTHENTICATOR, NULL,
 915                                 0) < 0 &&
 916             radius_msg_get_attr(msg, RADIUS_ATTR_EAP_MESSAGE, NULL, 0) < 0) {
 917                 wpa_printf(MSG_DEBUG, "Allowing RADIUS "
 918                               "Access-Reject without Message-Authenticator "
 919                               "since it does not include EAP-Message\n");
 920         } else if (radius_msg_verify(msg, shared_secret, shared_secret_len,
 921                                      req, 1)) {
 922                 printf("Incoming RADIUS packet did not have correct "
 923                        "Message-Authenticator - dropped\n");
 924                 return RADIUS_RX_UNKNOWN;
 925         }
 926
 927         if (hdr->code != RADIUS_CODE_ACCESS_ACCEPT &&
 928             hdr->code != RADIUS_CODE_ACCESS_REJECT &&
 929             hdr->code != RADIUS_CODE_ACCESS_CHALLENGE) {
 930                 printf("Unknown RADIUS message code\n");
 931                 return RADIUS_RX_UNKNOWN;
 932         }
 933
 934         e->radius_identifier = -1;
 935         wpa_printf(MSG_DEBUG, "RADIUS packet matching with station");
 936
 937         radius_msg_free(e->last_recv_radius);
 938         e->last_recv_radius = msg;
 939
 940         switch (hdr->code) {
 941         case RADIUS_CODE_ACCESS_ACCEPT:
 942                 e->radius_access_accept_received = 1;
 943                 ieee802_1x_get_keys(e, msg, req, shared_secret,
 944                                     shared_secret_len);
 945                 break;
 946         case RADIUS_CODE_ACCESS_REJECT:
 947                 e->radius_access_reject_received = 1;
 948                 break;
 949         }
 950
 951         ieee802_1x_decapsulate_radius(e);
 952
 953         if ((hdr->code == RADIUS_CODE_ACCESS_ACCEPT &&
 954              e->eapol_test_num_reauths < 0) ||
 955             hdr->code == RADIUS_CODE_ACCESS_REJECT) {
 956                 if (!e->ctrl_iface)
 957                         eloop_terminate();
 958         }
 959
 960         return RADIUS_RX_QUEUED;
 961 }
 962
 963
 964 static int driver_get_ssid(void *priv, u8 *ssid)
 965 {
 966         ssid[0] = 0;
 967         return 0;
 968 }
 969
 970
 971 static int driver_get_bssid(void *priv, u8 *bssid)
 972 {
 973         struct eapol_test_data *e = priv;
 974
 975         if (e->ctrl_iface && !e->id_req_sent) {
 976                 eloop_register_timeout(0, 0, send_eap_request_identity,
 977                                        e->wpa_s, NULL);
 978                 e->id_req_sent = 1;
 979         }
 980
 981         os_memset(bssid, 0, ETH_ALEN);
 982         bssid[5] = 1;
 983         return 0;
 984 }
 985
 986
 987 static int driver_get_capa(void *priv, struct wpa_driver_capa *capa)
 988 {
 989         os_memset(capa, 0, sizeof(*capa));
 990         capa->flags = WPA_DRIVER_FLAGS_WIRED;
 991         return 0;
 992 }
 993
 994
 995 struct wpa_driver_ops eapol_test_drv_ops = {
 996         .name = "test",
 997         .get_ssid = driver_get_ssid,
 998         .get_bssid = driver_get_bssid,
 999         .get_capa = driver_get_capa,
1000 };
1001
1002 static void wpa_init_conf(struct eapol_test_data *e,
1003                           struct wpa_supplicant *wpa_s, const char *authsrv,
1004                           int port, const char *secret,
1005                           const char *cli_addr, const char *ifname)
1006 {
1007         struct hostapd_radius_server *as;
1008         int res;
1009
1010         wpa_s->driver = &eapol_test_drv_ops;
1011         wpa_s->drv_priv = e;
1012         wpa_s->bssid[5] = 1;
1013         os_memcpy(wpa_s->own_addr, e->own_addr, ETH_ALEN);
1014         e->own_ip_addr.s_addr = htonl((127 << 24) | 1);
1015         os_strlcpy(wpa_s->ifname, ifname, sizeof(wpa_s->ifname));
1016
1017         e->radius_conf = os_zalloc(sizeof(struct hostapd_radius_servers));
1018         assert(e->radius_conf != NULL);
1019         e->radius_conf->num_auth_servers = 1;
1020         as = os_zalloc(sizeof(struct hostapd_radius_server));
1021         assert(as != NULL);
1022 #if defined(CONFIG_NATIVE_WINDOWS) || defined(CONFIG_ANSI_C_EXTRA)
1023         {
1024                 int a[4];
1025                 u8 *pos;
1026                 sscanf(authsrv, "%d.%d.%d.%d", &a[0], &a[1], &a[2], &a[3]);
1027                 pos = (u8 *) &as->addr.u.v4;
1028                 *pos++ = a[0];
1029                 *pos++ = a[1];
1030                 *pos++ = a[2];
1031                 *pos++ = a[3];
1032         }
1033 #else /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */
1034         if (hostapd_parse_ip_addr(authsrv, &as->addr) < 0) {
1035                 wpa_printf(MSG_ERROR, "Invalid IP address '%s'",
1036                            authsrv);
1037                 assert(0);
1038         }
1039 #endif /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */
1040         as->port = port;
1041         as->shared_secret = (u8 *) os_strdup(secret);
1042         as->shared_secret_len = os_strlen(secret);
1043         e->radius_conf->auth_server = as;
1044         e->radius_conf->auth_servers = as;
1045         e->radius_conf->msg_dumps = 1;
1046         if (cli_addr) {
1047                 if (hostapd_parse_ip_addr(cli_addr,
1048                                           &e->radius_conf->client_addr) == 0)
1049                         e->radius_conf->force_client_addr = 1;
1050                 else {
1051                         wpa_printf(MSG_ERROR, "Invalid IP address '%s'",
1052                                    cli_addr);
1053                         assert(0);
1054                 }
1055         }
1056
1057         e->radius = radius_client_init(wpa_s, e->radius_conf);
1058         assert(e->radius != NULL);
1059
1060         res = radius_client_register(e->radius, RADIUS_AUTH,
1061                                      ieee802_1x_receive_auth, e);
1062         assert(res == 0);
1063 }
1064
1065
1066 static int scard_test(struct eapol_test_data *e)
1067 {
1068         struct scard_data *scard;
1069         size_t len;
1070         char imsi[20];
1071         unsigned char _rand[16];
1072 #ifdef PCSC_FUNCS
1073         unsigned char sres[4];
1074         unsigned char kc[8];
1075 #endif /* PCSC_FUNCS */
1076 #define num_triplets 5
1077         unsigned char rand_[num_triplets][16];
1078         unsigned char sres_[num_triplets][4];
1079         unsigned char kc_[num_triplets][8];
1080         int i, res;
1081         size_t j;
1082
1083 #define AKA_RAND_LEN 16
1084 #define AKA_AUTN_LEN 16
1085 #define AKA_AUTS_LEN 14
1086 #define RES_MAX_LEN 16
1087 #define IK_LEN 16
1088 #define CK_LEN 16
1089         unsigned char aka_rand[AKA_RAND_LEN];
1090         unsigned char aka_autn[AKA_AUTN_LEN];
1091         unsigned char aka_auts[AKA_AUTS_LEN];
1092         unsigned char aka_res[RES_MAX_LEN];
1093         size_t aka_res_len;
1094         unsigned char aka_ik[IK_LEN];
1095         unsigned char aka_ck[CK_LEN];
1096
1097         scard = scard_init(e->pcsc_reader);
1098         if (scard == NULL)
1099                 return -1;
1100         if (scard_set_pin(scard, e->pcsc_pin)) {
1101                 wpa_printf(MSG_WARNING, "PIN validation failed");
1102                 scard_deinit(scard);
1103                 return -1;
1104         }
1105
1106         len = sizeof(imsi);
1107         if (scard_get_imsi(scard, imsi, &len))
1108                 goto failed;
1109         wpa_hexdump_ascii(MSG_DEBUG, "SCARD: IMSI", (u8 *) imsi, len);
1110         /* NOTE: Permanent Username: 1 | IMSI */
1111
1112         wpa_printf(MSG_DEBUG, "SCARD: MNC length %d",
1113                    scard_get_mnc_len(scard));
1114
1115         os_memset(_rand, 0, sizeof(_rand));
1116         if (scard_gsm_auth(scard, _rand, sres, kc))
1117                 goto failed;
1118
1119         os_memset(_rand, 0xff, sizeof(_rand));
1120         if (scard_gsm_auth(scard, _rand, sres, kc))
1121                 goto failed;
1122
1123         for (i = 0; i < num_triplets; i++) {
1124                 os_memset(rand_[i], i, sizeof(rand_[i]));
1125                 if (scard_gsm_auth(scard, rand_[i], sres_[i], kc_[i]))
1126                         goto failed;
1127         }
1128
1129         for (i = 0; i < num_triplets; i++) {
1130                 printf("1");
1131                 for (j = 0; j < len; j++)
1132                         printf("%c", imsi[j]);
1133                 printf(",");
1134                 for (j = 0; j < 16; j++)
1135                         printf("%02X", rand_[i][j]);
1136                 printf(",");
1137                 for (j = 0; j < 4; j++)
1138                         printf("%02X", sres_[i][j]);
1139                 printf(",");
1140                 for (j = 0; j < 8; j++)
1141                         printf("%02X", kc_[i][j]);
1142                 printf("\n");
1143         }
1144
1145         wpa_printf(MSG_DEBUG, "Trying to use UMTS authentication");
1146
1147         /* seq 39 (0x28) */
1148         os_memset(aka_rand, 0xaa, 16);
1149         os_memcpy(aka_autn, "\x86\x71\x31\xcb\xa2\xfc\x61\xdf"
1150                   "\xa3\xb3\x97\x9d\x07\x32\xa2\x12", 16);
1151
1152         res = scard_umts_auth(scard, aka_rand, aka_autn, aka_res, &aka_res_len,
1153                               aka_ik, aka_ck, aka_auts);
1154         if (res == 0) {
1155                 wpa_printf(MSG_DEBUG, "UMTS auth completed successfully");
1156                 wpa_hexdump(MSG_DEBUG, "RES", aka_res, aka_res_len);
1157                 wpa_hexdump(MSG_DEBUG, "IK", aka_ik, IK_LEN);
1158                 wpa_hexdump(MSG_DEBUG, "CK", aka_ck, CK_LEN);
1159         } else if (res == -2) {
1160                 wpa_printf(MSG_DEBUG, "UMTS auth resulted in synchronization "
1161                            "failure");
1162                 wpa_hexdump(MSG_DEBUG, "AUTS", aka_auts, AKA_AUTS_LEN);
1163         } else {
1164                 wpa_printf(MSG_DEBUG, "UMTS auth failed");
1165         }
1166
1167 failed:
1168         scard_deinit(scard);
1169
1170         return 0;
1171 #undef num_triplets
1172 }
1173
1174
1175 static int scard_get_triplets(struct eapol_test_data *e, int argc, char *argv[])
1176 {
1177         struct scard_data *scard;
1178         size_t len;
1179         char imsi[20];
1180         unsigned char _rand[16];
1181         unsigned char sres[4];
1182         unsigned char kc[8];
1183         int num_triplets;
1184         int i;
1185         size_t j;
1186
1187         if (argc < 2 || ((num_triplets = atoi(argv[1])) <= 0)) {
1188                 printf("invalid parameters for sim command\n");
1189                 return -1;
1190         }
1191
1192         if (argc <= 2 || os_strcmp(argv[2], "debug") != 0) {
1193                 /* disable debug output */
1194                 wpa_debug_level = 99;
1195         }
1196
1197         scard = scard_init(e->pcsc_reader);
1198         if (scard == NULL) {
1199                 printf("Failed to open smartcard connection\n");
1200                 return -1;
1201         }
1202         if (scard_set_pin(scard, argv[0])) {
1203                 wpa_printf(MSG_WARNING, "PIN validation failed");
1204                 scard_deinit(scard);
1205                 return -1;
1206         }
1207
1208         len = sizeof(imsi);
1209         if (scard_get_imsi(scard, imsi, &len)) {
1210                 scard_deinit(scard);
1211                 return -1;
1212         }
1213
1214         for (i = 0; i < num_triplets; i++) {
1215                 os_memset(_rand, i, sizeof(_rand));
1216                 if (scard_gsm_auth(scard, _rand, sres, kc))
1217                         break;
1218
1219                 /* IMSI:Kc:SRES:RAND */
1220                 for (j = 0; j < len; j++)
1221                         printf("%c", imsi[j]);
1222                 printf(":");
1223                 for (j = 0; j < 8; j++)
1224                         printf("%02X", kc[j]);
1225                 printf(":");
1226                 for (j = 0; j < 4; j++)
1227                         printf("%02X", sres[j]);
1228                 printf(":");
1229                 for (j = 0; j < 16; j++)
1230                         printf("%02X", _rand[j]);
1231                 printf("\n");
1232         }
1233
1234         scard_deinit(scard);
1235
1236         return 0;
1237 }
1238
1239
1240 static void eapol_test_terminate(int sig, void *signal_ctx)
1241 {
1242         struct wpa_supplicant *wpa_s = signal_ctx;
1243         wpa_msg(wpa_s, MSG_INFO, "Signal %d received - terminating", sig);
1244         eloop_terminate();
1245 }
1246
1247
1248 static void usage(void)
1249 {
1250         printf("usage:\n"
1251                "eapol_test [-enWSv] -c<conf> [-a<AS IP>] [-p<AS port>] "
1252                "[-s<AS secret>]\\\n"
1253                "           [-r<count>] [-t<timeout>] [-C<Connect-Info>] \\\n"
1254                "           [-M<client MAC address>] [-o<server cert file] \\\n"
1255                "           [-N<attr spec>] [-R<PC/SC reader>] "
1256                "[-P<PC/SC PIN>] \\\n"
1257                "           [-A<client IP>] [-i<ifname>] [-T<ctrl_iface>]\n"
1258                "eapol_test scard\n"
1259                "eapol_test sim <PIN> <num triplets> [debug]\n"
1260                "\n");
1261         printf("options:\n"
1262                "  -c<conf> = configuration file\n"
1263                "  -a<AS IP> = IP address of the authentication server, "
1264                "default 127.0.0.1\n"
1265                "  -p<AS port> = UDP port of the authentication server, "
1266                "default 1812\n"
1267                "  -s<AS secret> = shared secret with the authentication "
1268                "server, default 'radius'\n"
1269                "  -A<client IP> = IP address of the client, default: select "
1270                "automatically\n"
1271                "  -r<count> = number of re-authentications\n"
1272                "  -e = Request EAP-Key-Name\n"
1273                "  -W = wait for a control interface monitor before starting\n"
1274                "  -S = save configuration after authentication\n"
1275                "  -n = no MPPE keys expected\n"
1276                "  -v = show version\n"
1277                "  -t<timeout> = sets timeout in seconds (default: 30 s)\n"
1278                "  -C<Connect-Info> = RADIUS Connect-Info (default: "
1279                "CONNECT 11Mbps 802.11b)\n"
1280                "  -M<client MAC address> = Set own MAC address "
1281                "(Calling-Station-Id,\n"
1282                "                           default: 02:00:00:00:00:01)\n"
1283                "  -o<server cert file> = Write received server certificate\n"
1284                "                         chain to the specified file\n"
1285                "  -N<attr spec> = send arbitrary attribute specified by:\n"
1286                "                  attr_id:syntax:value or attr_id\n"
1287                "                  attr_id - number id of the attribute\n"
1288                "                  syntax - one of: s, d, x\n"
1289                "                     s = string\n"
1290                "                     d = integer\n"
1291                "                     x = octet string\n"
1292                "                  value - attribute value.\n"
1293                "       When only attr_id is specified, NULL will be used as "
1294                "value.\n"
1295                "       Multiple attributes can be specified by using the "
1296                "option several times.\n");
1297 }
1298
1299
1300 int main(int argc, char *argv[])
1301 {
1302         struct wpa_global global;
1303         struct wpa_supplicant wpa_s;
1304         int c, ret = 1, wait_for_monitor = 0, save_config = 0;
1305         char *as_addr = "127.0.0.1";
1306         int as_port = 1812;
1307         char *as_secret = "radius";
1308         char *cli_addr = NULL;
1309         char *conf = NULL;
1310         int timeout = 30;
1311         char *pos;
1312         struct extra_radius_attr *p = NULL, *p1;
1313         const char *ifname = "test";
1314         const char *ctrl_iface = NULL;
1315
1316         if (os_program_init())
1317                 return -1;
1318
1319         hostapd_logger_register_cb(hostapd_logger_cb);
1320
1321         os_memset(&eapol_test, 0, sizeof(eapol_test));
1322         eapol_test.connect_info = "CONNECT 11Mbps 802.11b";
1323         os_memcpy(eapol_test.own_addr, "\x02\x00\x00\x00\x00\x01", ETH_ALEN);
1324         eapol_test.pcsc_pin = "1234";
1325
1326         wpa_debug_level = 0;
1327         wpa_debug_show_keys = 1;
1328
1329         for (;;) {
1330                 c = getopt(argc, argv, "a:A:c:C:ei:M:nN:o:p:P:r:R:s:St:T:vW");
1331                 if (c < 0)
1332                         break;
1333                 switch (c) {
1334                 case 'a':
1335                         as_addr = optarg;
1336                         break;
1337                 case 'A':
1338                         cli_addr = optarg;
1339                         break;
1340                 case 'c':
1341                         conf = optarg;
1342                         break;
1343                 case 'C':
1344                         eapol_test.connect_info = optarg;
1345                         break;
1346                 case 'e':
1347                         eapol_test.req_eap_key_name = 1;
1348                         break;
1349                 case 'i':
1350                         ifname = optarg;
1351                         break;
1352                 case 'M':
1353                         if (hwaddr_aton(optarg, eapol_test.own_addr)) {
1354                                 usage();
1355                                 return -1;
1356                         }
1357                         break;
1358                 case 'n':
1359                         eapol_test.no_mppe_keys++;
1360                         break;
1361                 case 'o':
1362                         if (eapol_test.server_cert_file)
1363                                 fclose(eapol_test.server_cert_file);
1364                         eapol_test.server_cert_file = fopen(optarg, "w");
1365                         if (eapol_test.server_cert_file == NULL) {
1366                                 printf("Could not open '%s' for writing\n",
1367                                        optarg);
1368                                 return -1;
1369                         }
1370                         break;
1371                 case 'p':
1372                         as_port = atoi(optarg);
1373                         break;
1374                 case 'P':
1375                         eapol_test.pcsc_pin = optarg;
1376                         break;
1377                 case 'r':
1378                         eapol_test.eapol_test_num_reauths = atoi(optarg);
1379                         break;
1380                 case 'R':
1381                         eapol_test.pcsc_reader = optarg;
1382                         break;
1383                 case 's':
1384                         as_secret = optarg;
1385                         break;
1386                 case 'S':
1387                         save_config++;
1388                         break;
1389                 case 't':
1390                         timeout = atoi(optarg);
1391                         break;
1392                 case 'T':
1393                         ctrl_iface = optarg;
1394                         eapol_test.ctrl_iface = 1;
1395                         break;
1396                 case 'v':
1397                         printf("eapol_test v" VERSION_STR "\n");
1398                         return 0;
1399                 case 'W':
1400                         wait_for_monitor++;
1401                         break;
1402                 case 'N':
1403                         p1 = os_zalloc(sizeof(*p1));
1404                         if (p1 == NULL)
1405                                 break;
1406                         if (!p)
1407                                 eapol_test.extra_attrs = p1;
1408                         else
1409                                 p->next = p1;
1410                         p = p1;
1411
1412                         p->type = atoi(optarg);
1413                         pos = os_strchr(optarg, ':');
1414                         if (pos == NULL) {
1415                                 p->syntax = 'n';
1416                                 p->data = NULL;
1417                                 break;
1418                         }
1419
1420                         pos++;
1421                         if (pos[0] == '\0' || pos[1] != ':') {
1422                                 printf("Incorrect format of attribute "
1423                                        "specification\n");
1424                                 break;
1425                         }
1426
1427                         p->syntax = pos[0];
1428                         p->data = pos + 2;
1429                         break;
1430                 default:
1431                         usage();
1432                         return -1;
1433                 }
1434         }
1435
1436         if (argc > optind && os_strcmp(argv[optind], "scard") == 0) {
1437                 return scard_test(&eapol_test);
1438         }
1439
1440         if (argc > optind && os_strcmp(argv[optind], "sim") == 0) {
1441                 return scard_get_triplets(&eapol_test, argc - optind - 1,
1442                                           &argv[optind + 1]);
1443         }
1444
1445         if (conf == NULL && !ctrl_iface) {
1446                 usage();
1447                 printf("Configuration file is required.\n");
1448                 return -1;
1449         }
1450
1451         if (eap_register_methods()) {
1452                 wpa_printf(MSG_ERROR, "Failed to register EAP methods");
1453                 return -1;
1454         }
1455
1456         if (eloop_init()) {
1457                 wpa_printf(MSG_ERROR, "Failed to initialize event loop");
1458                 return -1;
1459         }
1460
1461         os_memset(&global, 0, sizeof(global));
1462         os_memset(&wpa_s, 0, sizeof(wpa_s));
1463         wpa_s.global = &global;
1464         eapol_test.wpa_s = &wpa_s;
1465         dl_list_init(&wpa_s.bss);
1466         dl_list_init(&wpa_s.bss_id);
1467         if (conf)
1468                 wpa_s.conf = wpa_config_read(conf, NULL);
1469         else
1470                 wpa_s.conf = wpa_config_alloc_empty(ctrl_iface, NULL);
1471         if (wpa_s.conf == NULL) {
1472                 printf("Failed to parse configuration file '%s'.\n", conf);
1473                 return -1;
1474         }
1475         if (!ctrl_iface && wpa_s.conf->ssid == NULL) {
1476                 printf("No networks defined.\n");
1477                 return -1;
1478         }
1479
1480         if (eapol_test.pcsc_reader) {
1481                 os_free(wpa_s.conf->pcsc_reader);
1482                 wpa_s.conf->pcsc_reader = os_strdup(eapol_test.pcsc_reader);
1483         }
1484
1485         wpa_init_conf(&eapol_test, &wpa_s, as_addr, as_port, as_secret,
1486                       cli_addr, ifname);
1487         wpa_s.ctrl_iface = wpa_supplicant_ctrl_iface_init(&wpa_s);
1488         if (wpa_s.ctrl_iface == NULL) {
1489                 printf("Failed to initialize control interface '%s'.\n"
1490                        "You may have another eapol_test process already "
1491                        "running or the file was\n"
1492                        "left by an unclean termination of eapol_test in "
1493                        "which case you will need\n"
1494                        "to manually remove this file before starting "
1495                        "eapol_test again.\n",
1496                        wpa_s.conf->ctrl_interface);
1497                 return -1;
1498         }
1499         if (wpa_s.conf->ssid &&
1500             wpa_supplicant_scard_init(&wpa_s, wpa_s.conf->ssid))
1501                 return -1;
1502
1503         if (test_eapol(&eapol_test, &wpa_s, wpa_s.conf->ssid))
1504                 return -1;
1505
1506         if (wpas_init_ext_pw(&wpa_s) < 0)
1507                 return -1;
1508
1509         if (wait_for_monitor)
1510                 wpa_supplicant_ctrl_iface_wait(wpa_s.ctrl_iface);
1511
1512         if (!ctrl_iface) {
1513                 eloop_register_timeout(timeout, 0, eapol_test_timeout,
1514                                        &eapol_test, NULL);
1515                 eloop_register_timeout(0, 0, send_eap_request_identity, &wpa_s,
1516                                        NULL);
1517         }
1518         eloop_register_signal_terminate(eapol_test_terminate, &wpa_s);
1519         eloop_register_signal_reconfig(eapol_test_terminate, &wpa_s);
1520         eloop_run();
1521
1522         eloop_cancel_timeout(eapol_test_timeout, &eapol_test, NULL);
1523         eloop_cancel_timeout(eapol_sm_reauth, &eapol_test, NULL);
1524
1525         if (eapol_test_compare_pmk(&eapol_test) == 0 ||
1526             eapol_test.no_mppe_keys)
1527                 ret = 0;
1528         if (eapol_test.auth_timed_out)
1529                 ret = -2;
1530         if (eapol_test.radius_access_reject_received)
1531                 ret = -3;
1532
1533         if (save_config)
1534                 wpa_config_write(conf, wpa_s.conf);
1535
1536         test_eapol_clean(&eapol_test, &wpa_s);
1537
1538         eap_peer_unregister_methods();
1539 #ifdef CONFIG_AP
1540         eap_server_unregister_methods();
1541 #endif /* CONFIG_AP */
1542
1543         eloop_destroy();
1544
1545         if (eapol_test.server_cert_file)
1546                 fclose(eapol_test.server_cert_file);
1547
1548         printf("MPPE keys OK: %d  mismatch: %d\n",
1549                eapol_test.num_mppe_ok, eapol_test.num_mppe_mismatch);
1550         if (eapol_test.num_mppe_mismatch)
1551                 ret = -4;
1552         if (ret)
1553                 printf("FAILURE\n");
1554         else
1555                 printf("SUCCESS\n");
1556
1557         os_program_deinit();
1558
1559         return ret;
1560 }