18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Testing driver interface for a simulated network driver 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004-2010, Jouni Malinen <j@w1.fi> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 5c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * This software may be distributed under the terms of the BSD license. 6c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * See README for more details. 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* Make sure we get winsock2.h for Windows build to get sockaddr_storage */ 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "build_config.h" 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_NATIVE_WINDOWS 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <winsock2.h> 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NATIVE_WINDOWS */ 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/includes.h" 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_NATIVE_WINDOWS 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/un.h> 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <dirent.h> 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/stat.h> 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define DRIVER_TEST_UNIX 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NATIVE_WINDOWS */ 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/common.h" 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/eloop.h" 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/list.h" 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/trace.h" 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "crypto/sha1.h" 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "l2_packet/l2_packet.h" 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "p2p/p2p.h" 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps.h" 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "driver.h" 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct test_client_socket { 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *next; 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un un; 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t unlen; 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct test_driver_bss { 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv; 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct dl_list list; 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *bss_ctx; 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char ifname[IFNAMSIZ]; 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 bssid[ETH_ALEN]; 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *ie; 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t ielen; 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *wps_beacon_ie; 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t wps_beacon_ie_len; 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *wps_probe_resp_ie; 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t wps_probe_resp_ie_len; 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ssid[32]; 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t ssid_len; 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int privacy; 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_driver_test_global { 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int bss_add_used; 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 req_addr[ETH_ALEN]; 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wpa_driver_test_data { 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_global *global; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *ctx; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_TRACE_REF(ctx); 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 own_addr[ETH_ALEN]; 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int test_socket; 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un hostapd_addr; 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int hostapd_addr_set; 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in hostapd_addr_udp; 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int hostapd_addr_udp_set; 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *own_socket_path; 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *test_dir; 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MAX_SCAN_RESULTS 30 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_scan_res *scanres[MAX_SCAN_RESULTS]; 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t num_scanres; 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int use_associnfo; 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 assoc_wpa_ie[80]; 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t assoc_wpa_ie_len; 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int associated; 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *probe_req_ie; 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t probe_req_ie_len; 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 probe_req_ssid[32]; 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t probe_req_ssid_len; 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ibss; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ap; 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct dl_list bss; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int udp_port; 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int alloc_iface_idx; 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int probe_req_report; 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int remain_on_channel_freq; 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int remain_on_channel_duration; 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int current_freq; 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_data *p2p; 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int off_channel_freq; 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *pending_action_tx; 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 pending_action_src[ETH_ALEN]; 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 pending_action_dst[ETH_ALEN]; 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 pending_action_bssid[ETH_ALEN]; 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int pending_action_freq; 1131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt unsigned int pending_action_no_cck; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int pending_listen_freq; 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int pending_listen_duration; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int pending_p2p_scan; 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *probe_from; 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t probe_from_len; 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_deinit(void *priv); 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_attach(struct wpa_driver_test_data *drv, 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *dir, int ap); 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_close_test_socket( 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv); 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_remain_on_channel_timeout(void *eloop_ctx, void *timeout_ctx); 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_init_p2p(struct wpa_driver_test_data *drv); 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_free_bss(struct test_driver_bss *bss) 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->ie); 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->wps_beacon_ie); 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->wps_probe_resp_ie); 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss); 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_free_bsses(struct wpa_driver_test_data *drv) 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss, *tmp; 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each_safe(bss, tmp, &drv->bss, struct test_driver_bss, 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt list) { 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_del(&bss->list); 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_free_bss(bss); 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct test_client_socket * 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidttest_driver_get_cli(struct wpa_driver_test_data *drv, struct sockaddr_un *from, 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen) 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli = drv->cli; 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cli->unlen == fromlen && 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt strncmp(cli->un.sun_path, from->sun_path, 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen - sizeof(cli->un.sun_family)) == 0) 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return cli; 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_send_eapol(void *priv, const u8 *addr, const u8 *data, 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t data_len, int encrypt, 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *own_addr, u32 flags) 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct msghdr msg; 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iovec io[3]; 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr eth; 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = drv->cli; 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(cli->addr, addr, ETH_ALEN) == 0) 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!cli) { 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: no destination client entry", 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__); 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth.h_dest, addr, ETH_ALEN); 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth.h_source, own_addr, ETH_ALEN); 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth.h_proto = host_to_be16(ETH_P_EAPOL); 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_base = "EAPOL "; 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_len = 6; 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_base = ð 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_len = sizeof(eth); 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[2].iov_base = (u8 *) data; 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[2].iov_len = data_len; 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&msg, 0, sizeof(msg)); 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iov = io; 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iovlen = 3; 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &cli->un; 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = cli->unlen; 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sendmsg(drv->test_socket, &msg, 0); 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_send_ether(void *priv, const u8 *dst, const u8 *src, 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 proto, const u8 *data, size_t data_len) 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct msghdr msg; 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iovec io[3]; 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr eth; 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char desttxt[30]; 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr; 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct dirent *dent; 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt DIR *dir; 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0, broadcast = 0, count = 0; 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0 || drv->test_dir == NULL) { 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d " 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "test_dir=%p)", 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, drv->test_socket, drv->test_dir); 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt broadcast = memcmp(dst, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0; 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dst)); 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth.h_dest, dst, ETH_ALEN); 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth.h_source, src, ETH_ALEN); 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth.h_proto = host_to_be16(proto); 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_base = "ETHER "; 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_len = 6; 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_base = ð 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_len = sizeof(eth); 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[2].iov_base = (u8 *) data; 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[2].iov_len = data_len; 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&msg, 0, sizeof(msg)); 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iov = io; 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iovlen = 3; 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dir = opendir(drv->test_dir); 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dir == NULL) { 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("test_driver: opendir"); 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((dent = readdir(dir))) { 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef _DIRENT_HAVE_D_TYPE 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Skip the file if it is not a socket. Also accept 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * DT_UNKNOWN (0) in case the C library or underlying file 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * system does not support d_type. */ 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN) 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _DIRENT_HAVE_D_TYPE */ 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(dent->d_name, ".") == 0 || 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt strcmp(dent->d_name, "..") == 0) 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&addr, 0, sizeof(addr)); 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s", 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir, dent->d_name); 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(addr.sun_path, drv->own_socket_path) == 0) 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!broadcast && strstr(dent->d_name, desttxt) == NULL) 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Send ether frame to %s", 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, dent->d_name); 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &addr; 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(addr); 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = sendmsg(drv->test_socket, &msg, 0); 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("driver_test: sendmsg"); 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt count++; 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt closedir(dir); 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!broadcast && count == 0) { 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Destination " MACSTR " not found", 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(dst)); 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_send_mlme(void *priv, const u8 *data, 3061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt size_t data_len, int noack) 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct msghdr msg; 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iovec io[2]; 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *dest; 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr; 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct dirent *dent; 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt DIR *dir; 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int broadcast; 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211_hdr *hdr; 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 fc; 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char cmd[50]; 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int freq; 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char desttxt[30]; 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "test_send_mlme", data, data_len); 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0 || data_len < 10) { 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: invalid parameters (sock=%d len=%lu" 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " test_dir=%p)", 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, drv->test_socket, 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) data_len, 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir); 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dest = data + 4; 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt broadcast = os_memcmp(dest, "\xff\xff\xff\xff\xff\xff", ETH_ALEN) == 0; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(desttxt, sizeof(desttxt), MACSTR, MAC2STR(dest)); 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->remain_on_channel_freq) 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq = drv->remain_on_channel_freq; 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq = drv->current_freq; 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver(%s): MLME TX on freq %d MHz", 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ifname, freq); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(cmd, sizeof(cmd), "MLME freq=%d ", freq); 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_base = cmd; 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[0].iov_len = os_strlen(cmd); 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_base = (void *) data; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt io[1].iov_len = data_len; 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&msg, 0, sizeof(msg)); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iov = io; 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_iovlen = 2; 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_dir == NULL) { 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: test_dir == NULL", __func__); 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dir = opendir(drv->test_dir); 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dir == NULL) { 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("test_driver: opendir"); 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((dent = readdir(dir))) { 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef _DIRENT_HAVE_D_TYPE 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Skip the file if it is not a socket. Also accept 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * DT_UNKNOWN (0) in case the C library or underlying file 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * system does not support d_type. */ 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dent->d_type != DT_SOCK && dent->d_type != DT_UNKNOWN) 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _DIRENT_HAVE_D_TYPE */ 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(dent->d_name, ".") == 0 || 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strcmp(dent->d_name, "..") == 0) 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr, 0, sizeof(addr)); 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s", 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir, dent->d_name); 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(addr.sun_path, drv->own_socket_path) == 0) 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!broadcast && os_strstr(dent->d_name, desttxt) == NULL) 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Send management frame to %s", 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, dent->d_name); 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &addr; 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(addr); 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = sendmsg(drv->test_socket, &msg, 0); 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("driver_test: sendmsg(test_socket)"); 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt closedir(dir); 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* HOSTAPD */ 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(dest, dbss->bssid, ETH_ALEN) == 0 || 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir == NULL) { 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->hostapd_addr_udp_set) { 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &drv->hostapd_addr_udp; 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(drv->hostapd_addr_udp); 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &drv->hostapd_addr; 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(drv->hostapd_addr); 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (broadcast) { 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dir = opendir(drv->test_dir); 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dir == NULL) 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((dent = readdir(dir))) { 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef _DIRENT_HAVE_D_TYPE 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Skip the file if it is not a socket. 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Also accept DT_UNKNOWN (0) in case 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the C library or underlying file 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * system does not support d_type. */ 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dent->d_type != DT_SOCK && 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dent->d_type != DT_UNKNOWN) 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _DIRENT_HAVE_D_TYPE */ 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strcmp(dent->d_name, ".") == 0 || 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strcmp(dent->d_name, "..") == 0) 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Send broadcast MLME to %s", 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, dent->d_name); 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr, 0, sizeof(addr)); 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr.sun_path, sizeof(addr.sun_path), 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/%s", drv->test_dir, dent->d_name); 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &addr; 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(addr); 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = sendmsg(drv->test_socket, &msg, 0); 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("driver_test: sendmsg(test_socket)"); 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt closedir(dir); 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct stat st; 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr, 0, sizeof(addr)); 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr.sun_path, sizeof(addr.sun_path), 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/AP-" MACSTR, drv->test_dir, MAC2STR(dest)); 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (stat(addr.sun_path, &st) < 0) { 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr.sun_path, sizeof(addr.sun_path), 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/STA-" MACSTR, 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir, MAC2STR(dest)); 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_name = &addr; 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg.msg_namelen = sizeof(addr); 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sendmsg(drv->test_socket, &msg, 0) < 0) { 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendmsg(test_socket)"); 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct ieee80211_hdr *) data; 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fc = le_to_host16(hdr->frame_control); 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.type = WLAN_FC_GET_TYPE(fc); 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.stype = WLAN_FC_GET_STYPE(fc); 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.dst = hdr->addr1; 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.data = data; 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.data_len = data_len; 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.tx_status.ack = ret >= 0; 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_TX_STATUS, &event); 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p && 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_MGMT && 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_STYPE(fc) == WLAN_FC_STYPE_ACTION) { 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->pending_action_tx == NULL) { 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Ignore Action TX status - " 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "no pending operation"); 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(hdr->addr1, drv->pending_action_dst, ETH_ALEN) != 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 0) { 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Ignore Action TX status - " 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "unknown destination address"); 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->pending_action_tx); 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_tx = NULL; 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_send_action_cb(drv->p2p, drv->pending_action_freq, 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_dst, 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_src, 5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_bssid, 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret >= 0); 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_scan(struct wpa_driver_test_data *drv, 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen, 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *data) 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char buf[512], *pos, *end; 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 sa[ETH_ALEN]; 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie[512]; 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t ielen; 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* data: optional [ ' ' | STA-addr | ' ' | IEs(hex) ] */ 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: SCAN"); 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (*data) { 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (*data != ' ' || 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(data + 1, sa)) { 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Unexpected SCAN " 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "command format"); 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data += 18; 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*data == ' ') 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data++; 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = os_strlen(data) / 2; 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen > sizeof(ie)) 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = sizeof(ie); 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(data, ie, ielen) < 0) 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = 0; 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Scan from " MACSTR, 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(sa)); 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "test_driver: scan IEs", ie, ielen); 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.sa = sa; 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie = ie; 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie_len = ielen; 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_RX_PROBE_REQ, &event); 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) 5581f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt p2p_probe_req_rx(drv->p2p, sa, NULL, NULL, ie, ielen); 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(bss, &drv->bss, struct test_driver_bss, list) { 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = buf + sizeof(buf); 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* reply: SCANRESP BSSID SSID IEs */ 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, "SCANRESP " MACSTR " ", 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bss->bssid)); 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ssid, bss->ssid_len); 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, " "); 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, bss->ie, bss->ielen); 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, bss->wps_probe_resp_ie, 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie_len); 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss->privacy) { 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, " PRIVACY"); 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, buf, pos - buf, 0, 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) from, fromlen); 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_assoc(struct wpa_driver_test_data *drv, 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen, 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *data) 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie[256], ssid[32]; 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t ielen, ssid_len = 0; 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *pos2, cmd[50]; 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss, *tmp; 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* data: STA-addr SSID(hex) IEs(hex) */ 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = os_zalloc(sizeof(*cli)); 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cli == NULL) 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(data, cli->addr)) { 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("test_socket: Invalid MAC address '%s' in ASSOC\n", 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data); 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cli); 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data + 17; 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*pos == ' ') 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos2 = strchr(pos, ' '); 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = 0; 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos2) { 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ssid_len = (pos2 - pos) / 2; 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(pos, ssid, ssid_len) < 0) { 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Invalid SSID", __func__); 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cli); 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "test_driver_assoc: SSID", 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ssid, ssid_len); 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = pos2 + 1; 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = strlen(pos) / 2; 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen > sizeof(ie)) 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = sizeof(ie); 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(pos, ie, ielen) < 0) 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = 0; 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = NULL; 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(tmp, &drv->bss, struct test_driver_bss, list) { 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (tmp->ssid_len == ssid_len && 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcmp(tmp->ssid, ssid, ssid_len) == 0) { 6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = tmp; 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss == NULL) { 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: No matching SSID found from " 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "configured BSSes", __func__); 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cli); 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->bss = bss; 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&cli->un, from, sizeof(cli->un)); 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->unlen = fromlen; 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->next = drv->cli; 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->cli = cli; 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "test_socket: ASSOC sun_path", 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) cli->un.sun_path, 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->unlen - sizeof(cli->un.sun_family)); 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(cmd, sizeof(cmd), "ASSOCRESP " MACSTR " 0", 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bss->bssid)); 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, cmd, strlen(cmd), 0, 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) from, fromlen); 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(bss->bss_ctx, cli->addr, ie, ielen, 0); 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_disassoc(struct wpa_driver_test_data *drv, 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen) 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = test_driver_get_cli(drv, from, fromlen); 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!cli) 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->ctx, cli->addr); 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_eapol(struct wpa_driver_test_data *drv, 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen, 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *data, size_t datalen) 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *src = NULL; 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (datalen > 14) { 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Skip Ethernet header */ 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt src = data + ETH_ALEN; 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: dst=" MACSTR " src=" 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " proto=%04x", 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(data), MAC2STR(src), 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_GET_BE16(data + 2 * ETH_ALEN)); 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data += 14; 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt datalen -= 14; 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = test_driver_get_cli(drv, from, fromlen); 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cli) { 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(cli->bss->bss_ctx, cli->addr, data, 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt datalen); 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_socket: EAPOL from unknown " 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "client"); 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* HOSTAPD */ 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (src) 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->ctx, src, data, datalen); 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_ether(struct wpa_driver_test_data *drv, 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen, 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *data, size_t datalen) 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (datalen < sizeof(*eth)) 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) data; 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: RX ETHER dst=" MACSTR " src=" 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " proto=%04x", 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(eth->h_dest), MAC2STR(eth->h_source), 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt be_to_host16(eth->h_proto)); 7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211R 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (be_to_host16(eth->h_proto) == ETH_P_RRB) { 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data ev; 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&ev, 0, sizeof(ev)); 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev.ft_rrb_rx.src = eth->h_source; 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev.ft_rrb_rx.data = data + sizeof(*eth); 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ev.ft_rrb_rx.data_len = datalen - sizeof(*eth); 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211R */ 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_mlme(struct wpa_driver_test_data *drv, 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un *from, socklen_t fromlen, 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *data, size_t datalen) 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211_hdr *hdr; 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 fc; 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int freq = 0, own_freq; 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (datalen > 6 && os_memcmp(data, "freq=", 5) == 0) { 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t pos; 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (pos = 5; pos < datalen; pos++) { 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data[pos] == ' ') 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos < datalen) { 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq = atoi((const char *) &data[5]); 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver(%s): MLME RX on " 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "freq %d MHz", bss->ifname, freq); 7718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data += pos; 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt datalen -= pos; 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->remain_on_channel_freq) 7788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt own_freq = drv->remain_on_channel_freq; 7798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 7808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt own_freq = drv->current_freq; 7818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq && own_freq && freq != own_freq) { 7838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver(%s): Ignore MLME RX on " 7848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "another frequency %d MHz (own %d MHz)", 7858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ifname, freq, own_freq); 7868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct ieee80211_hdr *) data; 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (test_driver_get_cli(drv, from, fromlen) == NULL && datalen >= 16) { 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = os_zalloc(sizeof(*cli)); 7948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cli == NULL) 7958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Adding client entry for " MACSTR, 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(hdr->addr2)); 7988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(cli->addr, hdr->addr2, ETH_ALEN); 7998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&cli->un, from, sizeof(cli->un)); 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->unlen = fromlen; 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->next = drv->cli; 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->cli = cli; 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "test_driver_mlme: received frame", 8068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data, datalen); 8078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fc = le_to_host16(hdr->frame_control); 8088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) { 8098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "%s: received non-mgmt frame", 8108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__); 8118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 8158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_mgmt.frame = data; 8168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_mgmt.frame_len = datalen; 8178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_RX_MGMT, &event); 8188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_driver_receive_unix(int sock, void *eloop_ctx, void *sock_ctx) 8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char buf[2000]; 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int res; 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un from; 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen = sizeof(from); 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = recvfrom(sock, buf, sizeof(buf) - 1, 0, 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &from, &fromlen); 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res < 0) { 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("recvfrom(test_socket)"); 8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[res] = '\0'; 8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: received %u bytes", res); 8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strncmp(buf, "SCAN", 4) == 0) { 8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_scan(drv, &from, fromlen, buf + 4); 8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(buf, "ASSOC ", 6) == 0) { 8428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_assoc(drv, &from, fromlen, buf + 6); 8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strcmp(buf, "DISASSOC") == 0) { 8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_disassoc(drv, &from, fromlen); 8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(buf, "EAPOL ", 6) == 0) { 8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_eapol(drv, &from, fromlen, (u8 *) buf + 6, 8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res - 6); 8488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(buf, "ETHER ", 6) == 0) { 8498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_ether(drv, &from, fromlen, (u8 *) buf + 6, 8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res - 6); 8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(buf, "MLME ", 5) == 0) { 8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_mlme(drv, &from, fromlen, (u8 *) buf + 5, res - 5); 8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "Unknown test_socket command", 8558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) buf, res); 8568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_set_generic_elem(void *priv, 8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *elem, size_t elem_len) 8628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss = priv; 8648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->ie); 8668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (elem == NULL) { 8688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ie = NULL; 8698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ielen = 0; 8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ie = os_malloc(elem_len); 8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss->ie == NULL) { 8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ielen = 0; 8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(bss->ie, elem, elem_len); 8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ielen = elem_len; 8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 8828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 8878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 8888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss = priv; 8908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (beacon == NULL) 8928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Clear Beacon WPS IE"); 8938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 8948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "test_driver: Beacon WPS IE", 8958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon); 8968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->wps_beacon_ie); 8988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (beacon == NULL) { 9008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_beacon_ie = NULL; 9018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_beacon_ie_len = 0; 9028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 9038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_beacon_ie = os_malloc(wpabuf_len(beacon)); 9048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss->wps_beacon_ie == NULL) { 9058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_beacon_ie_len = 0; 9068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->wps_beacon_ie, wpabuf_head(beacon), 9108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(beacon)); 9118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_beacon_ie_len = wpabuf_len(beacon); 9128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (proberesp == NULL) 9158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Clear Probe Response WPS " 9168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "IE"); 9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "test_driver: Probe Response WPS " 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "IE", proberesp); 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(bss->wps_probe_resp_ie); 9228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (proberesp == NULL) { 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie = NULL; 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie_len = 0; 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie = os_malloc(wpabuf_len(proberesp)); 9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss->wps_probe_resp_ie == NULL) { 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie_len = 0; 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->wps_probe_resp_ie, wpabuf_head(proberesp), 9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(proberesp)); 9358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->wps_probe_resp_ie_len = wpabuf_len(proberesp); 9368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 9398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_sta_deauth(void *priv, const u8 *own_addr, 9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int reason) 9448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = drv->cli; 9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(cli->addr, addr, ETH_ALEN) == 0) 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 9578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!cli) 9608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sendto(drv->test_socket, "DEAUTH", 6, 0, 9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &cli->un, cli->unlen); 9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_sta_disassoc(void *priv, const u8 *own_addr, 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int reason) 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = drv->cli; 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(cli->addr, addr, ETH_ALEN) == 0) 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!cli) 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return sendto(drv->test_socket, "DISASSOC", 8, 0, 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &cli->un, cli->unlen); 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_bss_add(void *priv, const char *ifname, const u8 *bssid, 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *bss_ctx, void **drv_priv) 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(ifname=%s bssid=" MACSTR ")", 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ifname, MAC2STR(bssid)); 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = os_zalloc(sizeof(*bss)); 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss == NULL) 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bss_ctx = bss_ctx; 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->drv = drv; 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(bss->ifname, ifname, IFNAMSIZ); 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->bssid, bssid, ETH_ALEN); 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&drv->bss, &bss->list); 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->global) { 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->global->bss_add_used = 1; 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->global->req_addr, bssid, ETH_ALEN); 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv_priv) 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *drv_priv = bss; 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_bss_remove(void *priv, const char *ifname) 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli, *prev_c; 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, ifname); 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_for_each(bss, &drv->bss, struct test_driver_bss, list) { 10348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(bss->ifname, ifname) != 0) 10358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 10368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (prev_c = NULL, cli = drv->cli; cli; 10388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt prev_c = cli, cli = cli->next) { 10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cli->bss != bss) 10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (prev_c) 10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt prev_c->next = cli->next; 10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->cli = cli->next; 10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cli); 10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_del(&bss->list); 10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_free_bss(bss); 10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_if_add(void *priv, enum wpa_driver_if_type type, 10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *ifname, const u8 *addr, 10608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *bss_ctx, void **drv_priv, 10618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *force_ifname, u8 *if_addr, 10628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *bridge) 10638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 10658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 10668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s bss_ctx=%p)", 10688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, type, ifname, bss_ctx); 10698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr) 10708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(if_addr, addr, ETH_ALEN); 10718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else { 10728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->alloc_iface_idx++; 10738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_addr[0] = 0x02; /* locally administered */ 10748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sha1_prf(drv->own_addr, ETH_ALEN, 10758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "hostapd test addr generation", 10768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) &drv->alloc_iface_idx, 10778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->alloc_iface_idx), 10788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if_addr + 1, ETH_ALEN - 1); 10798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (type == WPA_IF_AP_BSS || type == WPA_IF_P2P_GO || 10818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt type == WPA_IF_P2P_CLIENT || type == WPA_IF_P2P_GROUP) 10828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return test_driver_bss_add(priv, ifname, if_addr, bss_ctx, 10838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_priv); 10848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_if_remove(void *priv, enum wpa_driver_if_type type, 10898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *ifname) 10908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(type=%d ifname=%s)", __func__, type, ifname); 10928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (type == WPA_IF_AP_BSS || type == WPA_IF_P2P_GO || 10938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt type == WPA_IF_P2P_CLIENT || type == WPA_IF_P2P_GROUP) 10948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return test_driver_bss_remove(priv, ifname); 10958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_set_ssid(void *priv, const u8 *buf, int len) 11008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss = priv; 11028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(ifname=%s)", __func__, bss->ifname); 11048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < 0) 11058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 11068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "test_driver_set_ssid: SSID", buf, len); 11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((size_t) len > sizeof(bss->ssid)) 11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->ssid, buf, len); 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ssid_len = len; 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_set_privacy(void *priv, int enabled) 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(enabled=%d)", __func__, enabled); 11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->privacy = enabled; 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_set_sta_vlan(void *priv, const u8 *addr, 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *ifname, int vlan_id) 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(addr=" MACSTR " ifname=%s vlan_id=%d)", 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), ifname, vlan_id); 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_driver_sta_add(void *priv, 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_sta_add_params *params) 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss = priv; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = bss->drv; 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli; 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(ifname=%s addr=" MACSTR " aid=%d " 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "capability=0x%x listen_interval=%d)", 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, bss->ifname, MAC2STR(params->addr), params->aid, 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->capability, params->listen_interval); 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "test_driver_sta_add - supp_rates", 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->supp_rates, params->supp_rates_len); 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = drv->cli; 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(cli->addr, params->addr, ETH_ALEN) == 0) 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!cli) { 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: no matching client entry", 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__); 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli->bss = bss; 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpa_driver_test_data * test_alloc_data(void *ctx, 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *ifname) 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv; 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct wpa_driver_test_data)); 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "Could not allocate memory for test " 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "driver data"); 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = os_zalloc(sizeof(struct test_driver_bss)); 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss == NULL) { 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv); 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ctx = ctx; 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_trace_add_ref(drv, ctx, ctx); 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_init(&drv->bss); 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dl_list_add(&drv->bss, &bss->list); 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(bss->ifname, ifname, IFNAMSIZ); 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bss_ctx = ctx; 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->drv = drv; 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Generate a MAC address to help testing with multiple STAs */ 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_addr[0] = 0x02; /* locally administered */ 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sha1_prf((const u8 *) ifname, os_strlen(ifname), 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "test mac addr generation", 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 0, drv->own_addr + 1, ETH_ALEN - 1); 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * test_driver_init(struct hostapd_data *hapd, 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_init_params *params) 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv; 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr_un; 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_in addr_in; 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *addr; 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t alen; 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = test_alloc_data(hapd, params->ifname); 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ap = 1; 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 12221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->global = params->global_priv; 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bss_ctx = hapd; 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->bssid, drv->own_addr, ETH_ALEN); 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(params->own_addr, drv->own_addr, ETH_ALEN); 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->test_socket) { 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strlen(params->test_socket) >= 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(addr_un.sun_path)) { 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Too long test_socket path\n"); 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_deinit(bss); 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strncmp(params->test_socket, "DIR:", 4) == 0) { 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len = strlen(params->test_socket) + 30; 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir = os_strdup(params->test_socket + 4); 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = os_malloc(len); 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path) { 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(drv->own_socket_path, len, 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/AP-" MACSTR, 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->test_socket + 4, 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(params->own_addr)); 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(params->test_socket, "UDP:", 4) == 0) { 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->udp_port = atoi(params->test_socket + 4); 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = os_strdup(params->test_socket); 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path == NULL && drv->udp_port == 0) { 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_deinit(bss); 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = socket(drv->udp_port ? PF_INET : PF_UNIX, 12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt SOCK_DGRAM, 0); 12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) { 12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("socket"); 12598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_deinit(bss); 12608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->udp_port) { 12648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr_in, 0, sizeof(addr_in)); 12658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr_in.sin_family = AF_INET; 12668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr_in.sin_port = htons(drv->udp_port); 12678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr = (struct sockaddr *) &addr_in; 12688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = sizeof(addr_in); 12698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr_un, 0, sizeof(addr_un)); 12718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr_un.sun_family = AF_UNIX; 12728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(addr_un.sun_path, drv->own_socket_path, 12738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(addr_un.sun_path)); 12748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr = (struct sockaddr *) &addr_un; 12758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = sizeof(addr_un); 12768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bind(drv->test_socket, addr, alen) < 0) { 12788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("bind(PF_UNIX)"); 12798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->test_socket); 12808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path) 12818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unlink(drv->own_socket_path); 12828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_deinit(bss); 12838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_read_sock(drv->test_socket, 12868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_receive_unix, drv, NULL); 12878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 12888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = -1; 12898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return bss; 12918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_poll(void *eloop_ctx, void *timeout_ctx) 12958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 12998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->associated && drv->hostapd_addr_set) { 13008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct stat st; 13018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (stat(drv->hostapd_addr.sun_path, &st) < 0) { 13028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: lost connection to AP: %s", 13038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 13048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 0; 13058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_DISASSOC, NULL); 13068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 13098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(1, 0, wpa_driver_test_poll, drv, NULL); 13118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_scan_timeout(void *eloop_ctx, void *timeout_ctx) 13158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 13178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Scan timeout - try to get results"); 13188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->pending_p2p_scan && drv->p2p) { 13198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 13208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 13218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < drv->num_scanres; i++) { 13228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_scan_res *bss = drv->scanres[i]; 13238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (p2p_scan_res_handler(drv->p2p, bss->bssid, 13248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->freq, bss->level, 13258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) (bss + 1), 13268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ie_len) > 0) 13278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_scan_res_handled(drv->p2p); 13308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 13318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(timeout_ctx, EVENT_SCAN_RESULTS, NULL); 13348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 13388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_scan_dir(struct wpa_driver_test_data *drv, 13398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *path) 13408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct dirent *dent; 13428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt DIR *dir; 13438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr; 13448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char cmd[512], *pos, *end; 13458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 13468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dir = opendir(path); 13488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dir == NULL) 13498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = cmd + sizeof(cmd); 13528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = cmd; 13538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, "SCAN " MACSTR, 13548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(drv->own_addr)); 13558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret >= 0 && ret < end - pos) 13568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 13578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->probe_req_ie) { 13588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, " "); 13598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret >= 0 && ret < end - pos) 13608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 13618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, drv->probe_req_ie, 13628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie_len); 13638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->probe_req_ssid_len) { 13658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Add SSID IE */ 13668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, "%02x%02x", 13678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_EID_SSID, 13688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned int) drv->probe_req_ssid_len); 13698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret >= 0 && ret < end - pos) 13708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 13718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, drv->probe_req_ssid, 13728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ssid_len); 13738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end[-1] = '\0'; 13758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((dent = readdir(dir))) { 13778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strncmp(dent->d_name, "AP-", 3) != 0 && 13788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strncmp(dent->d_name, "STA-", 4) != 0) 13798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 13808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path) { 13818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t olen, dlen; 13828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt olen = os_strlen(drv->own_socket_path); 13838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dlen = os_strlen(dent->d_name); 13848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (olen >= dlen && 13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strcmp(dent->d_name, 13868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path + olen - dlen) == 0) 13878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: SCAN %s", __func__, dent->d_name); 13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr, 0, sizeof(addr)); 13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr.sun_path, sizeof(addr.sun_path), "%s/%s", 13948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt path, dent->d_name); 13958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sendto(drv->test_socket, cmd, os_strlen(cmd), 0, 13978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &addr, sizeof(addr)) < 0) { 13988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt closedir(dir); 14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_scan(void *priv, 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_scan_params *params) 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 14128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: priv=%p", __func__, priv); 14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->probe_req_ie); 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->extra_ies) { 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie = os_malloc(params->extra_ies_len); 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->probe_req_ie == NULL) { 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie_len = 0; 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->probe_req_ie, params->extra_ies, 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->extra_ies_len); 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie_len = params->extra_ies_len; 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie = NULL; 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ie_len = 0; 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < params->num_ssids; i++) 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "Scan SSID", 14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->ssids[i].ssid, params->ssids[i].ssid_len); 14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ssid_len = 0; 14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->num_ssids) { 14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->probe_req_ssid, params->ssids[0].ssid, 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->ssids[0].ssid_len); 14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_ssid_len = params->ssids[0].ssid_len; 14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "Scan extra IE(s)", 14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->extra_ies, params->extra_ies_len); 14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->num_scanres = 0; 14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0 && drv->test_dir) 14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_scan_dir(drv, drv->test_dir); 14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0 && drv->hostapd_addr_set && 14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, "SCAN", 4, 0, 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr, 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr)) < 0) { 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0 && drv->hostapd_addr_udp_set && 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, "SCAN", 4, 0, 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr_udp, 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr_udp)) < 0) { 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_driver_test_scan_timeout, drv, drv->ctx); 14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(1, 0, wpa_driver_test_scan_timeout, drv, 14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ctx); 14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpa_scan_results * wpa_driver_test_get_scan_results2(void *priv) 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_scan_results *res; 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = os_zalloc(sizeof(*res)); 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res == NULL) 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->res = os_zalloc(drv->num_scanres * sizeof(struct wpa_scan_res *)); 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res->res == NULL) { 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(res); 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < drv->num_scanres; i++) { 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_scan_res *r; 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->scanres[i] == NULL) 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt r = os_malloc(sizeof(*r) + drv->scanres[i]->ie_len); 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (r == NULL) 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(r, drv->scanres[i], 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(*r) + drv->scanres[i]->ie_len); 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->res[res->num++] = r; 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return res; 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_set_key(const char *ifname, void *priv, 15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt enum wpa_alg alg, const u8 *addr, 15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int key_idx, int set_tx, 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *seq, size_t seq_len, 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *key, size_t key_len) 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: ifname=%s priv=%p alg=%d key_idx=%d " 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "set_tx=%d", 15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ifname, priv, alg, key_idx, set_tx); 15128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr) 15138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, " addr=" MACSTR, MAC2STR(addr)); 15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (seq) 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, " seq", seq, seq_len); 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key) 15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_key(MSG_DEBUG, " key", key, key_len); 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_update_mode(struct wpa_driver_test_data *drv, int ap) 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ap && !drv->ap) { 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_close_test_socket(drv); 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_attach(drv, drv->test_dir, 1); 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ap = 1; 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (!ap && drv->ap) { 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_close_test_socket(drv); 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_attach(drv, drv->test_dir, 0); 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ap = 0; 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_associate( 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *priv, struct wpa_driver_associate_params *params) 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: priv=%p freq=%d pairwise_suite=%d " 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "group_suite=%d key_mgmt_suite=%d auth_alg=%d mode=%d", 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, priv, params->freq, params->pairwise_suite, 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->group_suite, params->key_mgmt_suite, 15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->auth_alg, params->mode); 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_update_mode(drv, params->mode == IEEE80211_MODE_AP); 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bssid) { 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, " bssid=" MACSTR, 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(params->bssid)); 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ssid) { 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, " ssid", 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->ssid, params->ssid_len); 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_ie) { 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_DEBUG, " wpa_ie", 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_ie, params->wpa_ie_len); 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->assoc_wpa_ie_len = params->wpa_ie_len; 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->assoc_wpa_ie_len > sizeof(drv->assoc_wpa_ie)) 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->assoc_wpa_ie_len = sizeof(drv->assoc_wpa_ie); 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->assoc_wpa_ie, params->wpa_ie, 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->assoc_wpa_ie_len); 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->assoc_wpa_ie_len = 0; 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_update_mode(drv, params->mode == IEEE80211_MODE_AP); 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ibss = params->mode == IEEE80211_MODE_IBSS; 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->privacy = params->key_mgmt_suite & 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (WPA_KEY_MGMT_IEEE8021X | 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_PSK | 15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_WPA_NONE | 15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_FT_IEEE8021X | 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_FT_PSK | 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_IEEE8021X_SHA256 | 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_KEY_MGMT_PSK_SHA256); 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wep_key_len[params->wep_tx_keyidx]) 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->privacy = 1; 15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_dir && params->bssid && 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->mode != IEEE80211_MODE_IBSS) { 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&drv->hostapd_addr, 0, sizeof(drv->hostapd_addr)); 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr.sun_family = AF_UNIX; 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(drv->hostapd_addr.sun_path, 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr.sun_path), 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/AP-" MACSTR, 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir, MAC2STR(params->bssid)); 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr_set = 1; 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->mode == IEEE80211_MODE_AP) { 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->ssid, params->ssid, params->ssid_len); 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ssid_len = params->ssid_len; 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->bssid, drv->own_addr, ETH_ALEN); 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_ie && params->wpa_ie_len) { 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ie = os_malloc(params->wpa_ie_len); 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dbss->ie) { 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->ie, params->wpa_ie, 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_ie_len); 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ielen = params->wpa_ie_len; 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (drv->test_socket >= 0 && 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->hostapd_addr_set || drv->hostapd_addr_udp_set)) { 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char cmd[200], *pos, *end; 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = cmd + sizeof(cmd); 16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = cmd; 16138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, "ASSOC " MACSTR " ", 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(drv->own_addr)); 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret >= 0 && ret < end - pos) 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, params->ssid, 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->ssid_len); 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, " "); 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret >= 0 && ret < end - pos) 16218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, params->wpa_ie, 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_ie_len); 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end[-1] = '\0'; 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->hostapd_addr_set && 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, cmd, os_strlen(cmd), 0, 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr, 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr)) < 0) { 16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->hostapd_addr_udp_set && 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, cmd, os_strlen(cmd), 0, 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr_udp, 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr_udp)) < 0) { 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->ssid, params->ssid, params->ssid_len); 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ssid_len = params->ssid_len; 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 1; 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->mode == IEEE80211_MODE_IBSS) { 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->ssid, params->ssid, params->ssid_len); 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->ssid_len = params->ssid_len; 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bssid) 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(dbss->bssid, params->bssid, 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_ALEN); 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else { 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_get_random(dbss->bssid, ETH_ALEN); 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->bssid[0] &= ~0x01; 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dbss->bssid[0] |= 0x02; 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_ASSOC, NULL); 16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_get_bssid(void *priv, u8 *bssid) 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 16688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bssid, dbss->bssid, ETH_ALEN); 16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_get_ssid(void *priv, u8 *ssid) 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(ssid, dbss->ssid, 32); 16778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return dbss->ssid_len; 16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_send_disassoc(struct wpa_driver_test_data *drv) 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0 && 16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, "DISASSOC", 8, 0, 16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr, 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr)) < 0) { 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0 && drv->hostapd_addr_udp_set && 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, "DISASSOC", 8, 0, 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &drv->hostapd_addr_udp, 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(drv->hostapd_addr_udp)) < 0) { 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendto(test_socket)"); 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_deauthenticate(void *priv, const u8 *addr, 17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 17078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 17088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s addr=" MACSTR " reason_code=%d", 17098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 17108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(dbss->bssid, 0, ETH_ALEN); 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 0; 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_DISASSOC, NULL); 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return wpa_driver_test_send_disassoc(drv); 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_disassociate(void *priv, const u8 *addr, 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s addr=" MACSTR " reason_code=%d", 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(dbss->bssid, 0, ETH_ALEN); 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 0; 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_DISASSOC, NULL); 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return wpa_driver_test_send_disassoc(drv); 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const u8 * wpa_scan_get_ie(const struct wpa_scan_res *res, u8 ie) 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *end, *pos; 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (const u8 *) (res + 1); 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = pos + res->ie_len; 17378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (pos + 1 < end) { 17398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos + 2 + pos[1] > end) 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos[0] == ie) 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return pos; 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 2 + pos[1]; 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_scanresp(struct wpa_driver_test_data *drv, 17518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 17528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen, 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *data) 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_scan_res *res; 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *pos, *pos2; 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *ie_pos, *ie_start, *ie_end; 17598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MAX_IE_LEN 1000 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ds_params; 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: SCANRESP %s", data); 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->num_scanres >= MAX_SCAN_RESULTS) { 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: No room for the new scan " 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "result"); 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* SCANRESP BSSID SSID IEs */ 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = os_zalloc(sizeof(*res) + MAX_IE_LEN); 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res == NULL) 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie_start = ie_pos = (u8 *) (res + 1); 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie_end = ie_pos + MAX_IE_LEN; 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(data, res->bssid)) { 17788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: invalid BSSID in scanres"); 17798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(res); 17808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data + 17; 17848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*pos == ' ') 17858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 17868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos2 = os_strchr(pos, ' '); 17878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos2 == NULL) { 17888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: invalid SSID termination " 17898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "in scanres"); 17908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(res); 17918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 17928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = (pos2 - pos) / 2; 17948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > 32) 17958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = 32; 17968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 17978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Generate SSID IE from the SSID field since this IE is not included 17988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * in the main IE field. 17998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 18008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *ie_pos++ = WLAN_EID_SSID; 18018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *ie_pos++ = len; 18028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(pos, ie_pos, len) < 0) { 18038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: invalid SSID in scanres"); 18048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(res); 18058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 18068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie_pos += len; 18088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = pos2 + 1; 18108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos2 = os_strchr(pos, ' '); 18118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos2 == NULL) 18128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = os_strlen(pos) / 2; 18138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 18148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = (pos2 - pos) / 2; 18158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((int) len > ie_end - ie_pos) 18168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = ie_end - ie_pos; 18178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(pos, ie_pos, len) < 0) { 18188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: invalid IEs in scanres"); 18198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(res); 18208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 18218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie_pos += len; 18238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->ie_len = ie_pos - ie_start; 18248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos2) { 18268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = pos2 + 1; 18278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*pos == ' ') 18288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 18298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strstr(pos, "PRIVACY")) 18308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->caps |= IEEE80211_CAP_PRIVACY; 18318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strstr(pos, "IBSS")) 18328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->caps |= IEEE80211_CAP_IBSS; 18338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ds_params = wpa_scan_get_ie(res, WLAN_EID_DS_PARAMS); 18368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ds_params && ds_params[1] > 0) { 18378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ds_params[2] >= 1 && ds_params[2] <= 13) 18388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res->freq = 2407 + ds_params[2] * 5; 18398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->scanres[drv->num_scanres]); 18428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->scanres[drv->num_scanres++] = res; 18438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_assocresp(struct wpa_driver_test_data *drv, 18478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 18488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen, 18498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *data) 18508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 18528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 18548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* ASSOCRESP BSSID <res> */ 18568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(data, bss->bssid)) { 18578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: invalid BSSID in " 18588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "assocresp"); 18598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->use_associnfo) { 18618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 18628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 18638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.assoc_info.req_ies = drv->assoc_wpa_ie; 18648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.assoc_info.req_ies_len = drv->assoc_wpa_ie_len; 18658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_ASSOCINFO, &event); 18668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 18678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 1; 18688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_ASSOC, NULL); 18698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_disassoc(struct wpa_driver_test_data *drv, 18738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 18748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen) 18758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->associated = 0; 18778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_DISASSOC, NULL); 18788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 18798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_eapol(struct wpa_driver_test_data *drv, 18828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 18838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen, 18848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *data, size_t data_len) 18858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 18868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *src; 18878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 18888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 18908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data_len > 14) { 18928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Skip Ethernet header */ 18938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt src = data + ETH_ALEN; 18948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data += 14; 18958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data_len -= 14; 18968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 18978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt src = bss->bssid; 18988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 18998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->ctx, src, data, data_len); 19008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 19018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_mlme(struct wpa_driver_test_data *drv, 19048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 19058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen, 19068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *data, size_t data_len) 19078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 19088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int freq = 0, own_freq; 19098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 19108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 19118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 fc; 19128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 19138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 19158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data_len > 6 && os_memcmp(data, "freq=", 5) == 0) { 19168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t pos; 19178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (pos = 5; pos < data_len; pos++) { 19188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (data[pos] == ' ') 19198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 19208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos < data_len) { 19228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq = atoi((const char *) &data[5]); 19238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver(%s): MLME RX on " 19248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "freq %d MHz", bss->ifname, freq); 19258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos++; 19268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data += pos; 19278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data_len -= pos; 19288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->remain_on_channel_freq) 19328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt own_freq = drv->remain_on_channel_freq; 19338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 19348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt own_freq = drv->current_freq; 19358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq && own_freq && freq != own_freq) { 19378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver(%s): Ignore MLME RX on " 19388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "another frequency %d MHz (own %d MHz)", 19398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ifname, freq, own_freq); 19408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 19418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 19448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.mlme_rx.buf = data; 19458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.mlme_rx.len = data_len; 19468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.mlme_rx.freq = freq; 19478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_MLME_RX, &event); 19488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) data; 19508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 19518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->probe_req_report && data_len >= 24) { 19538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_MGMT && 19548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_STYPE(fc) == WLAN_FC_STYPE_PROBE_REQ) { 19558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 19568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.sa = mgmt->sa; 19571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.da = mgmt->da; 19581f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.bssid = mgmt->bssid; 19598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie = mgmt->u.probe_req.variable; 19608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie_len = 19618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data_len - (mgmt->u.probe_req.variable - data); 19628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_RX_PROBE_REQ, 19638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &event); 19648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 19658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) 19668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_probe_req_rx(drv->p2p, mgmt->sa, 19671f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt mgmt->da, mgmt->bssid, 19688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie, 19698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie_len); 19708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 19718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 19758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p && 19768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_MGMT && 19778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_STYPE(fc) == WLAN_FC_STYPE_ACTION) { 19788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t hdr_len; 19798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr_len = (const u8 *) 19808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &mgmt->u.action.u.vs_public_action.action - data; 19818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_rx_action(drv->p2p, mgmt->da, mgmt->sa, mgmt->bssid, 19828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mgmt->u.action.category, 19838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &mgmt->u.action.u.vs_public_action.action, 19848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data_len - hdr_len, freq); 19858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 19868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 19878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 19898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 19918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_scan_cmd(struct wpa_driver_test_data *drv, 19928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *from, 19938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen, 19948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *data, size_t data_len) 19958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 19968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char buf[512], *pos, *end; 19978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 19988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 19998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 20018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* data: optional [ STA-addr | ' ' | IEs(hex) ] */ 20038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 20048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->probe_req_report && drv->p2p && data_len) { 20058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *d = (const char *) data; 20068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 sa[ETH_ALEN]; 20078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 ie[512]; 20088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t ielen; 20098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(d, sa)) 20118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt d += 18; 20138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (*d == ' ') 20148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt d++; 20158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = os_strlen(d) / 2; 20168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen > sizeof(ie)) 20178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = sizeof(ie); 20188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hexstr2bin(d, ie, ielen) < 0) 20198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = 0; 20208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_from = from; 20218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_from_len = fromlen; 20221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt p2p_probe_req_rx(drv->p2p, sa, NULL, NULL, ie, ielen); 20238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_from = NULL; 20248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 20268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->ibss) 20288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = buf; 20318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = buf + sizeof(buf); 20328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* reply: SCANRESP BSSID SSID IEs */ 20348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, "SCANRESP " MACSTR " ", 20358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(bss->bssid)); 20368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 20378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 20398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, 20408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ssid, bss->ssid_len); 20418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, " "); 20428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 20438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 20458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, drv->assoc_wpa_ie, 20468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->assoc_wpa_ie_len); 20478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bss->privacy) { 20498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, " PRIVACY"); 20508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 20518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 20538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = snprintf(pos, end - pos, " IBSS"); 20568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 20578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 20598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, buf, pos - buf, 0, 20618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) from, fromlen); 20628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 20638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_receive_unix(int sock, void *eloop_ctx, 20668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *sock_ctx) 20678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 20688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 20698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *buf; 20708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int res; 20718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_storage from; 20728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t fromlen = sizeof(from); 20738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const size_t buflen = 2000; 20748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ap) { 20768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_receive_unix(sock, eloop_ctx, sock_ctx); 20778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = os_malloc(buflen); 20818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 20828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt res = recvfrom(sock, buf, buflen - 1, 0, 20848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (struct sockaddr *) &from, &fromlen); 20858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (res < 0) { 20868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("recvfrom(test_socket)"); 20878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(buf); 20888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 20898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 20908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[res] = '\0'; 20918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: received %u bytes", res); 20938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 20948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strncmp(buf, "SCANRESP ", 9) == 0) { 20958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_scanresp(drv, (struct sockaddr *) &from, 20968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen, buf + 9); 20978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strncmp(buf, "ASSOCRESP ", 10) == 0) { 20988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_assocresp(drv, (struct sockaddr *) &from, 20998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen, buf + 10); 21008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strcmp(buf, "DISASSOC") == 0) { 21018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_disassoc(drv, (struct sockaddr *) &from, 21028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen); 21038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strcmp(buf, "DEAUTH") == 0) { 21048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_disassoc(drv, (struct sockaddr *) &from, 21058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen); 21068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strncmp(buf, "EAPOL ", 6) == 0) { 21078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_eapol(drv, (struct sockaddr *) &from, fromlen, 21088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) buf + 6, res - 6); 21098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strncmp(buf, "MLME ", 5) == 0) { 21108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_mlme(drv, (struct sockaddr *) &from, fromlen, 21118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) buf + 5, res - 5); 21128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (os_strncmp(buf, "SCAN ", 5) == 0) { 21138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_scan_cmd(drv, (struct sockaddr *) &from, 21148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fromlen, 21158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (const u8 *) buf + 5, res - 5); 21168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 21178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "Unknown test_socket command", 21188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) buf, res); 21198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(buf); 21218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 21228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * wpa_driver_test_init2(void *ctx, const char *ifname, 21258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt void *global_priv) 21268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 21278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv; 21288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_global *global = global_priv; 21298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *bss; 21308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = test_alloc_data(ctx, ifname); 21328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) 21338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 21348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss = dl_list_first(&drv->bss, struct test_driver_bss, list); 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->global = global_priv; 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = -1; 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Set dummy BSSID and SSID for testing. */ 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[0] = 0x02; 21408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[1] = 0x00; 21418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[2] = 0x00; 21428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[3] = 0x00; 21438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[4] = 0x00; 21448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->bssid[5] = 0x01; 21458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(bss->ssid, "test", 5); 21468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bss->ssid_len = 4; 21478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (global->bss_add_used) { 21498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->own_addr, global->req_addr, ETH_ALEN); 21508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt global->bss_add_used = 0; 21518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(1, 0, wpa_driver_test_poll, drv, NULL); 21548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return bss; 21568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 21578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_close_test_socket(struct wpa_driver_test_data *drv) 21608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 21618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket >= 0) { 21628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_unregister_read_sock(drv->test_socket); 21638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->test_socket); 21648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = -1; 21658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path) { 21688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unlink(drv->own_socket_path); 21698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->own_socket_path); 21708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = NULL; 21718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 21738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_deinit(void *priv) 21768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 21778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 21788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 21798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_client_socket *cli, *prev; 21808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 21818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 21838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) 21848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_deinit(drv->p2p); 21858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->pending_action_tx); 21868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 21878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = drv->cli; 21898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (cli) { 21908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt prev = cli; 21918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cli = cli->next; 21928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(prev); 21938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 21948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 21958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef HOSTAPD 21968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* There should be only one BSS remaining at this point. */ 21978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dl_list_len(&drv->bss) != 1) 21988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "%s: %u remaining BSS entries", 21998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, dl_list_len(&drv->bss)); 22008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* HOSTAPD */ 22018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_driver_free_bsses(drv); 22038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_close_test_socket(drv); 22058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_driver_test_scan_timeout, drv, drv->ctx); 22068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(wpa_driver_test_poll, drv, NULL); 22078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(test_remain_on_channel_timeout, drv, NULL); 22088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->test_dir); 22098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < MAX_SCAN_RESULTS; i++) 22108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->scanres[i]); 22118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->probe_req_ie); 22128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_trace_remove_ref(drv, ctx, drv->ctx); 22138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv); 22148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 22158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_attach(struct wpa_driver_test_data *drv, 22188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *dir, int ap) 22198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 22208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 22218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static unsigned int counter = 0; 22228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr; 22238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 22248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->own_socket_path); 22268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dir) { 22278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = os_strlen(dir) + 30; 22288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = os_malloc(len); 22298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path == NULL) 22308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(drv->own_socket_path, len, "%s/%s-" MACSTR, 22328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dir, ap ? "AP" : "STA", MAC2STR(drv->own_addr)); 22338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 22348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = os_malloc(100); 22358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->own_socket_path == NULL) 22368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(drv->own_socket_path, 100, 22388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "/tmp/wpa_supplicant_test-%d-%d", 22398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt getpid(), counter++); 22408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = socket(PF_UNIX, SOCK_DGRAM, 0); 22438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) { 22448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("socket(PF_UNIX)"); 22458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->own_socket_path); 22468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = NULL; 22478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr, 0, sizeof(addr)); 22518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr.sun_family = AF_UNIX; 22528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(addr.sun_path, drv->own_socket_path, sizeof(addr.sun_path)); 22538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bind(drv->test_socket, (struct sockaddr *) &addr, 22548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(addr)) < 0) { 22558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("bind(PF_UNIX)"); 22568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->test_socket); 22578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unlink(drv->own_socket_path); 22588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->own_socket_path); 22598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->own_socket_path = NULL; 22608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_read_sock(drv->test_socket, 22648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_receive_unix, drv, NULL); 22658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 22678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* DRIVER_TEST_UNIX */ 22688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 22708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 22718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_attach_udp(struct wpa_driver_test_data *drv, 22748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dst) 22758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 22768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 22778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strchr(dst, ':'); 22798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) 22808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = '\0'; 22828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s port=%s", __func__, dst, pos); 22838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_socket = socket(PF_INET, SOCK_DGRAM, 0); 22858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_socket < 0) { 22868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("socket(PF_INET)"); 22878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 22888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 22898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 22908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&drv->hostapd_addr_udp, 0, sizeof(drv->hostapd_addr_udp)); 22918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr_udp.sin_family = AF_INET; 22928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#if defined(CONFIG_NATIVE_WINDOWS) || defined(CONFIG_ANSI_C_EXTRA) 22938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 22948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int a[4]; 22958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *pos; 22968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sscanf(dst, "%d.%d.%d.%d", &a[0], &a[1], &a[2], &a[3]); 22978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = (u8 *) &drv->hostapd_addr_udp.sin_addr; 22988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = a[0]; 22998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = a[1]; 23008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = a[2]; 23018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = a[3]; 23028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */ 23048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt inet_aton(dst, &drv->hostapd_addr_udp.sin_addr); 23058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NATIVE_WINDOWS or CONFIG_ANSI_C_EXTRA */ 23068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr_udp.sin_port = htons(atoi(pos)); 23078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr_udp_set = 1; 23098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_read_sock(drv->test_socket, 23118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_receive_unix, drv, NULL); 23128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 23148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 23158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_set_param(void *priv, const char *param) 23188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 23198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 23208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 23218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *pos; 23228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: param='%s'", __func__, param); 23248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (param == NULL) 23258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 23268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_close_test_socket(drv); 23288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 23308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strstr(param, "test_socket="); 23318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos) { 23328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *pos2; 23338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 23348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 12; 23368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos2 = os_strchr(pos, ' '); 23378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos2) 23388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = pos2 - pos; 23398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 23408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = os_strlen(pos); 23418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(drv->hostapd_addr.sun_path)) 23428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&drv->hostapd_addr, 0, sizeof(drv->hostapd_addr)); 23448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr.sun_family = AF_UNIX; 23458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->hostapd_addr.sun_path, pos, len); 23468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hostapd_addr_set = 1; 23478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 23498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strstr(param, "test_dir="); 23518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos) { 23528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *end; 23538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(drv->test_dir); 23548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir = os_strdup(pos + 9); 23558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->test_dir == NULL) 23568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = os_strchr(drv->test_dir, ' '); 23588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (end) 23598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *end = '\0'; 23608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_attach(drv, drv->test_dir, 0)) 23618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 23638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = os_strstr(param, "test_udp="); 23648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos) { 23658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dst, *epos; 23668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt dst = os_strdup(pos + 9); 23678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (dst == NULL) 23688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt epos = os_strchr(dst, ' '); 23708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (epos) 23718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *epos = '\0'; 23728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_attach_udp(drv, dst)) 23738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(dst); 23758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (wpa_driver_test_attach(drv, NULL, 0)) 23768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strstr(param, "use_associnfo=1")) { 23808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Use AssocInfo events"); 23818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->use_associnfo = 1; 23828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_strstr(param, "p2p_mgmt=1")) { 23858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test_driver: Use internal P2P " 23868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "management"); 23878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_init_p2p(drv) < 0) 23888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 23898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 23908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 23928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 23938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 23958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const u8 * wpa_driver_test_get_mac_addr(void *priv) 23968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 23978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 23988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 23998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 24008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv->own_addr; 24018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_send_eapol(void *priv, const u8 *dest, u16 proto, 24058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *data, size_t data_len) 24068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 24088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 24098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *msg; 24108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t msg_len; 24118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr eth; 24128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr *addr; 24138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt socklen_t alen; 24148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 24158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct sockaddr_un addr_un; 24168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 24178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "test_send_eapol TX frame", data, data_len); 24198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(ð, 0, sizeof(eth)); 24218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(eth.h_dest, dest, ETH_ALEN); 24228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(eth.h_source, drv->own_addr, ETH_ALEN); 24238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth.h_proto = host_to_be16(proto); 24248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg_len = 6 + sizeof(eth) + data_len; 24268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt msg = os_malloc(msg_len); 24278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (msg == NULL) 24288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 24298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(msg, "EAPOL ", 6); 24308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(msg + 6, ð, sizeof(eth)); 24318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(msg + 6 + sizeof(eth), data, data_len); 24328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (os_memcmp(dest, dbss->bssid, ETH_ALEN) == 0 || 24348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir == NULL) { 24358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->hostapd_addr_udp_set) { 24368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr = (struct sockaddr *) &drv->hostapd_addr_udp; 24378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = sizeof(drv->hostapd_addr_udp); 24388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 24398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 24408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr = (struct sockaddr *) &drv->hostapd_addr; 24418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = sizeof(drv->hostapd_addr); 24428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* DRIVER_TEST_UNIX */ 24438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(msg); 24448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 24458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 24468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 24488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef DRIVER_TEST_UNIX 24498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct stat st; 24508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&addr_un, 0, sizeof(addr_un)); 24518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr_un.sun_family = AF_UNIX; 24528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr_un.sun_path, sizeof(addr_un.sun_path), 24538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/STA-" MACSTR, drv->test_dir, MAC2STR(dest)); 24548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (stat(addr_un.sun_path, &st) < 0) { 24558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_snprintf(addr_un.sun_path, sizeof(addr_un.sun_path), 24568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "%s/AP-" MACSTR, 24578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->test_dir, MAC2STR(dest)); 24588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt addr = (struct sockaddr *) &addr_un; 24608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alen = sizeof(addr_un); 24618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* DRIVER_TEST_UNIX */ 24628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(msg); 24638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 24648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* DRIVER_TEST_UNIX */ 24658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (sendto(drv->test_socket, msg, msg_len, 0, addr, alen) < 0) { 24688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("sendmsg(test_socket)"); 24698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(msg); 24708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 24718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 24728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(msg); 24748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 24758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 24768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 24788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_get_capa(void *priv, struct wpa_driver_capa *capa) 24798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 24808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 24818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 24828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(capa, 0, sizeof(*capa)); 24838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->key_mgmt = WPA_DRIVER_CAPA_KEY_MGMT_WPA | 24848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_WPA2 | 24858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_WPA_PSK | 24868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK | 24878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_WPA_NONE | 24888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_FT | 24898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_KEY_MGMT_FT_PSK; 24908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->enc = WPA_DRIVER_CAPA_ENC_WEP40 | 24918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_ENC_WEP104 | 24928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_ENC_TKIP | 24938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_CAPA_ENC_CCMP; 24948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->auth = WPA_DRIVER_AUTH_OPEN | 24958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_AUTH_SHARED | 24968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPA_DRIVER_AUTH_LEAP; 24978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) 24988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->flags |= WPA_DRIVER_FLAGS_P2P_MGMT; 24998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->flags |= WPA_DRIVER_FLAGS_AP; 25008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->flags |= WPA_DRIVER_FLAGS_P2P_CONCURRENT; 25018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->flags |= WPA_DRIVER_FLAGS_P2P_DEDICATED_INTERFACE; 25028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->flags |= WPA_DRIVER_FLAGS_P2P_CAPABLE; 25038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->max_scan_ssids = 2; 25048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt capa->max_remain_on_chan = 60000; 25058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 25078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_mlme_setprotection(void *priv, const u8 *addr, 25118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int protect_type, 25128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int key_type) 25138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 25148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: protect_type=%d key_type=%d", 25158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, protect_type, key_type); 25168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr) { 25188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=" MACSTR, 25198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr)); 25208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 25218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 25238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * wpa_driver_test_global_init(void) 25278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 25288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_global *global; 25298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt global = os_zalloc(sizeof(*global)); 25318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return global; 25328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wpa_driver_test_global_deinit(void *priv) 25368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 25378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_global *global = priv; 25388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(global); 25398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct wpa_interface_info * 25438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtwpa_driver_test_get_interfaces(void *global_priv) 25448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 25458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* struct wpa_driver_test_global *global = priv; */ 25468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_interface_info *iface; 25478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface = os_zalloc(sizeof(*iface)); 25498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iface == NULL) 25508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return iface; 25518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->ifname = os_strdup("sta0"); 25528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->desc = os_strdup("test interface 0"); 25538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->drv_name = "test"; 25548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->next = os_zalloc(sizeof(*iface)); 25558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iface->next) { 25568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->next->ifname = os_strdup("sta1"); 25578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->next->desc = os_strdup("test interface 1"); 25588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iface->next->drv_name = "test"; 25598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 25608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return iface; 25628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 25638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic struct hostapd_hw_modes * 25668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtwpa_driver_test_get_hw_feature_data(void *priv, u16 *num_modes, u16 *flags) 25678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 25688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_hw_modes *modes; 25698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t i; 25708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 25718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *num_modes = 3; 25728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *flags = 0; 25738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes = os_zalloc(*num_modes * sizeof(struct hostapd_hw_modes)); 25748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (modes == NULL) 25758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 25768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].mode = HOSTAPD_MODE_IEEE80211G; 25778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].num_channels = 11; 25788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].num_rates = 12; 25798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].channels = 25808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_zalloc(11 * sizeof(struct hostapd_channel_data)); 25818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates = os_zalloc(modes[0].num_rates * sizeof(int)); 25828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (modes[0].channels == NULL || modes[0].rates == NULL) 25838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 25848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < 11; i++) { 25858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].channels[i].chan = i + 1; 25868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].channels[i].freq = 2412 + 5 * i; 25878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].channels[i].flag = 0; 25888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 25898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[0] = 10; 25908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[1] = 20; 25918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[2] = 55; 25928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[3] = 110; 25938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[4] = 60; 25948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[5] = 90; 25958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[6] = 120; 25968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[7] = 180; 25978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[8] = 240; 25988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[9] = 360; 25998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[10] = 480; 26008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[0].rates[11] = 540; 26018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].mode = HOSTAPD_MODE_IEEE80211B; 26038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].num_channels = 11; 26048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].num_rates = 4; 26058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].channels = 26068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_zalloc(11 * sizeof(struct hostapd_channel_data)); 26078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].rates = os_zalloc(modes[1].num_rates * sizeof(int)); 26088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (modes[1].channels == NULL || modes[1].rates == NULL) 26098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 26108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < 11; i++) { 26118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].channels[i].chan = i + 1; 26128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].channels[i].freq = 2412 + 5 * i; 26138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].channels[i].flag = 0; 26148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 26158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].rates[0] = 10; 26168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].rates[1] = 20; 26178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].rates[2] = 55; 26188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[1].rates[3] = 110; 26198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].mode = HOSTAPD_MODE_IEEE80211A; 26218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].num_channels = 1; 26228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].num_rates = 8; 26238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].channels = os_zalloc(sizeof(struct hostapd_channel_data)); 26248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates = os_zalloc(modes[2].num_rates * sizeof(int)); 26258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (modes[2].channels == NULL || modes[2].rates == NULL) 26268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto fail; 26278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].channels[0].chan = 60; 26288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].channels[0].freq = 5300; 26298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].channels[0].flag = 0; 26308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[0] = 60; 26318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[1] = 90; 26328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[2] = 120; 26338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[3] = 180; 26348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[4] = 240; 26358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[5] = 360; 26368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[6] = 480; 26378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt modes[2].rates[7] = 540; 26388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return modes; 26408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtfail: 26428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (modes) { 26438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < *num_modes; i++) { 26448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(modes[i].channels); 26458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(modes[i].rates); 26468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 26478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(modes); 26488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 26498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 26508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 26518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_set_freq(void *priv, 26548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_freq_params *freq) 26558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 26568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 26578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 26588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test: set_freq %u MHz", freq->freq); 26598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->current_freq = freq->freq; 26608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 26618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 26628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_send_action(void *priv, unsigned int freq, 26658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int wait, 26668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *dst, const u8 *src, 26678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *bssid, 26681f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt const u8 *data, size_t data_len, 26691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt int no_cck) 26708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 26718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 26728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 26738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = -1; 26748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *buf; 26758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211_hdr *hdr; 26768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test: Send Action frame"); 26788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if ((drv->remain_on_channel_freq && 26808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq != drv->remain_on_channel_freq) || 26818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->remain_on_channel_freq == 0 && 26828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq != (unsigned int) drv->current_freq)) { 26838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test: Reject Action frame TX on " 26848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "unexpected channel: freq=%u MHz (current_freq=%u " 26858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MHz, remain-on-channel freq=%u MHz)", 26868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt freq, drv->current_freq, 26878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_freq); 26888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 26898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 26908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 26918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = os_zalloc(24 + data_len); 26928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 26938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 26948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(buf + 24, data, data_len); 26958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr = (struct ieee80211_hdr *) buf; 26968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hdr->frame_control = 26978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_FC(WLAN_FC_TYPE_MGMT, WLAN_FC_STYPE_ACTION); 26988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(hdr->addr1, dst, ETH_ALEN); 26998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(hdr->addr2, src, ETH_ALEN); 27008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(hdr->addr3, bssid, ETH_ALEN); 27018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt ret = wpa_driver_test_send_mlme(priv, buf, 24 + data_len, 0); 27038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(buf); 27048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 27058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 27068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 27098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_send_action_cb(void *eloop_ctx, void *timeout_ctx) 27108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 27118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 27128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->pending_action_tx == NULL) 27148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 27158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->off_channel_freq != drv->pending_action_freq) { 27178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Pending Action frame TX " 27188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "waiting for another freq=%u", 27198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_freq); 27208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 27218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 27228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Sending pending Action frame to " 27238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR, MAC2STR(drv->pending_action_dst)); 27241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_driver_test_send_action(drv, drv->pending_action_freq, 0, 27251f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->pending_action_dst, 27261f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->pending_action_src, 27271f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->pending_action_bssid, 27281f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpabuf_head(drv->pending_action_tx), 27291f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpabuf_len(drv->pending_action_tx), 27301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->pending_action_no_cck); 27318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 27328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 27338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_remain_on_channel_timeout(void *eloop_ctx, void *timeout_ctx) 27368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 27378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = eloop_ctx; 27388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 27398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test: Remain-on-channel timeout"); 27418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 27438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.remain_on_channel.freq = drv->remain_on_channel_freq; 27448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.remain_on_channel.duration = drv->remain_on_channel_duration; 27458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) 27478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->off_channel_freq = 0; 27488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_freq = 0; 27508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_CANCEL_REMAIN_ON_CHANNEL, &data); 27528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 27538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_remain_on_channel(void *priv, unsigned int freq, 27568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int duration) 27578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 27588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 27598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 27608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 27618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(freq=%u, duration=%u)", 27638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, freq, duration); 27648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->remain_on_channel_freq && 27658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_freq != freq) { 27668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "test: Refuse concurrent " 27678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "remain_on_channel request"); 27688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 27698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 27708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_freq = freq; 27728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_duration = duration; 27738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(test_remain_on_channel_timeout, drv, NULL); 27748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(duration / 1000, (duration % 1000) * 1000, 27758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_remain_on_channel_timeout, drv, NULL); 27768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 27788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.remain_on_channel.freq = freq; 27798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.remain_on_channel.duration = duration; 27808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_REMAIN_ON_CHANNEL, &data); 27818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 27838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p) { 27848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->off_channel_freq = drv->remain_on_channel_freq; 27858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt test_send_action_cb(drv, NULL); 27868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->off_channel_freq == drv->pending_listen_freq) { 27878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_listen_cb(drv->p2p, drv->pending_listen_freq, 27888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_listen_duration); 27898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_listen_freq = 0; 27908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 27918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 27928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 27938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 27958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 27968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 27988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_cancel_remain_on_channel(void *priv) 27998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 28018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 28028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 28038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->remain_on_channel_freq) 28048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->remain_on_channel_freq = 0; 28068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(test_remain_on_channel_timeout, drv, NULL); 28078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 28088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_probe_req_report(void *priv, int report) 28128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct test_driver_bss *dbss = priv; 28148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = dbss->drv; 28158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(report=%d)", __func__, report); 28168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_req_report = report; 28178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 28188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 28228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_find(void *priv, unsigned int timeout, int type) 28248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(timeout=%u)", __func__, timeout); 28278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2829c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt return p2p_find(drv->p2p, timeout, type, 0, NULL, NULL); 28308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_stop_find(void *priv) 28348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 28378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_stop_find(drv->p2p); 28408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 28418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_listen(void *priv, unsigned int timeout) 28458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(timeout=%u)", __func__, timeout); 28488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return p2p_listen(drv->p2p, timeout); 28518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_connect(void *priv, const u8 *peer_addr, 28558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int wps_method, int go_intent, 28568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *own_interface_addr, 28578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int force_freq, 28588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int persistent_group) 28598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(peer_addr=" MACSTR " wps_method=%d " 28628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "go_intent=%d " 28638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "own_interface_addr=" MACSTR " force_freq=%u " 28648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "persistent_group=%d)", 28658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(peer_addr), wps_method, go_intent, 28668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(own_interface_addr), force_freq, persistent_group); 28678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return p2p_connect(drv->p2p, peer_addr, wps_method, go_intent, 28708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt own_interface_addr, force_freq, persistent_group); 28718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_wps_success_cb(void *priv, const u8 *peer_addr) 28758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(peer_addr=" MACSTR ")", 28788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(peer_addr)); 28798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_wps_success_cb(drv->p2p, peer_addr); 28828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 28838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_group_formation_failed(void *priv) 28878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 28888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 28898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 28908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 28918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 28928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_group_formation_failed(drv->p2p); 28938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 28948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 28958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 28978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_p2p_set_params(void *priv, 28988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_params *params) 28998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 29008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = priv; 29018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 29028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->p2p) 29038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 29048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (p2p_set_dev_name(drv->p2p, params->dev_name) < 0 || 29058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_set_pri_dev_type(drv->p2p, params->pri_dev_type) < 0 || 29068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p_set_sec_dev_types(drv->p2p, params->sec_dev_type, 29078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->num_sec_dev_types) < 0) 29088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 29098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 29108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 29118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_p2p_scan(void *ctx, enum p2p_scan_type type, int freq, 29148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int num_req_dev_types, 2915c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt const u8 *req_dev_types, const u8 *dev_id) 29168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 29178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 29188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_scan_params params; 29198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 29208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_ie, *ies; 29218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int social_channels[] = { 2412, 2437, 2462, 0, 0 }; 29221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt size_t ielen; 29238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(type=%d freq=%d)", 29258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, type, freq); 29268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(¶ms, 0, sizeof(params)); 29288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* P2P Wildcard SSID */ 29308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.num_ssids = 1; 29318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.ssids[0].ssid = (u8 *) P2P_WILDCARD_SSID; 29328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.ssids[0].ssid_len = P2P_WILDCARD_SSID_LEN; 29338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#if 0 /* TODO: WPS IE */ 29358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_s->wps->dev.p2p = 1; 29368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_ie = wps_build_probe_req_ie(0, &wpa_s->wps->dev, wpa_s->wps->uuid, 29378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WPS_REQ_ENROLLEE); 29388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else 29398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_ie = wpabuf_alloc(1); 29408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 29418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wps_ie == NULL) 29428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 29438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt ielen = p2p_scan_ie_buf_len(drv->p2p); 29451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt ies = wpabuf_alloc(wpabuf_len(wps_ie) + ielen); 29468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ies == NULL) { 29478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(wps_ie); 29488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 29498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 29508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_buf(ies, wps_ie); 29518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(wps_ie); 29528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2953c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt p2p_scan_ie(drv->p2p, ies, dev_id); 29548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.extra_ies = wpabuf_head(ies); 29568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.extra_ies_len = wpabuf_len(ies); 29578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (type) { 29598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case P2P_SCAN_SOCIAL: 29608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.freqs = social_channels; 29618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 29628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case P2P_SCAN_FULL: 29638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 29648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case P2P_SCAN_SPECIFIC: 29658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt social_channels[0] = freq; 29668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt social_channels[1] = 0; 29678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.freqs = social_channels; 29688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 29698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case P2P_SCAN_SOCIAL_PLUS_ONE: 29708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt social_channels[3] = freq; 29718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params.freqs = social_channels; 29728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 29738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 29748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_p2p_scan = 1; 29768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = wpa_driver_test_scan(drv, ¶ms); 29778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(ies); 29798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 29818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 29828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_send_action(void *ctx, unsigned int freq, const u8 *dst, 29858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *src, const u8 *bssid, const u8 *buf, 29868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len, unsigned int wait_time) 29878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 29888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 29898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 29908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(freq=%u dst=" MACSTR " src=" MACSTR 29918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " bssid=" MACSTR " len=%d", 29928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, freq, MAC2STR(dst), MAC2STR(src), MAC2STR(bssid), 29938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (int) len); 29948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (freq <= 0) { 29958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_WARNING, "P2P: No frequency specified for " 29968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "action frame TX"); 29978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 29988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 29998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->pending_action_tx) { 30018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Dropped pending Action frame TX " 30028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "to " MACSTR, MAC2STR(drv->pending_action_dst)); 30038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->pending_action_tx); 30048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 30058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_tx = wpabuf_alloc(len); 30068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->pending_action_tx == NULL) 30078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 30088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_put_data(drv->pending_action_tx, buf, len); 30098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->pending_action_src, src, ETH_ALEN); 30108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->pending_action_dst, dst, ETH_ALEN); 30118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(drv->pending_action_bssid, bssid, ETH_ALEN); 30128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_action_freq = freq; 30131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->pending_action_no_cck = 1; 30148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->off_channel_freq == freq) { 30168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Already on requested channel; send immediately */ 30178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: Would there ever be need to extend the current 30188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * duration on the channel? */ 30198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_cancel_timeout(test_send_action_cb, drv, NULL); 30208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eloop_register_timeout(0, 0, test_send_action_cb, drv, NULL); 30218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 30228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 30238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Schedule Action frame to be transmitted " 30258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "once the driver gets to the requested channel"); 30268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_remain_on_channel(drv, freq, wait_time) < 0) { 30278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "P2P: Failed to request driver " 30288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "to remain on channel (%u MHz) for Action " 30298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "Frame TX", freq); 30308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 30318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 30328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 30348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 30358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_send_action_done(void *ctx) 30388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 30398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 30408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 30418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 30428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_go_neg_completed(void *ctx, struct p2p_go_neg_results *res) 30458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 30468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 30478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 30488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 30498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 30508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_go_neg_completed.res = res; 30518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_P2P_GO_NEG_COMPLETED, &event); 30528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 30538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_go_neg_req_rx(void *ctx, const u8 *src, u16 dev_passwd_id) 30568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 30578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 30588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 30598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(src=" MACSTR ")", __func__, MAC2STR(src)); 30608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 30618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_go_neg_req_rx.src = src; 30628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_go_neg_req_rx.dev_passwd_id = dev_passwd_id; 30638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_P2P_GO_NEG_REQ_RX, &event); 30648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 30658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_dev_found(void *ctx, const u8 *addr, 30688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct p2p_peer_info *info, int new_device) 30698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 30708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 30718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 30728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char devtype[WPS_DEV_TYPE_BUFSIZE]; 30738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(" MACSTR " p2p_dev_addr=" MACSTR 30748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " pri_dev_type=%s name='%s' config_methods=0x%x " 30758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "dev_capab=0x%x group_capab=0x%x)", 30768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), MAC2STR(info->p2p_device_addr), 30778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wps_dev_type_bin2str(info->pri_dev_type, devtype, 30788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(devtype)), 30798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt info->device_name, info->config_methods, info->dev_capab, 30808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt info->group_capab); 30818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 30838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.addr = addr; 30848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.dev_addr = info->p2p_device_addr; 30858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.pri_dev_type = info->pri_dev_type; 30868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.dev_name = info->device_name; 30878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.config_methods = info->config_methods; 30888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.dev_capab = info->dev_capab; 30898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.p2p_dev_found.group_capab = info->group_capab; 30908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->ctx, EVENT_P2P_DEV_FOUND, &event); 30918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 30928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 30948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_start_listen(void *ctx, unsigned int freq, 30958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int duration, 30968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *probe_resp_ie) 30978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 30988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 30998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(freq=%u duration=%u)", 31018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, freq, duration); 31028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_probe_req_report(drv, 1) < 0) 31048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_listen_freq = freq; 31078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_listen_duration = duration; 31088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpa_driver_test_remain_on_channel(drv, freq, duration) < 0) { 31108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->pending_listen_freq = 0; 31118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 31138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 31158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 31168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_stop_listen(void *ctx) 31198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 31208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 31218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 31228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 31238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int test_send_probe_resp(void *ctx, const struct wpabuf *buf) 31268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 31278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_driver_test_data *drv = ctx; 31288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char resp[512], *pos, *end; 31298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 31308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 31318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *ie, *ie_end; 31328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 31348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump_buf(MSG_MSGDUMP, "Probe Response", buf); 31358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (wpabuf_len(buf) < 24) 31368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!drv->probe_from) { 31388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: probe_from not set", __func__); 31398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 31418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = resp; 31438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = resp + sizeof(resp); 31448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mgmt = wpabuf_head(buf); 31468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* reply: SCANRESP BSSID SSID IEs */ 31488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, "SCANRESP " MACSTR " ", 31498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MAC2STR(mgmt->bssid)); 31508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 31518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 31538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie = mgmt->u.probe_resp.variable; 31558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie_end = wpabuf_head_u8(buf) + wpabuf_len(buf); 31568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ie_end - ie < 2 || ie[0] != WLAN_EID_SSID || 31578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie + 2 + ie[1] > ie_end) 31588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, ie + 2, ie[1]); 31608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = os_snprintf(pos, end - pos, " "); 31628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0 || ret >= end - pos) 31638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 31648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += ret; 31658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += wpa_snprintf_hex(pos, end - pos, ie, ie_end - ie); 31668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sendto(drv->test_socket, resp, pos - resp, 0, 31688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->probe_from, drv->probe_from_len); 31698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 31718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 31728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_sd_request(void *ctx, int freq, const u8 *sa, u8 dialog_token, 31758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 update_indic, const u8 *tlvs, size_t tlvs_len) 31768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 31778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 31788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 31798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 31808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_sd_response(void *ctx, const u8 *sa, u16 update_indic, 31838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *tlvs, size_t tlvs_len) 31848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 31858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 31868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 31878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 31888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 31908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_prov_disc_req(void *ctx, const u8 *peer, u16 config_methods, 31918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *dev_addr, const u8 *pri_dev_type, 31928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const char *dev_name, u16 supp_config_methods, 31931f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt u8 dev_capab, u8 group_capab, 31941f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt const u8 *group_id, size_t group_id_len) 31958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 31968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(peer=" MACSTR " config_methods=0x%x)", 31978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(peer), config_methods); 31988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 31998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 32008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void test_prov_disc_resp(void *ctx, const u8 *peer, u16 config_methods) 32038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 32048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s(peer=" MACSTR " config_methods=0x%x)", 32058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(peer), config_methods); 32068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO */ 32078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 32088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 32108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wpa_driver_test_init_p2p(struct wpa_driver_test_data *drv) 32138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 32148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 32158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct p2p_config p2p; 32168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned int r; 32178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 32188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&p2p, 0, sizeof(p2p)); 32208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.msg_ctx = drv->ctx; 32218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.cb_ctx = drv; 32228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.p2p_scan = test_p2p_scan; 32238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.send_action = test_send_action; 32248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.send_action_done = test_send_action_done; 32258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.go_neg_completed = test_go_neg_completed; 32268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.go_neg_req_rx = test_go_neg_req_rx; 32278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.dev_found = test_dev_found; 32288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.start_listen = test_start_listen; 32298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.stop_listen = test_stop_listen; 32308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.send_probe_resp = test_send_probe_resp; 32318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.sd_request = test_sd_request; 32328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.sd_response = test_sd_response; 32338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.prov_disc_req = test_prov_disc_req; 32348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.prov_disc_resp = test_prov_disc_resp; 32358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(p2p.dev_addr, drv->own_addr, ETH_ALEN); 32378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.reg_class = 12; /* TODO: change depending on location */ 32398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 32408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Pick one of the social channels randomly as the listen 32418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * channel. 32428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 32438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_get_random((u8 *) &r, sizeof(r)); 32448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.channel = 1 + (r % 3) * 5; 32458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* TODO: change depending on location */ 32478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.op_reg_class = 12; 32488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 32498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * For initial tests, pick the operation channel randomly. 32508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * TODO: Use scan results (etc.) to select the best channel. 32518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 32528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.op_channel = 1 + r % 11; 32538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(p2p.country, "US ", 3); 32558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* FIX: fetch available channels from the driver */ 32578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.channels.reg_classes = 1; 32588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.channels.reg_class[0].reg_class = 12; /* US/12 = 2.4 GHz band */ 32598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.channels.reg_class[0].channels = 11; 32608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < 11; i++) 32618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.channels.reg_class[0].channel[i] = i + 1; 32628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt p2p.max_peers = 100; 32648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->p2p = p2p_init(&p2p); 32668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->p2p == NULL) 32678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 32688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 32698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_P2P */ 32708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_INFO, "driver_test: P2P support not included"); 32718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 32728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 32738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 32748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 32768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_test_ops = { 32778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "test", 32788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "wpa_supplicant test driver", 32798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = test_driver_init, 32808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = wpa_driver_test_deinit, 32818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = test_driver_send_eapol, 32828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .send_mlme = wpa_driver_test_send_mlme, 32838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = test_driver_set_generic_elem, 32848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = test_driver_sta_deauth, 32858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = test_driver_sta_disassoc, 32868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_hw_feature_data = wpa_driver_test_get_hw_feature_data, 32878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .if_add = test_driver_if_add, 32888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .if_remove = test_driver_if_remove, 32898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = test_driver_set_ssid, 32908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = test_driver_set_privacy, 32918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_sta_vlan = test_driver_set_sta_vlan, 32928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_add = test_driver_sta_add, 32938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .send_ether = test_driver_send_ether, 32948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = test_driver_set_ap_wps_ie, 32958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_bssid = wpa_driver_test_get_bssid, 32968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_ssid = wpa_driver_test_get_ssid, 32978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = wpa_driver_test_set_key, 32988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .deinit = wpa_driver_test_deinit, 32998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_param = wpa_driver_test_set_param, 33008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .deauthenticate = wpa_driver_test_deauthenticate, 33018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .disassociate = wpa_driver_test_disassociate, 33028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .associate = wpa_driver_test_associate, 33038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_capa = wpa_driver_test_get_capa, 33048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_mac_addr = wpa_driver_test_get_mac_addr, 33058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .send_eapol = wpa_driver_test_send_eapol, 33068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .mlme_setprotection = wpa_driver_test_mlme_setprotection, 33078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_scan_results2 = wpa_driver_test_get_scan_results2, 33088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .global_init = wpa_driver_test_global_init, 33098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .global_deinit = wpa_driver_test_global_deinit, 33108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .init2 = wpa_driver_test_init2, 33118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_interfaces = wpa_driver_test_get_interfaces, 33128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .scan2 = wpa_driver_test_scan, 33138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_freq = wpa_driver_test_set_freq, 33148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .send_action = wpa_driver_test_send_action, 33158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .remain_on_channel = wpa_driver_test_remain_on_channel, 33168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .cancel_remain_on_channel = wpa_driver_test_cancel_remain_on_channel, 33178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .probe_req_report = wpa_driver_test_probe_req_report, 33188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P 33198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_find = wpa_driver_test_p2p_find, 33208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_stop_find = wpa_driver_test_p2p_stop_find, 33218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_listen = wpa_driver_test_p2p_listen, 33228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_connect = wpa_driver_test_p2p_connect, 33238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .wps_success_cb = wpa_driver_test_wps_success_cb, 33248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_group_formation_failed = 33258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_driver_test_p2p_group_formation_failed, 33268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .p2p_set_params = wpa_driver_test_p2p_set_params, 33278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */ 33288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 3329