driver_madwifi.c revision 1f69aa52ea2e0a73ac502565df8c666ee49cab6a
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * WPA Supplicant - driver interaction with MADWIFI 802.11 driver 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Sam Leffler <sam@errno.com> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Video54 Technologies 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004-2007, Jouni Malinen <j@w1.fi> 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * This program is free software; you can redistribute it and/or modify 88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * it under the terms of the GNU General Public License version 2 as 98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * published by the Free Software Foundation. 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Alternatively, this software may be distributed under the terms of BSD 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * license. 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See README and COPYING for more details. 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * While this driver wrapper supports both AP (hostapd) and station 178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * (wpa_supplicant) operations, the station side is deprecated and 188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * driver_wext.c should be used instead. This driver wrapper should only be 198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * used with hostapd for AP mode functionality. 208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/ioctl.h> 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "driver.h" 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "driver_wext.h" 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eloop.h" 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#include "linux_wext.h" 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Avoid conflicts with wpa_supplicant definitions by undefining a definition. 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#undef WME_OUI_TYPE 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <include/compat.h> 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net80211/ieee80211.h> 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WME_NUM_AC 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* Assume this is built against BSD branch of madwifi driver. */ 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MADWIFI_BSD 428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net80211/_ieee80211.h> 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* WME_NUM_AC */ 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net80211/ieee80211_crypto.h> 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net80211/ieee80211_ioctl.h> 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef IEEE80211_IOCTL_FILTERFRAME 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <netpacket/packet.h> 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef ETH_P_80211_RAW 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define ETH_P_80211_RAW 0x0019 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* IEEE80211_IOCTL_FILTERFRAME */ 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Avoid conflicts with hostapd definitions by undefining couple of defines 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * from madwifi header files. 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#undef RSN_VERSION 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#undef WPA_VERSION 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#undef WPA_OUI_TYPE 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#undef WME_OUI_TYPE 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef IEEE80211_IOCTL_SETWMMPARAMS 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* Assume this is built against madwifi-ng */ 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define MADWIFI_NG 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* IEEE80211_IOCTL_SETWMMPARAMS */ 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define WPA_KEY_RSC_LEN 8 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "priv_netlink.h" 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "netlink.h" 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "linux_ioctl.h" 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "l2_packet/l2_packet.h" 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct madwifi_driver_data { 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd; /* back pointer */ 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char iface[IFNAMSIZ + 1]; 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ifindex; 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_xmit; /* raw packet xmit socket */ 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_recv; /* raw packet recv socket */ 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ioctl_sock; /* socket for ioctl() use */ 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_data *netlink; 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int we_version; 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 acct_mac[ETH_ALEN]; 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostap_sta_driver_data acct_data; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_raw; /* raw 802.11 management frames */ 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int madwifi_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code); 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211priv(struct madwifi_driver_data *drv, int op, void *data, int len) 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int do_inline = len < IFNAMSIZ; 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef IEEE80211_IOCTL_FILTERFRAME 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* FILTERFRAME must be NOT inline, regardless of size. */ 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (op == IEEE80211_IOCTL_FILTERFRAME) 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt do_inline = 0; 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* IEEE80211_IOCTL_FILTERFRAME */ 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (op == IEEE80211_IOCTL_SET_APPIEBUF) 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt do_inline = 0; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (do_inline) { 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data fits inline; put it there. 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name, data, len); 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data too big for inline transfer; setup a 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * parameter block instead; the kernel will transfer 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the data for the driver. 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = data; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = len; 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, op, &iwr) < 0) { 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef MADWIFI_NG 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int first = IEEE80211_IOCTL_SETPARAM; 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static const char *opnames[] = { 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETPARAM]", 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETPARAM]", 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETMODE]", 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETMODE]", 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETWMMPARAMS]", 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETWMMPARAMS]", 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETCHANLIST]", 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETCHANLIST]", 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_CHANSWITCH]", 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GET_APPIEBUF]", 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SET_APPIEBUF]", 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETSCANRESULTS]", 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_FILTERFRAME]", 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETCHANINFO]", 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETOPTIE]", 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETOPTIE]", 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETMLME]", 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETKEY]", 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_DELKEY]", 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_ADDMAC]", 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_DELMAC]", 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_WDSMAC]", 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_WDSDELMAC]", 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt NULL, 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_KICKMAC]", 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt }; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* MADWIFI_NG */ 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int first = IEEE80211_IOCTL_SETPARAM; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static const char *opnames[] = { 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETPARAM]", 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETPARAM]", 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETKEY]", 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+3]", 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_DELKEY]", 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+5]", 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETMLME]", 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+7]", 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_SETOPTIE]", 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETOPTIE]", 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_ADDMAC]", 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+11]", 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_DELMAC]", 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+13]", 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_CHANLIST]", 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+15]", 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETRSN]", 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[SIOCIWFIRSTPRIV+17]", 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "ioctl[IEEE80211_IOCTL_GETKEY]", 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt }; 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_NG */ 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int idx = op - first; 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (first <= op && 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt idx < (int) (sizeof(opnames) / sizeof(opnames[0])) && 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt opnames[idx]) 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror(opnames[idx]); 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[unknown???]"); 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211param(struct madwifi_driver_data *drv, int op, int arg) 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = op; 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name+sizeof(__u32), &arg, sizeof(arg)); 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_SETPARAM, &iwr) < 0) { 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[IEEE80211_IOCTL_SETPARAM]"); 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set parameter (op %d " 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "arg %d)", __func__, op, arg); 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_NO_STDOUT_DEBUG 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtether_sprintf(const u8 *addr) 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static char buf[sizeof(MACSTR)]; 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr)); 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0); 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NO_STDOUT_DEBUG */ 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Configure WPA parameters. 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_configure_wpa(struct madwifi_driver_data *drv, 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_bss_params *params) 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int v; 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (params->wpa_group) { 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_CCMP: 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM; 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_TKIP: 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_TKIP; 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP104: 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP40: 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_NONE: 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_NONE; 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "Unknown group key cipher %u", 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_group); 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: group key cipher=%d", __func__, v); 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTCIPHER, v)) { 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set group key cipher to %u\n", v); 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (v == IEEE80211_CIPHER_WEP) { 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* key length is done only for specific ciphers */ 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5); 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTKEYLEN, v)) { 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set group key length to %u\n", v); 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP) 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM; 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_TKIP) 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_TKIP; 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_NONE) 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_NONE; 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v); 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_UCASTCIPHERS, v)) { 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set pairwise key ciphers to 0x%x\n", v); 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x", 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, params->wpa_key_mgmt); 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_KEYMGTALGS, 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt)) { 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set key management algorithms to 0x%x\n", 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt); 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->rsn_preauth) 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(0); 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x", 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, params->rsn_preauth); 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_RSNCAPS, v)) { 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set RSN capabilities to 0x%x\n", v); 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enable WPA=0x%x", __func__, params->wpa); 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_WPA, params->wpa)) { 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set WPA to %u\n", params->wpa); 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_ieee8021x(void *priv, struct wpa_bss_params *params) 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled); 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->enabled) { 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* XXX restore state */ 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_AUTH_AUTO); 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->wpa && !params->ieee802_1x) { 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "No 802.1X or WPA enabled!"); 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa && madwifi_configure_wpa(drv, params) != 0) { 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "Error configuring WPA state!"); 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) { 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "Error enabling WPA/802.1X!"); 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_privacy(void *priv, int enabled) 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled); 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_PRIVACY, enabled); 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_sta_authorized(void *priv, const u8 *addr, int authorized) 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d", 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), authorized); 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (authorized) 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTHORIZE; 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_UNAUTHORIZE; 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = 0; 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to %sauthorize STA " MACSTR, 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, authorized ? "" : "un", MAC2STR(addr)); 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_sta_set_flags(void *priv, const u8 *addr, 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int total_flags, int flags_or, int flags_and) 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* For now, only support setting Authorized flag */ 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (flags_or & WPA_STA_AUTHORIZED) 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return madwifi_set_sta_authorized(priv, addr, 1); 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!(flags_and & WPA_STA_AUTHORIZED)) 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return madwifi_set_sta_authorized(priv, addr, 0); 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_del_key(void *priv, const u8 *addr, int key_idx) 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_del_key wk; 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d", 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), key_idx); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) { 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN); 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = (u8) IEEE80211_KEYIX_NONE; 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = key_idx; 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_DELKEY, &wk, sizeof(wk)); 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to delete key (addr %s" 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d)", __func__, ether_sprintf(addr), 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_idx); 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtwpa_driver_madwifi_set_key(const char *ifname, void *priv, enum wpa_alg alg, 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int key_idx, int set_tx, 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *seq, size_t seq_len, 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *key, size_t key_len) 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u_int8_t cipher; 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alg == WPA_ALG_NONE) 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return madwifi_del_key(drv, addr, key_idx); 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d", 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg, ether_sprintf(addr), key_idx); 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alg == WPA_ALG_WEP) 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_WEP; 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (alg == WPA_ALG_TKIP) 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_TKIP; 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (alg == WPA_ALG_CCMP) 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM; 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else { 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("%s: unknown/unsupported algorithm %d\n", 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg); 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key_len > sizeof(wk.ik_keydata)) { 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("%s: key length %lu too big\n", __func__, 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) key_len); 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -3; 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_type = cipher; 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT; 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL || is_broadcast_ether_addr(addr)) { 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = key_idx; 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags |= IEEE80211_KEY_DEFAULT; 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = IEEE80211_KEYIX_NONE; 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keylen = key_len; 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_keydata, key, key_len); 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETKEY, &wk, sizeof(wk)); 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set key (addr %s" 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d alg %d key_len %lu set_tx %d)", 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(wk.ik_macaddr), key_idx, 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alg, (unsigned long) key_len, set_tx); 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx, 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *seq) 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d", 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), idx); 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL) 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = idx; 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk))) { 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get encryption data " 5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(addr " MACSTR " key_idx %d)", 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(wk.ik_macaddr), idx); 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wk.ik_keytsc is in host byte order (big endian), need to 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * swap it to match with the byte order used in WPA. 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tmp[WPA_KEY_RSC_LEN]; 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < WPA_KEY_RSC_LEN; i++) { 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1]; 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* WORDS_BIGENDIAN */ 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* WORDS_BIGENDIAN */ 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_flush(void *priv) 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef MADWIFI_BSD 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 allsta[IEEE80211_ADDR_LEN]; 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(allsta, 0xff, IEEE80211_ADDR_LEN); 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return madwifi_sta_deauth(priv, NULL, allsta, 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_REASON_AUTH_LEAVE); 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* MADWIFI_BSD */ 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; /* XXX */ 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_BSD */ 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data, 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr) 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef MADWIFI_BSD 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_sta_stats stats; 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(data, 0, sizeof(*data)); 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch statistics for station from the system. 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&stats, 0, sizeof(stats)); 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN); 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef MADWIFI_NG 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_IOCTL_STA_STATS, 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* MADWIFI_NG */ 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_IOCTL_GETSTASTATS, 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_NG */ 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &stats, sizeof(stats))) { 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to fetch STA stats (addr " 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(data, &drv->acct_data, sizeof(*data)); 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Failed to get station stats information element.\n"); 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_packets = stats.is_stats.ns_rx_data; 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_bytes = stats.is_stats.ns_rx_bytes; 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_packets = stats.is_stats.ns_tx_data; 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_bytes = stats.is_stats.ns_tx_bytes; 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* MADWIFI_BSD */ 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char buf[1024], line[128], *pos; 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt FILE *f; 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned long val; 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(data, 0, sizeof(*data)); 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), "/proc/net/madwifi/%s/" MACSTR, 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->iface, MAC2STR(addr)); 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt f = fopen(buf, "r"); 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!f) { 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) != 0) 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(data, &drv->acct_data, sizeof(*data)); 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Need to read proc file with in one piece, so use large enough 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * buffer. */ 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt setbuffer(f, buf, sizeof(buf)); 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (fgets(line, sizeof(line), f)) { 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = strchr(line, '='); 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!pos) 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *pos++ = '\0'; 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(pos, NULL, 10); 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(line, "rx_packets") == 0) 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_packets = val; 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(line, "tx_packets") == 0) 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_packets = val; 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(line, "rx_bytes") == 0) 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_bytes = val; 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(line, "tx_bytes") == 0) 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_bytes = val; 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fclose(f); 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_BSD */ 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_sta_clear_stats(void *priv, const u8 *addr) 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#if defined(MADWIFI_BSD) && defined(IEEE80211_MLME_CLEAR_STATS) 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s", __func__, ether_sprintf(addr)); 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_CLEAR_STATS; 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(mlme)); 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to clear STA stats (addr " 6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* MADWIFI_BSD && IEEE80211_MLME_CLEAR_STATS */ 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; /* FIX */ 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_BSD && IEEE80211_MLME_CLEAR_STATS */ 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_opt_ie(void *priv, const u8 *ie, size_t ie_len) 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Do nothing; we setup parameters at startup that define the 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * contents of the beacon information element. 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DEAUTH; 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to deauth STA (addr " MACSTR 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " reason %d)", 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr, 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DISASSOC; 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to disassoc STA (addr " 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " reason %d)", 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef IEEE80211_IOCTL_FILTERFRAME 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void madwifi_raw_receive(void *ctx, const u8 *src_addr, const u8 *buf, 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len) 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = ctx; 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 fc; 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Send Probe Request information to WPS processing */ 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)) 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT || 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_STYPE(fc) != WLAN_FC_STYPE_PROBE_REQ) 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.sa = mgmt->sa; 7351f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.da = mgmt->da; 7361f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.bssid = mgmt->bssid; 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie = mgmt->u.probe_req.variable; 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie_len = 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_PROBE_REQ, &event); 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* IEEE80211_IOCTL_FILTERFRAME */ 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int madwifi_receive_probe_req(struct madwifi_driver_data *drv) 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef IEEE80211_IOCTL_FILTERFRAME 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_set_filter filt; 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s Enter", __func__); 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt filt.app_filterype = IEEE80211_FILTER_TYPE_PROBE_REQ; 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_set_filter)); 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret) 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_raw = l2_packet_init(drv->iface, NULL, ETH_P_80211_RAW, 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_raw_receive, drv, 1); 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw == NULL) 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* IEEE80211_IOCTL_FILTERFRAME */ 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_wps_ie(void *priv, const u8 *ie, size_t len, u32 frametype) 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[256]; 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *beac_ie; 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu", __func__, 7788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) len); 7798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie = (struct ieee80211req_getset_appiebuf *) buf; 7818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_frmtype = frametype; 7828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen = len; 7838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&(beac_ie->app_buf[0]), ie, len); 7848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, beac_ie, 7868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + len); 7878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 7918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 7928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 7938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (madwifi_set_wps_ie(priv, beacon ? wpabuf_head(beacon) : NULL, 7958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon ? wpabuf_len(beacon) : 0, 7968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_BEACON) < 0) 7978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 7988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return madwifi_set_wps_ie(priv, 7998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_head(proberesp) : NULL, 8008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_len(proberesp) : 0, 8018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_PROBE_RESP); 8028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_WPS */ 8048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define madwifi_set_ap_wps_ie NULL 8058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 8068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int madwifi_set_freq(void *priv, struct hostapd_freq_params *freq) 8081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 8091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct madwifi_driver_data *drv = priv; 8101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt struct iwreq iwr; 8111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 8121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 8131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 8141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.freq.m = freq->channel; 8151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.freq.e = 0; 8161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 8171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWFREQ, &iwr) < 0) { 8181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt perror("ioctl[SIOCSIWFREQ]"); 8191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return -1; 8201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt } 8211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 8221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 8231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 8241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 8268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_new_sta(struct madwifi_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN]) 8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = drv->hapd; 8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_wpaie ie; 8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen = 0; 8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *iebuf = NULL; 8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch negotiated WPA/RSN parameters from the system. 8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ie, 0, sizeof(ie)); 8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN); 8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETWPAIE, &ie, sizeof(ie))) { 8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WPA/RSN IE", 8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__); 8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto no_ie; 8428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "madwifi req WPA IE", 8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wpa_ie, IEEE80211_MAX_OPT_IE); 8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wpa_ie; 8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* madwifi seems to return some random data if WPA/RSN IE is not set. 8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Assume the IE was not included if the IE type is unknown. */ 8488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_VENDOR_SPECIFIC) 8498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef MADWIFI_NG 8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "madwifi req RSN IE", 8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.rsn_ie, IEEE80211_MAX_OPT_IE); 8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[1] == 0 && ie.rsn_ie[1] > 0) { 8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* madwifi-ng svn #1453 added rsn_ie. Use it, if wpa_ie was not 8558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * set. This is needed for WPA2. */ 8568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.rsn_ie; 8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_RSN) 8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 8598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* MADWIFI_NG */ 8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = iebuf[1]; 8638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen == 0) 8648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = NULL; 8658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 8668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 2; 8678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtno_ie: 8698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(hapd, addr, iebuf, ielen, 0); 8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cached accounting data is not valid anymore. */ 8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(drv->acct_mac, 0, ETH_ALEN); 8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&drv->acct_data, 0, sizeof(drv->acct_data)); 8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_wireless_event_wireless_custom(struct madwifi_driver_data *drv, 8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *custom) 8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 8828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Custom wireless event: '%s'", custom); 8838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 8848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) { 8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 8878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = strstr(custom, "addr="); 8888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 8898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 8908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 8918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "without sender address ignored"); 8928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 8938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 8948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 8958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(pos, addr) == 0) { 8968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 8978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 8988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.unicast = 1; 8998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.src = addr; 9008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, 9018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EVENT_MICHAEL_MIC_FAILURE, &data); 9028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 9038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 9048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 9058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with invalid MAC address"); 9068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "STA-TRAFFIC-STAT", 16) == 0) { 9088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *key, *value; 9098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 val; 9108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = custom; 9118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((key = strchr(key, '\n')) != NULL) { 9128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key++; 9138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt value = strchr(key, '='); 9148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (value == NULL) 9158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 9168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *value++ = '\0'; 9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(value, NULL, 10); 9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(key, "mac") == 0) 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(value, drv->acct_mac); 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_packets") == 0) 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_packets = val; 9228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_packets") == 0) 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_packets = val; 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_bytes") == 0) 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_bytes = val; 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_bytes") == 0) 9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_bytes = val; 9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = value; 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_wireless_event_wireless(struct madwifi_driver_data *drv, 9358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *data, int len) 9368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_event iwe_buf, *iwe = &iwe_buf; 9388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *end, *custom, *buf; 9398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data; 9418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = data + len; 9428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (pos + IW_EV_LCP_LEN <= end) { 9448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Event data may be unaligned, so make a local, aligned copy 9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before processing. */ 9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, IW_EV_LCP_LEN); 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "Wireless event: cmd=0x%x len=%d", 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd, iwe->len); 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iwe->len <= IW_EV_LCP_LEN) 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom = pos + IW_EV_POINT_LEN; 9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->we_version > 18 && 9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (iwe->cmd == IWEVMICHAELMICFAILURE || 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVCUSTOM)) { 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* WE-19 removed the pointer from struct iw_point */ 9578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dpos = (char *) &iwe_buf.u.data.length; 9588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int dlen = dpos - (char *) &iwe_buf; 9598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(dpos, pos + IW_EV_LCP_LEN, 9608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct iw_event) - dlen); 9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, sizeof(struct iw_event)); 9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom += IW_EV_POINT_OFF; 9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (iwe->cmd) { 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVEXPIRED: 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->hapd, 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) iwe->u.addr.sa_data); 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVREGISTERED: 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_new_sta(drv, (u8 *) iwe->u.addr.sa_data); 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVCUSTOM: 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (custom + iwe->u.data.length > end) 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = malloc(iwe->u.data.length + 1); 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; /* XXX */ 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(buf, custom, iwe->u.data.length); 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[iwe->u.data.length] = '\0'; 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_wireless_event_wireless_custom(drv, buf); 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(buf); 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += iwe->len; 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_wireless_event_rtm_newlink(void *ctx, struct ifinfomsg *ifi, 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *buf, size_t len) 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = ctx; 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, rta_len; 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifi->ifi_index != drv->ifindex) 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = len; 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) buf; 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_WIRELESS) { 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_wireless_event_wireless( 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv, ((char *) attr) + rta_len, 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->rta_len - rta_len); 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_get_we_version(struct madwifi_driver_data *drv) 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_range *range; 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int minlen; 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buflen; 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = 0; 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Use larger buffer than struct iw_range in order to allow the 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * structure to grow in the future. 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buflen = sizeof(struct iw_range) + 500; 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range = os_zalloc(buflen); 10348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (range == NULL) 10358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 10388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = (caddr_t) range; 10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = buflen; 10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt minlen = ((char *) &range->enc_capa) - (char *) range + 10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(range->enc_capa); 10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) { 10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCGIWRANGE]"); 10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(range); 10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (iwr.u.data.length >= minlen && 10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled >= 18) { 10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d " 10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WE(source)=%d enc_capa=0x%x", 10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled, 10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_source, 10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->enc_capa); 10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = range->we_version_compiled; 10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(range); 10608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_wireless_event_init(struct madwifi_driver_data *drv) 10668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_config *cfg; 10688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_get_we_version(drv); 10708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg = os_zalloc(sizeof(*cfg)); 10728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cfg == NULL) 10738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->ctx = drv; 10758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->newlink_cb = madwifi_wireless_event_rtm_newlink; 10768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->netlink = netlink_init(cfg); 10778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->netlink == NULL) { 10788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cfg); 10798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 10838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len, 10888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int encrypt, const u8 *own_addr, u32 flags) 10898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 10918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char buf[3000]; 10928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *bp = buf; 10938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 10948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 10958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int status; 10968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 10988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Prepend the Ethernet header. If the caller left us 10998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * space at the front we could just insert it but since 11008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * we don't know we copy to a local buffer. Given the frequency 11018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and size of frames this probably doesn't matter. 11028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = data_len + sizeof(struct l2_ethhdr); 11048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(buf)) { 11058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bp = malloc(len); 11068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp == NULL) { 11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("EAPOL frame discarded, cannot malloc temp " 11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "buffer of size %lu!\n", (unsigned long) len); 11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) bp; 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_dest, addr, ETH_ALEN); 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_source, own_addr, ETH_ALEN); 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth->h_proto = host_to_be16(ETH_P_EAPOL); 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth+1, data, data_len); 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len); 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len); 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp != buf) 11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(bp); 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return status; 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidthandle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len) 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = ctx; 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->hapd, src_addr, buf + sizeof(struct l2_ethhdr), 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - sizeof(struct l2_ethhdr)); 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_init(struct hostapd_data *hapd, struct wpa_init_params *params) 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv; 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char brname[IFNAMSIZ]; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct madwifi_driver_data)); 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Could not allocate memory for madwifi driver data\n"); 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hapd = hapd; 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0); 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock < 0) { 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("socket[PF_INET,SOCK_DGRAM]"); 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(drv->iface, params->ifname, sizeof(drv->iface)); 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ifr, 0, sizeof(ifr)); 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name)); 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIFINDEX, &ifr) != 0) { 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl(SIOCGIFINDEX)"); 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ifindex = ifr.ifr_ifindex; 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL, 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit == NULL) 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr)) 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bridge[0]) { 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Configure bridge %s for EAPOL traffic.", 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->bridge[0]); 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(params->bridge[0], NULL, 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_EAPOL, handle_read, drv, 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1); 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (linux_br_get(brname, drv->iface) == 0) { 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Interface in bridge %s; configure for " 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "EAPOL receive", brname); 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(brname, NULL, ETH_P_EAPOL, 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = drv->sock_xmit; 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = IW_MODE_MASTER; 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0) { 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCSIWMODE]"); 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Could not set interface to master mode!\n"); 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* mark down during setup */ 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_set_privacy(drv, 0); /* default to no privacy */ 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt madwifi_receive_probe_req(drv); 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (madwifi_wireless_event_init(drv)) 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtbad: 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv != NULL) 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_deinit(void *priv) 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt netlink_deinit(drv->netlink); 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (void) linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw) 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_ssid(void *priv, const u8 *buf, int len) 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.flags = 1; /* SSID active */ 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len + 1; 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) { 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCSIWESSID]"); 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("len=%d\n", len); 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 12608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_get_ssid(void *priv, u8 *buf, int len) 12618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 12638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 12648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 12658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 12678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 12688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 12698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len; 12708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) { 12728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCGIWESSID]"); 12738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = -1; 12748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 12758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = iwr.u.essid.length; 12768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 12788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 12818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_set_countermeasures(void *priv, int enabled) 12828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 12848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); 12858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_COUNTERMEASURES, enabled); 12868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 12898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtmadwifi_commit(void *priv) 12908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct madwifi_driver_data *drv = priv; 12928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return linux_set_iface_flags(drv->ioctl_sock, drv->iface, 1); 12938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_madwifi_ops = { 12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .name = "madwifi", 12988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .desc = "MADWIFI 802.11 support (Atheros, etc.)", 12998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = wpa_driver_madwifi_set_key, 13008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = madwifi_init, 13018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = madwifi_deinit, 13028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ieee8021x = madwifi_set_ieee8021x, 13038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = madwifi_set_privacy, 13048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_seqnum = madwifi_get_seqnum, 13058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .flush = madwifi_flush, 13068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = madwifi_set_opt_ie, 13078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_set_flags = madwifi_sta_set_flags, 13088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .read_sta_data = madwifi_read_sta_driver_data, 13098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = madwifi_send_eapol, 13108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = madwifi_sta_disassoc, 13118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = madwifi_sta_deauth, 13128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = madwifi_set_ssid, 13138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_get_ssid = madwifi_get_ssid, 13148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_countermeasures = madwifi_set_countermeasures, 13158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_clear_stats = madwifi_sta_clear_stats, 13168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .commit = madwifi_commit, 13178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = madwifi_set_ap_wps_ie, 13181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt .set_freq = madwifi_set_freq, 13198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 1320