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 58d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211W) || defined(CONFIG_IEEE80211R) || defined(CONFIG_HS20) || defined(CONFIG_WNM) || defined(CONFIG_WPS) 59d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#define ATHEROS_USE_RAW_RECEIVE 60d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif 61d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct atheros_driver_data { 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd; /* back pointer */ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char iface[IFNAMSIZ + 1]; 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ifindex; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_xmit; /* raw packet xmit socket */ 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_recv; /* raw packet recv socket */ 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ioctl_sock; /* socket for ioctl() use */ 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_data *netlink; 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int we_version; 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 acct_mac[ETH_ALEN]; 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostap_sta_driver_data acct_data; 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_raw; /* raw 802.11 management frames */ 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wpa_ie; 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_beacon_ie; 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_probe_resp_ie; 8004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 own_addr[ETH_ALEN]; 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code); 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_set_privacy(void *priv, int enabled); 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_ioctl_name(int op) 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETPARAM: 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETPARAM"; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETPARAM: 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETPARAM"; 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETKEY: 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETKEY"; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETWMMPARAMS: 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETWMMPARAMS"; 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELKEY: 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELKEY"; 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWMMPARAMS: 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWMMPARAMS"; 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMLME: 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMLME"; 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANINFO: 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANINFO"; 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETOPTIE: 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETOPTIE"; 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETOPTIE: 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETOPTIE"; 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_ADDMAC: 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "ADDMAC"; 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELMAC: 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELMAC"; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANLIST: 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANLIST"; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETCHANLIST: 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETCHANLIST"; 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_KICKMAC: 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KICKMAC"; 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_CHANSWITCH: 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "CHANSWITCH"; 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETMODE: 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETMODE"; 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMODE: 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMODE"; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_APPIEBUF: 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_APPIEBUF"; 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_APPIEBUF: 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_APPIEBUF"; 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_ACPARAMS: 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_ACPARAMS"; 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_FILTERFRAME: 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "FILTERFRAME"; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RTPARAMS: 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RTPARAMS"; 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_MEDENYENTRY: 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_MEDENYENTRY"; 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_MACADDR: 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_MACADDR"; 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_HBRPARAMS: 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_HBRPARAMS"; 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RXTIMEOUT: 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RXTIMEOUT"; 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_STA_STATS: 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "STA_STATS"; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWPAIE: 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWPAIE"; 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_param_name(int op) 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOC_MCASTCIPHER: 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTCIPHER"; 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_MCASTKEYLEN: 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTKEYLEN"; 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_UCASTCIPHERS: 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "UCASTCIPHERS"; 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_KEYMGTALGS: 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KEYMGTALGS"; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_RSNCAPS: 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "RSNCAPS"; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_WPA: 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "WPA"; 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_AUTHMODE: 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "AUTHMODE"; 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_PRIVACY: 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "PRIVACY"; 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_COUNTERMEASURES: 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "COUNTERMEASURES"; 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211priv(struct atheros_driver_data *drv, int op, void *data, int len) 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int do_inline = len < IFNAMSIZ; 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Certain ioctls must use the non-inlined method */ 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (op == IEEE80211_IOCTL_SET_APPIEBUF || 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op == IEEE80211_IOCTL_FILTERFRAME) 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt do_inline = 0; 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1920e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (do_inline) { 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data fits inline; put it there. 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1980e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(iwr.u.name, data, len); 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data too big for inline transfer; setup a 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * parameter block instead; the kernel will transfer 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the data for the driver. 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = data; 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = len; 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, op, &iwr) < 0) { 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %s: %s: ioctl op=0x%x " 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(%s) len=%d failed: %d (%s)", 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, drv->iface, op, 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt athr_get_ioctl_name(op), 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len, errno, strerror(errno)); 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211param(struct atheros_driver_data *drv, int op, int arg) 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2250e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 2278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = op; 2280e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(iwr.u.name + sizeof(__u32), &arg, sizeof(arg)); 2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_SETPARAM, &iwr) < 0) { 2316c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 2326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "%s: %s: Failed to set parameter (op %d (%s) arg %d): ioctl[IEEE80211_IOCTL_SETPARAM]: %s", 2336c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, drv->iface, op, athr_get_param_name(op), 2346c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt arg, strerror(errno)); 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_NO_STDOUT_DEBUG 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtether_sprintf(const u8 *addr) 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static char buf[sizeof(MACSTR)]; 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) 2470e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr)); 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 2490e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_snprintf(buf, sizeof(buf), MACSTR, 0, 0, 0, 0, 0, 0); 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NO_STDOUT_DEBUG */ 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Configure WPA parameters. 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_configure_wpa(struct atheros_driver_data *drv, 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_bss_params *params) 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int v; 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (params->wpa_group) { 2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_CCMP: 2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM; 2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 26709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 26809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_CCMP_256: 26909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM_256; 27009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 27109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_GCMP: 27209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_GCM; 27309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 27409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_GCMP_256: 27509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_GCM_256; 27609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 27709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_TKIP: 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_TKIP; 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP104: 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP40: 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_NONE: 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_NONE; 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "Unknown group key cipher %u", 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_group); 2938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: group key cipher=%d", __func__, v); 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTCIPHER, v)) { 2976c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set group key cipher to %u", v); 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (v == IEEE80211_CIPHER_WEP) { 3018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* key length is done only for specific ciphers */ 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5); 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTKEYLEN, v)) { 3046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set group key length to %u", v); 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP) 3128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM; 31309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 31409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP_256) 31509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM_256; 31609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_GCMP) 31709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_GCM; 31809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_GCMP_256) 31909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_GCM_256; 32009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_TKIP) 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_TKIP; 3238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_NONE) 3248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_NONE; 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v); 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_UCASTCIPHERS, v)) { 3276c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3286c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set pairwise key ciphers to 0x%x", v); 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x", 3338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, params->wpa_key_mgmt); 3348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_KEYMGTALGS, 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt)) { 3366c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3376c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set key management algorithms to 0x%x", 3386c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt params->wpa_key_mgmt); 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->rsn_preauth) 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(0); 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w != NO_MGMT_FRAME_PROTECTION) { 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(7); 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w == MGMT_FRAME_PROTECTION_REQUIRED) 3498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(6); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 3528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3534530cfd4d14a77c58e35393b91e40f8dd9d62697Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x", __func__, v); 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_RSNCAPS, v)) { 3556c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set RSN capabilities to 0x%x", 3566c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt v); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enable WPA=0x%x", __func__, params->wpa); 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_WPA, params->wpa)) { 3626c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set WPA to %u", params->wpa); 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ieee8021x(void *priv, struct wpa_bss_params *params) 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled); 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->enabled) { 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* XXX restore state */ 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_AUTH_AUTO) < 0) 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* IEEE80211_AUTH_AUTO ends up enabling Privacy; clear that */ 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_privacy(drv, 0); 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->wpa && !params->ieee802_1x) { 3845460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "No 802.1X or WPA enabled!"); 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa && atheros_configure_wpa(drv, params) != 0) { 3885460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "Error configuring WPA state!"); 3898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) { 3935460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "Error enabling WPA/802.1X!"); 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_privacy(void *priv, int enabled) 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled); 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_PRIVACY, enabled); 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_sta_authorized(void *priv, const u8 *addr, int authorized) 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d", 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), authorized); 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (authorized) 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTHORIZE; 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_UNAUTHORIZE; 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = 0; 4250e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to %sauthorize STA " MACSTR, 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, authorized ? "" : "un", MAC2STR(addr)); 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_set_flags(void *priv, const u8 *addr, 437d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt unsigned int total_flags, unsigned int flags_or, 438d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt unsigned int flags_and) 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* For now, only support setting Authorized flag */ 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (flags_or & WPA_STA_AUTHORIZED) 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 1); 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!(flags_and & WPA_STA_AUTHORIZED)) 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 0); 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_del_key(void *priv, const u8 *addr, int key_idx) 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_del_key wk; 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d", 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), key_idx); 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4580e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&wk, 0, sizeof(wk)); 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) { 4600e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN); 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = (u8) IEEE80211_KEYIX_NONE; 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = key_idx; 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_DELKEY, &wk, sizeof(wk)); 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to delete key (addr %s" 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d)", __func__, ether_sprintf(addr), 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_idx); 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_key(const char *ifname, void *priv, enum wpa_alg alg, 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int key_idx, int set_tx, const u8 *seq, 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t seq_len, const u8 *key, size_t key_len) 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u_int8_t cipher; 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alg == WPA_ALG_NONE) 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_del_key(drv, addr, key_idx); 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d", 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg, ether_sprintf(addr), key_idx); 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (alg) { 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_WEP: 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_WEP; 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_TKIP: 4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_TKIP; 4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_CCMP: 5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM; 5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 50209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 50309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_CCMP_256: 50409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM_256; 50509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 50609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_GCMP: 50709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GCM; 50809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 50909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_GCMP_256: 51009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GCM_256; 51109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 51209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_IGTK: 5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CMAC; 5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 51709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 51809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_CMAC_256: 51909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CMAC_256; 52009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 52109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_GMAC_128: 52209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GMAC; 52309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 52409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_GMAC_256: 52509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GMAC_256; 52609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 52709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 5306c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "%s: unknown/unsupported algorithm %d", 5316c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, alg); 5328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key_len > sizeof(wk.ik_keydata)) { 5366c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "%s: key length %lu too big", __func__, 5376c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt (unsigned long) key_len); 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -3; 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5410e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&wk, 0, sizeof(wk)); 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_type = cipher; 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT; 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL || is_broadcast_ether_addr(addr)) { 5450e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = key_idx; 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set_tx) 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags |= IEEE80211_KEY_DEFAULT; 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5500e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = IEEE80211_KEYIX_NONE; 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keylen = key_len; 5540e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(wk.ik_keydata, key, key_len); 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETKEY, &wk, sizeof(wk)); 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set key (addr %s" 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d alg %d key_len %lu set_tx %d)", 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(wk.ik_macaddr), key_idx, 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alg, (unsigned long) key_len, set_tx); 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx, 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *seq) 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d", 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), idx); 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5780e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&wk, 0, sizeof(wk)); 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL) 5800e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 5820e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = idx; 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk))) { 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get encryption data " 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(addr " MACSTR " key_idx %d)", 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(wk.ik_macaddr), idx); 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wk.ik_keytsc is in host byte order (big endian), need to 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * swap it to match with the byte order used in WPA. 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef WPA_KEY_RSC_LEN 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define WPA_KEY_RSC_LEN 8 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tmp[WPA_KEY_RSC_LEN]; 6030e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < WPA_KEY_RSC_LEN; i++) { 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1]; 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* WORDS_BIGENDIAN */ 6090e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* WORDS_BIGENDIAN */ 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_flush(void *priv) 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 allsta[IEEE80211_ADDR_LEN]; 6190e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(allsta, 0xff, IEEE80211_ADDR_LEN); 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_sta_deauth(priv, NULL, allsta, 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_REASON_AUTH_LEAVE); 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data, 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr) 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_sta_stats stats; 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6320e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(data, 0, sizeof(*data)); 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch statistics for station from the system. 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 6370e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&stats, 0, sizeof(stats)); 6380e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN); 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_STA_STATS, 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &stats, sizeof(stats))) { 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to fetch STA stats (addr " 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6430e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 6440e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(data, &drv->acct_data, sizeof(*data)); 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6486c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 6496c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Failed to get station stats information element"); 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_packets = stats.is_stats.ns_rx_data; 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_bytes = stats.is_stats.ns_rx_bytes; 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_packets = stats.is_stats.ns_tx_data; 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_bytes = stats.is_stats.ns_tx_bytes; 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_clear_stats(void *priv, const u8 *addr) 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s", __func__, ether_sprintf(addr)); 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_CLEAR_STATS; 6710e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(mlme)); 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to clear STA stats (addr " 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_opt_ie(void *priv, const u8 *ie, size_t ie_len) 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *app_ie; 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu", __func__, 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) ie_len); 6921f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: set_generic_elem", ie, ie_len); 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wpa_ie); 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wpa_ie = wpabuf_alloc_copy(ie, ie_len); 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie = (struct ieee80211req_getset_appiebuf *) buf; 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[0]), ie, ie_len); 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_BEACON; 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Beacon */ 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_beacon_ie != NULL) { 7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_beacon_ie), 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_beacon_ie)); 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + wpabuf_len(drv->wps_beacon_ie); 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(Beacon)", 7111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Probe Response */ 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_PROBE_RESP; 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_probe_resp_ie != NULL) { 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_probe_resp_ie), 7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie)); 7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie); 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 7261f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(ProbeResp)", 7271f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DEAUTH; 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7470e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to deauth STA (addr " MACSTR 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " reason %d)", 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr, 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DISASSOC; 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7710e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to disassoc STA (addr " 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " reason %d)", 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 782051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidtstatic int atheros_set_qos_map(void *ctx, const u8 *qos_map_set, 783051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt u8 qos_map_set_len) 784051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt{ 785051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt#ifdef CONFIG_ATHEROS_QOS_MAP 786051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 787051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct ieee80211req_athdbg req; 788051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct ieee80211_qos_map *qos_map = &req.data.qos_map; 789051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct iwreq iwr; 790051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt int i, up_start; 791051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 792051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (qos_map_set_len < 16 || qos_map_set_len > 58 || 793051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map_set_len & 1) { 794051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt wpa_printf(MSG_ERROR, "Invalid QoS Map"); 795051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return -1; 796051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } else { 7970e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&req, 0, sizeof(struct ieee80211req_athdbg)); 798051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt req.cmd = IEEE80211_DBGREQ_SETQOSMAPCONF; 799051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 80068d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, sizeof(iwr.ifr_name)); 801051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt iwr.u.data.pointer = (void *) &req; 802051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt iwr.u.data.length = sizeof(struct ieee80211req_athdbg); 803051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 804051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 805051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->valid = 1; 806051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->num_dscp_except = (qos_map_set_len - 16) / 2; 807051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (qos_map->num_dscp_except) { 808051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt for (i = 0; i < qos_map->num_dscp_except; i++) { 809051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->dscp_exception[i].dscp = qos_map_set[i * 2]; 810051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->dscp_exception[i].up = qos_map_set[i * 2 + 1]; 811051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 812051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 813051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 814051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt up_start = qos_map_set_len - 16; 815051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt for (i = 0; i < IEEE80211_MAX_QOS_UP_RANGE; i++) { 816051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->up[i].low = qos_map_set[up_start + (i * 2)]; 817051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->up[i].high = qos_map_set[up_start + (i * 2) + 1]; 818051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 819051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 820051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_DBGREQ, &iwr) < 0) { 8216c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, 8226c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "%s: %s: Failed to set QoS Map: ioctl[IEEE80211_IOCTL_DBGREQ]: %s", 8236c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, drv->iface, strerror(errno)); 824051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return -1; 825051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 826051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt#endif /* CONFIG_ATHEROS_QOS_MAP */ 827051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 828051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return 0; 829051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt} 830051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 831d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef ATHEROS_USE_RAW_RECEIVE 8326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidtstatic void atheros_raw_receive(void *ctx, const u8 *src_addr, const u8 *buf, 8336c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt size_t len) 83461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 83561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 83661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 8376c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt union wpa_event_data event; 8386c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt u16 fc, stype; 8396c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt int ielen; 8406c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt const u8 *iebuf; 84161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < IEEE80211_HDRLEN) 84361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 8446c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 84561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 84661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 84861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) 85061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 8516c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 85261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 85361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 85461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: subtype 0x%x len %d", __func__, stype, 85561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) len); 85661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 8576c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (stype == WLAN_FC_STYPE_PROBE_REQ) { 858e4663044d3a689fb5458247e9bc0f8b58cf72fcaDmitry Shmidt if (len < IEEE80211_HDRLEN) 8596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return; 8606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 8616c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memset(&event, 0, sizeof(event)); 8626c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.sa = mgmt->sa; 8636c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.da = mgmt->da; 8646c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.bssid = mgmt->bssid; 865e4663044d3a689fb5458247e9bc0f8b58cf72fcaDmitry Shmidt event.rx_probe_req.ie = buf + IEEE80211_HDRLEN; 866e4663044d3a689fb5458247e9bc0f8b58cf72fcaDmitry Shmidt event.rx_probe_req.ie_len = len - IEEE80211_HDRLEN; 8676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_PROBE_REQ, &event); 8686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return; 8696c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt } 8706c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 87161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (os_memcmp(drv->own_addr, mgmt->bssid, ETH_ALEN) != 0) { 87261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: BSSID does not match - ignore", 87361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__); 87461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 87561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 87661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 87761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (stype) { 8786c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_ASSOC_REQ: 8796c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)) 8806c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8816c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)); 8826c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.assoc_req.variable; 8836c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 0); 8846c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8856c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_REASSOC_REQ: 8866c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)) 8876c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8886c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)); 8896c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.reassoc_req.variable; 8906c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 1); 8916c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 89261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WLAN_FC_STYPE_ACTION: 89361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 894fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame = buf; 895fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame_len = len; 896fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, &event); 89761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 8986c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_AUTH: 8996c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.auth)) 9006c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 9016c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memset(&event, 0, sizeof(event)); 9026c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN); 9036c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.bssid, mgmt->bssid, ETH_ALEN); 9046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg); 9056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.status_code = 9066c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.status_code); 9076c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_transaction = 9086c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.auth_transaction); 9096c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies = mgmt->u.auth.variable; 9106c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies_len = len - IEEE80211_HDRLEN - 9116c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt sizeof(mgmt->u.auth); 9126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_AUTH, &event); 9136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 91461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 91561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 91661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 91761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 918d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* ATHEROS_USE_RAW_RECEIVE */ 91904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 92004949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_receive_pkt(struct atheros_driver_data *drv) 92104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 92204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret = 0; 9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_set_filter filt; 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s Enter", __func__); 92604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 92704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS 92804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_PROBE_REQ; 92904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 930d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211W) || defined(CONFIG_IEEE80211R) 93104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= (IEEE80211_FILTER_TYPE_ASSOC_REQ | 93261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_AUTH | 93361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_ACTION); 934d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 935a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#ifdef CONFIG_WNM 93661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 937a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#endif /* CONFIG_WNM */ 93861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 93961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 94061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 94104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (filt.app_filterype) { 94204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 94304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 94404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret) 94504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 94604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 94804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) 9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_raw = l2_packet_init(drv->iface, NULL, ETH_P_80211_RAW, 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive, drv, 1); 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw == NULL) 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 95304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS || CONFIG_IEEE80211R */ 9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 95704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_reset_appfilter(struct atheros_driver_data *drv) 95804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 95904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_set_filter filt; 96004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 96104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 96204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 96304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 96404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_wps_ie(void *priv, const u8 *ie, size_t len, u32 frametype) 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *beac_ie; 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu frametype=%u", __func__, 9741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (unsigned long) len, frametype); 9751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: IE", ie, len); 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie = (struct ieee80211req_getset_appiebuf *) buf; 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_frmtype = frametype; 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen = len; 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[0]), ie, len); 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append the WPA/RSN IE if it is set already */ 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (((frametype == IEEE80211_APPIE_FRAME_BEACON) || 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (frametype == IEEE80211_APPIE_FRAME_PROBE_RESP)) && 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->wpa_ie != NULL)) { 9861f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: Append WPA/RSN IE", 9871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->wpa_ie); 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[len]), wpabuf_head(drv->wpa_ie), 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wpa_ie)); 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen += wpabuf_len(drv->wpa_ie); 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9931f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF", 9941f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt beac_ie->app_buf, beac_ie->app_buflen); 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, beac_ie, 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen); 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - beacon", beacon); 10081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - proberesp", 10091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt proberesp); 10101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - assocresp", 10111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt assocresp); 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_beacon_ie = beacon ? wpabuf_dup(beacon) : NULL; 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_probe_resp_ie = proberesp ? wpabuf_dup(proberesp) : NULL; 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_wps_ie(priv, assocresp ? wpabuf_head(assocresp) : NULL, 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt assocresp ? wpabuf_len(assocresp) : 0, 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_ASSOC_RESP); 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_set_wps_ie(priv, beacon ? wpabuf_head(beacon) : NULL, 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon ? wpabuf_len(beacon) : 0, 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_BEACON)) 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_wps_ie(priv, 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_head(proberesp) : NULL, 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_len(proberesp): 0, 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_PROBE_RESP); 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_WPS */ 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define atheros_set_ap_wps_ie NULL 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1033d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 103404949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 103504949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_auth(void *priv, const u8 *own_addr, const u8 *addr, u16 seq, 103604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 status_code, const u8 *ie, size_t len) 103704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 103804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 103904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 104004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 104104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 104204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d", 104304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code); 104404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 104504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTH; 104604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 104704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_seq = seq; 104804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 104904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 105004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 105104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 105204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 105304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 105404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 105504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 105604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 105704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 105804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 105904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 106004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 106304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 106404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to auth STA (addr " MACSTR 106504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 106604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 106704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 106904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 107004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 107204949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_assoc(void *priv, const u8 *own_addr, const u8 *addr, 107304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int reassoc, u16 status_code, const u8 *ie, size_t len) 107404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 107504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 107604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 107704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 107804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d reassoc %d", 108004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code, reassoc); 108104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 108204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (reassoc) 108304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_REASSOC; 108404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt else 108504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_ASSOC; 108604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 108704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 108804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 108904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 109004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 109104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 109204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 109304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 109404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 109504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 109604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 109704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 109804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 109904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 110204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 110304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to assoc STA (addr " MACSTR 110404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 110504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 110604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 110804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 1109d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 111004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_new_sta(struct atheros_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN]) 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = drv->hapd; 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_wpaie ie; 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen = 0; 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *iebuf = NULL; 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch negotiated WPA/RSN parameters from the system. 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11220e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&ie, 0, sizeof(ie)); 11230e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN); 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETWPAIE, &ie, sizeof(ie))) { 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See ATH_WPS_IE comment in the beginning of the file for a 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * possible cause for the failure.. 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WPA/RSN IE: %s", 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto no_ie; 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPA IE", 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wpa_ie, IEEE80211_MAX_OPT_IE); 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req RSN IE", 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.rsn_ie, IEEE80211_MAX_OPT_IE); 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPS IE", 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wps_ie, IEEE80211_MAX_OPT_IE); 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wpa_ie; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros seems to return some random data if WPA/RSN IE is not set. 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Assume the IE was not included if the IE type is unknown. */ 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_VENDOR_SPECIFIC) 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[1] == 0 && ie.rsn_ie[1] > 0) { 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros-ng svn #1453 added rsn_ie. Use it, if wpa_ie was not 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * set. This is needed for WPA2. */ 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.rsn_ie; 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_RSN) 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = iebuf[1]; 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* if WPS IE is present, preference is given to WPS */ 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ie.wps_ie && 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (ie.wps_ie[1] > 0 && (ie.wps_ie[0] == WLAN_EID_VENDOR_SPECIFIC))) { 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wps_ie; 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = ie.wps_ie[1]; 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen == 0) 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = NULL; 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 2; 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtno_ie: 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(hapd, addr, iebuf, ielen, 0); 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11730e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cached accounting data is not valid anymore. */ 11750e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(drv->acct_mac, 0, ETH_ALEN); 11760e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&drv->acct_data, 0, sizeof(drv->acct_data)); 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless_custom(struct atheros_driver_data *drv, 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *custom, char *end) 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1184d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#define MGMT_FRAM_TAG_SIZE 30 /* hardcoded in driver */ 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Custom wireless event: '%s'", custom); 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11870e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) { 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 11900e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt pos = os_strstr(custom, "addr="); 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "without sender address ignored"); 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(pos, addr) == 0) { 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.unicast = 1; 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.src = addr; 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EVENT_MICHAEL_MIC_FAILURE, &data); 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with invalid MAC address"); 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "STA-TRAFFIC-STAT", 16) == 0) { 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *key, *value; 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 val; 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = custom; 12140e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt while ((key = os_strchr(key, '\n')) != NULL) { 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key++; 12160e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt value = os_strchr(key, '='); 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (value == NULL) 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *value++ = '\0'; 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(value, NULL, 10); 12210e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_strcmp(key, "mac") == 0) 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(value, drv->acct_mac); 12230e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "rx_packets") == 0) 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_packets = val; 12250e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "tx_packets") == 0) 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_packets = val; 12270e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "rx_bytes") == 0) 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_bytes = val; 12290e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "tx_bytes") == 0) 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_bytes = val; 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = value; 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 12340e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "PUSH-BUTTON.indication", 22) == 0) { 12358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Some atheros kernels send push button as a wireless event */ 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* PROBLEM! this event is received for ALL BSSs ... 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * so all are enabled for WPS... ugh. 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_WPS_BUTTON_PUSHED, NULL); 12400e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.prob_req ", 16) == 0) { 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Atheros driver uses a hack to pass Probe Request frames as a 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * binary data in the custom wireless event. The old way (using 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * packet sniffing) didn't work when bridging. 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Format: "Manage.prob_req <frame len>" | zero padding | frame 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len = atoi(custom + 16); 1248d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req event " 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "length %d", len); 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive(drv, NULL, 125461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1255d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_WPS */ 1256d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 12570e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.assoc_req ", 17) == 0) { 125804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 125904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 126004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 17); 1261d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 1262d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1263d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.assoc_req event length %d", 1264d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt len); 126504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 126604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 126704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 126861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 12690e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.auth ", 12) == 0) { 1270d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt /* Format: "Manage.auth <frame len>" | zero padding | frame */ 1271d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int len = atoi(custom + 12); 1272d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || 1273d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt MGMT_FRAM_TAG_SIZE + len > end - custom) { 1274d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1275d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.auth event length %d", len); 127604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 127704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 127804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 127961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1280d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211W || CONFIG_IEEE80211R */ 1281d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef ATHEROS_USE_RAW_RECEIVE 12820e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.action ", 14) == 0) { 1283d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | frame 128404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt */ 1285d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int len = atoi(custom + 14); 1286d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 1287d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1288d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.action event length %d", 1289d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt len); 129004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 129104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 129204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 129361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1294d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* ATHEROS_USE_RAW_RECEIVE */ 12958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 129861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 129961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* Handle size of data problem. WEXT only allows data of 256 bytes for custom 130061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* events, and p2p data can be much bigger. So the athr driver sends a small 130161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* event telling me to collect the big data with an ioctl. 130261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* On the first event, send all pending events to supplicant. 130361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt*/ 130461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void fetch_pending_big_events(struct atheros_driver_data *drv) 130561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 130661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 130761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 130861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 tbuf[IW_PRIV_SIZE_MASK]; /* max size is 2047 bytes */ 130961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc, stype; 131061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 131161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t data_len; 131261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u32 freq, frame_type; 131361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (1) { 131561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 131668d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 131761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) tbuf; 131961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = sizeof(tbuf); 132061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = IEEE80211_IOC_P2P_FETCH_FRAME; 132161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 132261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) 132361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt < 0) { 132461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (errno == ENOSPC) { 132561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s:%d exit", 132661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, __LINE__); 132761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 132861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 132961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s: P2P_BIG_PARAM[" 133061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "P2P_FETCH_FRAME] failed: %s", 133161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, strerror(errno)); 133261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 133361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 133461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len = iwr.u.data.length; 133561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "athr: P2P_FETCH_FRAME data", 133661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) tbuf, data_len); 133761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data_len < sizeof(freq) + sizeof(frame_type) + 24) { 133861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: frame too short"); 133961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 134061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 134161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&freq, tbuf, sizeof(freq)); 134261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&frame_type, &tbuf[sizeof(freq)], 134361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(frame_type)); 134461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (void *) &tbuf[sizeof(freq) + sizeof(frame_type)]; 134561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len -= sizeof(freq) + sizeof(frame_type); 134661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (frame_type == IEEE80211_EV_RX_MGMT) { 134861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 134961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 135061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 135161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: EV_RX_MGMT stype=%u " 135261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "freq=%u len=%u", stype, freq, (int) data_len); 135361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 135461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (stype == WLAN_FC_STYPE_ACTION) { 135561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 135661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame = (const u8 *) mgmt; 135761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame_len = data_len; 135861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, 135961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &event); 136061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 136161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 136361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s unknown type %d", 136461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, frame_type); 136561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 136661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 136961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 137061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void 137161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtatheros_wireless_event_atheros_custom(struct atheros_driver_data *drv, 137261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int opcode, char *buf, int len) 137361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 137461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (opcode) { 137561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case IEEE80211_EV_RX_MGMT: 137661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "WEXT: EV_RX_MGMT"); 137761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fetch_pending_big_events(drv); 137861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 137961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 138061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 138161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 138261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 138361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 13848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless(struct atheros_driver_data *drv, 1386d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt char *data, unsigned int len) 13878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_event iwe_buf, *iwe = &iwe_buf; 13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *end, *custom, *buf; 13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data; 13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = data + len; 13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1394d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt while ((size_t) (end - pos) >= IW_EV_LCP_LEN) { 13958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Event data may be unaligned, so make a local, aligned copy 13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before processing. */ 13970e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN); 13988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "Wireless event: cmd=0x%x len=%d", 13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd, iwe->len); 1400d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (iwe->len <= IW_EV_LCP_LEN || iwe->len > end - pos) 14018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom = pos + IW_EV_POINT_LEN; 14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->we_version > 18 && 14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (iwe->cmd == IWEVMICHAELMICFAILURE || 14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVASSOCREQIE || 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVCUSTOM)) { 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* WE-19 removed the pointer from struct iw_point */ 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dpos = (char *) &iwe_buf.u.data.length; 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int dlen = dpos - (char *) &iwe_buf; 14110e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(dpos, pos + IW_EV_LCP_LEN, 14120e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt sizeof(struct iw_event) - dlen); 14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 14140e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(&iwe_buf, pos, sizeof(struct iw_event)); 14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom += IW_EV_POINT_OFF; 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (iwe->cmd) { 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVEXPIRED: 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->hapd, 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) iwe->u.addr.sa_data); 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVREGISTERED: 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_new_sta(drv, (u8 *) iwe->u.addr.sa_data); 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVASSOCREQIE: 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Driver hack.. Use IWEVASSOCREQIE to bypass 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * IWEVCUSTOM size limitations. Need to handle this 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * just like IWEVCUSTOM. 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVCUSTOM: 1432d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (iwe->u.data.length > end - custom) 14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14340e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt buf = os_malloc(iwe->u.data.length + 1); 14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; /* XXX */ 14370e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(buf, custom, iwe->u.data.length); 14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[iwe->u.data.length] = '\0'; 143961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 144061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (iwe->u.data.flags != 0) { 144161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_atheros_custom( 144261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, (int) iwe->u.data.flags, 144361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf, len); 144461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 144561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_wireless_custom( 144661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, buf, buf + iwe->u.data.length); 144761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 14480e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_free(buf); 14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += iwe->len; 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_rtm_newlink(void *ctx, 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifinfomsg *ifi, u8 *buf, size_t len) 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, rta_len; 14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifi->ifi_index != drv->ifindex) 14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = len; 14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) buf; 14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_WIRELESS) { 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_wireless_event_wireless( 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv, ((char *) attr) + rta_len, 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->rta_len - rta_len); 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_we_version(struct atheros_driver_data *drv) 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_range *range; 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int minlen; 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buflen; 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = 0; 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Use larger buffer than struct iw_range in order to allow the 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * structure to grow in the future. 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buflen = sizeof(struct iw_range) + 500; 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range = os_zalloc(buflen); 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (range == NULL) 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15020e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 15038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = (caddr_t) range; 15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = buflen; 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt minlen = ((char *) &range->enc_capa) - (char *) range + 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(range->enc_capa); 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) { 15116c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWRANGE]: %s", 15126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 15136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_free(range); 15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (iwr.u.data.length >= minlen && 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled >= 18) { 15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d " 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WE(source)=%d enc_capa=0x%x", 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled, 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_source, 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->enc_capa); 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = range->we_version_compiled; 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 152575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen os_free(range); 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_init(struct atheros_driver_data *drv) 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_config *cfg; 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_get_we_version(drv); 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg = os_zalloc(sizeof(*cfg)); 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cfg == NULL) 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->ctx = drv; 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->newlink_cb = atheros_wireless_event_rtm_newlink; 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->netlink = netlink_init(cfg); 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->netlink == NULL) { 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cfg); 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len, 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int encrypt, const u8 *own_addr, u32 flags) 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char buf[3000]; 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *bp = buf; 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int status; 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Prepend the Ethernet header. If the caller left us 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * space at the front we could just insert it but since 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * we don't know we copy to a local buffer. Given the frequency 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and size of frames this probably doesn't matter. 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = data_len + sizeof(struct l2_ethhdr); 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(buf)) { 15710e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt bp = os_malloc(len); 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp == NULL) { 15736c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 15746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "EAPOL frame discarded, cannot malloc temp buffer of size %lu!", 15756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt (unsigned long) len); 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) bp; 15800e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth->h_dest, addr, ETH_ALEN); 15810e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth->h_source, own_addr, ETH_ALEN); 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth->h_proto = host_to_be16(ETH_P_EAPOL); 15830e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth + 1, data, data_len); 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len); 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len); 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp != buf) 15900e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_free(bp); 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return status; 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidthandle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len) 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->hapd, src_addr, buf + sizeof(struct l2_ethhdr), 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - sizeof(struct l2_ethhdr)); 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_init(struct hostapd_data *hapd, struct wpa_init_params *params) 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv; 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char brname[IFNAMSIZ]; 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct atheros_driver_data)); 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 16126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 16136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not allocate memory for atheros driver data"); 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hapd = hapd; 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0); 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock < 0) { 16206c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "socket[PF_INET,SOCK_DGRAM]: %s", 16216c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16240e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(drv->iface, params->ifname, sizeof(drv->iface)); 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16260e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&ifr, 0, sizeof(ifr)); 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name)); 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIFINDEX, &ifr) != 0) { 16296c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s", 16306c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ifindex = ifr.ifr_ifindex; 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL, 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit == NULL) 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr)) 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 1641d5e4923d04122f81300fa68fb07d64ede28fd44dDmitry Shmidt os_memcpy(drv->own_addr, params->own_addr, ETH_ALEN); 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bridge[0]) { 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Configure bridge %s for EAPOL traffic.", 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->bridge[0]); 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(params->bridge[0], NULL, 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_EAPOL, handle_read, drv, 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1); 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (linux_br_get(brname, drv->iface) == 0) { 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Interface in bridge %s; configure for " 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "EAPOL receive", brname); 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(brname, NULL, ETH_P_EAPOL, 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = drv->sock_xmit; 16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16600e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = IW_MODE_MASTER; 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0) { 16666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, 16676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not set interface to master mode! ioctl[SIOCSIWMODE]: %s", 16686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* mark down during setup */ 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_privacy(drv, 0); /* default to no privacy */ 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1676a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (atheros_receive_pkt(drv)) 1677a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt goto bad; 16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_wireless_event_init(drv)) 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtbad: 1684a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt atheros_reset_appfilter(drv); 1685a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (drv->sock_raw) 1686a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 16934171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt os_free(drv); 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_deinit(void *priv) 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 170304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_reset_appfilter(drv); 1704dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt 1705dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt if (drv->wpa_ie || drv->wps_beacon_ie || drv->wps_probe_resp_ie) { 1706d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt atheros_set_opt_ie(priv, NULL, 0); 1707dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wpa_ie); 1708dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 1709dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 1710dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt } 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt netlink_deinit(drv->netlink); 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (void) linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw) 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 17214171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt os_free(drv); 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ssid(void *priv, const u8 *buf, int len) 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17300e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 17318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.flags = 1; /* SSID active */ 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len + 1; 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) { 17376c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCSIWESSID,len=%d]: %s", 17386c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt len, strerror(errno)); 17398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_ssid(void *priv, u8 *buf, int len) 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17510e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 17528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17541f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.essid.length = (len > IW_ESSID_MAX_SIZE) ? 17551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt IW_ESSID_MAX_SIZE : len; 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) { 17586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWESSID]: %s", 17596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = -1; 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = iwr.u.essid.length; 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_countermeasures(void *priv, int enabled) 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_COUNTERMEASURES, enabled); 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_commit(void *priv) 17778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return linux_set_iface_flags(drv->ioctl_sock, drv->iface, 1); 17808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinenstatic int atheros_set_authmode(void *priv, int auth_algs) 178375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen{ 178475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen int authmode; 178575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 178675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen if ((auth_algs & WPA_AUTH_ALG_OPEN) && 178775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen (auth_algs & WPA_AUTH_ALG_SHARED)) 178875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_AUTO; 178975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_OPEN) 179075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_OPEN; 179175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_SHARED) 179275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_SHARED; 179375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else 179475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return -1; 179575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 179675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return set80211param(priv, IEEE80211_PARAM_AUTHMODE, authmode); 179775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen} 179875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 17991f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int atheros_set_ap(void *priv, struct wpa_driver_ap_params *params) 18001f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 18011f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 18021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * TODO: Use this to replace set_authmode, set_privacy, set_ieee8021x, 18031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * set_generic_elem, and hapd_set_ssid. 18041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 18051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 18061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: set_ap - pairwise_ciphers=0x%x " 18071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "group_cipher=0x%x key_mgmt_suites=0x%x auth_algs=0x%x " 18081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "wpa_version=0x%x privacy=%d interworking=%d", 18091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->pairwise_ciphers, params->group_cipher, 18101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->key_mgmt_suites, params->auth_algs, 18111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->wpa_version, params->privacy, params->interworking); 18121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "atheros: SSID", 18131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->ssid, params->ssid_len); 18141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (params->hessid) 18151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: HESSID " MACSTR, 18161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(params->hessid)); 18171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: beacon_ies", 18181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->beacon_ies); 18191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: proberesp_ies", 18201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->proberesp_ies); 18211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: assocresp_ies", 18221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->assocresp_ies); 18231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1824203eadb9eda41a1dde4a583edb4684319e3f399eDmitry Shmidt#if defined(CONFIG_HS20) && (defined(IEEE80211_PARAM_OSEN) || defined(CONFIG_ATHEROS_OSEN)) 18257d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (params->osen) { 18267d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt struct wpa_bss_params bss_params; 18277d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18287d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt os_memset(&bss_params, 0, sizeof(struct wpa_bss_params)); 18297d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.enabled = 1; 18307d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa = 2; 18317d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_pairwise = WPA_CIPHER_CCMP; 18327d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_group = WPA_CIPHER_CCMP; 18337d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.ieee802_1x = 1; 18347d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18357d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (atheros_set_privacy(priv, 1) || 18367d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt set80211param(priv, IEEE80211_PARAM_OSEN, 1)) 18377d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return -1; 18387d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18397d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return atheros_set_ieee8021x(priv, &bss_params); 18407d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt } 18417d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt#endif /* CONFIG_HS20 && IEEE80211_PARAM_OSEN */ 18427d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18431f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 18441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 18451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 184604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 1847d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 184804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 184904949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_send_mgmt(void *priv, const u8 *frm, size_t data_len, 1850d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int noack, unsigned int freq, 1851d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt const u16 *csa_offs, size_t csa_offs_len) 185204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 185304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 185404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 buf[1510]; 185504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const struct ieee80211_mgmt *mgmt; 185604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mgmtbuf *mgmt_frm; 185704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 185804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt = (const struct ieee80211_mgmt *) frm; 185904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s frmlen = %lu " MACSTR, __func__, 186004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (unsigned long) data_len, MAC2STR(mgmt->da)); 186104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm = (struct ieee80211req_mgmtbuf *) buf; 18620e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mgmt_frm->macaddr, (u8 *)mgmt->da, IEEE80211_ADDR_LEN); 186304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm->buflen = data_len; 186404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (&mgmt_frm->buf[0] + data_len > buf + sizeof(buf)) { 186504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_INFO, "atheros: Too long frame for " 186604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "atheros_send_mgmt (%u)", (unsigned int) data_len); 186704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 186804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 186904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&mgmt_frm->buf[0], frm, data_len); 187004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SEND_MGMT, mgmt_frm, 187104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_mgmtbuf) + data_len); 187204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 1873d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 1874d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 187504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 1876d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef CONFIG_IEEE80211R 187704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 187804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_tspec(void *priv, const u8 *addr, u8 *tspec_ie, 187904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t tspec_ielen) 188004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 188104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 188204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int retv; 188304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 188404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addts *addts = &req.u.addts; 188504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 188604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 188704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDTS; 188804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 188904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(addts->tspecie, tspec_ie, tspec_ielen); 189004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt retv = set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 189104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 189204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (retv < 0) { 189304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s IEEE80211_IOCTL_RES_REQ FAILED " 189404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "retv = %d", __func__, retv); 189504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 189604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 189704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(tspec_ie, addts->tspecie, tspec_ielen); 189804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return addts->status; 189904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 190004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190204949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_sta_node(void *priv, const u8 *addr, u16 auth_alg) 190304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 190404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 190504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 190604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addnode *addnode = &req.u.addnode; 190704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 190904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDNODE; 191004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 191104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt addnode->auth_alg = auth_alg; 191204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 191304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 191404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 191504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 191604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 191704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 191804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 191961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* Use only to set a big param, get will not work. */ 192061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int 192161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtset80211big(struct atheros_driver_data *drv, int op, const void *data, int len) 192261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 192361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 192461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 192561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 192661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 192761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 192861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) data; 192961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = len; 193061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = op; 193161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x=%d (%s) len=0x%x", 193261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, op, athr_get_param_name(op), len); 193361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) < 0) { 193561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x (%s) subop=0x%x=%d " 193661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "value=0x%x,0x%x failed: %d (%s)", 193761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, athr_get_ioctl_name(op), iwr.u.mode, 193861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.mode, iwr.u.data.length, 193961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags, errno, strerror(errno)); 194061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 194161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 194261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 194361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 194461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_send_action(void *priv, unsigned int freq, 194761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt unsigned int wait, 194861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *dst, const u8 *src, 194961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *bssid, 195061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *data, size_t data_len, int no_cck) 195161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 195261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 195361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211_p2p_send_action *act; 195461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int res; 195561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 195661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act = os_zalloc(sizeof(*act) + data_len); 195761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (act == NULL) 195861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 195961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act->freq = freq; 196061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->dst_addr, dst, ETH_ALEN); 196161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->src_addr, src, ETH_ALEN); 196261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->bssid, bssid, ETH_ALEN); 196361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act + 1, data, data_len); 196461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: freq=%d, wait=%u, dst=" MACSTR ", src=" 196561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MACSTR ", bssid=" MACSTR, 196661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, act->freq, wait, MAC2STR(act->dst_addr), 196761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MAC2STR(act->src_addr), MAC2STR(act->bssid)); 196861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: act", (u8 *) act, sizeof(*act)); 196961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: data", data, data_len); 197061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = set80211big(drv, IEEE80211_IOC_P2P_SEND_ACTION, 197261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act, sizeof(*act) + data_len); 197361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(act); 197461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 197561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 197661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 19785605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 197961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int athr_wnm_tfs(struct atheros_driver_data *drv, const u8* peer, 198061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *ie, u16 *len, enum wnm_oper oper) 198161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 198261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define IEEE80211_APPIE_MAX 1024 /* max appie buffer size */ 198361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 buf[IEEE80211_APPIE_MAX]; 198461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211req_getset_appiebuf *tfs_ie; 198561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 198661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 198761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: ifname=%s, WNM TFS IE oper=%d " MACSTR, 198861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv->iface, oper, MAC2STR(peer)); 198961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 199161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 199261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*len > IEEE80211_APPIE_MAX - 199361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf)) { 199461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) too large"); 199561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 199661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 199761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 199861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 199961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = ETH_ALEN + 2 + 2 + *len; 200061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 200161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 200261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 200361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 200461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 200561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = *len; 200661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 200761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 200861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy the ie */ 200961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2 + 2, ie, *len); 201061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 201161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 201261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 201361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 201461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 201561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 201661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 201761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 201861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 201961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 202061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 202161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 202261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 202361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 202461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 202561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 202661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 202761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 202861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 202961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 203061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GET_APPIEBUF, tfs_ie, 203161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 203261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WNM TFS IE: " 203361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 203461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 203561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 203661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 203761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = tfs_ie->app_buflen; 203861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(ie, &(tfs_ie->app_buf[0]), *len); 203961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %c len=%d", tfs_ie->app_buf[0], 204061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len); 204161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 204261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 204361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = 0; 204461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 204561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 204661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 204761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 204861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 204961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 205061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 205161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 205261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 205361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 205461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 205561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 205661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 205861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 205961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 206061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 206161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 206261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 206361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 206461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 206561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Unsupported TFS oper %d", oper); 206661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 206761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 206861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 206961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 207061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 207161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_sleep(struct atheros_driver_data *drv, 207461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *peer, enum wnm_oper oper) 207561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 207661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *data, *pos; 207761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t dlen; 207861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int ret; 207961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 208061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: WNM-Sleep Oper %d, " MACSTR, 208261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper, MAC2STR(peer)); 208361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt dlen = ETH_ALEN + 2 + 2; 208561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data = os_malloc(dlen); 208661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data == NULL) 208761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 208861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 209061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = data; 209161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, peer, ETH_ALEN); 209261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ETH_ALEN; 209361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 209561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 209661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 2; 209761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 209961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 210061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ret = atheros_set_wps_ie(drv, data, dlen, IEEE80211_APPIE_FRAME_WNM); 210261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(data); 210461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return ret; 210661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 210761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_oper(void *priv, enum wnm_oper oper, const u8 *peer, 211061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len) 211161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 211261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 211361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 211461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 211561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_CONFIRM: 211661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_FAIL: 211761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_CONFIRM: 211861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_FAIL: 211961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return atheros_wnm_sleep(drv, peer, oper); 212061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 212161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 212261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 212361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 212461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return athr_wnm_tfs(drv, peer, buf, buf_len, oper); 212561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 212661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: Unsupported WNM operation %d", 212761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper); 212861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 212961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 213061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 21315605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 213261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 213361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_atheros_ops = { 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .name = "atheros", 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = atheros_init, 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = atheros_deinit, 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ieee8021x = atheros_set_ieee8021x, 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = atheros_set_privacy, 21408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = atheros_set_key, 21418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_seqnum = atheros_get_seqnum, 21428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .flush = atheros_flush, 21438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = atheros_set_opt_ie, 21448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_set_flags = atheros_sta_set_flags, 21458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .read_sta_data = atheros_read_sta_driver_data, 21468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = atheros_send_eapol, 21478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = atheros_sta_disassoc, 21488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = atheros_sta_deauth, 21498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = atheros_set_ssid, 21508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_get_ssid = atheros_get_ssid, 21518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_countermeasures = atheros_set_countermeasures, 21528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_clear_stats = atheros_sta_clear_stats, 21538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .commit = atheros_commit, 21548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = atheros_set_ap_wps_ie, 215575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen .set_authmode = atheros_set_authmode, 21561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt .set_ap = atheros_set_ap, 2157d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 215804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_assoc = atheros_sta_assoc, 215904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_auth = atheros_sta_auth, 216004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .send_mlme = atheros_send_mgmt, 2161d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 2162d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef CONFIG_IEEE80211R 216304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_tspec = atheros_add_tspec, 216404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_sta_node = atheros_add_sta_node, 216504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 216661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .send_action = atheros_send_action, 21675605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 216861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .wnm_oper = atheros_wnm_oper, 21695605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 2170051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt .set_qos_map = atheros_set_qos_map, 21718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 2172