driver_atheros.c revision 4530cfd4d14a77c58e35393b91e40f8dd9d62697
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / Driver interaction with Atheros driver 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Sam Leffler <sam@errno.com> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Video54 Technologies 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2005-2007, Jouni Malinen <j@w1.fi> 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, Atheros Communications 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * This software may be distributed under the terms of the BSD license. 904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * See README for more details. 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net/if.h> 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/ioctl.h> 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 1761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "eloop.h" 1861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common/ieee802_11_defs.h" 1961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "l2_packet/l2_packet.h" 2061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "p2p/p2p.h" 2161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef _BYTE_ORDER 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _BYTE_ORDER _BIG_ENDIAN 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _BYTE_ORDER _LITTLE_ENDIAN 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _BYTE_ORDER */ 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Note, the ATH_WPS_IE setting must match with the driver build.. If the 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * driver does not include this, the IEEE80211_IOCTL_GETWPAIE ioctl will fail. 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define ATH_WPS_IE 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#include "ieee80211_external.h" 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <netpacket/packet.h> 4204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef ETH_P_80211_RAW 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define ETH_P_80211_RAW 0x0019 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 481f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#include "linux_wext.h" 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "driver.h" 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eloop.h" 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "priv_netlink.h" 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "l2_packet/l2_packet.h" 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "netlink.h" 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "linux_ioctl.h" 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct atheros_driver_data { 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd; /* back pointer */ 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char iface[IFNAMSIZ + 1]; 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ifindex; 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_xmit; /* raw packet xmit socket */ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_recv; /* raw packet recv socket */ 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ioctl_sock; /* socket for ioctl() use */ 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_data *netlink; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int we_version; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 acct_mac[ETH_ALEN]; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostap_sta_driver_data acct_data; 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_raw; /* raw 802.11 management frames */ 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wpa_ie; 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_beacon_ie; 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_probe_resp_ie; 7604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 own_addr[ETH_ALEN]; 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code); 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_set_privacy(void *priv, int enabled); 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_ioctl_name(int op) 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETPARAM: 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETPARAM"; 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETPARAM: 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETPARAM"; 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETKEY: 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETKEY"; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETWMMPARAMS: 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETWMMPARAMS"; 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELKEY: 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELKEY"; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWMMPARAMS: 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWMMPARAMS"; 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMLME: 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMLME"; 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANINFO: 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANINFO"; 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETOPTIE: 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETOPTIE"; 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETOPTIE: 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETOPTIE"; 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_ADDMAC: 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "ADDMAC"; 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELMAC: 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELMAC"; 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANLIST: 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANLIST"; 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETCHANLIST: 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETCHANLIST"; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_KICKMAC: 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KICKMAC"; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_CHANSWITCH: 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "CHANSWITCH"; 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETMODE: 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETMODE"; 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMODE: 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMODE"; 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_APPIEBUF: 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_APPIEBUF"; 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_APPIEBUF: 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_APPIEBUF"; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_ACPARAMS: 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_ACPARAMS"; 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_FILTERFRAME: 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "FILTERFRAME"; 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RTPARAMS: 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RTPARAMS"; 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_MEDENYENTRY: 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_MEDENYENTRY"; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_MACADDR: 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_MACADDR"; 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_HBRPARAMS: 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_HBRPARAMS"; 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RXTIMEOUT: 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RXTIMEOUT"; 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_STA_STATS: 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "STA_STATS"; 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWPAIE: 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWPAIE"; 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_param_name(int op) 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOC_MCASTCIPHER: 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTCIPHER"; 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_MCASTKEYLEN: 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTKEYLEN"; 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_UCASTCIPHERS: 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "UCASTCIPHERS"; 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_KEYMGTALGS: 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KEYMGTALGS"; 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_RSNCAPS: 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "RSNCAPS"; 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_WPA: 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "WPA"; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_AUTHMODE: 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "AUTHMODE"; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_PRIVACY: 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "PRIVACY"; 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_COUNTERMEASURES: 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "COUNTERMEASURES"; 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211priv(struct atheros_driver_data *drv, int op, void *data, int len) 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int do_inline = len < IFNAMSIZ; 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Certain ioctls must use the non-inlined method */ 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (op == IEEE80211_IOCTL_SET_APPIEBUF || 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op == IEEE80211_IOCTL_FILTERFRAME) 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt do_inline = 0; 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (do_inline) { 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data fits inline; put it there. 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name, data, len); 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data too big for inline transfer; setup a 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * parameter block instead; the kernel will transfer 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the data for the driver. 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = data; 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = len; 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, op, &iwr) < 0) { 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %s: %s: ioctl op=0x%x " 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(%s) len=%d failed: %d (%s)", 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, drv->iface, op, 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt athr_get_ioctl_name(op), 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len, errno, strerror(errno)); 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211param(struct atheros_driver_data *drv, int op, int arg) 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = op; 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name+sizeof(__u32), &arg, sizeof(arg)); 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_SETPARAM, &iwr) < 0) { 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[IEEE80211_IOCTL_SETPARAM]"); 2288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: %s: Failed to set parameter (op %d " 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(%s) arg %d)", __func__, drv->iface, op, 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt athr_get_param_name(op), arg); 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_NO_STDOUT_DEBUG 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtether_sprintf(const u8 *addr) 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static char buf[sizeof(MACSTR)]; 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr)); 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0); 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NO_STDOUT_DEBUG */ 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Configure WPA parameters. 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_configure_wpa(struct atheros_driver_data *drv, 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_bss_params *params) 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int v; 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (params->wpa_group) { 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_CCMP: 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM; 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_TKIP: 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_TKIP; 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP104: 2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP40: 2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_NONE: 2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_NONE; 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "Unknown group key cipher %u", 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_group); 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: group key cipher=%d", __func__, v); 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTCIPHER, v)) { 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set group key cipher to %u\n", v); 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (v == IEEE80211_CIPHER_WEP) { 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* key length is done only for specific ciphers */ 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5); 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTKEYLEN, v)) { 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set group key length to %u\n", v); 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP) 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM; 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_TKIP) 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_TKIP; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_NONE) 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_NONE; 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v); 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_UCASTCIPHERS, v)) { 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set pairwise key ciphers to 0x%x\n", v); 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x", 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, params->wpa_key_mgmt); 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_KEYMGTALGS, 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt)) { 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set key management algorithms to 0x%x\n", 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt); 3138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->rsn_preauth) 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(0); 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w != NO_MGMT_FRAME_PROTECTION) { 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(7); 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w == MGMT_FRAME_PROTECTION_REQUIRED) 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(6); 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3274530cfd4d14a77c58e35393b91e40f8dd9d62697Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x", __func__, v); 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_RSNCAPS, v)) { 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set RSN capabilities to 0x%x\n", v); 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enable WPA=0x%x", __func__, params->wpa); 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_WPA, params->wpa)) { 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Unable to set WPA to %u\n", params->wpa); 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ieee8021x(void *priv, struct wpa_bss_params *params) 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled); 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->enabled) { 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* XXX restore state */ 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_AUTH_AUTO) < 0) 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* IEEE80211_AUTH_AUTO ends up enabling Privacy; clear that */ 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_privacy(drv, 0); 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->wpa && !params->ieee802_1x) { 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "No 802.1X or WPA enabled!"); 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa && atheros_configure_wpa(drv, params) != 0) { 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "Error configuring WPA state!"); 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) { 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hostapd_logger(drv->hapd, NULL, HOSTAPD_MODULE_DRIVER, 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt HOSTAPD_LEVEL_WARNING, "Error enabling WPA/802.1X!"); 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_privacy(void *priv, int enabled) 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled); 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_PRIVACY, enabled); 3848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_sta_authorized(void *priv, const u8 *addr, int authorized) 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d", 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), authorized); 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (authorized) 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTHORIZE; 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_UNAUTHORIZE; 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = 0; 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to %sauthorize STA " MACSTR, 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, authorized ? "" : "un", MAC2STR(addr)); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_set_flags(void *priv, const u8 *addr, 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int total_flags, int flags_or, int flags_and) 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* For now, only support setting Authorized flag */ 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (flags_or & WPA_STA_AUTHORIZED) 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 1); 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!(flags_and & WPA_STA_AUTHORIZED)) 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 0); 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_del_key(void *priv, const u8 *addr, int key_idx) 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_del_key wk; 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d", 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), key_idx); 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) { 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN); 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = (u8) IEEE80211_KEYIX_NONE; 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = key_idx; 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_DELKEY, &wk, sizeof(wk)); 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to delete key (addr %s" 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d)", __func__, ether_sprintf(addr), 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_idx); 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_key(const char *ifname, void *priv, enum wpa_alg alg, 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int key_idx, int set_tx, const u8 *seq, 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t seq_len, const u8 *key, size_t key_len) 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u_int8_t cipher; 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alg == WPA_ALG_NONE) 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_del_key(drv, addr, key_idx); 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d", 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg, ether_sprintf(addr), key_idx); 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (alg) { 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_WEP: 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_WEP; 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_TKIP: 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_TKIP; 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_CCMP: 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM; 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_IGTK: 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CMAC; 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("%s: unknown/unsupported algorithm %d\n", 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg); 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key_len > sizeof(wk.ik_keydata)) { 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("%s: key length %lu too big\n", __func__, 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) key_len); 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -3; 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_type = cipher; 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT; 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL || is_broadcast_ether_addr(addr)) { 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = key_idx; 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set_tx) 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags |= IEEE80211_KEY_DEFAULT; 5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = IEEE80211_KEYIX_NONE; 5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keylen = key_len; 5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_keydata, key, key_len); 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETKEY, &wk, sizeof(wk)); 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set key (addr %s" 5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d alg %d key_len %lu set_tx %d)", 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(wk.ik_macaddr), key_idx, 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alg, (unsigned long) key_len, set_tx); 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx, 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *seq) 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 5268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d", 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), idx); 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL) 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = idx; 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk))) { 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get encryption data " 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(addr " MACSTR " key_idx %d)", 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(wk.ik_macaddr), idx); 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wk.ik_keytsc is in host byte order (big endian), need to 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * swap it to match with the byte order used in WPA. 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef WPA_KEY_RSC_LEN 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define WPA_KEY_RSC_LEN 8 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tmp[WPA_KEY_RSC_LEN]; 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < WPA_KEY_RSC_LEN; i++) { 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1]; 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* WORDS_BIGENDIAN */ 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* WORDS_BIGENDIAN */ 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_flush(void *priv) 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 allsta[IEEE80211_ADDR_LEN]; 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(allsta, 0xff, IEEE80211_ADDR_LEN); 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_sta_deauth(priv, NULL, allsta, 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_REASON_AUTH_LEAVE); 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data, 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr) 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_sta_stats stats; 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(data, 0, sizeof(*data)); 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch statistics for station from the system. 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&stats, 0, sizeof(stats)); 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN); 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_STA_STATS, 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &stats, sizeof(stats))) { 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to fetch STA stats (addr " 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(data, &drv->acct_data, sizeof(*data)); 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Failed to get station stats information element.\n"); 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_packets = stats.is_stats.ns_rx_data; 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_bytes = stats.is_stats.ns_rx_bytes; 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_packets = stats.is_stats.ns_tx_data; 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_bytes = stats.is_stats.ns_tx_bytes; 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_clear_stats(void *priv, const u8 *addr) 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s", __func__, ether_sprintf(addr)); 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_CLEAR_STATS; 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(mlme)); 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to clear STA stats (addr " 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_opt_ie(void *priv, const u8 *ie, size_t ie_len) 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *app_ie; 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu", __func__, 6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) ie_len); 6441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: set_generic_elem", ie, ie_len); 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wpa_ie); 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wpa_ie = wpabuf_alloc_copy(ie, ie_len); 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie = (struct ieee80211req_getset_appiebuf *) buf; 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[0]), ie, ie_len); 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_BEACON; 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Beacon */ 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_beacon_ie != NULL) { 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_beacon_ie), 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_beacon_ie)); 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + wpabuf_len(drv->wps_beacon_ie); 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6621f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(Beacon)", 6631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Probe Response */ 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_PROBE_RESP; 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_probe_resp_ie != NULL) { 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_probe_resp_ie), 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie)); 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie); 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 6781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(ProbeResp)", 6791f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DEAUTH; 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to deauth STA (addr " MACSTR 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " reason %d)", 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr, 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DISASSOC; 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to disassoc STA (addr " 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " reason %d)", 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 73504949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic void atheros_raw_recv_wps(void *ctx, const u8 *src_addr, const u8 *buf, 73604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t len) 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u16 fc; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data event; 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Send Probe Request information to WPS processing */ 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)) 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT || 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt WLAN_FC_GET_STYPE(fc) != WLAN_FC_STYPE_PROBE_REQ) 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.sa = mgmt->sa; 7561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.da = mgmt->da; 7571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt event.rx_probe_req.bssid = mgmt->bssid; 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie = mgmt->u.probe_req.variable; 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt event.rx_probe_req.ie_len = 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_PROBE_REQ, &event); 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 76504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 76604949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic void atheros_raw_recv_11r(void *ctx, const u8 *src_addr, const u8 *buf, 76704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t len) 76804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 76904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = ctx; 77004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt union wpa_event_data event; 77104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const struct ieee80211_mgmt *mgmt; 77204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 fc; 77304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 stype; 77404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ielen; 77504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const u8 *iebuf; 77604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 77704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Do 11R processing for ASSOC/AUTH/FT ACTION frames */ 77804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_HDRLEN) 77904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 78004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 78104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 78204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt fc = le_to_host16(mgmt->frame_control); 78304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 78404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) 78504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 78604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 78704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 78804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: subtype 0x%x len %d", __func__, stype, 78904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 79004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 79104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (os_memcmp(drv->own_addr, mgmt->bssid, ETH_ALEN) != 0) { 79204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: BSSID does not match - ignore", 79304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__); 79404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 79504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 79604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt switch (stype) { 79704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt case WLAN_FC_STYPE_ASSOC_REQ: 79804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len - IEEE80211_HDRLEN < sizeof(mgmt->u.assoc_req)) 79904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 80004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)); 80104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt iebuf = mgmt->u.assoc_req.variable; 80204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 0); 80304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 80404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt case WLAN_FC_STYPE_REASSOC_REQ: 80504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len - IEEE80211_HDRLEN < sizeof(mgmt->u.reassoc_req)) 80604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 80704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)); 80804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt iebuf = mgmt->u.reassoc_req.variable; 80904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 1); 81004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 81104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt case WLAN_FC_STYPE_ACTION: 81204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (&mgmt->u.action.category > buf + len) 81304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 81404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memset(&event, 0, sizeof(event)); 81504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.da = mgmt->da; 81604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.sa = mgmt->sa; 81704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.bssid = mgmt->bssid; 81804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.category = mgmt->u.action.category; 81904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.data = &mgmt->u.action.category; 82004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.rx_action.len = buf + len - event.rx_action.data; 82104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_ACTION, &event); 82204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 82304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt case WLAN_FC_STYPE_AUTH: 82404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len - IEEE80211_HDRLEN < sizeof(mgmt->u.auth)) 82504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 82604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memset(&event, 0, sizeof(event)); 82704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN); 82804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(event.auth.bssid, mgmt->bssid, ETH_ALEN); 82904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg); 83004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.auth.status_code = 83104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt le_to_host16(mgmt->u.auth.status_code); 83204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.auth.auth_transaction = 83304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt le_to_host16(mgmt->u.auth.auth_transaction); 83404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.auth.ies = mgmt->u.auth.variable; 83504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt event.auth.ies_len = len - IEEE80211_HDRLEN - 83604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(mgmt->u.auth); 83704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_AUTH, &event); 83804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 83904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt default: 84004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt break; 84104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 84204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 84304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 84404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 84561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 84661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void atheros_raw_recv_hs20(void *ctx, const u8 *src_addr, const u8 *buf, 84761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t len) 84861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 84961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 85061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 85161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc; 85261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 85361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 85461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Send the Action frame for HS20 processing */ 85561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 85661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.action.category) + 85761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(mgmt->u.action.u.public_action)) 85861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 85961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 86061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 86161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 86261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 86361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT || 86461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WLAN_FC_GET_STYPE(fc) != WLAN_FC_STYPE_ACTION || 86561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.category != WLAN_ACTION_PUBLIC) 86661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 86761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 86861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s:Received Public Action frame", __func__); 86961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 87061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 87161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame = (const u8 *) mgmt; 87261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame_len = len; 87361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, &event); 87461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 87561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 87661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 87761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#if defined(CONFIG_IEEE80211V) && !defined(CONFIG_IEEE80211R) 87861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void atheros_raw_recv_11v(void *ctx, const u8 *src_addr, const u8 *buf, 87961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t len) 88061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 88161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 88261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 88361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 88461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc; 88561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 stype; 88661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 88761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Do 11R processing for WNM ACTION frames */ 88861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < IEEE80211_HDRLEN) 88961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 89061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 89161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 89261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 89361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 89461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) 89561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 89661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 89761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 89861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: subtype 0x%x len %d", __func__, stype, 89961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) len); 90061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 90161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (os_memcmp(drv->own_addr, mgmt->bssid, ETH_ALEN) != 0) { 90261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: BSSID does not match - ignore", 90361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__); 90461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 90561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 90661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 90761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (stype) { 90861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WLAN_FC_STYPE_ACTION: 90961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (&mgmt->u.action.category > buf + len) 91061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 91161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 91261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.da = mgmt->da; 91361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.sa = mgmt->sa; 91461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.bssid = mgmt->bssid; 91561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.category = mgmt->u.action.category; 91661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.data = &mgmt->u.action.category; 91761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_action.len = buf + len - event.rx_action.data; 91861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_ACTION, &event); 91961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 92061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 92161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 92261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 92361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 92461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 92561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 92661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211V) 92704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic void atheros_raw_receive(void *ctx, const u8 *src_addr, const u8 *buf, 92804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t len) 9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 93104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_recv_wps(ctx, src_addr, buf, len); 93204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 93304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 93404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_recv_11r(ctx, src_addr, buf, len); 93504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 93661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#if defined(CONFIG_IEEE80211V) && !defined(CONFIG_IEEE80211R) 93761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_raw_recv_11v(ctx, src_addr, buf, len); 93861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 93961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 94061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_raw_recv_hs20(ctx, src_addr, buf, len); 94161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 94204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 94304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS || CONFIG_IEEE80211R */ 94404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 94504949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_receive_pkt(struct atheros_driver_data *drv) 94604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 94704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret = 0; 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_set_filter filt; 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s Enter", __func__); 95104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 95204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS 95304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_PROBE_REQ; 95404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 95504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 95604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= (IEEE80211_FILTER_TYPE_ASSOC_REQ | 95761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_AUTH | 95861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_ACTION); 95904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif 96061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211V 96161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 96261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 96361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 96461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 96561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 96604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (filt.app_filterype) { 96704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 96804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 96904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret) 97004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 97104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 97304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_raw = l2_packet_init(drv->iface, NULL, ETH_P_80211_RAW, 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive, drv, 1); 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw == NULL) 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 97804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS || CONFIG_IEEE80211R */ 97904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, drv->own_addr)) 98004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 98404949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_reset_appfilter(struct atheros_driver_data *drv) 98504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 98604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_set_filter filt; 98704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 98804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 98904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 99004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 99104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_wps_ie(void *priv, const u8 *ie, size_t len, u32 frametype) 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *beac_ie; 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10001f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu frametype=%u", __func__, 10011f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (unsigned long) len, frametype); 10021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: IE", ie, len); 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie = (struct ieee80211req_getset_appiebuf *) buf; 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_frmtype = frametype; 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen = len; 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[0]), ie, len); 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append the WPA/RSN IE if it is set already */ 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (((frametype == IEEE80211_APPIE_FRAME_BEACON) || 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (frametype == IEEE80211_APPIE_FRAME_PROBE_RESP)) && 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->wpa_ie != NULL)) { 10131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: Append WPA/RSN IE", 10141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->wpa_ie); 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[len]), wpabuf_head(drv->wpa_ie), 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wpa_ie)); 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen += wpabuf_len(drv->wpa_ie); 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF", 10211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt beac_ie->app_buf, beac_ie->app_buflen); 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, beac_ie, 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen); 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10341f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - beacon", beacon); 10351f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - proberesp", 10361f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt proberesp); 10371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - assocresp", 10381f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt assocresp); 10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_beacon_ie = beacon ? wpabuf_dup(beacon) : NULL; 10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_probe_resp_ie = proberesp ? wpabuf_dup(proberesp) : NULL; 10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_wps_ie(priv, assocresp ? wpabuf_head(assocresp) : NULL, 10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt assocresp ? wpabuf_len(assocresp) : 0, 10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_ASSOC_RESP); 10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_set_wps_ie(priv, beacon ? wpabuf_head(beacon) : NULL, 10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon ? wpabuf_len(beacon) : 0, 10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_BEACON)) 10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_wps_ie(priv, 10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_head(proberesp) : NULL, 10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_len(proberesp): 0, 10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_PROBE_RESP); 10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_WPS */ 10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define atheros_set_ap_wps_ie NULL 10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 106004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 106104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 106204949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_auth(void *priv, const u8 *own_addr, const u8 *addr, u16 seq, 106304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 status_code, const u8 *ie, size_t len) 106404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 106504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 106604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 106704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 106804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 106904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d", 107004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code); 107104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTH; 107304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 107404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_seq = seq; 107504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 107604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 107704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 107804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 107904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 108004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 108104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 108204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 108304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 108404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 108504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 108604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 108704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 108804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 108904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 109004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 109104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to auth STA (addr " MACSTR 109204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 109304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 109404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 109504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 109604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 109704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 109804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 109904949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_assoc(void *priv, const u8 *own_addr, const u8 *addr, 110004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int reassoc, u16 status_code, const u8 *ie, size_t len) 110104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 110204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 110304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 110404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 110504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 110604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d reassoc %d", 110704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code, reassoc); 110804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 110904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (reassoc) 111004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_REASSOC; 111104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt else 111204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_ASSOC; 111304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 111404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 111504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 111604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 111704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 111804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 111904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 112004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 112104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 112204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 112304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 112404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 112504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 112604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 112704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 112804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 112904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 113004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to assoc STA (addr " MACSTR 113104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 113204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 113304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 113404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 113504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 113604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 113704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_new_sta(struct atheros_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN]) 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = drv->hapd; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_wpaie ie; 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen = 0; 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *iebuf = NULL; 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch negotiated WPA/RSN parameters from the system. 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ie, 0, sizeof(ie)); 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN); 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETWPAIE, &ie, sizeof(ie))) { 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See ATH_WPS_IE comment in the beginning of the file for a 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * possible cause for the failure.. 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WPA/RSN IE: %s", 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto no_ie; 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPA IE", 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wpa_ie, IEEE80211_MAX_OPT_IE); 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req RSN IE", 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.rsn_ie, IEEE80211_MAX_OPT_IE); 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPS IE", 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wps_ie, IEEE80211_MAX_OPT_IE); 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wpa_ie; 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros seems to return some random data if WPA/RSN IE is not set. 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Assume the IE was not included if the IE type is unknown. */ 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_VENDOR_SPECIFIC) 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[1] == 0 && ie.rsn_ie[1] > 0) { 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros-ng svn #1453 added rsn_ie. Use it, if wpa_ie was not 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * set. This is needed for WPA2. */ 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.rsn_ie; 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_RSN) 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = iebuf[1]; 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* if WPS IE is present, preference is given to WPS */ 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ie.wps_ie && 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (ie.wps_ie[1] > 0 && (ie.wps_ie[0] == WLAN_EID_VENDOR_SPECIFIC))) { 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wps_ie; 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = ie.wps_ie[1]; 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen == 0) 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = NULL; 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 2; 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtno_ie: 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(hapd, addr, iebuf, ielen, 0); 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cached accounting data is not valid anymore. */ 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(drv->acct_mac, 0, ETH_ALEN); 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&drv->acct_data, 0, sizeof(drv->acct_data)); 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless_custom(struct atheros_driver_data *drv, 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *custom, char *end) 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Custom wireless event: '%s'", custom); 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) { 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = strstr(custom, "addr="); 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "without sender address ignored"); 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(pos, addr) == 0) { 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.unicast = 1; 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.src = addr; 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EVENT_MICHAEL_MIC_FAILURE, &data); 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with invalid MAC address"); 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "STA-TRAFFIC-STAT", 16) == 0) { 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *key, *value; 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 val; 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = custom; 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((key = strchr(key, '\n')) != NULL) { 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key++; 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt value = strchr(key, '='); 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (value == NULL) 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *value++ = '\0'; 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(value, NULL, 10); 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(key, "mac") == 0) 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(value, drv->acct_mac); 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_packets") == 0) 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_packets = val; 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_packets") == 0) 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_packets = val; 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_bytes") == 0) 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_bytes = val; 12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_bytes") == 0) 12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_bytes = val; 12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = value; 12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 12608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "PUSH-BUTTON.indication", 22) == 0) { 12618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Some atheros kernels send push button as a wireless event */ 12628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* PROBLEM! this event is received for ALL BSSs ... 12638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * so all are enabled for WPS... ugh. 12648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_WPS_BUTTON_PUSHED, NULL); 126604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 126761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) || defined(CONFIG_HS20) 126861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MGMT_FRAM_TAG_SIZE 30 /* hardcoded in driver */ 12698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "Manage.prob_req ", 16) == 0) { 12708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 12718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Atheros driver uses a hack to pass Probe Request frames as a 12728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * binary data in the custom wireless event. The old way (using 12738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * packet sniffing) didn't work when bridging. 12748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Format: "Manage.prob_req <frame len>" | zero padding | frame 12758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len = atoi(custom + 16); 127761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 12788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req event " 12798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "length %d", len); 12808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive(drv, NULL, 128361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 128404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.assoc_req ", 17) == 0) { 128504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 128604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 128704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 17); 128861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 128904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 129004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 129104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 129204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 129304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 129461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 129504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.action ", 14) == 0) { 129604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 129704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 129804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 14); 129961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 130004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 130104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 130204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 130304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 130404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 130561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 130604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.auth ", 12) == 0) { 130704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.auth <frame len>" | zero padding | frame 130804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt */ 130904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 12); 131061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 131104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 131204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 131304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 131404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 131504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 131661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 131704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS or CONFIG_IEEE80211R */ 13188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 13198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 13208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 132161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 132261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* Handle size of data problem. WEXT only allows data of 256 bytes for custom 132361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* events, and p2p data can be much bigger. So the athr driver sends a small 132461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* event telling me to collect the big data with an ioctl. 132561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* On the first event, send all pending events to supplicant. 132661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt*/ 132761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void fetch_pending_big_events(struct atheros_driver_data *drv) 132861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 132961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 133061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 133161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 tbuf[IW_PRIV_SIZE_MASK]; /* max size is 2047 bytes */ 133261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc, stype; 133361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 133461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t data_len; 133561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u32 freq, frame_type; 133661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 133761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (1) { 133861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 133961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_strncpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 134061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) tbuf; 134261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = sizeof(tbuf); 134361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = IEEE80211_IOC_P2P_FETCH_FRAME; 134461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) 134661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt < 0) { 134761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (errno == ENOSPC) { 134861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s:%d exit", 134961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, __LINE__); 135061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 135161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 135261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s: P2P_BIG_PARAM[" 135361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "P2P_FETCH_FRAME] failed: %s", 135461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, strerror(errno)); 135561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 135661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 135761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len = iwr.u.data.length; 135861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "athr: P2P_FETCH_FRAME data", 135961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) tbuf, data_len); 136061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data_len < sizeof(freq) + sizeof(frame_type) + 24) { 136161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: frame too short"); 136261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 136361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&freq, tbuf, sizeof(freq)); 136561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&frame_type, &tbuf[sizeof(freq)], 136661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(frame_type)); 136761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (void *) &tbuf[sizeof(freq) + sizeof(frame_type)]; 136861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len -= sizeof(freq) + sizeof(frame_type); 136961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 137061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (frame_type == IEEE80211_EV_RX_MGMT) { 137161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 137261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 137361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 137461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: EV_RX_MGMT stype=%u " 137561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "freq=%u len=%u", stype, freq, (int) data_len); 137661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 137761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (stype == WLAN_FC_STYPE_ACTION) { 137861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 137961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame = (const u8 *) mgmt; 138061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame_len = data_len; 138161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, 138261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &event); 138361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 138461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 138561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 138661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s unknown type %d", 138761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, frame_type); 138861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 138961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 139061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 139161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 139261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 139361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void 139461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtatheros_wireless_event_atheros_custom(struct atheros_driver_data *drv, 139561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int opcode, char *buf, int len) 139661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 139761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (opcode) { 139861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case IEEE80211_EV_RX_MGMT: 139961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "WEXT: EV_RX_MGMT"); 140061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fetch_pending_big_events(drv); 140161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 140261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 140361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 140461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 140561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 140661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless(struct atheros_driver_data *drv, 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *data, int len) 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_event iwe_buf, *iwe = &iwe_buf; 14128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *end, *custom, *buf; 14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data; 14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = data + len; 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (pos + IW_EV_LCP_LEN <= end) { 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Event data may be unaligned, so make a local, aligned copy 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before processing. */ 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, IW_EV_LCP_LEN); 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "Wireless event: cmd=0x%x len=%d", 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd, iwe->len); 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iwe->len <= IW_EV_LCP_LEN) 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom = pos + IW_EV_POINT_LEN; 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->we_version > 18 && 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (iwe->cmd == IWEVMICHAELMICFAILURE || 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVASSOCREQIE || 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVCUSTOM)) { 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* WE-19 removed the pointer from struct iw_point */ 14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dpos = (char *) &iwe_buf.u.data.length; 14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int dlen = dpos - (char *) &iwe_buf; 14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(dpos, pos + IW_EV_LCP_LEN, 14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct iw_event) - dlen); 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, sizeof(struct iw_event)); 14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom += IW_EV_POINT_OFF; 14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (iwe->cmd) { 14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVEXPIRED: 14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->hapd, 14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) iwe->u.addr.sa_data); 14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVREGISTERED: 14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_new_sta(drv, (u8 *) iwe->u.addr.sa_data); 14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVASSOCREQIE: 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Driver hack.. Use IWEVASSOCREQIE to bypass 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * IWEVCUSTOM size limitations. Need to handle this 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * just like IWEVCUSTOM. 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVCUSTOM: 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (custom + iwe->u.data.length > end) 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = malloc(iwe->u.data.length + 1); 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; /* XXX */ 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(buf, custom, iwe->u.data.length); 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[iwe->u.data.length] = '\0'; 146261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 146361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (iwe->u.data.flags != 0) { 146461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_atheros_custom( 146561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, (int) iwe->u.data.flags, 146661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf, len); 146761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 146861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_wireless_custom( 146961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, buf, buf + iwe->u.data.length); 147061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(buf); 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += iwe->len; 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_rtm_newlink(void *ctx, 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifinfomsg *ifi, u8 *buf, size_t len) 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, rta_len; 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifi->ifi_index != drv->ifindex) 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = len; 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) buf; 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_WIRELESS) { 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_wireless_event_wireless( 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv, ((char *) attr) + rta_len, 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->rta_len - rta_len); 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_we_version(struct atheros_driver_data *drv) 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_range *range; 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int minlen; 15128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buflen; 15138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = 0; 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Use larger buffer than struct iw_range in order to allow the 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * structure to grow in the future. 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buflen = sizeof(struct iw_range) + 500; 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range = os_zalloc(buflen); 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (range == NULL) 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = (caddr_t) range; 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = buflen; 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt minlen = ((char *) &range->enc_capa) - (char *) range + 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(range->enc_capa); 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) { 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCGIWRANGE]"); 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(range); 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (iwr.u.data.length >= minlen && 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled >= 18) { 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d " 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WE(source)=%d enc_capa=0x%x", 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled, 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_source, 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->enc_capa); 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = range->we_version_compiled; 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 154775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen os_free(range); 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_init(struct atheros_driver_data *drv) 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_config *cfg; 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_get_we_version(drv); 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg = os_zalloc(sizeof(*cfg)); 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cfg == NULL) 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->ctx = drv; 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->newlink_cb = atheros_wireless_event_rtm_newlink; 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->netlink = netlink_init(cfg); 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->netlink == NULL) { 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cfg); 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len, 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int encrypt, const u8 *own_addr, u32 flags) 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char buf[3000]; 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *bp = buf; 15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int status; 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Prepend the Ethernet header. If the caller left us 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * space at the front we could just insert it but since 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * we don't know we copy to a local buffer. Given the frequency 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and size of frames this probably doesn't matter. 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = data_len + sizeof(struct l2_ethhdr); 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(buf)) { 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bp = malloc(len); 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp == NULL) { 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("EAPOL frame discarded, cannot malloc temp " 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "buffer of size %lu!\n", (unsigned long) len); 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) bp; 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_dest, addr, ETH_ALEN); 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_source, own_addr, ETH_ALEN); 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth->h_proto = host_to_be16(ETH_P_EAPOL); 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth+1, data, data_len); 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len); 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len); 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp != buf) 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(bp); 16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return status; 16138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidthandle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len) 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->hapd, src_addr, buf + sizeof(struct l2_ethhdr), 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - sizeof(struct l2_ethhdr)); 16218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_init(struct hostapd_data *hapd, struct wpa_init_params *params) 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv; 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char brname[IFNAMSIZ]; 16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct atheros_driver_data)); 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Could not allocate memory for atheros driver data\n"); 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hapd = hapd; 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0); 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock < 0) { 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("socket[PF_INET,SOCK_DGRAM]"); 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(drv->iface, params->ifname, sizeof(drv->iface)); 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ifr, 0, sizeof(ifr)); 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name)); 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIFINDEX, &ifr) != 0) { 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl(SIOCGIFINDEX)"); 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ifindex = ifr.ifr_ifindex; 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL, 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit == NULL) 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr)) 16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bridge[0]) { 16608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Configure bridge %s for EAPOL traffic.", 16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->bridge[0]); 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(params->bridge[0], NULL, 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_EAPOL, handle_read, drv, 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1); 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (linux_br_get(brname, drv->iface) == 0) { 16688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Interface in bridge %s; configure for " 16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "EAPOL receive", brname); 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(brname, NULL, ETH_P_EAPOL, 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = drv->sock_xmit; 16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = IW_MODE_MASTER; 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0) { 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCSIWMODE]"); 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("Could not set interface to master mode!\n"); 16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* mark down during setup */ 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_privacy(drv, 0); /* default to no privacy */ 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 169204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_receive_pkt(drv); 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_wireless_event_init(drv)) 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtbad: 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv != NULL) 17068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 17078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 17088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_deinit(void *priv) 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 171604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_reset_appfilter(drv); 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt netlink_deinit(drv->netlink); 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (void) linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw) 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wpa_ie); 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 17308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 17318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ssid(void *priv, const u8 *buf, int len) 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.flags = 1; /* SSID active */ 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len + 1; 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) { 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCSIWESSID]"); 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt printf("len=%d\n", len); 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_ssid(void *priv, u8 *buf, int len) 17558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 17598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.essid.length = (len > IW_ESSID_MAX_SIZE) ? 17641f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt IW_ESSID_MAX_SIZE : len; 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) { 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt perror("ioctl[SIOCGIWESSID]"); 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = -1; 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = iwr.u.essid.length; 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_countermeasures(void *priv, int enabled) 17778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); 17808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_COUNTERMEASURES, enabled); 17818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_commit(void *priv) 17858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return linux_set_iface_flags(drv->ioctl_sock, drv->iface, 1); 17888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 179075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinenstatic int atheros_set_authmode(void *priv, int auth_algs) 179175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen{ 179275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen int authmode; 179375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 179475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen if ((auth_algs & WPA_AUTH_ALG_OPEN) && 179575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen (auth_algs & WPA_AUTH_ALG_SHARED)) 179675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_AUTO; 179775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_OPEN) 179875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_OPEN; 179975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_SHARED) 180075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_SHARED; 180175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else 180275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return -1; 180375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 180475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return set80211param(priv, IEEE80211_PARAM_AUTHMODE, authmode); 180575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen} 180675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 18071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int atheros_set_ap(void *priv, struct wpa_driver_ap_params *params) 18081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 18091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 18101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * TODO: Use this to replace set_authmode, set_privacy, set_ieee8021x, 18111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * set_generic_elem, and hapd_set_ssid. 18121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 18131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 18141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: set_ap - pairwise_ciphers=0x%x " 18151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "group_cipher=0x%x key_mgmt_suites=0x%x auth_algs=0x%x " 18161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "wpa_version=0x%x privacy=%d interworking=%d", 18171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->pairwise_ciphers, params->group_cipher, 18181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->key_mgmt_suites, params->auth_algs, 18191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->wpa_version, params->privacy, params->interworking); 18201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "atheros: SSID", 18211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->ssid, params->ssid_len); 18221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (params->hessid) 18231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: HESSID " MACSTR, 18241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(params->hessid)); 18251f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: beacon_ies", 18261f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->beacon_ies); 18271f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: proberesp_ies", 18281f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->proberesp_ies); 18291f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: assocresp_ies", 18301f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->assocresp_ies); 18311f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 18321f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 18331f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 18341f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 183504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 183604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 183704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 183804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_send_mgmt(void *priv, const u8 *frm, size_t data_len, 183904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int noack) 184004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 184104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 184204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 buf[1510]; 184304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const struct ieee80211_mgmt *mgmt; 184404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mgmtbuf *mgmt_frm; 184504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 184604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt = (const struct ieee80211_mgmt *) frm; 184704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s frmlen = %lu " MACSTR, __func__, 184804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (unsigned long) data_len, MAC2STR(mgmt->da)); 184904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm = (struct ieee80211req_mgmtbuf *) buf; 185004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt memcpy(mgmt_frm->macaddr, (u8 *)mgmt->da, IEEE80211_ADDR_LEN); 185104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm->buflen = data_len; 185204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (&mgmt_frm->buf[0] + data_len > buf + sizeof(buf)) { 185304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_INFO, "atheros: Too long frame for " 185404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "atheros_send_mgmt (%u)", (unsigned int) data_len); 185504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 185604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 185704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&mgmt_frm->buf[0], frm, data_len); 185804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SEND_MGMT, mgmt_frm, 185904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_mgmtbuf) + data_len); 186004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 186104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 186204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 186304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_tspec(void *priv, const u8 *addr, u8 *tspec_ie, 186404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t tspec_ielen) 186504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 186604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 186704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int retv; 186804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 186904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addts *addts = &req.u.addts; 187004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 187104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 187204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDTS; 187304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 187404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(addts->tspecie, tspec_ie, tspec_ielen); 187504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt retv = set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 187604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 187704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (retv < 0) { 187804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s IEEE80211_IOCTL_RES_REQ FAILED " 187904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "retv = %d", __func__, retv); 188004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 188104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 188204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(tspec_ie, addts->tspecie, tspec_ielen); 188304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return addts->status; 188404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 188504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 188604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 188704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_sta_node(void *priv, const u8 *addr, u16 auth_alg) 188804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 188904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 189004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 189104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addnode *addnode = &req.u.addnode; 189204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 189304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 189404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDNODE; 189504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 189604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt addnode->auth_alg = auth_alg; 189704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 189804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 189904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 190004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 190204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* Use only to set a big param, get will not work. */ 190561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int 190661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtset80211big(struct atheros_driver_data *drv, int op, const void *data, int len) 190761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 190861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 190961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 191061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 191161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 191261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 191361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) data; 191461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = len; 191561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = op; 191661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x=%d (%s) len=0x%x", 191761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, op, athr_get_param_name(op), len); 191861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 191961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) < 0) { 192061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x (%s) subop=0x%x=%d " 192161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "value=0x%x,0x%x failed: %d (%s)", 192261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, athr_get_ioctl_name(op), iwr.u.mode, 192361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.mode, iwr.u.data.length, 192461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags, errno, strerror(errno)); 192561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 192661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 192761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 192861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 192961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_send_action(void *priv, unsigned int freq, 193261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt unsigned int wait, 193361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *dst, const u8 *src, 193461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *bssid, 193561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *data, size_t data_len, int no_cck) 193661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 193761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 193861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211_p2p_send_action *act; 193961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int res; 194061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act = os_zalloc(sizeof(*act) + data_len); 194261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (act == NULL) 194361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 194461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act->freq = freq; 194561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->dst_addr, dst, ETH_ALEN); 194661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->src_addr, src, ETH_ALEN); 194761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->bssid, bssid, ETH_ALEN); 194861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act + 1, data, data_len); 194961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: freq=%d, wait=%u, dst=" MACSTR ", src=" 195061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MACSTR ", bssid=" MACSTR, 195161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, act->freq, wait, MAC2STR(act->dst_addr), 195261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MAC2STR(act->src_addr), MAC2STR(act->bssid)); 195361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: act", (u8 *) act, sizeof(*act)); 195461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: data", data, data_len); 195561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 195661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = set80211big(drv, IEEE80211_IOC_P2P_SEND_ACTION, 195761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act, sizeof(*act) + data_len); 195861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(act); 195961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 196061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 196161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 196261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 196361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211V 196461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int athr_wnm_tfs(struct atheros_driver_data *drv, const u8* peer, 196561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *ie, u16 *len, enum wnm_oper oper) 196661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 196761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define IEEE80211_APPIE_MAX 1024 /* max appie buffer size */ 196861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 buf[IEEE80211_APPIE_MAX]; 196961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211req_getset_appiebuf *tfs_ie; 197061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 197161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: ifname=%s, WNM TFS IE oper=%d " MACSTR, 197361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv->iface, oper, MAC2STR(peer)); 197461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 197661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 197761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*len > IEEE80211_APPIE_MAX - 197861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf)) { 197961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) too large"); 198061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 198161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 198261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 198361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 198461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = ETH_ALEN + 2 + 2 + *len; 198561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 198661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 198761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 198861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 198961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 199061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = *len; 199161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 199261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy the ie */ 199461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2 + 2, ie, *len); 199561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 199761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 199861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 199961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 200061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 200161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 200261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 200361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 200461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 200561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 200661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 200761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 200861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 200961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 201061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 201161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 201261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 201361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 201461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 201561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GET_APPIEBUF, tfs_ie, 201661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 201761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WNM TFS IE: " 201861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 201961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 202061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 202161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 202261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = tfs_ie->app_buflen; 202361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(ie, &(tfs_ie->app_buf[0]), *len); 202461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %c len=%d", tfs_ie->app_buf[0], 202561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len); 202661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 202761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 202861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = 0; 202961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 203061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 203161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 203261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 203361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 203461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 203561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 203661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 203761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 203861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 203961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 204061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 204161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 204261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 204361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 204461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 204561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 204661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 204761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 204861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 204961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 205061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Unsupported TFS oper %d", oper); 205161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 205261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 205361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 205561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 205661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_sleep(struct atheros_driver_data *drv, 205961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *peer, enum wnm_oper oper) 206061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 206161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *data, *pos; 206261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t dlen; 206361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int ret; 206461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 206561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 206661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: WNM-Sleep Oper %d, " MACSTR, 206761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper, MAC2STR(peer)); 206861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 206961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt dlen = ETH_ALEN + 2 + 2; 207061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data = os_malloc(dlen); 207161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data == NULL) 207261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 207361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 207561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = data; 207661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, peer, ETH_ALEN); 207761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ETH_ALEN; 207861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 208061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 208161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 2; 208261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 208461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 208561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ret = atheros_set_wps_ie(drv, data, dlen, IEEE80211_APPIE_FRAME_WNM); 208761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(data); 208961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return ret; 209161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 209261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_oper(void *priv, enum wnm_oper oper, const u8 *peer, 209561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len) 209661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 209761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 209861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 210061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_CONFIRM: 210161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_FAIL: 210261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_CONFIRM: 210361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_FAIL: 210461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return atheros_wnm_sleep(drv, peer, oper); 210561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 210661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 210761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 210861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 210961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return athr_wnm_tfs(drv, peer, buf, buf_len, oper); 211061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 211161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: Unsupported WNM operation %d", 211261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper); 211361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 211461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 211561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 211661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 211761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 211861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_atheros_ops = { 21208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .name = "atheros", 21218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = atheros_init, 21228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = atheros_deinit, 21238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ieee8021x = atheros_set_ieee8021x, 21248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = atheros_set_privacy, 21258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = atheros_set_key, 21268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_seqnum = atheros_get_seqnum, 21278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .flush = atheros_flush, 21288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = atheros_set_opt_ie, 21298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_set_flags = atheros_sta_set_flags, 21308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .read_sta_data = atheros_read_sta_driver_data, 21318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = atheros_send_eapol, 21328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = atheros_sta_disassoc, 21338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = atheros_sta_deauth, 21348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = atheros_set_ssid, 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_get_ssid = atheros_get_ssid, 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_countermeasures = atheros_set_countermeasures, 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_clear_stats = atheros_sta_clear_stats, 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .commit = atheros_commit, 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = atheros_set_ap_wps_ie, 214075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen .set_authmode = atheros_set_authmode, 21411f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt .set_ap = atheros_set_ap, 214204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 214304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_assoc = atheros_sta_assoc, 214404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_auth = atheros_sta_auth, 214504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .send_mlme = atheros_send_mgmt, 214604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_tspec = atheros_add_tspec, 214704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_sta_node = atheros_add_sta_node, 214804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 214961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .send_action = atheros_send_action, 215061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211V 215161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .wnm_oper = atheros_wnm_oper, 215261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 21538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 2154