driver_atheros.c revision 0e58d9be2680098adccaadeadf31375ca54b7256
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) { 8586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)) 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; 8656c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.ie = mgmt->u.probe_req.variable; 8666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.ie_len = 8676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); 8686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_PROBE_REQ, &event); 8696c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return; 8706c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt } 8716c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 87261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (os_memcmp(drv->own_addr, mgmt->bssid, ETH_ALEN) != 0) { 87361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: BSSID does not match - ignore", 87461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__); 87561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 87661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 87761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 87861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (stype) { 8796c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_ASSOC_REQ: 8806c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)) 8816c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8826c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)); 8836c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.assoc_req.variable; 8846c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 0); 8856c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8866c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_REASSOC_REQ: 8876c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)) 8886c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8896c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)); 8906c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.reassoc_req.variable; 8916c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 1); 8926c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 89361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WLAN_FC_STYPE_ACTION: 89461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 895fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame = buf; 896fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame_len = len; 897fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, &event); 89861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 8996c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_AUTH: 9006c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.auth)) 9016c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 9026c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memset(&event, 0, sizeof(event)); 9036c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN); 9046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.bssid, mgmt->bssid, ETH_ALEN); 9056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg); 9066c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.status_code = 9076c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.status_code); 9086c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_transaction = 9096c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.auth_transaction); 9106c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies = mgmt->u.auth.variable; 9116c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies_len = len - IEEE80211_HDRLEN - 9126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt sizeof(mgmt->u.auth); 9136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_AUTH, &event); 9146c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 91561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 91661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 91761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 91861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 919d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* ATHEROS_USE_RAW_RECEIVE */ 92004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 92104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_receive_pkt(struct atheros_driver_data *drv) 92204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 92304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret = 0; 9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_set_filter filt; 9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s Enter", __func__); 92704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 92804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS 92904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_PROBE_REQ; 93004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 931d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211W) || defined(CONFIG_IEEE80211R) 93204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= (IEEE80211_FILTER_TYPE_ASSOC_REQ | 93361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_AUTH | 93461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_ACTION); 935d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 936a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#ifdef CONFIG_WNM 93761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 938a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#endif /* CONFIG_WNM */ 93961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 94061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 94161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 94204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (filt.app_filterype) { 94304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 94404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 94504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret) 94604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 94704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 94904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_raw = l2_packet_init(drv->iface, NULL, ETH_P_80211_RAW, 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive, drv, 1); 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw == NULL) 9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 95404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS || CONFIG_IEEE80211R */ 9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 9568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 95804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_reset_appfilter(struct atheros_driver_data *drv) 95904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 96004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_set_filter filt; 96104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 96204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 96304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 96404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 96504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_wps_ie(void *priv, const u8 *ie, size_t len, u32 frametype) 9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *beac_ie; 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu frametype=%u", __func__, 9751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (unsigned long) len, frametype); 9761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: IE", ie, len); 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie = (struct ieee80211req_getset_appiebuf *) buf; 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_frmtype = frametype; 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen = len; 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[0]), ie, len); 9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append the WPA/RSN IE if it is set already */ 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (((frametype == IEEE80211_APPIE_FRAME_BEACON) || 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (frametype == IEEE80211_APPIE_FRAME_PROBE_RESP)) && 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->wpa_ie != NULL)) { 9871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: Append WPA/RSN IE", 9881f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->wpa_ie); 9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[len]), wpabuf_head(drv->wpa_ie), 9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wpa_ie)); 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen += wpabuf_len(drv->wpa_ie); 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9941f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF", 9951f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt beac_ie->app_buf, beac_ie->app_buflen); 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, beac_ie, 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen); 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 10078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - beacon", beacon); 10091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - proberesp", 10101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt proberesp); 10111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - assocresp", 10121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt assocresp); 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_beacon_ie = beacon ? wpabuf_dup(beacon) : NULL; 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_probe_resp_ie = proberesp ? wpabuf_dup(proberesp) : NULL; 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_wps_ie(priv, assocresp ? wpabuf_head(assocresp) : NULL, 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt assocresp ? wpabuf_len(assocresp) : 0, 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_ASSOC_RESP); 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_set_wps_ie(priv, beacon ? wpabuf_head(beacon) : NULL, 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon ? wpabuf_len(beacon) : 0, 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_BEACON)) 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_wps_ie(priv, 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_head(proberesp) : NULL, 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_len(proberesp): 0, 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_PROBE_RESP); 10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_WPS */ 10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define atheros_set_ap_wps_ie NULL 10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1034d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 103504949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 103604949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_auth(void *priv, const u8 *own_addr, const u8 *addr, u16 seq, 103704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 status_code, const u8 *ie, size_t len) 103804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 103904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 104004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 104104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 104204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 104304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d", 104404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code); 104504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 104604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTH; 104704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 104804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_seq = seq; 104904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 105004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 105104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 105204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 105304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 105404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 105504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 105604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 105704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 105804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 105904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 106004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 106104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 106404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 106504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to auth STA (addr " MACSTR 106604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 106704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 106804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 107004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 107104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107204949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 107304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_assoc(void *priv, const u8 *own_addr, const u8 *addr, 107404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int reassoc, u16 status_code, const u8 *ie, size_t len) 107504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 107604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 107704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 107804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 107904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 108004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d reassoc %d", 108104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code, reassoc); 108204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 108304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (reassoc) 108404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_REASSOC; 108504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt else 108604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_ASSOC; 108704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 108804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 108904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 109004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 109104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 109204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 109304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 109404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 109504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 109604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 109704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 109804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 109904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 110004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 110304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 110404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to assoc STA (addr " MACSTR 110504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 110604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 110704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 110904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 1110d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 111104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_new_sta(struct atheros_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN]) 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = drv->hapd; 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_wpaie ie; 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen = 0; 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *iebuf = NULL; 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch negotiated WPA/RSN parameters from the system. 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11230e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&ie, 0, sizeof(ie)); 11240e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN); 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETWPAIE, &ie, sizeof(ie))) { 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See ATH_WPS_IE comment in the beginning of the file for a 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * possible cause for the failure.. 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WPA/RSN IE: %s", 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto no_ie; 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPA IE", 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wpa_ie, IEEE80211_MAX_OPT_IE); 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req RSN IE", 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.rsn_ie, IEEE80211_MAX_OPT_IE); 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPS IE", 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wps_ie, IEEE80211_MAX_OPT_IE); 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wpa_ie; 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros seems to return some random data if WPA/RSN IE is not set. 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Assume the IE was not included if the IE type is unknown. */ 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_VENDOR_SPECIFIC) 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[1] == 0 && ie.rsn_ie[1] > 0) { 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros-ng svn #1453 added rsn_ie. Use it, if wpa_ie was not 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * set. This is needed for WPA2. */ 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.rsn_ie; 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_RSN) 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = iebuf[1]; 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* if WPS IE is present, preference is given to WPS */ 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ie.wps_ie && 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (ie.wps_ie[1] > 0 && (ie.wps_ie[0] == WLAN_EID_VENDOR_SPECIFIC))) { 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wps_ie; 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = ie.wps_ie[1]; 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen == 0) 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = NULL; 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 2; 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtno_ie: 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(hapd, addr, iebuf, ielen, 0); 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11740e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cached accounting data is not valid anymore. */ 11760e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(drv->acct_mac, 0, ETH_ALEN); 11770e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&drv->acct_data, 0, sizeof(drv->acct_data)); 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless_custom(struct atheros_driver_data *drv, 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *custom, char *end) 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1185d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#define MGMT_FRAM_TAG_SIZE 30 /* hardcoded in driver */ 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Custom wireless event: '%s'", custom); 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11880e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) { 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 11910e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt pos = os_strstr(custom, "addr="); 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "without sender address ignored"); 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(pos, addr) == 0) { 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.unicast = 1; 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.src = addr; 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EVENT_MICHAEL_MIC_FAILURE, &data); 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with invalid MAC address"); 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "STA-TRAFFIC-STAT", 16) == 0) { 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *key, *value; 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 val; 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = custom; 12150e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt while ((key = os_strchr(key, '\n')) != NULL) { 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key++; 12170e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt value = os_strchr(key, '='); 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (value == NULL) 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *value++ = '\0'; 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(value, NULL, 10); 12220e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt if (os_strcmp(key, "mac") == 0) 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(value, drv->acct_mac); 12240e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "rx_packets") == 0) 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_packets = val; 12260e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "tx_packets") == 0) 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_packets = val; 12280e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "rx_bytes") == 0) 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_bytes = val; 12300e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt else if (os_strcmp(key, "tx_bytes") == 0) 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_bytes = val; 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = value; 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 12350e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "PUSH-BUTTON.indication", 22) == 0) { 12368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Some atheros kernels send push button as a wireless event */ 12378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* PROBLEM! this event is received for ALL BSSs ... 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * so all are enabled for WPS... ugh. 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_WPS_BUTTON_PUSHED, NULL); 12410e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.prob_req ", 16) == 0) { 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Atheros driver uses a hack to pass Probe Request frames as a 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * binary data in the custom wireless event. The old way (using 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * packet sniffing) didn't work when bridging. 12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Format: "Manage.prob_req <frame len>" | zero padding | frame 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len = atoi(custom + 16); 1249d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req event " 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "length %d", len); 12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive(drv, NULL, 125561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1256d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_WPS */ 1257d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 12580e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.assoc_req ", 17) == 0) { 125904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 126004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 126104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 17); 1262d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 1263d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1264d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.assoc_req event length %d", 1265d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt len); 126604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 126704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 126804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 126961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 12700e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.auth ", 12) == 0) { 1271d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt /* Format: "Manage.auth <frame len>" | zero padding | frame */ 1272d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int len = atoi(custom + 12); 1273d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || 1274d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt MGMT_FRAM_TAG_SIZE + len > end - custom) { 1275d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1276d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.auth event length %d", len); 127704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 127804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 127904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 128061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1281d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211W || CONFIG_IEEE80211R */ 1282d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef ATHEROS_USE_RAW_RECEIVE 12830e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt } else if (os_strncmp(custom, "Manage.action ", 14) == 0) { 1284d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | frame 128504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt */ 1286d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int len = atoi(custom + 14); 1287d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (len < 0 || MGMT_FRAM_TAG_SIZE + len > end - custom) { 1288d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt wpa_printf(MSG_DEBUG, 1289d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt "Invalid Manage.action event length %d", 1290d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt len); 129104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 129204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 129304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 129461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 1295d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* ATHEROS_USE_RAW_RECEIVE */ 12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 129961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 130061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* Handle size of data problem. WEXT only allows data of 256 bytes for custom 130161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* events, and p2p data can be much bigger. So the athr driver sends a small 130261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* event telling me to collect the big data with an ioctl. 130361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* On the first event, send all pending events to supplicant. 130461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt*/ 130561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void fetch_pending_big_events(struct atheros_driver_data *drv) 130661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 130761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 130861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 130961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 tbuf[IW_PRIV_SIZE_MASK]; /* max size is 2047 bytes */ 131061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc, stype; 131161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 131261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t data_len; 131361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u32 freq, frame_type; 131461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (1) { 131661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 131768d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 131861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) tbuf; 132061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = sizeof(tbuf); 132161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = IEEE80211_IOC_P2P_FETCH_FRAME; 132261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 132361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) 132461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt < 0) { 132561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (errno == ENOSPC) { 132661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s:%d exit", 132761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, __LINE__); 132861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 132961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 133061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s: P2P_BIG_PARAM[" 133161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "P2P_FETCH_FRAME] failed: %s", 133261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, strerror(errno)); 133361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 133461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 133561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len = iwr.u.data.length; 133661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "athr: P2P_FETCH_FRAME data", 133761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) tbuf, data_len); 133861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data_len < sizeof(freq) + sizeof(frame_type) + 24) { 133961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: frame too short"); 134061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 134161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 134261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&freq, tbuf, sizeof(freq)); 134361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&frame_type, &tbuf[sizeof(freq)], 134461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(frame_type)); 134561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (void *) &tbuf[sizeof(freq) + sizeof(frame_type)]; 134661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len -= sizeof(freq) + sizeof(frame_type); 134761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (frame_type == IEEE80211_EV_RX_MGMT) { 134961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 135061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 135161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 135261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: EV_RX_MGMT stype=%u " 135361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "freq=%u len=%u", stype, freq, (int) data_len); 135461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 135561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (stype == WLAN_FC_STYPE_ACTION) { 135661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 135761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame = (const u8 *) mgmt; 135861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame_len = data_len; 135961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, 136061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &event); 136161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 136261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 136461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s unknown type %d", 136561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, frame_type); 136661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 136761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 137061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 137161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void 137261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtatheros_wireless_event_atheros_custom(struct atheros_driver_data *drv, 137361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int opcode, char *buf, int len) 137461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 137561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (opcode) { 137661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case IEEE80211_EV_RX_MGMT: 137761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "WEXT: EV_RX_MGMT"); 137861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fetch_pending_big_events(drv); 137961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 138061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 138161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 138261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 138361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 138461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 13868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless(struct atheros_driver_data *drv, 1387d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt char *data, unsigned int len) 13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_event iwe_buf, *iwe = &iwe_buf; 13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *end, *custom, *buf; 13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data; 13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = data + len; 13948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1395d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt while ((size_t) (end - pos) >= IW_EV_LCP_LEN) { 13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Event data may be unaligned, so make a local, aligned copy 13978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before processing. */ 13980e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(&iwe_buf, pos, IW_EV_LCP_LEN); 13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "Wireless event: cmd=0x%x len=%d", 14008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd, iwe->len); 1401d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (iwe->len <= IW_EV_LCP_LEN || iwe->len > end - pos) 14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom = pos + IW_EV_POINT_LEN; 14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->we_version > 18 && 14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (iwe->cmd == IWEVMICHAELMICFAILURE || 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVASSOCREQIE || 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVCUSTOM)) { 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* WE-19 removed the pointer from struct iw_point */ 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dpos = (char *) &iwe_buf.u.data.length; 14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int dlen = dpos - (char *) &iwe_buf; 14120e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(dpos, pos + IW_EV_LCP_LEN, 14130e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt sizeof(struct iw_event) - dlen); 14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 14150e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(&iwe_buf, pos, sizeof(struct iw_event)); 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom += IW_EV_POINT_OFF; 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (iwe->cmd) { 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVEXPIRED: 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->hapd, 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) iwe->u.addr.sa_data); 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVREGISTERED: 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_new_sta(drv, (u8 *) iwe->u.addr.sa_data); 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVASSOCREQIE: 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Driver hack.. Use IWEVASSOCREQIE to bypass 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * IWEVCUSTOM size limitations. Need to handle this 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * just like IWEVCUSTOM. 14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVCUSTOM: 1433d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt if (iwe->u.data.length > end - custom) 14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14350e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt buf = os_malloc(iwe->u.data.length + 1); 14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; /* XXX */ 14380e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(buf, custom, iwe->u.data.length); 14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[iwe->u.data.length] = '\0'; 144061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 144161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (iwe->u.data.flags != 0) { 144261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_atheros_custom( 144361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, (int) iwe->u.data.flags, 144461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf, len); 144561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 144661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_wireless_custom( 144761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, buf, buf + iwe->u.data.length); 144861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 14490e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_free(buf); 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += iwe->len; 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_rtm_newlink(void *ctx, 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifinfomsg *ifi, u8 *buf, size_t len) 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, rta_len; 14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifi->ifi_index != drv->ifindex) 14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = len; 14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) buf; 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_WIRELESS) { 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_wireless_event_wireless( 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv, ((char *) attr) + rta_len, 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->rta_len - rta_len); 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_we_version(struct atheros_driver_data *drv) 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_range *range; 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int minlen; 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buflen; 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = 0; 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Use larger buffer than struct iw_range in order to allow the 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * structure to grow in the future. 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buflen = sizeof(struct iw_range) + 500; 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range = os_zalloc(buflen); 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (range == NULL) 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15030e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = (caddr_t) range; 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = buflen; 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt minlen = ((char *) &range->enc_capa) - (char *) range + 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(range->enc_capa); 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) { 15126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWRANGE]: %s", 15136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 15146c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_free(range); 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (iwr.u.data.length >= minlen && 15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled >= 18) { 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d " 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WE(source)=%d enc_capa=0x%x", 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled, 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_source, 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->enc_capa); 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = range->we_version_compiled; 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 152675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen os_free(range); 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_init(struct atheros_driver_data *drv) 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_config *cfg; 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_get_we_version(drv); 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg = os_zalloc(sizeof(*cfg)); 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cfg == NULL) 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->ctx = drv; 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->newlink_cb = atheros_wireless_event_rtm_newlink; 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->netlink = netlink_init(cfg); 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->netlink == NULL) { 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cfg); 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len, 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int encrypt, const u8 *own_addr, u32 flags) 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char buf[3000]; 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *bp = buf; 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int status; 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Prepend the Ethernet header. If the caller left us 15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * space at the front we could just insert it but since 15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * we don't know we copy to a local buffer. Given the frequency 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and size of frames this probably doesn't matter. 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = data_len + sizeof(struct l2_ethhdr); 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(buf)) { 15720e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt bp = os_malloc(len); 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp == NULL) { 15746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 15756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "EAPOL frame discarded, cannot malloc temp buffer of size %lu!", 15766c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt (unsigned long) len); 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) bp; 15810e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth->h_dest, addr, ETH_ALEN); 15820e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth->h_source, own_addr, ETH_ALEN); 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth->h_proto = host_to_be16(ETH_P_EAPOL); 15840e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(eth + 1, data, data_len); 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len); 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len); 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp != buf) 15910e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_free(bp); 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return status; 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidthandle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len) 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->hapd, src_addr, buf + sizeof(struct l2_ethhdr), 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - sizeof(struct l2_ethhdr)); 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * 16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_init(struct hostapd_data *hapd, struct wpa_init_params *params) 16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv; 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char brname[IFNAMSIZ]; 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct atheros_driver_data)); 16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 16136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 16146c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not allocate memory for atheros driver data"); 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hapd = hapd; 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0); 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock < 0) { 16216c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "socket[PF_INET,SOCK_DGRAM]: %s", 16226c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16250e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(drv->iface, params->ifname, sizeof(drv->iface)); 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16270e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&ifr, 0, sizeof(ifr)); 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name)); 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIFINDEX, &ifr) != 0) { 16306c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s", 16316c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ifindex = ifr.ifr_ifindex; 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL, 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit == NULL) 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr)) 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 1642d5e4923d04122f81300fa68fb07d64ede28fd44dDmitry Shmidt os_memcpy(drv->own_addr, params->own_addr, ETH_ALEN); 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bridge[0]) { 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Configure bridge %s for EAPOL traffic.", 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->bridge[0]); 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(params->bridge[0], NULL, 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_EAPOL, handle_read, drv, 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1); 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (linux_br_get(brname, drv->iface) == 0) { 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Interface in bridge %s; configure for " 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "EAPOL receive", brname); 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(brname, NULL, ETH_P_EAPOL, 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = drv->sock_xmit; 16608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16610e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = IW_MODE_MASTER; 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0) { 16676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, 16686c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not set interface to master mode! ioctl[SIOCSIWMODE]: %s", 16696c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* mark down during setup */ 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_privacy(drv, 0); /* default to no privacy */ 16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1677a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (atheros_receive_pkt(drv)) 1678a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt goto bad; 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_wireless_event_init(drv)) 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtbad: 1685a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt atheros_reset_appfilter(drv); 1686a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (drv->sock_raw) 1687a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 16944171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt os_free(drv); 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_deinit(void *priv) 17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 170404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_reset_appfilter(drv); 1705dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt 1706dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt if (drv->wpa_ie || drv->wps_beacon_ie || drv->wps_probe_resp_ie) { 1707d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt atheros_set_opt_ie(priv, NULL, 0); 1708dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wpa_ie); 1709dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 1710dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 1711dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt } 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt netlink_deinit(drv->netlink); 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (void) linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw) 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 17224171258d30a612645aa061cede62233b5c58ca2aDmitry Shmidt os_free(drv); 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ssid(void *priv, const u8 *buf, int len) 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17310e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.flags = 1; /* SSID active */ 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len + 1; 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) { 17386c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCSIWESSID,len=%d]: %s", 17396c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt len, strerror(errno)); 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_ssid(void *priv, u8 *buf, int len) 17478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 17518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17520e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.essid.length = (len > IW_ESSID_MAX_SIZE) ? 17561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt IW_ESSID_MAX_SIZE : len; 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) { 17596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWESSID]: %s", 17606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = -1; 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = iwr.u.essid.length; 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_countermeasures(void *priv, int enabled) 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_COUNTERMEASURES, enabled); 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_commit(void *priv) 17788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return linux_set_iface_flags(drv->ioctl_sock, drv->iface, 1); 17818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 178375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinenstatic int atheros_set_authmode(void *priv, int auth_algs) 178475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen{ 178575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen int authmode; 178675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 178775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen if ((auth_algs & WPA_AUTH_ALG_OPEN) && 178875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen (auth_algs & WPA_AUTH_ALG_SHARED)) 178975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_AUTO; 179075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_OPEN) 179175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_OPEN; 179275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_SHARED) 179375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_SHARED; 179475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else 179575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return -1; 179675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 179775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return set80211param(priv, IEEE80211_PARAM_AUTHMODE, authmode); 179875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen} 179975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 18001f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int atheros_set_ap(void *priv, struct wpa_driver_ap_params *params) 18011f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 18021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 18031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * TODO: Use this to replace set_authmode, set_privacy, set_ieee8021x, 18041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * set_generic_elem, and hapd_set_ssid. 18051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 18061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 18071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: set_ap - pairwise_ciphers=0x%x " 18081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "group_cipher=0x%x key_mgmt_suites=0x%x auth_algs=0x%x " 18091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "wpa_version=0x%x privacy=%d interworking=%d", 18101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->pairwise_ciphers, params->group_cipher, 18111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->key_mgmt_suites, params->auth_algs, 18121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->wpa_version, params->privacy, params->interworking); 18131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "atheros: SSID", 18141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->ssid, params->ssid_len); 18151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (params->hessid) 18161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: HESSID " MACSTR, 18171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(params->hessid)); 18181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: beacon_ies", 18191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->beacon_ies); 18201f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: proberesp_ies", 18211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->proberesp_ies); 18221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: assocresp_ies", 18231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->assocresp_ies); 18241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1825203eadb9eda41a1dde4a583edb4684319e3f399eDmitry Shmidt#if defined(CONFIG_HS20) && (defined(IEEE80211_PARAM_OSEN) || defined(CONFIG_ATHEROS_OSEN)) 18267d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (params->osen) { 18277d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt struct wpa_bss_params bss_params; 18287d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18297d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt os_memset(&bss_params, 0, sizeof(struct wpa_bss_params)); 18307d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.enabled = 1; 18317d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa = 2; 18327d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_pairwise = WPA_CIPHER_CCMP; 18337d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_group = WPA_CIPHER_CCMP; 18347d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.ieee802_1x = 1; 18357d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18367d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (atheros_set_privacy(priv, 1) || 18377d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt set80211param(priv, IEEE80211_PARAM_OSEN, 1)) 18387d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return -1; 18397d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18407d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return atheros_set_ieee8021x(priv, &bss_params); 18417d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt } 18427d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt#endif /* CONFIG_HS20 && IEEE80211_PARAM_OSEN */ 18437d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 18451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 18461f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 184704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 1848d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 184904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 185004949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_send_mgmt(void *priv, const u8 *frm, size_t data_len, 1851d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt int noack, unsigned int freq, 1852d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt const u16 *csa_offs, size_t csa_offs_len) 185304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 185404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 185504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 buf[1510]; 185604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const struct ieee80211_mgmt *mgmt; 185704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mgmtbuf *mgmt_frm; 185804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 185904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt = (const struct ieee80211_mgmt *) frm; 186004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s frmlen = %lu " MACSTR, __func__, 186104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (unsigned long) data_len, MAC2STR(mgmt->da)); 186204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm = (struct ieee80211req_mgmtbuf *) buf; 18630e58d9be2680098adccaadeadf31375ca54b7256Dmitry Shmidt os_memcpy(mgmt_frm->macaddr, (u8 *)mgmt->da, IEEE80211_ADDR_LEN); 186404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm->buflen = data_len; 186504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (&mgmt_frm->buf[0] + data_len > buf + sizeof(buf)) { 186604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_INFO, "atheros: Too long frame for " 186704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "atheros_send_mgmt (%u)", (unsigned int) data_len); 186804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 186904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 187004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&mgmt_frm->buf[0], frm, data_len); 187104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SEND_MGMT, mgmt_frm, 187204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_mgmtbuf) + data_len); 187304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 1874d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 1875d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt 187604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 1877d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef CONFIG_IEEE80211R 187804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 187904949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_tspec(void *priv, const u8 *addr, u8 *tspec_ie, 188004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t tspec_ielen) 188104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 188204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 188304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int retv; 188404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 188504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addts *addts = &req.u.addts; 188604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 188704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 188804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDTS; 188904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 189004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(addts->tspecie, tspec_ie, tspec_ielen); 189104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt retv = set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 189204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 189304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (retv < 0) { 189404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s IEEE80211_IOCTL_RES_REQ FAILED " 189504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "retv = %d", __func__, retv); 189604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 189704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 189804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(tspec_ie, addts->tspecie, tspec_ielen); 189904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return addts->status; 190004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 190104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_sta_node(void *priv, const u8 *addr, u16 auth_alg) 190404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 190504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 190604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 190704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addnode *addnode = &req.u.addnode; 190804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 191004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDNODE; 191104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 191204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt addnode->auth_alg = auth_alg; 191304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 191404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 191504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 191604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 191704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 191804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 191904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 192061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* Use only to set a big param, get will not work. */ 192161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int 192261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtset80211big(struct atheros_driver_data *drv, int op, const void *data, int len) 192361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 192461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 192561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 192661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 192761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 192861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 192961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) data; 193061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = len; 193161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = op; 193261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x=%d (%s) len=0x%x", 193361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, op, athr_get_param_name(op), len); 193461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) < 0) { 193661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x (%s) subop=0x%x=%d " 193761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "value=0x%x,0x%x failed: %d (%s)", 193861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, athr_get_ioctl_name(op), iwr.u.mode, 193961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.mode, iwr.u.data.length, 194061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags, errno, strerror(errno)); 194161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 194261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 194361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 194461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 194561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_send_action(void *priv, unsigned int freq, 194861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt unsigned int wait, 194961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *dst, const u8 *src, 195061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *bssid, 195161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *data, size_t data_len, int no_cck) 195261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 195361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 195461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211_p2p_send_action *act; 195561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int res; 195661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 195761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act = os_zalloc(sizeof(*act) + data_len); 195861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (act == NULL) 195961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 196061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act->freq = freq; 196161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->dst_addr, dst, ETH_ALEN); 196261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->src_addr, src, ETH_ALEN); 196361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->bssid, bssid, ETH_ALEN); 196461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act + 1, data, data_len); 196561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: freq=%d, wait=%u, dst=" MACSTR ", src=" 196661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MACSTR ", bssid=" MACSTR, 196761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, act->freq, wait, MAC2STR(act->dst_addr), 196861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MAC2STR(act->src_addr), MAC2STR(act->bssid)); 196961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: act", (u8 *) act, sizeof(*act)); 197061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: data", data, data_len); 197161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = set80211big(drv, IEEE80211_IOC_P2P_SEND_ACTION, 197361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act, sizeof(*act) + data_len); 197461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(act); 197561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 197661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 197761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 19795605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 198061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int athr_wnm_tfs(struct atheros_driver_data *drv, const u8* peer, 198161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *ie, u16 *len, enum wnm_oper oper) 198261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 198361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define IEEE80211_APPIE_MAX 1024 /* max appie buffer size */ 198461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 buf[IEEE80211_APPIE_MAX]; 198561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211req_getset_appiebuf *tfs_ie; 198661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 198761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 198861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: ifname=%s, WNM TFS IE oper=%d " MACSTR, 198961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv->iface, oper, MAC2STR(peer)); 199061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 199261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 199361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*len > IEEE80211_APPIE_MAX - 199461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf)) { 199561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) too large"); 199661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 199761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 199861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 199961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 200061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = ETH_ALEN + 2 + 2 + *len; 200161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 200261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 200361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 200461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 200561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 200661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = *len; 200761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 200861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 200961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy the ie */ 201061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2 + 2, ie, *len); 201161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 201261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 201361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 201461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 201561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 201661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 201761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 201861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 201961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 202061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 202161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 202261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 202361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 202461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 202561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 202661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 202761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 202861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 202961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 203061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 203161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GET_APPIEBUF, tfs_ie, 203261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 203361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WNM TFS IE: " 203461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 203561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 203661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 203761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 203861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = tfs_ie->app_buflen; 203961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(ie, &(tfs_ie->app_buf[0]), *len); 204061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %c len=%d", tfs_ie->app_buf[0], 204161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len); 204261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 204361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 204461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = 0; 204561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 204661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 204761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 204861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 204961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 205061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 205161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 205261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 205361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 205461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 205561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 205661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 205761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 205961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 206061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 206161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 206261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 206361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 206461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 206561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 206661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Unsupported TFS oper %d", oper); 206761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 206861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 206961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 207161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 207261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_sleep(struct atheros_driver_data *drv, 207561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *peer, enum wnm_oper oper) 207661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 207761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *data, *pos; 207861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t dlen; 207961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int ret; 208061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 208161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: WNM-Sleep Oper %d, " MACSTR, 208361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper, MAC2STR(peer)); 208461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt dlen = ETH_ALEN + 2 + 2; 208661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data = os_malloc(dlen); 208761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data == NULL) 208861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 208961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 209161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = data; 209261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, peer, ETH_ALEN); 209361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ETH_ALEN; 209461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 209661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 209761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 2; 209861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 210061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 210161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ret = atheros_set_wps_ie(drv, data, dlen, IEEE80211_APPIE_FRAME_WNM); 210361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(data); 210561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return ret; 210761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 210861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 211061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_oper(void *priv, enum wnm_oper oper, const u8 *peer, 211161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len) 211261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 211361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 211461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 211561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 211661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_CONFIRM: 211761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_FAIL: 211861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_CONFIRM: 211961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_FAIL: 212061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return atheros_wnm_sleep(drv, peer, oper); 212161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 212261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 212361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 212461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 212561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return athr_wnm_tfs(drv, peer, buf, buf_len, oper); 212661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 212761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: Unsupported WNM operation %d", 212861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper); 212961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 213061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 213161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 21325605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 213361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 213461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_atheros_ops = { 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .name = "atheros", 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = atheros_init, 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = atheros_deinit, 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ieee8021x = atheros_set_ieee8021x, 21408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = atheros_set_privacy, 21418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = atheros_set_key, 21428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_seqnum = atheros_get_seqnum, 21438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .flush = atheros_flush, 21448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = atheros_set_opt_ie, 21458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_set_flags = atheros_sta_set_flags, 21468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .read_sta_data = atheros_read_sta_driver_data, 21478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = atheros_send_eapol, 21488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = atheros_sta_disassoc, 21498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = atheros_sta_deauth, 21508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = atheros_set_ssid, 21518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_get_ssid = atheros_get_ssid, 21528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_countermeasures = atheros_set_countermeasures, 21538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_clear_stats = atheros_sta_clear_stats, 21548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .commit = atheros_commit, 21558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = atheros_set_ap_wps_ie, 215675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen .set_authmode = atheros_set_authmode, 21571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt .set_ap = atheros_set_ap, 2158d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#if defined(CONFIG_IEEE80211R) || defined(CONFIG_IEEE80211W) 215904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_assoc = atheros_sta_assoc, 216004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_auth = atheros_sta_auth, 216104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .send_mlme = atheros_send_mgmt, 2162d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#endif /* CONFIG_IEEE80211R || CONFIG_IEEE80211W */ 2163d80a401aed31d06f261efd19223cf55d1a2a8228Dmitry Shmidt#ifdef CONFIG_IEEE80211R 216404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_tspec = atheros_add_tspec, 216504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_sta_node = atheros_add_sta_node, 216604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 216761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .send_action = atheros_send_action, 21685605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 216961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .wnm_oper = atheros_wnm_oper, 21705605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 2171051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt .set_qos_map = atheros_set_qos_map, 21728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 2173