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         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 }