git.maemo.org Git - wpasupplicant/blob - hostapd/driver_test.c

   1 /*
   2  * hostapd / Driver interface for development testing
   3  * Copyright (c) 2004-2008, Jouni Malinen <j@w1.fi>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License version 2 as
   7  * published by the Free Software Foundation.
   8  *
   9  * Alternatively, this software may be distributed under the terms of BSD
  10  * license.
  11  *
  12  * See README and COPYING for more details.
  13  */
  14
  15 #include "includes.h"
  16 #include <sys/un.h>
  17 #include <dirent.h>
  18
  19 #include "hostapd.h"
  20 #include "driver.h"
  21 #include "sha1.h"
  22 #include "eloop.h"
  23 #include "wpa.h"
  24 #include "l2_packet/l2_packet.h"
  25 #include "hw_features.h"
  26 #include "wps_hostapd.h"
  27
  28
  29 struct test_client_socket {
  30         struct test_client_socket *next;
  31         u8 addr[ETH_ALEN];
  32         struct sockaddr_un un;
  33         socklen_t unlen;
  34         struct test_driver_bss *bss;
  35 };
  36
  37 struct test_driver_bss {
  38         struct test_driver_bss *next;
  39         char ifname[IFNAMSIZ + 1];
  40         u8 bssid[ETH_ALEN];
  41         u8 *ie;
  42         size_t ielen;
  43         u8 *wps_beacon_ie;
  44         size_t wps_beacon_ie_len;
  45         u8 *wps_probe_resp_ie;
  46         size_t wps_probe_resp_ie_len;
  47         u8 ssid[32];
  48         size_t ssid_len;
  49         int privacy;
  50 };
  51
  52 struct test_driver_data {
  53         struct hostapd_data *hapd;
  54         struct test_client_socket *cli;
  55         int test_socket;
  56         struct test_driver_bss *bss;
  57         char *socket_dir;
  58         char *own_socket_path;
  59         int udp_port;
  60 };
  61
  62
  63 static void test_driver_free_bss(struct test_driver_bss *bss)
  64 {
  65         free(bss->ie);
  66         free(bss->wps_beacon_ie);
  67         free(bss->wps_probe_resp_ie);
  68         free(bss);
  69 }
  70
  71
  72 static void test_driver_free_priv(struct test_driver_data *drv)
  73 {
  74         struct test_driver_bss *bss, *prev;
  75
  76         if (drv == NULL)
  77                 return;
  78
  79         bss = drv->bss;
  80         while (bss) {
  81                 prev = bss;
  82                 bss = bss->next;
  83                 test_driver_free_bss(prev);
  84         }
  85         free(drv->own_socket_path);
  86         free(drv->socket_dir);
  87         free(drv);
  88 }
  89
  90
  91 static struct test_client_socket *
  92 test_driver_get_cli(struct test_driver_data *drv, struct sockaddr_un *from,
  93                     socklen_t fromlen)
  94 {
  95         struct test_client_socket *cli = drv->cli;
  96
  97         while (cli) {
  98                 if (cli->unlen == fromlen &&
  99                     strncmp(cli->un.sun_path, from->sun_path,
 100                             fromlen - sizeof(cli->un.sun_family)) == 0)
 101                         return cli;
 102                 cli = cli->next;
 103         }
 104
 105         return NULL;
 106 }
 107
 108
 109 static int test_driver_send_eapol(void *priv, const u8 *addr, const u8 *data,
 110                                   size_t data_len, int encrypt,
 111                                   const u8 *own_addr)
 112 {
 113         struct test_driver_data *drv = priv;
 114         struct test_client_socket *cli;
 115         struct msghdr msg;
 116         struct iovec io[3];
 117         struct l2_ethhdr eth;
 118
 119         if (drv->test_socket < 0)
 120                 return -1;
 121
 122         cli = drv->cli;
 123         while (cli) {
 124                 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
 125                         break;
 126                 cli = cli->next;
 127         }
 128
 129         if (!cli) {
 130                 wpa_printf(MSG_DEBUG, "%s: no destination client entry",
 131                            __func__);
 132                 return -1;
 133         }
 134
 135         memcpy(eth.h_dest, addr, ETH_ALEN);
 136         memcpy(eth.h_source, own_addr, ETH_ALEN);
 137         eth.h_proto = host_to_be16(ETH_P_EAPOL);
 138
 139         io[0].iov_base = "EAPOL ";
 140         io[0].iov_len = 6;
 141         io[1].iov_base = &eth;
 142         io[1].iov_len = sizeof(eth);
 143         io[2].iov_base = (u8 *) data;
 144         io[2].iov_len = data_len;
 145
 146         memset(&msg, 0, sizeof(msg));
 147         msg.msg_iov = io;
 148         msg.msg_iovlen = 3;
 149         msg.msg_name = &cli->un;
 150         msg.msg_namelen = cli->unlen;
 151         return sendmsg(drv->test_socket, &msg, 0);
 152 }
 153
 154
 155 static int test_driver_send_ether(void *priv, const u8 *dst, const u8 *src,
 156                                   u16 proto, const u8 *data, size_t data_len)
 157 {
 158         struct test_driver_data *drv = priv;
 159         struct msghdr msg;
 160         struct iovec io[3];
 161         struct l2_ethhdr eth;
 162         char desttxt[30];
 163         struct sockaddr_un addr;
 164         struct dirent *dent;
 165         DIR *dir;
 166         int ret = 0, broadcast = 0, count = 0;
 167
 168         if (drv->test_socket < 0 || drv->socket_dir == NULL) {
 169                 wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d "
 170                            "socket_dir=%p)",
 171                            __func__, drv->test_socket, drv->socket_dir);
 172                 return -1;
 173         }
 174
 175         broadcast = memcmp(dst, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0;
 176         snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dst));
 177
 178         memcpy(eth.h_dest, dst, ETH_ALEN);
 179         memcpy(eth.h_source, src, ETH_ALEN);
 180         eth.h_proto = host_to_be16(proto);
 181
 182         io[0].iov_base = "ETHER ";
 183         io[0].iov_len = 6;
 184         io[1].iov_base = &eth;
 185         io[1].iov_len = sizeof(eth);
 186         io[2].iov_base = (u8 *) data;
 187         io[2].iov_len = data_len;
 188
 189         memset(&msg, 0, sizeof(msg));
 190         msg.msg_iov = io;
 191         msg.msg_iovlen = 3;
 192
 193         dir = opendir(drv->socket_dir);
 194         if (dir == NULL) {
 195                 perror("test_driver: opendir");
 196                 return -1;
 197         }
 198         while ((dent = readdir(dir))) {
 199 #ifdef _DIRENT_HAVE_D_TYPE
 200                 /* Skip the file if it is not a socket. Also accept
 201                  * DT_UNKNOWN (0) in case the C library or underlying file
 202                  * system does not support d_type. */
 203                 if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN)
 204                         continue;
 205 #endif /* _DIRENT_HAVE_D_TYPE */
 206                 if (strcmp(dent->d_name, ".") == 0 ||
 207                     strcmp(dent->d_name, "..") == 0)
 208                         continue;
 209
 210                 memset(&addr, 0, sizeof(addr));
 211                 addr.sun_family = AF_UNIX;
 212                 snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s",
 213                          drv->socket_dir, dent->d_name);
 214
 215                 if (strcmp(addr.sun_path, drv->own_socket_path) == 0)
 216                         continue;
 217                 if (!broadcast && strstr(dent->d_name, desttxt) == NULL)
 218                         continue;
 219
 220                 wpa_printf(MSG_DEBUG, "%s: Send ether frame to %s",
 221                            __func__, dent->d_name);
 222
 223                 msg.msg_name = &addr;
 224                 msg.msg_namelen = sizeof(addr);
 225                 ret = sendmsg(drv->test_socket, &msg, 0);
 226                 if (ret < 0)
 227                         perror("driver_test: sendmsg");
 228                 count++;
 229         }
 230         closedir(dir);
 231
 232         if (!broadcast && count == 0) {
 233                 wpa_printf(MSG_DEBUG, "%s: Destination " MACSTR " not found",
 234                            __func__, MAC2STR(dst));
 235                 return -1;
 236         }
 237
 238         return ret;
 239 }
 240
 241
 242 static int test_driver_send_mgmt_frame(void *priv, const void *buf,
 243                                        size_t len, int flags)
 244 {
 245         struct test_driver_data *drv = priv;
 246         struct msghdr msg;
 247         struct iovec io[2];
 248         const u8 *dest;
 249         int ret = 0, broadcast = 0;
 250         char desttxt[30];
 251         struct sockaddr_un addr;
 252         struct dirent *dent;
 253         DIR *dir;
 254         struct ieee80211_hdr *hdr;
 255         u16 fc;
 256
 257         if (drv->test_socket < 0 || len < 10 || drv->socket_dir == NULL) {
 258                 wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d len=%lu"
 259                            " socket_dir=%p)",
 260                            __func__, drv->test_socket, (unsigned long) len,
 261                            drv->socket_dir);
 262                 return -1;
 263         }
 264
 265         dest = buf;
 266         dest += 4;
 267         broadcast = memcmp(dest, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0;
 268         snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dest));
 269
 270         io[0].iov_base = "MLME ";
 271         io[0].iov_len = 5;
 272         io[1].iov_base = (void *) buf;
 273         io[1].iov_len = len;
 274
 275         memset(&msg, 0, sizeof(msg));
 276         msg.msg_iov = io;
 277         msg.msg_iovlen = 2;
 278
 279         dir = opendir(drv->socket_dir);
 280         if (dir == NULL) {
 281                 perror("test_driver: opendir");
 282                 return -1;
 283         }
 284         while ((dent = readdir(dir))) {
 285 #ifdef _DIRENT_HAVE_D_TYPE
 286                 /* Skip the file if it is not a socket. Also accept
 287                  * DT_UNKNOWN (0) in case the C library or underlying file
 288                  * system does not support d_type. */
 289                 if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN)
 290                         continue;
 291 #endif /* _DIRENT_HAVE_D_TYPE */
 292                 if (strcmp(dent->d_name, ".") == 0 ||
 293                     strcmp(dent->d_name, "..") == 0)
 294                         continue;
 295
 296                 memset(&addr, 0, sizeof(addr));
 297                 addr.sun_family = AF_UNIX;
 298                 snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s",
 299                          drv->socket_dir, dent->d_name);
 300
 301                 if (strcmp(addr.sun_path, drv->own_socket_path) == 0)
 302                         continue;
 303                 if (!broadcast && strstr(dent->d_name, desttxt) == NULL)
 304                         continue;
 305
 306                 wpa_printf(MSG_DEBUG, "%s: Send management frame to %s",
 307                            __func__, dent->d_name);
 308
 309                 msg.msg_name = &addr;
 310                 msg.msg_namelen = sizeof(addr);
 311                 ret = sendmsg(drv->test_socket, &msg, 0);
 312                 if (ret < 0)
 313                         perror("driver_test: sendmsg");
 314         }
 315         closedir(dir);
 316
 317         hdr = (struct ieee80211_hdr *) buf;
 318         fc = le_to_host16(hdr->frame_control);
 319         hostapd_mgmt_tx_cb(drv->hapd, (u8 *) buf, len, WLAN_FC_GET_STYPE(fc),
 320                            ret >= 0);
 321
 322         return ret;
 323 }
 324
 325
 326 static void test_driver_scan(struct test_driver_data *drv,
 327                              struct sockaddr_un *from, socklen_t fromlen,
 328                              char *data)
 329 {
 330         char buf[512], *pos, *end;
 331         int ret;
 332         struct test_driver_bss *bss;
 333         u8 sa[ETH_ALEN];
 334         u8 ie[512];
 335         size_t ielen;
 336
 337         /* data: optional [ ' ' | STA-addr | ' ' | IEs(hex) ] */
 338
 339         wpa_printf(MSG_DEBUG, "test_driver: SCAN");
 340
 341         if (*data) {
 342                 if (*data != ' ' ||
 343                     hwaddr_aton(data + 1, sa)) {
 344                         wpa_printf(MSG_DEBUG, "test_driver: Unexpected SCAN "
 345                                    "command format");
 346                         return;
 347                 }
 348
 349                 data += 18;
 350                 while (*data == ' ')
 351                         data++;
 352                 ielen = os_strlen(data) / 2;
 353                 if (ielen > sizeof(ie))
 354                         ielen = sizeof(ie);
 355                 if (hexstr2bin(data, ie, ielen) < 0)
 356                         ielen = 0;
 357
 358                 wpa_printf(MSG_DEBUG, "test_driver: Scan from " MACSTR,
 359                            MAC2STR(sa));
 360                 wpa_hexdump(MSG_MSGDUMP, "test_driver: scan IEs", ie, ielen);
 361
 362                 hostapd_wps_probe_req_rx(drv->hapd, sa, ie, ielen);
 363         }
 364
 365         for (bss = drv->bss; bss; bss = bss->next) {
 366                 pos = buf;
 367                 end = buf + sizeof(buf);
 368
 369                 /* reply: SCANRESP BSSID SSID IEs */
 370                 ret = snprintf(pos, end - pos, "SCANRESP " MACSTR " ",
 371                                MAC2STR(bss->bssid));
 372                 if (ret < 0 || ret >= end - pos)
 373                         return;
 374                 pos += ret;
 375                 pos += wpa_snprintf_hex(pos, end - pos,
 376                                         bss->ssid, bss->ssid_len);
 377                 ret = snprintf(pos, end - pos, " ");
 378                 if (ret < 0 || ret >= end - pos)
 379                         return;
 380                 pos += ret;
 381                 pos += wpa_snprintf_hex(pos, end - pos, bss->ie, bss->ielen);
 382                 pos += wpa_snprintf_hex(pos, end - pos, bss->wps_probe_resp_ie,
 383                                         bss->wps_probe_resp_ie_len);
 384
 385                 if (bss->privacy) {
 386                         ret = snprintf(pos, end - pos, " PRIVACY");
 387                         if (ret < 0 || ret >= end - pos)
 388                                 return;
 389                         pos += ret;
 390                 }
 391
 392                 sendto(drv->test_socket, buf, pos - buf, 0,
 393                        (struct sockaddr *) from, fromlen);
 394         }
 395 }
 396
 397
 398 static struct hostapd_data * test_driver_get_hapd(struct test_driver_data *drv,
 399                                                   struct test_driver_bss *bss)
 400 {
 401         struct hostapd_iface *iface = drv->hapd->iface;
 402         struct hostapd_data *hapd = NULL;
 403         size_t i;
 404
 405         if (bss == NULL) {
 406                 wpa_printf(MSG_DEBUG, "%s: bss == NULL", __func__);
 407                 return NULL;
 408         }
 409
 410         for (i = 0; i < iface->num_bss; i++) {
 411                 hapd = iface->bss[i];
 412                 if (memcmp(hapd->own_addr, bss->bssid, ETH_ALEN) == 0)
 413                         break;
 414         }
 415         if (i == iface->num_bss) {
 416                 wpa_printf(MSG_DEBUG, "%s: no matching interface entry found "
 417                            "for BSSID " MACSTR, __func__, MAC2STR(bss->bssid));
 418                 return NULL;
 419         }
 420
 421         return hapd;
 422 }
 423
 424
 425 static int test_driver_new_sta(struct test_driver_data *drv,
 426                                struct test_driver_bss *bss, const u8 *addr,
 427                                const u8 *ie, size_t ielen)
 428 {
 429         struct hostapd_data *hapd;
 430
 431         hapd = test_driver_get_hapd(drv, bss);
 432         if (hapd == NULL)
 433                 return -1;
 434
 435         return hostapd_notif_assoc(hapd, addr, ie, ielen);
 436 }
 437
 438
 439 static void test_driver_assoc(struct test_driver_data *drv,
 440                               struct sockaddr_un *from, socklen_t fromlen,
 441                               char *data)
 442 {
 443         struct test_client_socket *cli;
 444         u8 ie[256], ssid[32];
 445         size_t ielen, ssid_len = 0;
 446         char *pos, *pos2, cmd[50];
 447         struct test_driver_bss *bss;
 448
 449         /* data: STA-addr SSID(hex) IEs(hex) */
 450
 451         cli = os_zalloc(sizeof(*cli));
 452         if (cli == NULL)
 453                 return;
 454
 455         if (hwaddr_aton(data, cli->addr)) {
 456                 printf("test_socket: Invalid MAC address '%s' in ASSOC\n",
 457                        data);
 458                 free(cli);
 459                 return;
 460         }
 461         pos = data + 17;
 462         while (*pos == ' ')
 463                 pos++;
 464         pos2 = strchr(pos, ' ');
 465         ielen = 0;
 466         if (pos2) {
 467                 ssid_len = (pos2 - pos) / 2;
 468                 if (hexstr2bin(pos, ssid, ssid_len) < 0) {
 469                         wpa_printf(MSG_DEBUG, "%s: Invalid SSID", __func__);
 470                         free(cli);
 471                         return;
 472                 }
 473                 wpa_hexdump_ascii(MSG_DEBUG, "test_driver_assoc: SSID",
 474                                   ssid, ssid_len);
 475
 476                 pos = pos2 + 1;
 477                 ielen = strlen(pos) / 2;
 478                 if (ielen > sizeof(ie))
 479                         ielen = sizeof(ie);
 480                 if (hexstr2bin(pos, ie, ielen) < 0)
 481                         ielen = 0;
 482         }
 483
 484         for (bss = drv->bss; bss; bss = bss->next) {
 485                 if (bss->ssid_len == ssid_len &&
 486                     memcmp(bss->ssid, ssid, ssid_len) == 0)
 487                         break;
 488         }
 489         if (bss == NULL) {
 490                 wpa_printf(MSG_DEBUG, "%s: No matching SSID found from "
 491                            "configured BSSes", __func__);
 492                 free(cli);
 493                 return;
 494         }
 495
 496         cli->bss = bss;
 497         memcpy(&cli->un, from, sizeof(cli->un));
 498         cli->unlen = fromlen;
 499         cli->next = drv->cli;
 500         drv->cli = cli;
 501         wpa_hexdump_ascii(MSG_DEBUG, "test_socket: ASSOC sun_path",
 502                           (const u8 *) cli->un.sun_path,
 503                           cli->unlen - sizeof(cli->un.sun_family));
 504
 505         snprintf(cmd, sizeof(cmd), "ASSOCRESP " MACSTR " 0",
 506                  MAC2STR(bss->bssid));
 507         sendto(drv->test_socket, cmd, strlen(cmd), 0,
 508                (struct sockaddr *) from, fromlen);
 509
 510         if (test_driver_new_sta(drv, bss, cli->addr, ie, ielen) < 0) {
 511                 wpa_printf(MSG_DEBUG, "test_driver: failed to add new STA");
 512         }
 513 }
 514
 515
 516 static void test_driver_disassoc(struct test_driver_data *drv,
 517                                  struct sockaddr_un *from, socklen_t fromlen)
 518 {
 519         struct test_client_socket *cli;
 520
 521         cli = test_driver_get_cli(drv, from, fromlen);
 522         if (!cli)
 523                 return;
 524
 525         hostapd_notif_disassoc(drv->hapd, cli->addr);
 526 }
 527
 528
 529 static void test_driver_eapol(struct test_driver_data *drv,
 530                               struct sockaddr_un *from, socklen_t fromlen,
 531                               u8 *data, size_t datalen)
 532 {
 533         struct test_client_socket *cli;
 534         if (datalen > 14) {
 535                 /* Skip Ethernet header */
 536                 wpa_printf(MSG_DEBUG, "test_driver: dst=" MACSTR " src="
 537                            MACSTR " proto=%04x",
 538                            MAC2STR(data), MAC2STR(data + ETH_ALEN),
 539                            WPA_GET_BE16(data + 2 * ETH_ALEN));
 540                 data += 14;
 541                 datalen -= 14;
 542         }
 543         cli = test_driver_get_cli(drv, from, fromlen);
 544         if (cli) {
 545                 struct hostapd_data *hapd;
 546                 hapd = test_driver_get_hapd(drv, cli->bss);
 547                 if (hapd == NULL)
 548                         return;
 549                 hostapd_eapol_receive(hapd, cli->addr, data, datalen);
 550         } else {
 551                 wpa_printf(MSG_DEBUG, "test_socket: EAPOL from unknown "
 552                            "client");
 553         }
 554 }
 555
 556
 557 static void test_driver_ether(struct test_driver_data *drv,
 558                               struct sockaddr_un *from, socklen_t fromlen,
 559                               u8 *data, size_t datalen)
 560 {
 561         struct l2_ethhdr *eth;
 562
 563         if (datalen < sizeof(*eth))
 564                 return;
 565
 566         eth = (struct l2_ethhdr *) data;
 567         wpa_printf(MSG_DEBUG, "test_driver: RX ETHER dst=" MACSTR " src="
 568                    MACSTR " proto=%04x",
 569                    MAC2STR(eth->h_dest), MAC2STR(eth->h_source),
 570                    be_to_host16(eth->h_proto));
 571
 572 #ifdef CONFIG_IEEE80211R
 573         if (be_to_host16(eth->h_proto) == ETH_P_RRB) {
 574                 wpa_ft_rrb_rx(drv->hapd->wpa_auth, eth->h_source,
 575                               data + sizeof(*eth), datalen - sizeof(*eth));
 576         }
 577 #endif /* CONFIG_IEEE80211R */
 578 }
 579
 580
 581 static void test_driver_mlme(struct test_driver_data *drv,
 582                              struct sockaddr_un *from, socklen_t fromlen,
 583                              u8 *data, size_t datalen)
 584 {
 585         struct ieee80211_hdr *hdr;
 586         u16 fc;
 587
 588         hdr = (struct ieee80211_hdr *) data;
 589
 590         if (test_driver_get_cli(drv, from, fromlen) == NULL && datalen >= 16) {
 591                 struct test_client_socket *cli;
 592                 cli = os_zalloc(sizeof(*cli));
 593                 if (cli == NULL)
 594                         return;
 595                 wpa_printf(MSG_DEBUG, "Adding client entry for " MACSTR,
 596                            MAC2STR(hdr->addr2));
 597                 memcpy(cli->addr, hdr->addr2, ETH_ALEN);
 598                 memcpy(&cli->un, from, sizeof(cli->un));
 599                 cli->unlen = fromlen;
 600                 cli->next = drv->cli;
 601                 drv->cli = cli;
 602         }
 603
 604         wpa_hexdump(MSG_MSGDUMP, "test_driver_mlme: received frame",
 605                     data, datalen);
 606         fc = le_to_host16(hdr->frame_control);
 607         if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) {
 608                 wpa_printf(MSG_ERROR, "%s: received non-mgmt frame",
 609                            __func__);
 610                 return;
 611         }
 612         hostapd_mgmt_rx(drv->hapd, data, datalen, WLAN_FC_GET_STYPE(fc), NULL);
 613 }
 614
 615
 616 static void test_driver_receive_unix(int sock, void *eloop_ctx, void *sock_ctx)
 617 {
 618         struct test_driver_data *drv = eloop_ctx;
 619         char buf[2000];
 620         int res;
 621         struct sockaddr_un from;
 622         socklen_t fromlen = sizeof(from);
 623
 624         res = recvfrom(sock, buf, sizeof(buf) - 1, 0,
 625                        (struct sockaddr *) &from, &fromlen);
 626         if (res < 0) {
 627                 perror("recvfrom(test_socket)");
 628                 return;
 629         }
 630         buf[res] = '\0';
 631
 632         wpa_printf(MSG_DEBUG, "test_driver: received %u bytes", res);
 633
 634         if (strncmp(buf, "SCAN", 4) == 0) {
 635                 test_driver_scan(drv, &from, fromlen, buf + 4);
 636         } else if (strncmp(buf, "ASSOC ", 6) == 0) {
 637                 test_driver_assoc(drv, &from, fromlen, buf + 6);
 638         } else if (strcmp(buf, "DISASSOC") == 0) {
 639                 test_driver_disassoc(drv, &from, fromlen);
 640         } else if (strncmp(buf, "EAPOL ", 6) == 0) {
 641                 test_driver_eapol(drv, &from, fromlen, (u8 *) buf + 6,
 642                                   res - 6);
 643         } else if (strncmp(buf, "ETHER ", 6) == 0) {
 644                 test_driver_ether(drv, &from, fromlen, (u8 *) buf + 6,
 645                                   res - 6);
 646         } else if (strncmp(buf, "MLME ", 5) == 0) {
 647                 test_driver_mlme(drv, &from, fromlen, (u8 *) buf + 5, res - 5);
 648         } else {
 649                 wpa_hexdump_ascii(MSG_DEBUG, "Unknown test_socket command",
 650                                   (u8 *) buf, res);
 651         }
 652 }
 653
 654
 655 static struct test_driver_bss *
 656 test_driver_get_bss(struct test_driver_data *drv, const char *ifname)
 657 {
 658         struct test_driver_bss *bss;
 659
 660         for (bss = drv->bss; bss; bss = bss->next) {
 661                 if (strcmp(bss->ifname, ifname) == 0)
 662                         return bss;
 663         }
 664         return NULL;
 665 }
 666
 667
 668 static int test_driver_set_generic_elem(const char *ifname, void *priv,
 669                                         const u8 *elem, size_t elem_len)
 670 {
 671         struct test_driver_data *drv = priv;
 672         struct test_driver_bss *bss;
 673
 674         bss = test_driver_get_bss(drv, ifname);
 675         if (bss == NULL)
 676                 return -1;
 677
 678         free(bss->ie);
 679
 680         if (elem == NULL) {
 681                 bss->ie = NULL;
 682                 bss->ielen = 0;
 683                 return 0;
 684         }
 685
 686         bss->ie = malloc(elem_len);
 687         if (bss->ie == NULL) {
 688                 bss->ielen = 0;
 689                 return -1;
 690         }
 691
 692         memcpy(bss->ie, elem, elem_len);
 693         bss->ielen = elem_len;
 694         return 0;
 695 }
 696
 697
 698 static int test_driver_set_wps_beacon_ie(const char *ifname, void *priv,
 699                                          const u8 *ie, size_t len)
 700 {
 701         struct test_driver_data *drv = priv;
 702         struct test_driver_bss *bss;
 703
 704         wpa_hexdump(MSG_DEBUG, "test_driver: Beacon WPS IE", ie, len);
 705         bss = test_driver_get_bss(drv, ifname);
 706         if (bss == NULL)
 707                 return -1;
 708
 709         free(bss->wps_beacon_ie);
 710
 711         if (ie == NULL) {
 712                 bss->wps_beacon_ie = NULL;
 713                 bss->wps_beacon_ie_len = 0;
 714                 return 0;
 715         }
 716
 717         bss->wps_beacon_ie = malloc(len);
 718         if (bss->wps_beacon_ie == NULL) {
 719                 bss->wps_beacon_ie_len = 0;
 720                 return -1;
 721         }
 722
 723         memcpy(bss->wps_beacon_ie, ie, len);
 724         bss->wps_beacon_ie_len = len;
 725         return 0;
 726 }
 727
 728
 729 static int test_driver_set_wps_probe_resp_ie(const char *ifname, void *priv,
 730                                              const u8 *ie, size_t len)
 731 {
 732         struct test_driver_data *drv = priv;
 733         struct test_driver_bss *bss;
 734
 735         wpa_hexdump(MSG_DEBUG, "test_driver: ProbeResp WPS IE", ie, len);
 736         bss = test_driver_get_bss(drv, ifname);
 737         if (bss == NULL)
 738                 return -1;
 739
 740         free(bss->wps_probe_resp_ie);
 741
 742         if (ie == NULL) {
 743                 bss->wps_probe_resp_ie = NULL;
 744                 bss->wps_probe_resp_ie_len = 0;
 745                 return 0;
 746         }
 747
 748         bss->wps_probe_resp_ie = malloc(len);
 749         if (bss->wps_probe_resp_ie == NULL) {
 750                 bss->wps_probe_resp_ie_len = 0;
 751                 return -1;
 752         }
 753
 754         memcpy(bss->wps_probe_resp_ie, ie, len);
 755         bss->wps_probe_resp_ie_len = len;
 756         return 0;
 757 }
 758
 759
 760 static int test_driver_sta_deauth(void *priv, const u8 *addr, int reason)
 761 {
 762         struct test_driver_data *drv = priv;
 763         struct test_client_socket *cli;
 764
 765         if (drv->test_socket < 0)
 766                 return -1;
 767
 768         cli = drv->cli;
 769         while (cli) {
 770                 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
 771                         break;
 772                 cli = cli->next;
 773         }
 774
 775         if (!cli)
 776                 return -1;
 777
 778         return sendto(drv->test_socket, "DEAUTH", 6, 0,
 779                       (struct sockaddr *) &cli->un, cli->unlen);
 780 }
 781
 782
 783 static int test_driver_sta_disassoc(void *priv, const u8 *addr, int reason)
 784 {
 785         struct test_driver_data *drv = priv;
 786         struct test_client_socket *cli;
 787
 788         if (drv->test_socket < 0)
 789                 return -1;
 790
 791         cli = drv->cli;
 792         while (cli) {
 793                 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
 794                         break;
 795                 cli = cli->next;
 796         }
 797
 798         if (!cli)
 799                 return -1;
 800
 801         return sendto(drv->test_socket, "DISASSOC", 8, 0,
 802                       (struct sockaddr *) &cli->un, cli->unlen);
 803 }
 804
 805
 806 static struct hostapd_hw_modes *
 807 test_driver_get_hw_feature_data(void *priv, u16 *num_modes, u16 *flags)
 808 {
 809         struct hostapd_hw_modes *modes;
 810
 811         *num_modes = 3;
 812         *flags = 0;
 813         modes = os_zalloc(*num_modes * sizeof(struct hostapd_hw_modes));
 814         if (modes == NULL)
 815                 return NULL;
 816         modes[0].mode = HOSTAPD_MODE_IEEE80211G;
 817         modes[0].num_channels = 1;
 818         modes[0].num_rates = 1;
 819         modes[0].channels = os_zalloc(sizeof(struct hostapd_channel_data));
 820         modes[0].rates = os_zalloc(sizeof(struct hostapd_rate_data));
 821         if (modes[0].channels == NULL || modes[0].rates == NULL) {
 822                 hostapd_free_hw_features(modes, *num_modes);
 823                 return NULL;
 824         }
 825         modes[0].channels[0].chan = 1;
 826         modes[0].channels[0].freq = 2412;
 827         modes[0].channels[0].flag = 0;
 828         modes[0].rates[0].rate = 10;
 829         modes[0].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
 830                 HOSTAPD_RATE_CCK | HOSTAPD_RATE_MANDATORY;
 831
 832         modes[1].mode = HOSTAPD_MODE_IEEE80211B;
 833         modes[1].num_channels = 1;
 834         modes[1].num_rates = 1;
 835         modes[1].channels = os_zalloc(sizeof(struct hostapd_channel_data));
 836         modes[1].rates = os_zalloc(sizeof(struct hostapd_rate_data));
 837         if (modes[1].channels == NULL || modes[1].rates == NULL) {
 838                 hostapd_free_hw_features(modes, *num_modes);
 839                 return NULL;
 840         }
 841         modes[1].channels[0].chan = 1;
 842         modes[1].channels[0].freq = 2412;
 843         modes[1].channels[0].flag = 0;
 844         modes[1].rates[0].rate = 10;
 845         modes[1].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
 846                 HOSTAPD_RATE_CCK | HOSTAPD_RATE_MANDATORY;
 847
 848         modes[2].mode = HOSTAPD_MODE_IEEE80211A;
 849         modes[2].num_channels = 1;
 850         modes[2].num_rates = 1;
 851         modes[2].channels = os_zalloc(sizeof(struct hostapd_channel_data));
 852         modes[2].rates = os_zalloc(sizeof(struct hostapd_rate_data));
 853         if (modes[2].channels == NULL || modes[2].rates == NULL) {
 854                 hostapd_free_hw_features(modes, *num_modes);
 855                 return NULL;
 856         }
 857         modes[2].channels[0].chan = 60;
 858         modes[2].channels[0].freq = 5300;
 859         modes[2].channels[0].flag = 0;
 860         modes[2].rates[0].rate = 60;
 861         modes[2].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
 862                 HOSTAPD_RATE_MANDATORY;
 863
 864         return modes;
 865 }
 866
 867
 868 static int test_driver_bss_add(void *priv, const char *ifname, const u8 *bssid)
 869 {
 870         struct test_driver_data *drv = priv;
 871         struct test_driver_bss *bss;
 872
 873         wpa_printf(MSG_DEBUG, "%s(ifname=%s bssid=" MACSTR ")",
 874                    __func__, ifname, MAC2STR(bssid));
 875
 876         bss = os_zalloc(sizeof(*bss));
 877         if (bss == NULL)
 878                 return -1;
 879
 880         os_strlcpy(bss->ifname, ifname, IFNAMSIZ);
 881         memcpy(bss->bssid, bssid, ETH_ALEN);
 882
 883         bss->next = drv->bss;
 884         drv->bss = bss;
 885
 886         return 0;
 887 }
 888
 889
 890 static int test_driver_bss_remove(void *priv, const char *ifname)
 891 {
 892         struct test_driver_data *drv = priv;
 893         struct test_driver_bss *bss, *prev;
 894         struct test_client_socket *cli, *prev_c;
 895
 896         wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, ifname);
 897
 898         for (prev = NULL, bss = drv->bss; bss; prev = bss, bss = bss->next) {
 899                 if (strcmp(bss->ifname, ifname) != 0)
 900                         continue;
 901
 902                 if (prev)
 903                         prev->next = bss->next;
 904                 else
 905                         drv->bss = bss->next;
 906
 907                 for (prev_c = NULL, cli = drv->cli; cli;
 908                      prev_c = cli, cli = cli->next) {
 909                         if (cli->bss != bss)
 910                                 continue;
 911                         if (prev_c)
 912                                 prev_c->next = cli->next;
 913                         else
 914                                 drv->cli = cli->next;
 915                         free(cli);
 916                         break;
 917                 }
 918
 919                 test_driver_free_bss(bss);
 920                 return 0;
 921         }
 922
 923         return -1;
 924 }
 925
 926
 927 static int test_driver_if_add(const char *iface, void *priv,
 928                               enum hostapd_driver_if_type type, char *ifname,
 929                               const u8 *addr)
 930 {
 931         wpa_printf(MSG_DEBUG, "%s(iface=%s type=%d ifname=%s)",
 932                    __func__, iface, type, ifname);
 933         return 0;
 934 }
 935
 936
 937 static int test_driver_if_update(void *priv, enum hostapd_driver_if_type type,
 938                                  char *ifname, const u8 *addr)
 939 {
 940         wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s)", __func__, type, ifname);
 941         return 0;
 942 }
 943
 944
 945 static int test_driver_if_remove(void *priv, enum hostapd_driver_if_type type,
 946                                  const char *ifname, const u8 *addr)
 947 {
 948         wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s)", __func__, type, ifname);
 949         return 0;
 950 }
 951
 952
 953 static int test_driver_valid_bss_mask(void *priv, const u8 *addr,
 954                                       const u8 *mask)
 955 {
 956         return 0;
 957 }
 958
 959
 960 static int test_driver_set_ssid(const char *ifname, void *priv, const u8 *buf,
 961                                 int len)
 962 {
 963         struct test_driver_data *drv = priv;
 964         struct test_driver_bss *bss;
 965
 966         wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, ifname);
 967         wpa_hexdump_ascii(MSG_DEBUG, "test_driver_set_ssid: SSID", buf, len);
 968
 969         for (bss = drv->bss; bss; bss = bss->next) {
 970                 if (strcmp(bss->ifname, ifname) != 0)
 971                         continue;
 972
 973                 if (len < 0 || (size_t) len > sizeof(bss->ssid))
 974                         return -1;
 975
 976                 memcpy(bss->ssid, buf, len);
 977                 bss->ssid_len = len;
 978
 979                 return 0;
 980         }
 981
 982         return -1;
 983 }
 984
 985
 986 static int test_driver_set_privacy(const char *ifname, void *priv, int enabled)
 987 {
 988         struct test_driver_data *drv = priv;
 989         struct test_driver_bss *bss;
 990
 991         wpa_printf(MSG_DEBUG, "%s(ifname=%s enabled=%d)",
 992                    __func__, ifname, enabled);
 993
 994         for (bss = drv->bss; bss; bss = bss->next) {
 995                 if (strcmp(bss->ifname, ifname) != 0)
 996                         continue;
 997
 998                 bss->privacy = enabled;
 999
1000                 return 0;
1001         }
1002
1003         return -1;
1004 }
1005
1006
1007 static int test_driver_set_encryption(const char *iface, void *priv,
1008                                       const char *alg, const u8 *addr, int idx,
1009                                       const u8 *key, size_t key_len, int txkey)
1010 {
1011         wpa_printf(MSG_DEBUG, "%s(iface=%s alg=%s idx=%d txkey=%d)",
1012                    __func__, iface, alg, idx, txkey);
1013         if (addr)
1014                 wpa_printf(MSG_DEBUG, "   addr=" MACSTR, MAC2STR(addr));
1015         if (key)
1016                 wpa_hexdump_key(MSG_DEBUG, "   key", key, key_len);
1017         return 0;
1018 }
1019
1020
1021 static int test_driver_set_sta_vlan(void *priv, const u8 *addr,
1022                                     const char *ifname, int vlan_id)
1023 {
1024         wpa_printf(MSG_DEBUG, "%s(addr=" MACSTR " ifname=%s vlan_id=%d)",
1025                    __func__, MAC2STR(addr), ifname, vlan_id);
1026         return 0;
1027 }
1028
1029
1030 static int test_driver_sta_add(const char *ifname, void *priv, const u8 *addr,
1031                                u16 aid, u16 capability, u8 *supp_rates,
1032                                size_t supp_rates_len, int flags,
1033                                u16 listen_interval)
1034 {
1035         struct test_driver_data *drv = priv;
1036         struct test_client_socket *cli;
1037         struct test_driver_bss *bss;
1038
1039         wpa_printf(MSG_DEBUG, "%s(ifname=%s addr=" MACSTR " aid=%d "
1040                    "capability=0x%x flags=0x%x listen_interval=%d)",
1041                    __func__, ifname, MAC2STR(addr), aid, capability, flags,
1042                    listen_interval);
1043         wpa_hexdump(MSG_DEBUG, "test_driver_sta_add - supp_rates",
1044                     supp_rates, supp_rates_len);
1045
1046         cli = drv->cli;
1047         while (cli) {
1048                 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
1049                         break;
1050                 cli = cli->next;
1051         }
1052         if (!cli) {
1053                 wpa_printf(MSG_DEBUG, "%s: no matching client entry",
1054                            __func__);
1055                 return -1;
1056         }
1057
1058         for (bss = drv->bss; bss; bss = bss->next) {
1059                 if (strcmp(ifname, bss->ifname) == 0)
1060                         break;
1061         }
1062         if (bss == NULL) {
1063                 wpa_printf(MSG_DEBUG, "%s: No matching interface found from "
1064                            "configured BSSes", __func__);
1065                 return -1;
1066         }
1067
1068         cli->bss = bss;
1069
1070         return 0;
1071 }
1072
1073
1074 static void * test_driver_init(struct hostapd_data *hapd)
1075 {
1076         struct test_driver_data *drv;
1077         struct sockaddr_un addr_un;
1078         struct sockaddr_in addr_in;
1079         struct sockaddr *addr;
1080         socklen_t alen;
1081
1082         drv = os_zalloc(sizeof(struct test_driver_data));
1083         if (drv == NULL) {
1084                 printf("Could not allocate memory for test driver data\n");
1085                 return NULL;
1086         }
1087         drv->bss = os_zalloc(sizeof(*drv->bss));
1088         if (drv->bss == NULL) {
1089                 printf("Could not allocate memory for test driver BSS data\n");
1090                 free(drv);
1091                 return NULL;
1092         }
1093
1094         drv->hapd = hapd;
1095
1096         /* Generate a MAC address to help testing with multiple APs */
1097         hapd->own_addr[0] = 0x02; /* locally administered */
1098         sha1_prf((const u8 *) hapd->conf->iface, strlen(hapd->conf->iface),
1099                  "hostapd test bssid generation",
1100                  (const u8 *) hapd->conf->ssid.ssid, hapd->conf->ssid.ssid_len,
1101                  hapd->own_addr + 1, ETH_ALEN - 1);
1102
1103         os_strlcpy(drv->bss->ifname, hapd->conf->iface, IFNAMSIZ);
1104         memcpy(drv->bss->bssid, hapd->own_addr, ETH_ALEN);
1105
1106         if (hapd->conf->test_socket) {
1107                 if (strlen(hapd->conf->test_socket) >=
1108                     sizeof(addr_un.sun_path)) {
1109                         printf("Too long test_socket path\n");
1110                         test_driver_free_priv(drv);
1111                         return NULL;
1112                 }
1113                 if (strncmp(hapd->conf->test_socket, "DIR:", 4) == 0) {
1114                         size_t len = strlen(hapd->conf->test_socket) + 30;
1115                         drv->socket_dir = strdup(hapd->conf->test_socket + 4);
1116                         drv->own_socket_path = malloc(len);
1117                         if (drv->own_socket_path) {
1118                                 snprintf(drv->own_socket_path, len,
1119                                          "%s/AP-" MACSTR,
1120                                          hapd->conf->test_socket + 4,
1121                                          MAC2STR(hapd->own_addr));
1122                         }
1123                 } else if (strncmp(hapd->conf->test_socket, "UDP:", 4) == 0) {
1124                         drv->udp_port = atoi(hapd->conf->test_socket + 4);
1125                 } else {
1126                         drv->own_socket_path = strdup(hapd->conf->test_socket);
1127                 }
1128                 if (drv->own_socket_path == NULL && drv->udp_port == 0) {
1129                         test_driver_free_priv(drv);
1130                         return NULL;
1131                 }
1132
1133                 drv->test_socket = socket(drv->udp_port ? PF_INET : PF_UNIX,
1134                                           SOCK_DGRAM, 0);
1135                 if (drv->test_socket < 0) {
1136                         perror("socket");
1137                         test_driver_free_priv(drv);
1138                         return NULL;
1139                 }
1140
1141                 if (drv->udp_port) {
1142                         os_memset(&addr_in, 0, sizeof(addr_in));
1143                         addr_in.sin_family = AF_INET;
1144                         addr_in.sin_port = htons(drv->udp_port);
1145                         addr = (struct sockaddr *) &addr_in;
1146                         alen = sizeof(addr_in);
1147                 } else {
1148                         os_memset(&addr_un, 0, sizeof(addr_un));
1149                         addr_un.sun_family = AF_UNIX;
1150                         os_strlcpy(addr_un.sun_path, drv->own_socket_path,
1151                                    sizeof(addr_un.sun_path));
1152                         addr = (struct sockaddr *) &addr_un;
1153                         alen = sizeof(addr_un);
1154                 }
1155                 if (bind(drv->test_socket, addr, alen) < 0) {
1156                         perror("bind(PF_UNIX)");
1157                         close(drv->test_socket);
1158                         if (drv->own_socket_path)
1159                                 unlink(drv->own_socket_path);
1160                         test_driver_free_priv(drv);
1161                         return NULL;
1162                 }
1163                 eloop_register_read_sock(drv->test_socket,
1164                                          test_driver_receive_unix, drv, NULL);
1165         } else
1166                 drv->test_socket = -1;
1167
1168         return drv;
1169 }
1170
1171
1172 static void test_driver_deinit(void *priv)
1173 {
1174         struct test_driver_data *drv = priv;
1175         struct test_client_socket *cli, *prev;
1176
1177         cli = drv->cli;
1178         while (cli) {
1179                 prev = cli;
1180                 cli = cli->next;
1181                 free(prev);
1182         }
1183
1184         if (drv->test_socket >= 0) {
1185                 eloop_unregister_read_sock(drv->test_socket);
1186                 close(drv->test_socket);
1187                 if (drv->own_socket_path)
1188                         unlink(drv->own_socket_path);
1189         }
1190
1191         /* There should be only one BSS remaining at this point. */
1192         if (drv->bss == NULL)
1193                 wpa_printf(MSG_ERROR, "%s: drv->bss == NULL", __func__);
1194         else if (drv->bss->next)
1195                 wpa_printf(MSG_ERROR, "%s: drv->bss->next != NULL", __func__);
1196
1197         test_driver_free_priv(drv);
1198 }
1199
1200
1201 const struct wpa_driver_ops wpa_driver_test_ops = {
1202         .name = "test",
1203         .init = test_driver_init,
1204         .deinit = test_driver_deinit,
1205         .send_eapol = test_driver_send_eapol,
1206         .send_mgmt_frame = test_driver_send_mgmt_frame,
1207         .set_generic_elem = test_driver_set_generic_elem,
1208         .sta_deauth = test_driver_sta_deauth,
1209         .sta_disassoc = test_driver_sta_disassoc,
1210         .get_hw_feature_data = test_driver_get_hw_feature_data,
1211         .bss_add = test_driver_bss_add,
1212         .bss_remove = test_driver_bss_remove,
1213         .if_add = test_driver_if_add,
1214         .if_update = test_driver_if_update,
1215         .if_remove = test_driver_if_remove,
1216         .valid_bss_mask = test_driver_valid_bss_mask,
1217         .set_ssid = test_driver_set_ssid,
1218         .set_privacy = test_driver_set_privacy,
1219         .set_encryption = test_driver_set_encryption,
1220         .set_sta_vlan = test_driver_set_sta_vlan,
1221         .sta_add = test_driver_sta_add,
1222         .send_ether = test_driver_send_ether,
1223         .set_wps_beacon_ie = test_driver_set_wps_beacon_ie,
1224         .set_wps_probe_resp_ie = test_driver_set_wps_probe_resp_ie,
1225 };