1 /* 2 * WPA Supplicant - test code for pre-authentication 3 * Copyright (c) 2003-2007, Jouni Malinen <j (at) w1.fi> 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License version 2 as 7 * published by the Free Software Foundation. 8 * 9 * Alternatively, this software may be distributed under the terms of BSD 10 * license. 11 * 12 * See README and COPYING for more details. 13 * 14 * IEEE 802.1X Supplicant test code (to be used in place of wpa_supplicant.c. 15 * Not used in production version. 16 */ 17 18 #include "includes.h" 19 #include <assert.h> 20 21 #include "common.h" 22 #include "config.h" 23 #include "eapol_supp/eapol_supp_sm.h" 24 #include "eloop.h" 25 #include "wpa.h" 26 #include "eap_peer/eap.h" 27 #include "wpa_supplicant_i.h" 28 #include "l2_packet/l2_packet.h" 29 #include "ctrl_iface.h" 30 #include "pcsc_funcs.h" 31 #include "preauth.h" 32 #include "pmksa_cache.h" 33 34 35 extern int wpa_debug_level; 36 extern int wpa_debug_show_keys; 37 38 struct wpa_driver_ops *wpa_supplicant_drivers[] = { NULL }; 39 40 41 struct preauth_test_data { 42 int auth_timed_out; 43 }; 44 45 46 static void _wpa_supplicant_disassociate(void *wpa_s, int reason_code) 47 { 48 wpa_supplicant_disassociate(wpa_s, reason_code); 49 } 50 51 52 static void _wpa_supplicant_deauthenticate(void *wpa_s, int reason_code) 53 { 54 wpa_supplicant_deauthenticate(wpa_s, reason_code); 55 } 56 57 58 static u8 * wpa_alloc_eapol(const struct wpa_supplicant *wpa_s, u8 type, 59 const void *data, u16 data_len, 60 size_t *msg_len, void **data_pos) 61 { 62 struct ieee802_1x_hdr *hdr; 63 64 *msg_len = sizeof(*hdr) + data_len; 65 hdr = os_malloc(*msg_len); 66 if (hdr == NULL) 67 return NULL; 68 69 hdr->version = wpa_s->conf->eapol_version; 70 hdr->type = type; 71 hdr->length = htons(data_len); 72 73 if (data) 74 os_memcpy(hdr + 1, data, data_len); 75 else 76 os_memset(hdr + 1, 0, data_len); 77 78 if (data_pos) 79 *data_pos = hdr + 1; 80 81 return (u8 *) hdr; 82 } 83 84 85 static u8 * _wpa_alloc_eapol(void *wpa_s, u8 type, 86 const void *data, u16 data_len, 87 size_t *msg_len, void **data_pos) 88 { 89 return wpa_alloc_eapol(wpa_s, type, data, data_len, msg_len, data_pos); 90 } 91 92 93 static void _wpa_supplicant_set_state(void *ctx, wpa_states state) 94 { 95 struct wpa_supplicant *wpa_s = ctx; 96 wpa_s->wpa_state = state; 97 } 98 99 100 static wpa_states _wpa_supplicant_get_state(void *ctx) 101 { 102 struct wpa_supplicant *wpa_s = ctx; 103 return wpa_s->wpa_state; 104 } 105 106 107 static int wpa_ether_send(void *wpa_s, const u8 *dest, u16 proto, 108 const u8 *buf, size_t len) 109 { 110 printf("%s - not implemented\n", __func__); 111 return -1; 112 } 113 114 115 static void * wpa_supplicant_get_network_ctx(void *wpa_s) 116 { 117 return wpa_supplicant_get_ssid(wpa_s); 118 } 119 120 121 static void _wpa_supplicant_cancel_auth_timeout(void *wpa_s) 122 { 123 wpa_supplicant_cancel_auth_timeout(wpa_s); 124 } 125 126 127 static int wpa_supplicant_get_beacon_ie(void *wpa_s) 128 { 129 printf("%s - not implemented\n", __func__); 130 return -1; 131 } 132 133 134 static int wpa_supplicant_get_bssid(void *wpa_s, u8 *bssid) 135 { 136 printf("%s - not implemented\n", __func__); 137 return -1; 138 } 139 140 141 static int wpa_supplicant_set_key(void *wpa_s, wpa_alg alg, 142 const u8 *addr, int key_idx, int set_tx, 143 const u8 *seq, size_t seq_len, 144 const u8 *key, size_t key_len) 145 { 146 printf("%s - not implemented\n", __func__); 147 return -1; 148 } 149 150 151 static int wpa_supplicant_mlme_setprotection(void *wpa_s, const u8 *addr, 152 int protection_type, 153 int key_type) 154 { 155 printf("%s - not implemented\n", __func__); 156 return -1; 157 } 158 159 160 static int wpa_supplicant_add_pmkid(void *wpa_s, 161 const u8 *bssid, const u8 *pmkid) 162 { 163 printf("%s - not implemented\n", __func__); 164 return -1; 165 } 166 167 168 static int wpa_supplicant_remove_pmkid(void *wpa_s, 169 const u8 *bssid, const u8 *pmkid) 170 { 171 printf("%s - not implemented\n", __func__); 172 return -1; 173 } 174 175 176 static void wpa_supplicant_set_config_blob(void *ctx, 177 struct wpa_config_blob *blob) 178 { 179 struct wpa_supplicant *wpa_s = ctx; 180 wpa_config_set_blob(wpa_s->conf, blob); 181 } 182 183 184 static const struct wpa_config_blob * 185 wpa_supplicant_get_config_blob(void *ctx, const char *name) 186 { 187 struct wpa_supplicant *wpa_s = ctx; 188 return wpa_config_get_blob(wpa_s->conf, name); 189 } 190 191 192 static void test_eapol_clean(struct wpa_supplicant *wpa_s) 193 { 194 rsn_preauth_deinit(wpa_s->wpa); 195 pmksa_candidate_free(wpa_s->wpa); 196 wpa_sm_deinit(wpa_s->wpa); 197 scard_deinit(wpa_s->scard); 198 if (wpa_s->ctrl_iface) { 199 wpa_supplicant_ctrl_iface_deinit(wpa_s->ctrl_iface); 200 wpa_s->ctrl_iface = NULL; 201 } 202 wpa_config_free(wpa_s->conf); 203 } 204 205 206 static void eapol_test_timeout(void *eloop_ctx, void *timeout_ctx) 207 { 208 struct preauth_test_data *p = eloop_ctx; 209 printf("EAPOL test timed out\n"); 210 p->auth_timed_out = 1; 211 eloop_terminate(); 212 } 213 214 215 static void eapol_test_poll(void *eloop_ctx, void *timeout_ctx) 216 { 217 struct wpa_supplicant *wpa_s = eloop_ctx; 218 if (!rsn_preauth_in_progress(wpa_s->wpa)) 219 eloop_terminate(); 220 else { 221 eloop_register_timeout(0, 100000, eapol_test_poll, eloop_ctx, 222 timeout_ctx); 223 } 224 } 225 226 227 static struct wpa_driver_ops dummy_driver; 228 229 230 static void wpa_init_conf(struct wpa_supplicant *wpa_s, const char *ifname) 231 { 232 struct l2_packet_data *l2; 233 struct wpa_sm_ctx *ctx; 234 235 os_memset(&dummy_driver, 0, sizeof(dummy_driver)); 236 wpa_s->driver = &dummy_driver; 237 238 ctx = os_zalloc(sizeof(*ctx)); 239 assert(ctx != NULL); 240 241 ctx->ctx = wpa_s; 242 ctx->set_state = _wpa_supplicant_set_state; 243 ctx->get_state = _wpa_supplicant_get_state; 244 ctx->deauthenticate = _wpa_supplicant_deauthenticate; 245 ctx->disassociate = _wpa_supplicant_disassociate; 246 ctx->set_key = wpa_supplicant_set_key; 247 ctx->get_network_ctx = wpa_supplicant_get_network_ctx; 248 ctx->get_bssid = wpa_supplicant_get_bssid; 249 ctx->ether_send = wpa_ether_send; 250 ctx->get_beacon_ie = wpa_supplicant_get_beacon_ie; 251 ctx->alloc_eapol = _wpa_alloc_eapol; 252 ctx->cancel_auth_timeout = _wpa_supplicant_cancel_auth_timeout; 253 ctx->add_pmkid = wpa_supplicant_add_pmkid; 254 ctx->remove_pmkid = wpa_supplicant_remove_pmkid; 255 ctx->set_config_blob = wpa_supplicant_set_config_blob; 256 ctx->get_config_blob = wpa_supplicant_get_config_blob; 257 ctx->mlme_setprotection = wpa_supplicant_mlme_setprotection; 258 259 wpa_s->wpa = wpa_sm_init(ctx); 260 assert(wpa_s->wpa != NULL); 261 wpa_sm_set_param(wpa_s->wpa, WPA_PARAM_PROTO, WPA_PROTO_RSN); 262 263 os_strlcpy(wpa_s->ifname, ifname, sizeof(wpa_s->ifname)); 264 wpa_sm_set_ifname(wpa_s->wpa, wpa_s->ifname, NULL); 265 266 l2 = l2_packet_init(wpa_s->ifname, NULL, ETH_P_RSN_PREAUTH, NULL, 267 NULL, 0); 268 assert(l2 != NULL); 269 if (l2_packet_get_own_addr(l2, wpa_s->own_addr)) { 270 wpa_printf(MSG_WARNING, "Failed to get own L2 address\n"); 271 exit(-1); 272 } 273 l2_packet_deinit(l2); 274 wpa_sm_set_own_addr(wpa_s->wpa, wpa_s->own_addr); 275 } 276 277 278 static void eapol_test_terminate(int sig, void *eloop_ctx, 279 void *signal_ctx) 280 { 281 struct wpa_supplicant *wpa_s = eloop_ctx; 282 wpa_msg(wpa_s, MSG_INFO, "Signal %d received - terminating", sig); 283 eloop_terminate(); 284 } 285 286 287 int main(int argc, char *argv[]) 288 { 289 struct wpa_supplicant wpa_s; 290 int ret = 1; 291 u8 bssid[ETH_ALEN]; 292 struct preauth_test_data preauth_test; 293 294 if (os_program_init()) 295 return -1; 296 297 os_memset(&preauth_test, 0, sizeof(preauth_test)); 298 299 wpa_debug_level = 0; 300 wpa_debug_show_keys = 1; 301 302 if (argc != 4) { 303 printf("usage: preauth_test <conf> <target MAC address> " 304 "<ifname>\n"); 305 return -1; 306 } 307 308 if (hwaddr_aton(argv[2], bssid)) { 309 printf("Failed to parse target address '%s'.\n", argv[2]); 310 return -1; 311 } 312 313 if (eap_peer_register_methods()) { 314 wpa_printf(MSG_ERROR, "Failed to register EAP methods"); 315 return -1; 316 } 317 318 if (eloop_init(&wpa_s)) { 319 wpa_printf(MSG_ERROR, "Failed to initialize event loop"); 320 return -1; 321 } 322 323 os_memset(&wpa_s, 0, sizeof(wpa_s)); 324 wpa_s.conf = wpa_config_read(argv[1]); 325 if (wpa_s.conf == NULL) { 326 printf("Failed to parse configuration file '%s'.\n", argv[1]); 327 return -1; 328 } 329 if (wpa_s.conf->ssid == NULL) { 330 printf("No networks defined.\n"); 331 return -1; 332 } 333 334 wpa_init_conf(&wpa_s, argv[3]); 335 wpa_s.ctrl_iface = wpa_supplicant_ctrl_iface_init(&wpa_s); 336 if (wpa_s.ctrl_iface == NULL) { 337 printf("Failed to initialize control interface '%s'.\n" 338 "You may have another preauth_test process already " 339 "running or the file was\n" 340 "left by an unclean termination of preauth_test in " 341 "which case you will need\n" 342 "to manually remove this file before starting " 343 "preauth_test again.\n", 344 wpa_s.conf->ctrl_interface); 345 return -1; 346 } 347 if (wpa_supplicant_scard_init(&wpa_s, wpa_s.conf->ssid)) 348 return -1; 349 350 if (rsn_preauth_init(wpa_s.wpa, bssid, &wpa_s.conf->ssid->eap)) 351 return -1; 352 353 eloop_register_timeout(30, 0, eapol_test_timeout, &preauth_test, NULL); 354 eloop_register_timeout(0, 100000, eapol_test_poll, &wpa_s, NULL); 355 eloop_register_signal_terminate(eapol_test_terminate, NULL); 356 eloop_register_signal_reconfig(eapol_test_terminate, NULL); 357 eloop_run(); 358 359 if (preauth_test.auth_timed_out) 360 ret = -2; 361 else { 362 ret = pmksa_cache_set_current(wpa_s.wpa, NULL, bssid, NULL, 0) 363 ? 0 : -3; 364 } 365 366 test_eapol_clean(&wpa_s); 367 368 eap_peer_unregister_methods(); 369 370 eloop_destroy(); 371 372 os_program_deinit(); 373 374 return ret; 375 } 376