2 * hostapd / Driver interface for development testing
3 * Copyright (c) 2004-2008, Jouni Malinen <j@w1.fi>
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.
9 * Alternatively, this software may be distributed under the terms of BSD
12 * See README and COPYING for more details.
25 #include "l2_packet/l2_packet.h"
26 #include "hw_features.h"
27 #include "wps_hostapd.h"
28 #include "ieee802_11_defs.h"
31 struct test_client_socket {
32 struct test_client_socket *next;
34 struct sockaddr_un un;
36 struct test_driver_bss *bss;
39 struct test_driver_bss {
40 struct test_driver_bss *next;
41 char ifname[IFNAMSIZ + 1];
46 size_t wps_beacon_ie_len;
47 u8 *wps_probe_resp_ie;
48 size_t wps_probe_resp_ie_len;
54 struct test_driver_data {
55 struct hostapd_data *hapd;
56 struct test_client_socket *cli;
58 struct test_driver_bss *bss;
60 char *own_socket_path;
65 static void test_driver_free_bss(struct test_driver_bss *bss)
68 free(bss->wps_beacon_ie);
69 free(bss->wps_probe_resp_ie);
74 static void test_driver_free_priv(struct test_driver_data *drv)
76 struct test_driver_bss *bss, *prev;
85 test_driver_free_bss(prev);
87 free(drv->own_socket_path);
88 free(drv->socket_dir);
93 static struct test_client_socket *
94 test_driver_get_cli(struct test_driver_data *drv, struct sockaddr_un *from,
97 struct test_client_socket *cli = drv->cli;
100 if (cli->unlen == fromlen &&
101 strncmp(cli->un.sun_path, from->sun_path,
102 fromlen - sizeof(cli->un.sun_family)) == 0)
111 static int test_driver_send_eapol(void *priv, const u8 *addr, const u8 *data,
112 size_t data_len, int encrypt,
115 struct test_driver_data *drv = priv;
116 struct test_client_socket *cli;
119 struct l2_ethhdr eth;
121 if (drv->test_socket < 0)
126 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
132 wpa_printf(MSG_DEBUG, "%s: no destination client entry",
137 memcpy(eth.h_dest, addr, ETH_ALEN);
138 memcpy(eth.h_source, own_addr, ETH_ALEN);
139 eth.h_proto = host_to_be16(ETH_P_EAPOL);
141 io[0].iov_base = "EAPOL ";
143 io[1].iov_base = ð
144 io[1].iov_len = sizeof(eth);
145 io[2].iov_base = (u8 *) data;
146 io[2].iov_len = data_len;
148 memset(&msg, 0, sizeof(msg));
151 msg.msg_name = &cli->un;
152 msg.msg_namelen = cli->unlen;
153 return sendmsg(drv->test_socket, &msg, 0);
157 static int test_driver_send_ether(void *priv, const u8 *dst, const u8 *src,
158 u16 proto, const u8 *data, size_t data_len)
160 struct test_driver_data *drv = priv;
163 struct l2_ethhdr eth;
165 struct sockaddr_un addr;
168 int ret = 0, broadcast = 0, count = 0;
170 if (drv->test_socket < 0 || drv->socket_dir == NULL) {
171 wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d "
173 __func__, drv->test_socket, drv->socket_dir);
177 broadcast = memcmp(dst, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0;
178 snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dst));
180 memcpy(eth.h_dest, dst, ETH_ALEN);
181 memcpy(eth.h_source, src, ETH_ALEN);
182 eth.h_proto = host_to_be16(proto);
184 io[0].iov_base = "ETHER ";
186 io[1].iov_base = ð
187 io[1].iov_len = sizeof(eth);
188 io[2].iov_base = (u8 *) data;
189 io[2].iov_len = data_len;
191 memset(&msg, 0, sizeof(msg));
195 dir = opendir(drv->socket_dir);
197 perror("test_driver: opendir");
200 while ((dent = readdir(dir))) {
201 #ifdef _DIRENT_HAVE_D_TYPE
202 /* Skip the file if it is not a socket. Also accept
203 * DT_UNKNOWN (0) in case the C library or underlying file
204 * system does not support d_type. */
205 if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN)
207 #endif /* _DIRENT_HAVE_D_TYPE */
208 if (strcmp(dent->d_name, ".") == 0 ||
209 strcmp(dent->d_name, "..") == 0)
212 memset(&addr, 0, sizeof(addr));
213 addr.sun_family = AF_UNIX;
214 snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s",
215 drv->socket_dir, dent->d_name);
217 if (strcmp(addr.sun_path, drv->own_socket_path) == 0)
219 if (!broadcast && strstr(dent->d_name, desttxt) == NULL)
222 wpa_printf(MSG_DEBUG, "%s: Send ether frame to %s",
223 __func__, dent->d_name);
225 msg.msg_name = &addr;
226 msg.msg_namelen = sizeof(addr);
227 ret = sendmsg(drv->test_socket, &msg, 0);
229 perror("driver_test: sendmsg");
234 if (!broadcast && count == 0) {
235 wpa_printf(MSG_DEBUG, "%s: Destination " MACSTR " not found",
236 __func__, MAC2STR(dst));
244 static int test_driver_send_mgmt_frame(void *priv, const void *buf,
245 size_t len, int flags)
247 struct test_driver_data *drv = priv;
251 int ret = 0, broadcast = 0;
253 struct sockaddr_un addr;
256 struct ieee80211_hdr *hdr;
259 if (drv->test_socket < 0 || len < 10 || drv->socket_dir == NULL) {
260 wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d len=%lu"
262 __func__, drv->test_socket, (unsigned long) len,
269 broadcast = memcmp(dest, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0;
270 snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dest));
272 io[0].iov_base = "MLME ";
274 io[1].iov_base = (void *) buf;
277 memset(&msg, 0, sizeof(msg));
281 dir = opendir(drv->socket_dir);
283 perror("test_driver: opendir");
286 while ((dent = readdir(dir))) {
287 #ifdef _DIRENT_HAVE_D_TYPE
288 /* Skip the file if it is not a socket. Also accept
289 * DT_UNKNOWN (0) in case the C library or underlying file
290 * system does not support d_type. */
291 if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN)
293 #endif /* _DIRENT_HAVE_D_TYPE */
294 if (strcmp(dent->d_name, ".") == 0 ||
295 strcmp(dent->d_name, "..") == 0)
298 memset(&addr, 0, sizeof(addr));
299 addr.sun_family = AF_UNIX;
300 snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s",
301 drv->socket_dir, dent->d_name);
303 if (strcmp(addr.sun_path, drv->own_socket_path) == 0)
305 if (!broadcast && strstr(dent->d_name, desttxt) == NULL)
308 wpa_printf(MSG_DEBUG, "%s: Send management frame to %s",
309 __func__, dent->d_name);
311 msg.msg_name = &addr;
312 msg.msg_namelen = sizeof(addr);
313 ret = sendmsg(drv->test_socket, &msg, 0);
315 perror("driver_test: sendmsg");
319 hdr = (struct ieee80211_hdr *) buf;
320 fc = le_to_host16(hdr->frame_control);
321 hostapd_mgmt_tx_cb(drv->hapd, (u8 *) buf, len, WLAN_FC_GET_STYPE(fc),
328 static void test_driver_scan(struct test_driver_data *drv,
329 struct sockaddr_un *from, socklen_t fromlen,
332 char buf[512], *pos, *end;
334 struct test_driver_bss *bss;
339 /* data: optional [ ' ' | STA-addr | ' ' | IEs(hex) ] */
341 wpa_printf(MSG_DEBUG, "test_driver: SCAN");
345 hwaddr_aton(data + 1, sa)) {
346 wpa_printf(MSG_DEBUG, "test_driver: Unexpected SCAN "
354 ielen = os_strlen(data) / 2;
355 if (ielen > sizeof(ie))
357 if (hexstr2bin(data, ie, ielen) < 0)
360 wpa_printf(MSG_DEBUG, "test_driver: Scan from " MACSTR,
362 wpa_hexdump(MSG_MSGDUMP, "test_driver: scan IEs", ie, ielen);
364 hostapd_wps_probe_req_rx(drv->hapd, sa, ie, ielen);
367 for (bss = drv->bss; bss; bss = bss->next) {
369 end = buf + sizeof(buf);
371 /* reply: SCANRESP BSSID SSID IEs */
372 ret = snprintf(pos, end - pos, "SCANRESP " MACSTR " ",
373 MAC2STR(bss->bssid));
374 if (ret < 0 || ret >= end - pos)
377 pos += wpa_snprintf_hex(pos, end - pos,
378 bss->ssid, bss->ssid_len);
379 ret = snprintf(pos, end - pos, " ");
380 if (ret < 0 || ret >= end - pos)
383 pos += wpa_snprintf_hex(pos, end - pos, bss->ie, bss->ielen);
384 pos += wpa_snprintf_hex(pos, end - pos, bss->wps_probe_resp_ie,
385 bss->wps_probe_resp_ie_len);
388 ret = snprintf(pos, end - pos, " PRIVACY");
389 if (ret < 0 || ret >= end - pos)
394 sendto(drv->test_socket, buf, pos - buf, 0,
395 (struct sockaddr *) from, fromlen);
400 static struct hostapd_data * test_driver_get_hapd(struct test_driver_data *drv,
401 struct test_driver_bss *bss)
403 struct hostapd_iface *iface = drv->hapd->iface;
404 struct hostapd_data *hapd = NULL;
408 wpa_printf(MSG_DEBUG, "%s: bss == NULL", __func__);
412 for (i = 0; i < iface->num_bss; i++) {
413 hapd = iface->bss[i];
414 if (memcmp(hapd->own_addr, bss->bssid, ETH_ALEN) == 0)
417 if (i == iface->num_bss) {
418 wpa_printf(MSG_DEBUG, "%s: no matching interface entry found "
419 "for BSSID " MACSTR, __func__, MAC2STR(bss->bssid));
427 static int test_driver_new_sta(struct test_driver_data *drv,
428 struct test_driver_bss *bss, const u8 *addr,
429 const u8 *ie, size_t ielen)
431 struct hostapd_data *hapd;
433 hapd = test_driver_get_hapd(drv, bss);
437 return hostapd_notif_assoc(hapd, addr, ie, ielen);
441 static void test_driver_assoc(struct test_driver_data *drv,
442 struct sockaddr_un *from, socklen_t fromlen,
445 struct test_client_socket *cli;
446 u8 ie[256], ssid[32];
447 size_t ielen, ssid_len = 0;
448 char *pos, *pos2, cmd[50];
449 struct test_driver_bss *bss;
451 /* data: STA-addr SSID(hex) IEs(hex) */
453 cli = os_zalloc(sizeof(*cli));
457 if (hwaddr_aton(data, cli->addr)) {
458 printf("test_socket: Invalid MAC address '%s' in ASSOC\n",
466 pos2 = strchr(pos, ' ');
469 ssid_len = (pos2 - pos) / 2;
470 if (hexstr2bin(pos, ssid, ssid_len) < 0) {
471 wpa_printf(MSG_DEBUG, "%s: Invalid SSID", __func__);
475 wpa_hexdump_ascii(MSG_DEBUG, "test_driver_assoc: SSID",
479 ielen = strlen(pos) / 2;
480 if (ielen > sizeof(ie))
482 if (hexstr2bin(pos, ie, ielen) < 0)
486 for (bss = drv->bss; bss; bss = bss->next) {
487 if (bss->ssid_len == ssid_len &&
488 memcmp(bss->ssid, ssid, ssid_len) == 0)
492 wpa_printf(MSG_DEBUG, "%s: No matching SSID found from "
493 "configured BSSes", __func__);
499 memcpy(&cli->un, from, sizeof(cli->un));
500 cli->unlen = fromlen;
501 cli->next = drv->cli;
503 wpa_hexdump_ascii(MSG_DEBUG, "test_socket: ASSOC sun_path",
504 (const u8 *) cli->un.sun_path,
505 cli->unlen - sizeof(cli->un.sun_family));
507 snprintf(cmd, sizeof(cmd), "ASSOCRESP " MACSTR " 0",
508 MAC2STR(bss->bssid));
509 sendto(drv->test_socket, cmd, strlen(cmd), 0,
510 (struct sockaddr *) from, fromlen);
512 if (test_driver_new_sta(drv, bss, cli->addr, ie, ielen) < 0) {
513 wpa_printf(MSG_DEBUG, "test_driver: failed to add new STA");
518 static void test_driver_disassoc(struct test_driver_data *drv,
519 struct sockaddr_un *from, socklen_t fromlen)
521 struct test_client_socket *cli;
523 cli = test_driver_get_cli(drv, from, fromlen);
527 hostapd_notif_disassoc(drv->hapd, cli->addr);
531 static void test_driver_eapol(struct test_driver_data *drv,
532 struct sockaddr_un *from, socklen_t fromlen,
533 u8 *data, size_t datalen)
535 struct test_client_socket *cli;
537 /* Skip Ethernet header */
538 wpa_printf(MSG_DEBUG, "test_driver: dst=" MACSTR " src="
539 MACSTR " proto=%04x",
540 MAC2STR(data), MAC2STR(data + ETH_ALEN),
541 WPA_GET_BE16(data + 2 * ETH_ALEN));
545 cli = test_driver_get_cli(drv, from, fromlen);
547 struct hostapd_data *hapd;
548 hapd = test_driver_get_hapd(drv, cli->bss);
551 hostapd_eapol_receive(hapd, cli->addr, data, datalen);
553 wpa_printf(MSG_DEBUG, "test_socket: EAPOL from unknown "
559 static void test_driver_ether(struct test_driver_data *drv,
560 struct sockaddr_un *from, socklen_t fromlen,
561 u8 *data, size_t datalen)
563 struct l2_ethhdr *eth;
565 if (datalen < sizeof(*eth))
568 eth = (struct l2_ethhdr *) data;
569 wpa_printf(MSG_DEBUG, "test_driver: RX ETHER dst=" MACSTR " src="
570 MACSTR " proto=%04x",
571 MAC2STR(eth->h_dest), MAC2STR(eth->h_source),
572 be_to_host16(eth->h_proto));
574 #ifdef CONFIG_IEEE80211R
575 if (be_to_host16(eth->h_proto) == ETH_P_RRB) {
576 wpa_ft_rrb_rx(drv->hapd->wpa_auth, eth->h_source,
577 data + sizeof(*eth), datalen - sizeof(*eth));
579 #endif /* CONFIG_IEEE80211R */
583 static void test_driver_mlme(struct test_driver_data *drv,
584 struct sockaddr_un *from, socklen_t fromlen,
585 u8 *data, size_t datalen)
587 struct ieee80211_hdr *hdr;
590 hdr = (struct ieee80211_hdr *) data;
592 if (test_driver_get_cli(drv, from, fromlen) == NULL && datalen >= 16) {
593 struct test_client_socket *cli;
594 cli = os_zalloc(sizeof(*cli));
597 wpa_printf(MSG_DEBUG, "Adding client entry for " MACSTR,
598 MAC2STR(hdr->addr2));
599 memcpy(cli->addr, hdr->addr2, ETH_ALEN);
600 memcpy(&cli->un, from, sizeof(cli->un));
601 cli->unlen = fromlen;
602 cli->next = drv->cli;
606 wpa_hexdump(MSG_MSGDUMP, "test_driver_mlme: received frame",
608 fc = le_to_host16(hdr->frame_control);
609 if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) {
610 wpa_printf(MSG_ERROR, "%s: received non-mgmt frame",
614 hostapd_mgmt_rx(drv->hapd, data, datalen, WLAN_FC_GET_STYPE(fc), NULL);
618 static void test_driver_receive_unix(int sock, void *eloop_ctx, void *sock_ctx)
620 struct test_driver_data *drv = eloop_ctx;
623 struct sockaddr_un from;
624 socklen_t fromlen = sizeof(from);
626 res = recvfrom(sock, buf, sizeof(buf) - 1, 0,
627 (struct sockaddr *) &from, &fromlen);
629 perror("recvfrom(test_socket)");
634 wpa_printf(MSG_DEBUG, "test_driver: received %u bytes", res);
636 if (strncmp(buf, "SCAN", 4) == 0) {
637 test_driver_scan(drv, &from, fromlen, buf + 4);
638 } else if (strncmp(buf, "ASSOC ", 6) == 0) {
639 test_driver_assoc(drv, &from, fromlen, buf + 6);
640 } else if (strcmp(buf, "DISASSOC") == 0) {
641 test_driver_disassoc(drv, &from, fromlen);
642 } else if (strncmp(buf, "EAPOL ", 6) == 0) {
643 test_driver_eapol(drv, &from, fromlen, (u8 *) buf + 6,
645 } else if (strncmp(buf, "ETHER ", 6) == 0) {
646 test_driver_ether(drv, &from, fromlen, (u8 *) buf + 6,
648 } else if (strncmp(buf, "MLME ", 5) == 0) {
649 test_driver_mlme(drv, &from, fromlen, (u8 *) buf + 5, res - 5);
651 wpa_hexdump_ascii(MSG_DEBUG, "Unknown test_socket command",
657 static struct test_driver_bss *
658 test_driver_get_bss(struct test_driver_data *drv, const char *ifname)
660 struct test_driver_bss *bss;
662 for (bss = drv->bss; bss; bss = bss->next) {
663 if (strcmp(bss->ifname, ifname) == 0)
670 static int test_driver_set_generic_elem(const char *ifname, void *priv,
671 const u8 *elem, size_t elem_len)
673 struct test_driver_data *drv = priv;
674 struct test_driver_bss *bss;
676 bss = test_driver_get_bss(drv, ifname);
688 bss->ie = malloc(elem_len);
689 if (bss->ie == NULL) {
694 memcpy(bss->ie, elem, elem_len);
695 bss->ielen = elem_len;
700 static int test_driver_set_wps_beacon_ie(const char *ifname, void *priv,
701 const u8 *ie, size_t len)
703 struct test_driver_data *drv = priv;
704 struct test_driver_bss *bss;
706 wpa_hexdump(MSG_DEBUG, "test_driver: Beacon WPS IE", ie, len);
707 bss = test_driver_get_bss(drv, ifname);
711 free(bss->wps_beacon_ie);
714 bss->wps_beacon_ie = NULL;
715 bss->wps_beacon_ie_len = 0;
719 bss->wps_beacon_ie = malloc(len);
720 if (bss->wps_beacon_ie == NULL) {
721 bss->wps_beacon_ie_len = 0;
725 memcpy(bss->wps_beacon_ie, ie, len);
726 bss->wps_beacon_ie_len = len;
731 static int test_driver_set_wps_probe_resp_ie(const char *ifname, void *priv,
732 const u8 *ie, size_t len)
734 struct test_driver_data *drv = priv;
735 struct test_driver_bss *bss;
737 wpa_hexdump(MSG_DEBUG, "test_driver: ProbeResp WPS IE", ie, len);
738 bss = test_driver_get_bss(drv, ifname);
742 free(bss->wps_probe_resp_ie);
745 bss->wps_probe_resp_ie = NULL;
746 bss->wps_probe_resp_ie_len = 0;
750 bss->wps_probe_resp_ie = malloc(len);
751 if (bss->wps_probe_resp_ie == NULL) {
752 bss->wps_probe_resp_ie_len = 0;
756 memcpy(bss->wps_probe_resp_ie, ie, len);
757 bss->wps_probe_resp_ie_len = len;
762 static int test_driver_sta_deauth(void *priv, const u8 *addr, int reason)
764 struct test_driver_data *drv = priv;
765 struct test_client_socket *cli;
767 if (drv->test_socket < 0)
772 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
780 return sendto(drv->test_socket, "DEAUTH", 6, 0,
781 (struct sockaddr *) &cli->un, cli->unlen);
785 static int test_driver_sta_disassoc(void *priv, const u8 *addr, int reason)
787 struct test_driver_data *drv = priv;
788 struct test_client_socket *cli;
790 if (drv->test_socket < 0)
795 if (memcmp(cli->addr, addr, ETH_ALEN) == 0)
803 return sendto(drv->test_socket, "DISASSOC", 8, 0,
804 (struct sockaddr *) &cli->un, cli->unlen);
808 static struct hostapd_hw_modes *
809 test_driver_get_hw_feature_data(void *priv, u16 *num_modes, u16 *flags)
811 struct hostapd_hw_modes *modes;
815 modes = os_zalloc(*num_modes * sizeof(struct hostapd_hw_modes));
818 modes[0].mode = HOSTAPD_MODE_IEEE80211G;
819 modes[0].num_channels = 1;
820 modes[0].num_rates = 1;
821 modes[0].channels = os_zalloc(sizeof(struct hostapd_channel_data));
822 modes[0].rates = os_zalloc(sizeof(struct hostapd_rate_data));
823 if (modes[0].channels == NULL || modes[0].rates == NULL) {
824 hostapd_free_hw_features(modes, *num_modes);
827 modes[0].channels[0].chan = 1;
828 modes[0].channels[0].freq = 2412;
829 modes[0].channels[0].flag = 0;
830 modes[0].rates[0].rate = 10;
831 modes[0].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
832 HOSTAPD_RATE_CCK | HOSTAPD_RATE_MANDATORY;
834 modes[1].mode = HOSTAPD_MODE_IEEE80211B;
835 modes[1].num_channels = 1;
836 modes[1].num_rates = 1;
837 modes[1].channels = os_zalloc(sizeof(struct hostapd_channel_data));
838 modes[1].rates = os_zalloc(sizeof(struct hostapd_rate_data));
839 if (modes[1].channels == NULL || modes[1].rates == NULL) {
840 hostapd_free_hw_features(modes, *num_modes);
843 modes[1].channels[0].chan = 1;
844 modes[1].channels[0].freq = 2412;
845 modes[1].channels[0].flag = 0;
846 modes[1].rates[0].rate = 10;
847 modes[1].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
848 HOSTAPD_RATE_CCK | HOSTAPD_RATE_MANDATORY;
850 modes[2].mode = HOSTAPD_MODE_IEEE80211A;
851 modes[2].num_channels = 1;
852 modes[2].num_rates = 1;
853 modes[2].channels = os_zalloc(sizeof(struct hostapd_channel_data));
854 modes[2].rates = os_zalloc(sizeof(struct hostapd_rate_data));
855 if (modes[2].channels == NULL || modes[2].rates == NULL) {
856 hostapd_free_hw_features(modes, *num_modes);
859 modes[2].channels[0].chan = 60;
860 modes[2].channels[0].freq = 5300;
861 modes[2].channels[0].flag = 0;
862 modes[2].rates[0].rate = 60;
863 modes[2].rates[0].flags = HOSTAPD_RATE_BASIC | HOSTAPD_RATE_SUPPORTED |
864 HOSTAPD_RATE_MANDATORY;
870 static int test_driver_bss_add(void *priv, const char *ifname, const u8 *bssid)
872 struct test_driver_data *drv = priv;
873 struct test_driver_bss *bss;
875 wpa_printf(MSG_DEBUG, "%s(ifname=%s bssid=" MACSTR ")",
876 __func__, ifname, MAC2STR(bssid));
878 bss = os_zalloc(sizeof(*bss));
882 os_strlcpy(bss->ifname, ifname, IFNAMSIZ);
883 memcpy(bss->bssid, bssid, ETH_ALEN);
885 bss->next = drv->bss;
892 static int test_driver_bss_remove(void *priv, const char *ifname)
894 struct test_driver_data *drv = priv;
895 struct test_driver_bss *bss, *prev;
896 struct test_client_socket *cli, *prev_c;
898 wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, ifname);
900 for (prev = NULL, bss = drv->bss; bss; prev = bss, bss = bss->next) {
901 if (strcmp(bss->ifname, ifname) != 0)
905 prev->next = bss->next;
907 drv->bss = bss->next;
909 for (prev_c = NULL, cli = drv->cli; cli;
910 prev_c = cli, cli = cli->next) {
914 prev_c->next = cli->next;
916 drv->cli = cli->next;
921 test_driver_free_bss(bss);
929 static int test_driver_if_add(const char *iface, void *priv,
930 enum hostapd_driver_if_type type, char *ifname,
933 wpa_printf(MSG_DEBUG, "%s(iface=%s type=%d ifname=%s)",
934 __func__, iface, type, ifname);
939 static int test_driver_if_update(void *priv, enum hostapd_driver_if_type type,
940 char *ifname, const u8 *addr)
942 wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s)", __func__, type, ifname);
947 static int test_driver_if_remove(void *priv, enum hostapd_driver_if_type type,
948 const char *ifname, const u8 *addr)
950 wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s)", __func__, type, ifname);
955 static int test_driver_valid_bss_mask(void *priv, const u8 *addr,
962 static int test_driver_set_ssid(const char *ifname, void *priv, const u8 *buf,
965 struct test_driver_data *drv = priv;
966 struct test_driver_bss *bss;
968 wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, ifname);
969 wpa_hexdump_ascii(MSG_DEBUG, "test_driver_set_ssid: SSID", buf, len);
971 for (bss = drv->bss; bss; bss = bss->next) {
972 if (strcmp(bss->ifname, ifname) != 0)
975 if (len < 0 || (size_t) len > sizeof(bss->ssid))
978 memcpy(bss->ssid, buf, len);
988 static int test_driver_set_privacy(const char *ifname, void *priv, int enabled)
990 struct test_driver_data *drv = priv;
991 struct test_driver_bss *bss;
993 wpa_printf(MSG_DEBUG, "%s(ifname=%s enabled=%d)",
994 __func__, ifname, enabled);
996 for (bss = drv->bss; bss; bss = bss->next) {
997 if (strcmp(bss->ifname, ifname) != 0)
1000 bss->privacy = enabled;
1009 static int test_driver_set_key(const char *iface, void *priv, wpa_alg alg,
1010 const u8 *addr, int key_idx, int set_tx,
1011 const u8 *seq, size_t seq_len,
1012 const u8 *key, size_t key_len)
1014 wpa_printf(MSG_DEBUG, "%s(iface=%s alg=%d idx=%d set_tx=%d)",
1015 __func__, iface, alg, key_idx, set_tx);
1017 wpa_printf(MSG_DEBUG, " addr=" MACSTR, MAC2STR(addr));
1019 wpa_hexdump_key(MSG_DEBUG, " key", key, key_len);
1024 static int test_driver_set_sta_vlan(void *priv, const u8 *addr,
1025 const char *ifname, int vlan_id)
1027 wpa_printf(MSG_DEBUG, "%s(addr=" MACSTR " ifname=%s vlan_id=%d)",
1028 __func__, MAC2STR(addr), ifname, vlan_id);
1033 static int test_driver_sta_add(const char *ifname, void *priv,
1034 struct hostapd_sta_add_params *params)
1036 struct test_driver_data *drv = priv;
1037 struct test_client_socket *cli;
1038 struct test_driver_bss *bss;
1040 wpa_printf(MSG_DEBUG, "%s(ifname=%s addr=" MACSTR " aid=%d "
1041 "capability=0x%x flags=0x%x listen_interval=%d)",
1042 __func__, ifname, MAC2STR(params->addr), params->aid,
1043 params->capability, params->flags,
1044 params->listen_interval);
1045 wpa_hexdump(MSG_DEBUG, "test_driver_sta_add - supp_rates",
1046 params->supp_rates, params->supp_rates_len);
1050 if (os_memcmp(cli->addr, params->addr, ETH_ALEN) == 0)
1055 wpa_printf(MSG_DEBUG, "%s: no matching client entry",
1060 for (bss = drv->bss; bss; bss = bss->next) {
1061 if (strcmp(ifname, bss->ifname) == 0)
1065 wpa_printf(MSG_DEBUG, "%s: No matching interface found from "
1066 "configured BSSes", __func__);
1076 static void * test_driver_init(struct hostapd_data *hapd)
1078 struct test_driver_data *drv;
1079 struct sockaddr_un addr_un;
1080 struct sockaddr_in addr_in;
1081 struct sockaddr *addr;
1084 drv = os_zalloc(sizeof(struct test_driver_data));
1086 printf("Could not allocate memory for test driver data\n");
1089 drv->bss = os_zalloc(sizeof(*drv->bss));
1090 if (drv->bss == NULL) {
1091 printf("Could not allocate memory for test driver BSS data\n");
1098 /* Generate a MAC address to help testing with multiple APs */
1099 hapd->own_addr[0] = 0x02; /* locally administered */
1100 sha1_prf((const u8 *) hapd->conf->iface, strlen(hapd->conf->iface),
1101 "hostapd test bssid generation",
1102 (const u8 *) hapd->conf->ssid.ssid, hapd->conf->ssid.ssid_len,
1103 hapd->own_addr + 1, ETH_ALEN - 1);
1105 os_strlcpy(drv->bss->ifname, hapd->conf->iface, IFNAMSIZ);
1106 memcpy(drv->bss->bssid, hapd->own_addr, ETH_ALEN);
1108 if (hapd->conf->test_socket) {
1109 if (strlen(hapd->conf->test_socket) >=
1110 sizeof(addr_un.sun_path)) {
1111 printf("Too long test_socket path\n");
1112 test_driver_free_priv(drv);
1115 if (strncmp(hapd->conf->test_socket, "DIR:", 4) == 0) {
1116 size_t len = strlen(hapd->conf->test_socket) + 30;
1117 drv->socket_dir = strdup(hapd->conf->test_socket + 4);
1118 drv->own_socket_path = malloc(len);
1119 if (drv->own_socket_path) {
1120 snprintf(drv->own_socket_path, len,
1122 hapd->conf->test_socket + 4,
1123 MAC2STR(hapd->own_addr));
1125 } else if (strncmp(hapd->conf->test_socket, "UDP:", 4) == 0) {
1126 drv->udp_port = atoi(hapd->conf->test_socket + 4);
1128 drv->own_socket_path = strdup(hapd->conf->test_socket);
1130 if (drv->own_socket_path == NULL && drv->udp_port == 0) {
1131 test_driver_free_priv(drv);
1135 drv->test_socket = socket(drv->udp_port ? PF_INET : PF_UNIX,
1137 if (drv->test_socket < 0) {
1139 test_driver_free_priv(drv);
1143 if (drv->udp_port) {
1144 os_memset(&addr_in, 0, sizeof(addr_in));
1145 addr_in.sin_family = AF_INET;
1146 addr_in.sin_port = htons(drv->udp_port);
1147 addr = (struct sockaddr *) &addr_in;
1148 alen = sizeof(addr_in);
1150 os_memset(&addr_un, 0, sizeof(addr_un));
1151 addr_un.sun_family = AF_UNIX;
1152 os_strlcpy(addr_un.sun_path, drv->own_socket_path,
1153 sizeof(addr_un.sun_path));
1154 addr = (struct sockaddr *) &addr_un;
1155 alen = sizeof(addr_un);
1157 if (bind(drv->test_socket, addr, alen) < 0) {
1158 perror("bind(PF_UNIX)");
1159 close(drv->test_socket);
1160 if (drv->own_socket_path)
1161 unlink(drv->own_socket_path);
1162 test_driver_free_priv(drv);
1165 eloop_register_read_sock(drv->test_socket,
1166 test_driver_receive_unix, drv, NULL);
1168 drv->test_socket = -1;
1174 static void test_driver_deinit(void *priv)
1176 struct test_driver_data *drv = priv;
1177 struct test_client_socket *cli, *prev;
1186 if (drv->test_socket >= 0) {
1187 eloop_unregister_read_sock(drv->test_socket);
1188 close(drv->test_socket);
1189 if (drv->own_socket_path)
1190 unlink(drv->own_socket_path);
1193 /* There should be only one BSS remaining at this point. */
1194 if (drv->bss == NULL)
1195 wpa_printf(MSG_ERROR, "%s: drv->bss == NULL", __func__);
1196 else if (drv->bss->next)
1197 wpa_printf(MSG_ERROR, "%s: drv->bss->next != NULL", __func__);
1199 test_driver_free_priv(drv);
1203 const struct hapd_driver_ops wpa_driver_test_ops = {
1205 .init = test_driver_init,
1206 .deinit = test_driver_deinit,
1207 .send_eapol = test_driver_send_eapol,
1208 .send_mgmt_frame = test_driver_send_mgmt_frame,
1209 .set_generic_elem = test_driver_set_generic_elem,
1210 .sta_deauth = test_driver_sta_deauth,
1211 .sta_disassoc = test_driver_sta_disassoc,
1212 .get_hw_feature_data = test_driver_get_hw_feature_data,
1213 .bss_add = test_driver_bss_add,
1214 .bss_remove = test_driver_bss_remove,
1215 .if_add = test_driver_if_add,
1216 .if_update = test_driver_if_update,
1217 .if_remove = test_driver_if_remove,
1218 .valid_bss_mask = test_driver_valid_bss_mask,
1219 .set_ssid = test_driver_set_ssid,
1220 .set_privacy = test_driver_set_privacy,
1221 .set_key = test_driver_set_key,
1222 .set_sta_vlan = test_driver_set_sta_vlan,
1223 .sta_add = test_driver_sta_add,
1224 .send_ether = test_driver_send_ether,
1225 .set_wps_beacon_ie = test_driver_set_wps_beacon_ie,
1226 .set_wps_probe_resp_ie = test_driver_set_wps_probe_resp_ie,