driver_atheros.c revision a3dc30964aa24aea2b518246f6812663a1103490
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / Driver interaction with Atheros driver 38d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Sam Leffler <sam@errno.com> 48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2004, Video54 Technologies 58d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2005-2007, Jouni Malinen <j@w1.fi> 68d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Copyright (c) 2009, Atheros Communications 78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * 804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * This software may be distributed under the terms of the BSD license. 904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * See README for more details. 108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "includes.h" 138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <net/if.h> 148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <sys/ioctl.h> 158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common.h" 1761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "eloop.h" 1861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common/ieee802_11_defs.h" 1961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "l2_packet/l2_packet.h" 2061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "p2p/p2p.h" 2161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common.h" 238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef _BYTE_ORDER 248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _BYTE_ORDER _BIG_ENDIAN 268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else 278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define _BYTE_ORDER _LITTLE_ENDIAN 288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* _BYTE_ORDER */ 308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Note, the ATH_WPS_IE setting must match with the driver build.. If the 338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * driver does not include this, the IEEE80211_IOCTL_GETWPAIE ioctl will fail. 348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define ATH_WPS_IE 368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#include "ieee80211_external.h" 388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include <netpacket/packet.h> 4204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef ETH_P_80211_RAW 458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define ETH_P_80211_RAW 0x0019 468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 481f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt#include "linux_wext.h" 498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "driver.h" 518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eloop.h" 528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "priv_netlink.h" 538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "l2_packet/l2_packet.h" 548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h" 558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "netlink.h" 568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "linux_ioctl.h" 578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct atheros_driver_data { 608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd; /* back pointer */ 618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char iface[IFNAMSIZ + 1]; 638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ifindex; 648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_xmit; /* raw packet xmit socket */ 658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_recv; /* raw packet recv socket */ 668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ioctl_sock; /* socket for ioctl() use */ 678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_data *netlink; 688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int we_version; 698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 acct_mac[ETH_ALEN]; 708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostap_sta_driver_data acct_data; 718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_packet_data *sock_raw; /* raw 802.11 management frames */ 738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wpa_ie; 748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_beacon_ie; 758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpabuf *wps_probe_resp_ie; 7604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 own_addr[ETH_ALEN]; 778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code); 818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int atheros_set_privacy(void *priv, int enabled); 828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_ioctl_name(int op) 848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETPARAM: 878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETPARAM"; 888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETPARAM: 898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETPARAM"; 908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETKEY: 918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETKEY"; 928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETWMMPARAMS: 938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETWMMPARAMS"; 948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELKEY: 958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELKEY"; 968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWMMPARAMS: 978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWMMPARAMS"; 988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMLME: 998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMLME"; 1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANINFO: 1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANINFO"; 1028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETOPTIE: 1038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETOPTIE"; 1048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETOPTIE: 1058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETOPTIE"; 1068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_ADDMAC: 1078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "ADDMAC"; 1088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_DELMAC: 1098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "DELMAC"; 1108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETCHANLIST: 1118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETCHANLIST"; 1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETCHANLIST: 1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETCHANLIST"; 1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_KICKMAC: 1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KICKMAC"; 1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_CHANSWITCH: 1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "CHANSWITCH"; 1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETMODE: 1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETMODE"; 1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SETMODE: 1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SETMODE"; 1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_APPIEBUF: 1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_APPIEBUF"; 1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_APPIEBUF: 1258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_APPIEBUF"; 1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_ACPARAMS: 1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_ACPARAMS"; 1288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_FILTERFRAME: 1298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "FILTERFRAME"; 1308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RTPARAMS: 1318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RTPARAMS"; 1328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_MEDENYENTRY: 1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_MEDENYENTRY"; 1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GET_MACADDR: 1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GET_MACADDR"; 1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_HBRPARAMS: 1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_HBRPARAMS"; 1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_SET_RXTIMEOUT: 1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "SET_RXTIMEOUT"; 1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_STA_STATS: 1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "STA_STATS"; 1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOCTL_GETWPAIE: 1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "GETWPAIE"; 1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * athr_get_param_name(int op) 1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (op) { 1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_IOC_MCASTCIPHER: 1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTCIPHER"; 1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_MCASTKEYLEN: 1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "MCASTKEYLEN"; 1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_UCASTCIPHERS: 1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "UCASTCIPHERS"; 1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_KEYMGTALGS: 1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "KEYMGTALGS"; 1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_RSNCAPS: 1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "RSNCAPS"; 1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_WPA: 1648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "WPA"; 1658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_AUTHMODE: 1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "AUTHMODE"; 1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_PRIVACY: 1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "PRIVACY"; 1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IEEE80211_PARAM_COUNTERMEASURES: 1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "COUNTERMEASURES"; 1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return "??"; 1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211priv(struct atheros_driver_data *drv, int op, void *data, int len) 1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int do_inline = len < IFNAMSIZ; 1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Certain ioctls must use the non-inlined method */ 1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (op == IEEE80211_IOCTL_SET_APPIEBUF || 1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt op == IEEE80211_IOCTL_FILTERFRAME) 1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt do_inline = 0; 1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (do_inline) { 1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data fits inline; put it there. 1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name, data, len); 1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Argument data too big for inline transfer; setup a 1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * parameter block instead; the kernel will transfer 1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * the data for the driver. 2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = data; 2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = len; 2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, op, &iwr) < 0) { 2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %s: %s: ioctl op=0x%x " 2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(%s) len=%d failed: %d (%s)", 2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, drv->iface, op, 2098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt athr_get_ioctl_name(op), 2108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len, errno, strerror(errno)); 2118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtset80211param(struct atheros_driver_data *drv, int op, int arg) 2188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 2208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 2228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 2238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = op; 2248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(iwr.u.name+sizeof(__u32), &arg, sizeof(arg)); 2258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_SETPARAM, &iwr) < 0) { 2276c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 2286c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "%s: %s: Failed to set parameter (op %d (%s) arg %d): ioctl[IEEE80211_IOCTL_SETPARAM]: %s", 2296c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, drv->iface, op, athr_get_param_name(op), 2306c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt arg, strerror(errno)); 2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_NO_STDOUT_DEBUG 2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const char * 2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtether_sprintf(const u8 *addr) 2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt static char buf[sizeof(MACSTR)]; 2418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) 2438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, MAC2STR(addr)); 2448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt snprintf(buf, sizeof(buf), MACSTR, 0,0,0,0,0,0); 2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return buf; 2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_NO_STDOUT_DEBUG */ 2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/* 2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Configure WPA parameters. 2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_configure_wpa(struct atheros_driver_data *drv, 2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct wpa_bss_params *params) 2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int v; 2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (params->wpa_group) { 2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_CCMP: 2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM; 2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 26309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 26409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_CCMP_256: 26509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_CCM_256; 26609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 26709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_GCMP: 26809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_GCM; 26909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 27009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_CIPHER_GCMP_256: 27109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v = IEEE80211_CIPHER_AES_GCM_256; 27209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 27309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_TKIP: 2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_TKIP; 2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP104: 2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_WEP40: 2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_WEP; 2828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_CIPHER_NONE: 2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = IEEE80211_CIPHER_NONE; 2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_ERROR, "Unknown group key cipher %u", 2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_group); 2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: group key cipher=%d", __func__, v); 2928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTCIPHER, v)) { 2936c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set group key cipher to %u", v); 2948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 2958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 2968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (v == IEEE80211_CIPHER_WEP) { 2978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* key length is done only for specific ciphers */ 2988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = (params->wpa_group == WPA_CIPHER_WEP104 ? 13 : 5); 2998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_MCASTKEYLEN, v)) { 3006c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3016c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set group key length to %u", v); 3028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP) 3088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM; 30909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 31009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_CCMP_256) 31109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_CCM_256; 31209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_GCMP) 31309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_GCM; 31409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_GCMP_256) 31509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_AES_GCM_256; 31609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 3178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_TKIP) 3188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_TKIP; 3198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa_pairwise & WPA_CIPHER_NONE) 3208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= 1<<IEEE80211_CIPHER_NONE; 3218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: pairwise key ciphers=0x%x", __func__, v); 3228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_UCASTCIPHERS, v)) { 3236c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3246c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set pairwise key ciphers to 0x%x", v); 3258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: key management algorithms=0x%x", 3298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, params->wpa_key_mgmt); 3308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_KEYMGTALGS, 3318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->wpa_key_mgmt)) { 3326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 3336c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Unable to set key management algorithms to 0x%x", 3346c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt params->wpa_key_mgmt); 3358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v = 0; 3398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->rsn_preauth) 3408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(0); 3418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 3428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w != NO_MGMT_FRAME_PROTECTION) { 3438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(7); 3448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->ieee80211w == MGMT_FRAME_PROTECTION_REQUIRED) 3458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt v |= BIT(6); 3468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 3488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3494530cfd4d14a77c58e35393b91e40f8dd9d62697Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: rsn capabilities=0x%x", __func__, v); 3508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_RSNCAPS, v)) { 3516c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set RSN capabilities to 0x%x", 3526c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt v); 3538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enable WPA=0x%x", __func__, params->wpa); 3578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(drv, IEEE80211_PARAM_WPA, params->wpa)) { 3586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "Unable to set WPA to %u", params->wpa); 3598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ieee8021x(void *priv, struct wpa_bss_params *params) 3668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 3688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, params->enabled); 3708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->enabled) { 3728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* XXX restore state */ 3738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_AUTH_AUTO) < 0) 3758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* IEEE80211_AUTH_AUTO ends up enabling Privacy; clear that */ 3778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_privacy(drv, 0); 3788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!params->wpa && !params->ieee802_1x) { 3805460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "No 802.1X or WPA enabled!"); 3818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->wpa && atheros_configure_wpa(drv, params) != 0) { 3845460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "Error configuring WPA state!"); 3858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211param(priv, IEEE80211_PARAM_AUTHMODE, 3888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (params->wpa ? IEEE80211_AUTH_WPA : IEEE80211_AUTH_8021X))) { 3895460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt wpa_printf(MSG_WARNING, "Error enabling WPA/802.1X!"); 3908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 3918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 3928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 3948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 3958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 3968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 3978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_privacy(void *priv, int enabled) 3988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 3998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __func__, enabled); 4028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_PRIVACY, enabled); 4048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_sta_authorized(void *priv, const u8 *addr, int authorized) 4088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 4118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s authorized=%d", 4148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), authorized); 4158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (authorized) 4178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTHORIZE; 4188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 4198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_UNAUTHORIZE; 4208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = 0; 4218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 4228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 4238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to %sauthorize STA " MACSTR, 4258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, authorized ? "" : "un", MAC2STR(addr)); 4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_set_flags(void *priv, const u8 *addr, 4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int total_flags, int flags_or, int flags_and) 4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* For now, only support setting Authorized flag */ 4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (flags_or & WPA_STA_AUTHORIZED) 4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 1); 4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (!(flags_and & WPA_STA_AUTHORIZED)) 4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_sta_authorized(priv, addr, 0); 4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_del_key(void *priv, const u8 *addr, int key_idx) 4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_del_key wk; 4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s key_idx=%d", 4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), key_idx); 4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr != NULL) { 4558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.idk_macaddr, addr, IEEE80211_ADDR_LEN); 4568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = (u8) IEEE80211_KEYIX_NONE; 4578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 4588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.idk_keyix = key_idx; 4598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_DELKEY, &wk, sizeof(wk)); 4628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 4638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to delete key (addr %s" 4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d)", __func__, ether_sprintf(addr), 4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key_idx); 4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_key(const char *ifname, void *priv, enum wpa_alg alg, 4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr, int key_idx, int set_tx, const u8 *seq, 4748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t seq_len, const u8 *key, size_t key_len) 4758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u_int8_t cipher; 4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (alg == WPA_ALG_NONE) 4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_del_key(drv, addr, key_idx); 4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: alg=%d addr=%s key_idx=%d", 4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, alg, ether_sprintf(addr), key_idx); 4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (alg) { 4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_WEP: 4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_WEP; 4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_TKIP: 4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_TKIP; 4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 4948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_CCMP: 4958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM; 4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 49709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 49809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_CCMP_256: 49909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CCM_256; 50009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 50109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_GCMP: 50209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GCM; 50309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 50409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_GCMP_256: 50509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GCM_256; 50609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 50709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_IEEE80211W 5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case WPA_ALG_IGTK: 5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CMAC; 5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 51209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#ifdef ATH_GCM_SUPPORT 51309f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_CMAC_256: 51409f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_CMAC_256; 51509f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 51609f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_GMAC_128: 51709f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GMAC; 51809f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 51909f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt case WPA_ALG_BIP_GMAC_256: 52009f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt cipher = IEEE80211_CIPHER_AES_GMAC_256; 52109f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt break; 52209f57babfc1e4473db20ced4f58a4c9f082c8ed8Dmitry Shmidt#endif /* ATH_GCM_SUPPORT */ 5238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 5248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt default: 5256c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "%s: unknown/unsupported algorithm %d", 5266c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, alg); 5278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (key_len > sizeof(wk.ik_keydata)) { 5316c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, "%s: key length %lu too big", __func__, 5326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt (unsigned long) key_len); 5338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -3; 5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_type = cipher; 5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags = IEEE80211_KEY_RECV | IEEE80211_KEY_XMIT; 5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL || is_broadcast_ether_addr(addr)) { 5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = key_idx; 5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set_tx) 5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_flags |= IEEE80211_KEY_DEFAULT; 5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = IEEE80211_KEYIX_NONE; 5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keylen = key_len; 5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_keydata, key, key_len); 5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETKEY, &wk, sizeof(wk)); 5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set key (addr %s" 5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " key_idx %d alg %d key_len %lu set_tx %d)", 5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(wk.ik_macaddr), key_idx, 5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt alg, (unsigned long) key_len, set_tx); 5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_seqnum(const char *ifname, void *priv, const u8 *addr, int idx, 5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *seq) 5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_key wk; 5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s idx=%d", 5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), idx); 5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&wk, 0, sizeof(wk)); 5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (addr == NULL) 5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(wk.ik_macaddr, 0xff, IEEE80211_ADDR_LEN); 5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(wk.ik_macaddr, addr, IEEE80211_ADDR_LEN); 5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wk.ik_keyix = idx; 5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETKEY, &wk, sizeof(wk))) { 5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get encryption data " 5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "(addr " MACSTR " key_idx %d)", 5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(wk.ik_macaddr), idx); 5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef WORDS_BIGENDIAN 5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt { 5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * wk.ik_keytsc is in host byte order (big endian), need to 5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * swap it to match with the byte order used in WPA. 5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int i; 5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef WPA_KEY_RSC_LEN 5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define WPA_KEY_RSC_LEN 8 5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif 5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 tmp[WPA_KEY_RSC_LEN]; 5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(tmp, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt for (i = 0; i < WPA_KEY_RSC_LEN; i++) { 6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt seq[i] = tmp[WPA_KEY_RSC_LEN - i - 1]; 6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* WORDS_BIGENDIAN */ 6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(seq, &wk.ik_keytsc, sizeof(wk.ik_keytsc)); 6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* WORDS_BIGENDIAN */ 6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_flush(void *priv) 6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 allsta[IEEE80211_ADDR_LEN]; 6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(allsta, 0xff, IEEE80211_ADDR_LEN); 6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_sta_deauth(priv, NULL, allsta, 6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_REASON_AUTH_LEAVE); 6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_read_sta_driver_data(void *priv, struct hostap_sta_driver_data *data, 6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const u8 *addr) 6238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_sta_stats stats; 6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(data, 0, sizeof(*data)); 6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch statistics for station from the system. 6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&stats, 0, sizeof(stats)); 6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(stats.is_u.macaddr, addr, IEEE80211_ADDR_LEN); 6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_STA_STATS, 6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt &stats, sizeof(stats))) { 6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to fetch STA stats (addr " 6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(data, &drv->acct_data, sizeof(*data)); 6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6436c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 6446c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Failed to get station stats information element"); 6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_packets = stats.is_stats.ns_rx_data; 6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->rx_bytes = stats.is_stats.ns_rx_bytes; 6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_packets = stats.is_stats.ns_tx_data; 6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data->tx_bytes = stats.is_stats.ns_tx_bytes; 6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_clear_stats(void *priv, const u8 *addr) 6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s", __func__, ether_sprintf(addr)); 6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_CLEAR_STATS; 6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, 6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(mlme)); 6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to clear STA stats (addr " 6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR ")", __func__, MAC2STR(addr)); 6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 6768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_opt_ie(void *priv, const u8 *ie, size_t ie_len) 6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *app_ie; 6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu", __func__, 6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (unsigned long) ie_len); 6871f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: set_generic_elem", ie, ie_len); 6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wpa_ie); 6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wpa_ie = wpabuf_alloc_copy(ie, ie_len); 6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie = (struct ieee80211req_getset_appiebuf *) buf; 6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[0]), ie, ie_len); 6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_BEACON; 6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Beacon */ 6998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_beacon_ie != NULL) { 7008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 7018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_beacon_ie), 7028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_beacon_ie)); 7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + wpabuf_len(drv->wps_beacon_ie); 7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(Beacon)", 7061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append WPS IE for Probe Response */ 7128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_frmtype = IEEE80211_APPIE_FRAME_PROBE_RESP; 7138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->wps_probe_resp_ie != NULL) { 7148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(app_ie->app_buf[ie_len]), 7158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_head(drv->wps_probe_resp_ie), 7168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie)); 7178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len + 7188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wps_probe_resp_ie); 7198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen = ie_len; 7211f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF(ProbeResp)", 7221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt app_ie->app_buf, app_ie->app_buflen); 7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, app_ie, 7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt app_ie->app_buflen); 7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_deauth(void *priv, const u8 *own_addr, const u8 *addr, 7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DEAUTH; 7418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to deauth STA (addr " MACSTR 7468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt " reason %d)", 7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 7548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_sta_disassoc(void *priv, const u8 *own_addr, const u8 *addr, 7558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int reason_code) 7568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 7578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 7588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_mlme mlme; 7598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret; 7608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s reason_code=%d", 7628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, ether_sprintf(addr), reason_code); 7638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_op = IEEE80211_MLME_DISASSOC; 7658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt mlme.im_reason = reason_code; 7668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 7678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 7688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ret < 0) { 7698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to disassoc STA (addr " 7708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt MACSTR " reason %d)", 7718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, MAC2STR(addr), reason_code); 7728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 7738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 7748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 7758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 7768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 777051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidtstatic int atheros_set_qos_map(void *ctx, const u8 *qos_map_set, 778051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt u8 qos_map_set_len) 779051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt{ 780051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt#ifdef CONFIG_ATHEROS_QOS_MAP 781051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 782051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct ieee80211req_athdbg req; 783051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct ieee80211_qos_map *qos_map = &req.data.qos_map; 784051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt struct iwreq iwr; 785051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt int i, up_start; 786051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 787051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (qos_map_set_len < 16 || qos_map_set_len > 58 || 788051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map_set_len & 1) { 789051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt wpa_printf(MSG_ERROR, "Invalid QoS Map"); 790051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return -1; 791051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } else { 792051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt memset(&req, 0, sizeof(struct ieee80211req_athdbg)); 793051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt req.cmd = IEEE80211_DBGREQ_SETQOSMAPCONF; 794051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 79568d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, sizeof(iwr.ifr_name)); 796051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt iwr.u.data.pointer = (void *) &req; 797051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt iwr.u.data.length = sizeof(struct ieee80211req_athdbg); 798051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 799051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 800051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->valid = 1; 801051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->num_dscp_except = (qos_map_set_len - 16) / 2; 802051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (qos_map->num_dscp_except) { 803051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt for (i = 0; i < qos_map->num_dscp_except; i++) { 804051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->dscp_exception[i].dscp = qos_map_set[i * 2]; 805051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->dscp_exception[i].up = qos_map_set[i * 2 + 1]; 806051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 807051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 808051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 809051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt up_start = qos_map_set_len - 16; 810051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt for (i = 0; i < IEEE80211_MAX_QOS_UP_RANGE; i++) { 811051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->up[i].low = qos_map_set[up_start + (i * 2)]; 812051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt qos_map->up[i].high = qos_map_set[up_start + (i * 2) + 1]; 813051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 814051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 815051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_DBGREQ, &iwr) < 0) { 8166c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, 8176c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "%s: %s: Failed to set QoS Map: ioctl[IEEE80211_IOCTL_DBGREQ]: %s", 8186c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt __func__, drv->iface, strerror(errno)); 819051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return -1; 820051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt } 821051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt#endif /* CONFIG_ATHEROS_QOS_MAP */ 822051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 823051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt return 0; 824051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt} 825051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt 8266c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) || defined(CONFIG_WNM) || defined(CONFIG_HS20) 8276c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidtstatic void atheros_raw_receive(void *ctx, const u8 *src_addr, const u8 *buf, 8286c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt size_t len) 82961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 83061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = ctx; 83161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 8326c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt union wpa_event_data event; 8336c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt u16 fc, stype; 8346c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt int ielen; 8356c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt const u8 *iebuf; 83661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 83761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < IEEE80211_HDRLEN) 83861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 8396c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 84061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (const struct ieee80211_mgmt *) buf; 84161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 84361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (WLAN_FC_GET_TYPE(fc) != WLAN_FC_TYPE_MGMT) 84561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 8466c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 84761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 84861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 84961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: subtype 0x%x len %d", __func__, stype, 85061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) len); 85161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 8526c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (stype == WLAN_FC_STYPE_PROBE_REQ) { 8536c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)) 8546c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return; 8556c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 8566c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memset(&event, 0, sizeof(event)); 8576c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.sa = mgmt->sa; 8586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.da = mgmt->da; 8596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.bssid = mgmt->bssid; 8606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.ie = mgmt->u.probe_req.variable; 8616c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.rx_probe_req.ie_len = 8626c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt len - (IEEE80211_HDRLEN + sizeof(mgmt->u.probe_req)); 8636c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_PROBE_REQ, &event); 8646c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt return; 8656c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt } 8666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt 86761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (os_memcmp(drv->own_addr, mgmt->bssid, ETH_ALEN) != 0) { 86861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: BSSID does not match - ignore", 86961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__); 87061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 87161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 87261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 87361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (stype) { 8746c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_ASSOC_REQ: 8756c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)) 8766c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8776c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req)); 8786c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.assoc_req.variable; 8796c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 0); 8806c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8816c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_REASSOC_REQ: 8826c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)) 8836c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8846c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt ielen = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req)); 8856c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt iebuf = mgmt->u.reassoc_req.variable; 8866c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt drv_event_assoc(drv->hapd, mgmt->sa, iebuf, ielen, 1); 8876c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 88861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WLAN_FC_STYPE_ACTION: 88961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 890fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame = buf; 891fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt event.rx_mgmt.frame_len = len; 892fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, &event); 89361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 8946c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt case WLAN_FC_STYPE_AUTH: 8956c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.auth)) 8966c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 8976c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memset(&event, 0, sizeof(event)); 8986c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.peer, mgmt->sa, ETH_ALEN); 8996c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_memcpy(event.auth.bssid, mgmt->bssid, ETH_ALEN); 9006c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_type = le_to_host16(mgmt->u.auth.auth_alg); 9016c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.status_code = 9026c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.status_code); 9036c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.auth_transaction = 9046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt le_to_host16(mgmt->u.auth.auth_transaction); 9056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies = mgmt->u.auth.variable; 9066c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt event.auth.ies_len = len - IEEE80211_HDRLEN - 9076c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt sizeof(mgmt->u.auth); 9086c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_AUTH, &event); 9096c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt break; 91061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 91161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 91261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 91361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 9146c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt#endif 91504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 91604949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_receive_pkt(struct atheros_driver_data *drv) 91704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 91804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret = 0; 9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_set_filter filt; 9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s Enter", __func__); 92204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 92304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS 92404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_PROBE_REQ; 92504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 92604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 92704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype |= (IEEE80211_FILTER_TYPE_ASSOC_REQ | 92861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_AUTH | 92961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_FILTER_TYPE_ACTION); 93004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif 931a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#ifdef CONFIG_WNM 93261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 933a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt#endif /* CONFIG_WNM */ 93461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_HS20 93561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt filt.app_filterype |= IEEE80211_FILTER_TYPE_ACTION; 93661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_HS20 */ 93704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (filt.app_filterype) { 93804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 93904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 94004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret) 94104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 94204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 94404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) 9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_raw = l2_packet_init(drv->iface, NULL, ETH_P_80211_RAW, 9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive, drv, 1); 9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw == NULL) 9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 94904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS || CONFIG_IEEE80211R */ 9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 95304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_reset_appfilter(struct atheros_driver_data *drv) 95404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 95504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_set_filter filt; 95604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt filt.app_filterype = 0; 95704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_FILTERFRAME, &filt, 95804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_set_filter)); 95904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 96004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_wps_ie(void *priv, const u8 *ie, size_t len, u32 frametype) 9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 buf[512]; 9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_getset_appiebuf *beac_ie; 9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9691f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s buflen = %lu frametype=%u", __func__, 9701f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt (unsigned long) len, frametype); 9711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: IE", ie, len); 9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie = (struct ieee80211req_getset_appiebuf *) buf; 9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_frmtype = frametype; 9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen = len; 9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[0]), ie, len); 9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* append the WPA/RSN IE if it is set already */ 9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (((frametype == IEEE80211_APPIE_FRAME_BEACON) || 9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (frametype == IEEE80211_APPIE_FRAME_PROBE_RESP)) && 9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (drv->wpa_ie != NULL)) { 9821f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: Append WPA/RSN IE", 9831f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt drv->wpa_ie); 9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memcpy(&(beac_ie->app_buf[len]), wpabuf_head(drv->wpa_ie), 9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_len(drv->wpa_ie)); 9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen += wpabuf_len(drv->wpa_ie); 9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9891f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump(MSG_DEBUG, "atheros: SET_APPIEBUF", 9901f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt beac_ie->app_buf, beac_ie->app_buflen); 9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, beac_ie, 9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf) + 9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beac_ie->app_buflen); 9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ap_wps_ie(void *priv, const struct wpabuf *beacon, 9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *proberesp, 9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt const struct wpabuf *assocresp) 10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - beacon", beacon); 10041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - proberesp", 10051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt proberesp); 10061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: set_ap_wps_ie - assocresp", 10071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt assocresp); 10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_beacon_ie = beacon ? wpabuf_dup(beacon) : NULL; 10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->wps_probe_resp_ie = proberesp ? wpabuf_dup(proberesp) : NULL; 10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_wps_ie(priv, assocresp ? wpabuf_head(assocresp) : NULL, 10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt assocresp ? wpabuf_len(assocresp) : 0, 10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_ASSOC_RESP); 10168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_set_wps_ie(priv, beacon ? wpabuf_head(beacon) : NULL, 10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt beacon ? wpabuf_len(beacon) : 0, 10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_BEACON)) 10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return atheros_set_wps_ie(priv, 10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_head(proberesp) : NULL, 10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt proberesp ? wpabuf_len(proberesp): 0, 10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt IEEE80211_APPIE_FRAME_PROBE_RESP); 10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#else /* CONFIG_WPS */ 10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#define atheros_set_ap_wps_ie NULL 10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS */ 10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 102904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 103004949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 103104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_auth(void *priv, const u8 *own_addr, const u8 *addr, u16 seq, 103204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u16 status_code, const u8 *ie, size_t len) 103304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 103404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 103504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 103604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 103704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 103804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d", 103904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code); 104004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 104104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_AUTH; 104204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 104304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_seq = seq; 104404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 104504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 104604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 104704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 104804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 104904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 105004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 105104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 105204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 105304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 105404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 105504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 105604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 105704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 105804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 105904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 106004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to auth STA (addr " MACSTR 106104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 106204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 106304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 106404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 106504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 106604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 106704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int 106804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtatheros_sta_assoc(void *priv, const u8 *own_addr, const u8 *addr, 106904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int reassoc, u16 status_code, const u8 *ie, size_t len) 107004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 107104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 107204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mlme mlme; 107304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int ret; 107404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: addr=%s status_code=%d reassoc %d", 107604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, ether_sprintf(addr), status_code, reassoc); 107704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 107804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (reassoc) 107904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_REASSOC; 108004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt else 108104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_op = IEEE80211_MLME_ASSOC; 108204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_reason = status_code; 108304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_macaddr, addr, IEEE80211_ADDR_LEN); 108404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mlme.im_optie_len = len; 108504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len) { 108604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (len < IEEE80211_MAX_OPT_IE) { 108704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(mlme.im_optie, ie, len); 108804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else { 108904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Not enough space to copy " 109004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "opt_ie STA (addr " MACSTR " reason %d, " 109104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "ie_len %d)", 109204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code, 109304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (int) len); 109404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 109504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 109604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 109704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt ret = set80211priv(drv, IEEE80211_IOCTL_SETMLME, &mlme, sizeof(mlme)); 109804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (ret < 0) { 109904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to assoc STA (addr " MACSTR 110004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt " reason %d)", 110104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt __func__, MAC2STR(addr), status_code); 110204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 110304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return ret; 110404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 110504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 110604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_new_sta(struct atheros_driver_data *drv, u8 addr[IEEE80211_ADDR_LEN]) 11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct hostapd_data *hapd = drv->hapd; 11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ieee80211req_wpaie ie; 11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ielen = 0; 11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 *iebuf = NULL; 11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Fetch negotiated WPA/RSN parameters from the system. 11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ie, 0, sizeof(ie)); 11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(ie.wpa_macaddr, addr, IEEE80211_ADDR_LEN); 11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GETWPAIE, &ie, sizeof(ie))) { 11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * See ATH_WPS_IE comment in the beginning of the file for a 11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * possible cause for the failure.. 11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WPA/RSN IE: %s", 11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt __func__, strerror(errno)); 11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto no_ie; 11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPA IE", 11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wpa_ie, IEEE80211_MAX_OPT_IE); 11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req RSN IE", 11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.rsn_ie, IEEE80211_MAX_OPT_IE); 11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "atheros req WPS IE", 11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ie.wps_ie, IEEE80211_MAX_OPT_IE); 11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wpa_ie; 11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros seems to return some random data if WPA/RSN IE is not set. 11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Assume the IE was not included if the IE type is unknown. */ 11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_VENDOR_SPECIFIC) 11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[1] == 0 && ie.rsn_ie[1] > 0) { 11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* atheros-ng svn #1453 added rsn_ie. Use it, if wpa_ie was not 11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * set. This is needed for WPA2. */ 11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.rsn_ie; 11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iebuf[0] != WLAN_EID_RSN) 11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf[1] = 0; 11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = iebuf[1]; 11518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef ATH_WPS_IE 11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* if WPS IE is present, preference is given to WPS */ 11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ie.wps_ie && 11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (ie.wps_ie[1] > 0 && (ie.wps_ie[0] == WLAN_EID_VENDOR_SPECIFIC))) { 11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = ie.wps_ie; 11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen = ie.wps_ie[1]; 11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* ATH_WPS_IE */ 11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ielen == 0) 11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iebuf = NULL; 11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else 11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ielen += 2; 11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtno_ie: 11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_assoc(hapd, addr, iebuf, ielen, 0); 11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (memcmp(addr, drv->acct_mac, ETH_ALEN) == 0) { 11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Cached accounting data is not valid anymore. */ 11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(drv->acct_mac, 0, ETH_ALEN); 11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&drv->acct_data, 0, sizeof(drv->acct_data)); 11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 11778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless_custom(struct atheros_driver_data *drv, 11788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *custom, char *end) 11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Custom wireless event: '%s'", custom); 11818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strncmp(custom, "MLME-MICHAELMICFAILURE.indication", 33) == 0) { 11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos; 11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u8 addr[ETH_ALEN]; 11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = strstr(custom, "addr="); 11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (pos == NULL) { 11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "without sender address ignored"); 11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += 5; 11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (hwaddr_aton(pos, addr) == 0) { 11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt union wpa_event_data data; 11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_memset(&data, 0, sizeof(data)); 11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.unicast = 1; 11978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt data.michael_mic_failure.src = addr; 11988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, 11998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt EVENT_MICHAEL_MIC_FAILURE, &data); 12008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 12018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, 12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "MLME-MICHAELMICFAILURE.indication " 12038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "with invalid MAC address"); 12048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "STA-TRAFFIC-STAT", 16) == 0) { 12068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *key, *value; 12078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt u32 val; 12088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = custom; 12098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while ((key = strchr(key, '\n')) != NULL) { 12108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key++; 12118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt value = strchr(key, '='); 12128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (value == NULL) 12138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt continue; 12148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *value++ = '\0'; 12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt val = strtoul(value, NULL, 10); 12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (strcmp(key, "mac") == 0) 12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt hwaddr_aton(value, drv->acct_mac); 12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_packets") == 0) 12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_packets = val; 12208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_packets") == 0) 12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_packets = val; 12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "rx_bytes") == 0) 12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.rx_bytes = val; 12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt else if (strcmp(key, "tx_bytes") == 0) 12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->acct_data.tx_bytes = val; 12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt key = value; 12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS 12298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "PUSH-BUTTON.indication", 22) == 0) { 12308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Some atheros kernels send push button as a wireless event */ 12318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* PROBLEM! this event is received for ALL BSSs ... 12328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * so all are enabled for WPS... ugh. 12338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_WPS_BUTTON_PUSHED, NULL); 123504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS */ 123661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#if defined(CONFIG_WPS) || defined(CONFIG_IEEE80211R) || defined(CONFIG_HS20) 123761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MGMT_FRAM_TAG_SIZE 30 /* hardcoded in driver */ 12388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (strncmp(custom, "Manage.prob_req ", 16) == 0) { 12398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 12408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Atheros driver uses a hack to pass Probe Request frames as a 12418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * binary data in the custom wireless event. The old way (using 12428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * packet sniffing) didn't work when bridging. 12438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Format: "Manage.prob_req <frame len>" | zero padding | frame 12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int len = atoi(custom + 16); 124661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req event " 12488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "length %d", len); 12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_raw_receive(drv, NULL, 125261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 125304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.assoc_req ", 17) == 0) { 125404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 125504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 125604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 17); 125761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 125804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 125904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 126004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 126104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 126204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 126361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 126404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.action ", 14) == 0) { 126504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.assoc_req <frame len>" | zero padding | 126604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * frame */ 126704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 14); 126861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 126904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 127004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 127104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 127204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 127304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 127461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 127504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } else if (strncmp(custom, "Manage.auth ", 12) == 0) { 127604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt /* Format: "Manage.auth <frame len>" | zero padding | frame 127704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt */ 127804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int len = atoi(custom + 12); 127961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (len < 0 || custom + MGMT_FRAM_TAG_SIZE + len > end) { 128004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "Invalid Manage.prob_req/" 128104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "assoc_req/auth event length %d", len); 128204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return; 128304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 128404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_raw_receive(drv, NULL, 128561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) custom + MGMT_FRAM_TAG_SIZE, len); 128604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS or CONFIG_IEEE80211R */ 12878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 12888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 12898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 129061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 129161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* Handle size of data problem. WEXT only allows data of 256 bytes for custom 129261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* events, and p2p data can be much bigger. So the athr driver sends a small 129361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* event telling me to collect the big data with an ioctl. 129461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt* On the first event, send all pending events to supplicant. 129561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt*/ 129661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void fetch_pending_big_events(struct atheros_driver_data *drv) 129761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 129861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt union wpa_event_data event; 129961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const struct ieee80211_mgmt *mgmt; 130061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 tbuf[IW_PRIV_SIZE_MASK]; /* max size is 2047 bytes */ 130161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 fc, stype; 130261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 130361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t data_len; 130461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u32 freq, frame_type; 130561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 130661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (1) { 130761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 130868d0e3ed07847339aedfac8e02f50db68c702e52Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 130961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) tbuf; 131161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = sizeof(tbuf); 131261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = IEEE80211_IOC_P2P_FETCH_FRAME; 131361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 131461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) 131561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt < 0) { 131661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (errno == ENOSPC) { 131761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s:%d exit", 131861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, __LINE__); 131961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 132061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 132161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s: P2P_BIG_PARAM[" 132261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "P2P_FETCH_FRAME] failed: %s", 132361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, strerror(errno)); 132461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 132561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 132661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len = iwr.u.data.length; 132761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "athr: P2P_FETCH_FRAME data", 132861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (u8 *) tbuf, data_len); 132961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data_len < sizeof(freq) + sizeof(frame_type) + 24) { 133061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: frame too short"); 133161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 133261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 133361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&freq, tbuf, sizeof(freq)); 133461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&frame_type, &tbuf[sizeof(freq)], 133561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(frame_type)); 133661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = (void *) &tbuf[sizeof(freq) + sizeof(frame_type)]; 133761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data_len -= sizeof(freq) + sizeof(frame_type); 133861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 133961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (frame_type == IEEE80211_EV_RX_MGMT) { 134061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fc = le_to_host16(mgmt->frame_control); 134161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt stype = WLAN_FC_GET_STYPE(fc); 134261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: EV_RX_MGMT stype=%u " 134461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "freq=%u len=%u", stype, freq, (int) data_len); 134561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 134661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (stype == WLAN_FC_STYPE_ACTION) { 134761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&event, 0, sizeof(event)); 134861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame = (const u8 *) mgmt; 134961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt event.rx_mgmt.frame_len = data_len; 135061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_supplicant_event(drv->hapd, EVENT_RX_MGMT, 135161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &event); 135261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 135361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 135461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 135561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "athr: %s unknown type %d", 135661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, frame_type); 135761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt continue; 135861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 135961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 136061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 136161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 136261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void 136361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtatheros_wireless_event_atheros_custom(struct atheros_driver_data *drv, 136461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int opcode, char *buf, int len) 136561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 136661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (opcode) { 136761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case IEEE80211_EV_RX_MGMT: 136861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "WEXT: EV_RX_MGMT"); 136961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt fetch_pending_big_events(drv); 137061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 137161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 137261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 137361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 137461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 137561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 13768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 13778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_wireless(struct atheros_driver_data *drv, 13788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *data, int len) 13798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 13808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_event iwe_buf, *iwe = &iwe_buf; 13818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *pos, *end, *custom, *buf; 13828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos = data; 13848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt end = data + len; 13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (pos + IW_EV_LCP_LEN <= end) { 13878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Event data may be unaligned, so make a local, aligned copy 13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * before processing. */ 13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, IW_EV_LCP_LEN); 13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_MSGDUMP, "Wireless event: cmd=0x%x len=%d", 13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd, iwe->len); 13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (iwe->len <= IW_EV_LCP_LEN) 13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 13948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 13958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom = pos + IW_EV_POINT_LEN; 13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->we_version > 18 && 13978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (iwe->cmd == IWEVMICHAELMICFAILURE || 13988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVASSOCREQIE || 13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwe->cmd == IWEVCUSTOM)) { 14008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* WE-19 removed the pointer from struct iw_point */ 14018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char *dpos = (char *) &iwe_buf.u.data.length; 14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int dlen = dpos - (char *) &iwe_buf; 14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(dpos, pos + IW_EV_LCP_LEN, 14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(struct iw_event) - dlen); 14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else { 14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(&iwe_buf, pos, sizeof(struct iw_event)); 14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt custom += IW_EV_POINT_OFF; 14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt switch (iwe->cmd) { 14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVEXPIRED: 14128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_disassoc(drv->hapd, 14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (u8 *) iwe->u.addr.sa_data); 14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVREGISTERED: 14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_new_sta(drv, (u8 *) iwe->u.addr.sa_data); 14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVASSOCREQIE: 14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* Driver hack.. Use IWEVASSOCREQIE to bypass 14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * IWEVCUSTOM size limitations. Need to handle this 14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * just like IWEVCUSTOM. 14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt case IWEVCUSTOM: 14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (custom + iwe->u.data.length > end) 14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf = malloc(iwe->u.data.length + 1); 14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (buf == NULL) 14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; /* XXX */ 14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(buf, custom, iwe->u.data.length); 14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buf[iwe->u.data.length] = '\0'; 143161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 143261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (iwe->u.data.flags != 0) { 143361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_atheros_custom( 143461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, (int) iwe->u.data.flags, 143561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt buf, len); 143661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 143761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt atheros_wireless_event_wireless_custom( 143861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv, buf, buf + iwe->u.data.length); 143961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(buf); 14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt break; 14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt pos += iwe->len; 14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_rtm_newlink(void *ctx, 14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifinfomsg *ifi, u8 *buf, size_t len) 14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int attrlen, rta_len; 14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct rtattr *attr; 14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ifi->ifi_index != drv->ifindex) 14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return; 14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attrlen = len; 14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = (struct rtattr *) buf; 14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt rta_len = RTA_ALIGN(sizeof(struct rtattr)); 14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt while (RTA_OK(attr, attrlen)) { 14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (attr->rta_type == IFLA_WIRELESS) { 14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_wireless_event_wireless( 14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv, ((char *) attr) + rta_len, 14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr->rta_len - rta_len); 14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt attr = RTA_NEXT(attr, attrlen); 14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_we_version(struct atheros_driver_data *drv) 14778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iw_range *range; 14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int minlen; 14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t buflen; 14828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = 0; 14848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 14868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Use larger buffer than struct iw_range in order to allow the 14878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * structure to grow in the future. 14888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 14898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt buflen = sizeof(struct iw_range) + 500; 14908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range = os_zalloc(buflen); 14918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (range == NULL) 14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.pointer = (caddr_t) range; 14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.data.length = buflen; 14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt minlen = ((char *) &range->enc_capa) - (char *) range + 15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt sizeof(range->enc_capa); 15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWRANGE, &iwr) < 0) { 15036c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWRANGE]: %s", 15046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 15056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt os_free(range); 15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (iwr.u.data.length >= minlen && 15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled >= 18) { 15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "SIOCGIWRANGE: WE(compiled)=%d " 15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "WE(source)=%d enc_capa=0x%x", 15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_compiled, 15128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->we_version_source, 15138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt range->enc_capa); 15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->we_version = range->we_version_compiled; 15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 151775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen os_free(range); 15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_wireless_event_init(struct atheros_driver_data *drv) 15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct netlink_config *cfg; 15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_get_we_version(drv); 15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg = os_zalloc(sizeof(*cfg)); 15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (cfg == NULL) 15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->ctx = drv; 15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt cfg->newlink_cb = atheros_wireless_event_rtm_newlink; 15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->netlink = netlink_init(cfg); 15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->netlink == NULL) { 15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_free(cfg); 15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_send_eapol(void *priv, const u8 *addr, const u8 *data, size_t data_len, 15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int encrypt, const u8 *own_addr, u32 flags) 15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char buf[3000]; 15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt unsigned char *bp = buf; 15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct l2_ethhdr *eth; 15528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt size_t len; 15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int status; 15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* 15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * Prepend the Ethernet header. If the caller left us 15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * space at the front we could just insert it but since 15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * we don't know we copy to a local buffer. Given the frequency 15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * and size of frames this probably doesn't matter. 15608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */ 15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len = data_len + sizeof(struct l2_ethhdr); 15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (len > sizeof(buf)) { 15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt bp = malloc(len); 15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp == NULL) { 15656c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 15666c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "EAPOL frame discarded, cannot malloc temp buffer of size %lu!", 15676c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt (unsigned long) len); 15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth = (struct l2_ethhdr *) bp; 15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_dest, addr, ETH_ALEN); 15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth->h_source, own_addr, ETH_ALEN); 15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt eth->h_proto = host_to_be16(ETH_P_EAPOL); 15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(eth+1, data, data_len); 15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "TX EAPOL", bp, len); 15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt status = l2_packet_send(drv->sock_xmit, addr, ETH_P_EAPOL, bp, len); 15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (bp != buf) 15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(bp); 15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return status; 15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidthandle_read(void *ctx, const u8 *src_addr, const u8 *buf, size_t len) 15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = ctx; 15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv_event_eapol_rx(drv->hapd, src_addr, buf + sizeof(struct l2_ethhdr), 15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt len - sizeof(struct l2_ethhdr)); 15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void * 15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_init(struct hostapd_data *hapd, struct wpa_init_params *params) 15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv; 15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct ifreq ifr; 15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt char brname[IFNAMSIZ]; 16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv = os_zalloc(sizeof(struct atheros_driver_data)); 16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv == NULL) { 16046c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_INFO, 16056c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not allocate memory for atheros driver data"); 16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->hapd = hapd; 16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ioctl_sock = socket(PF_INET, SOCK_DGRAM, 0); 16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock < 0) { 16126c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "socket[PF_INET,SOCK_DGRAM]: %s", 16136c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memcpy(drv->iface, params->ifname, sizeof(drv->iface)); 16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&ifr, 0, sizeof(ifr)); 16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(ifr.ifr_name, drv->iface, sizeof(ifr.ifr_name)); 16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIFINDEX, &ifr) != 0) { 16216c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl(SIOCGIFINDEX): %s", 16226c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->ifindex = ifr.ifr_ifindex; 16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_xmit = l2_packet_init(drv->iface, NULL, ETH_P_EAPOL, 16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit == NULL) 16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (l2_packet_get_own_addr(drv->sock_xmit, params->own_addr)) 16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 1633d5e4923d04122f81300fa68fb07d64ede28fd44dDmitry Shmidt os_memcpy(drv->own_addr, params->own_addr, ETH_ALEN); 16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (params->bridge[0]) { 16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Configure bridge %s for EAPOL traffic.", 16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt params->bridge[0]); 16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(params->bridge[0], NULL, 16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ETH_P_EAPOL, handle_read, drv, 16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1); 16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else if (linux_br_get(brname, drv->iface) == 0) { 16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "Interface in bridge %s; configure for " 16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt "EAPOL receive", brname); 16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = l2_packet_init(brname, NULL, ETH_P_EAPOL, 16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt handle_read, drv, 1); 16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv == NULL) 16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt drv->sock_recv = drv->sock_xmit; 16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.mode = IW_MODE_MASTER; 16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWMODE, &iwr) < 0) { 16586c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, 16596c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt "Could not set interface to master mode! ioctl[SIOCSIWMODE]: %s", 16606c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt /* mark down during setup */ 16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt atheros_set_privacy(drv, 0); /* default to no privacy */ 16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 1668a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (atheros_receive_pkt(drv)) 1669a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt goto bad; 16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (atheros_wireless_event_init(drv)) 16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt goto bad; 16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return drv; 16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtbad: 1676a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt atheros_reset_appfilter(drv); 1677a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (drv->sock_raw) 1678a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv != NULL) 16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return NULL; 16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void 16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_deinit(void *priv) 16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 169604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt atheros_reset_appfilter(drv); 1697dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt 1698dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt if (drv->wpa_ie || drv->wps_beacon_ie || drv->wps_probe_resp_ie) { 1699dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wpa_ie); 1700dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_beacon_ie); 1701dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt wpabuf_free(drv->wps_probe_resp_ie); 1702dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt atheros_set_opt_ie(priv, NULL, 0); 1703dda10c2afb8378747491ea5d329a1de635d6d58eDmitry Shmidt } 17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt netlink_deinit(drv->netlink); 17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt (void) linux_set_iface_flags(drv->ioctl_sock, drv->iface, 0); 17068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->ioctl_sock >= 0) 17078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt close(drv->ioctl_sock); 17088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_recv != NULL && drv->sock_recv != drv->sock_xmit) 17098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_recv); 17108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_xmit != NULL) 17118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_xmit); 17128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (drv->sock_raw) 17138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt l2_packet_deinit(drv->sock_raw); 17148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt free(drv); 17158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_ssid(void *priv, const u8 *buf, int len) 17198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 17248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.flags = 1; /* SSID active */ 17268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.length = len + 1; 17288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCSIWESSID, &iwr) < 0) { 17306c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCSIWESSID,len=%d]: %s", 17316c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt len, strerror(errno)); 17328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return -1; 17338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } 17348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return 0; 17358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_get_ssid(void *priv, u8 *buf, int len) 17398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct iwreq iwr; 17428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt int ret = 0; 17438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt memset(&iwr, 0, sizeof(iwr)); 17458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 17468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt iwr.u.essid.pointer = (caddr_t) buf; 17471f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt iwr.u.essid.length = (len > IW_ESSID_MAX_SIZE) ? 17481f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt IW_ESSID_MAX_SIZE : len; 17498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt if (ioctl(drv->ioctl_sock, SIOCGIWESSID, &iwr) < 0) { 17516c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt wpa_printf(MSG_ERROR, "ioctl[SIOCGIWESSID]: %s", 17526c0da2bb83f6915d8260912362692d1a742e057bDmitry Shmidt strerror(errno)); 17538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = -1; 17548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt } else 17558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt ret = iwr.u.essid.length; 17568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return ret; 17588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_set_countermeasures(void *priv, int enabled) 17628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: enabled=%d", __FUNCTION__, enabled); 17658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return set80211param(drv, IEEE80211_PARAM_COUNTERMEASURES, enabled); 17668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 17688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int 17698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtatheros_commit(void *priv) 17708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{ 17718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt struct atheros_driver_data *drv = priv; 17728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt return linux_set_iface_flags(drv->ioctl_sock, drv->iface, 1); 17738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt} 17748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt 177575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinenstatic int atheros_set_authmode(void *priv, int auth_algs) 177675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen{ 177775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen int authmode; 177875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 177975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen if ((auth_algs & WPA_AUTH_ALG_OPEN) && 178075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen (auth_algs & WPA_AUTH_ALG_SHARED)) 178175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_AUTO; 178275ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_OPEN) 178375ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_OPEN; 178475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else if (auth_algs & WPA_AUTH_ALG_SHARED) 178575ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen authmode = IEEE80211_AUTH_SHARED; 178675ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen else 178775ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return -1; 178875ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 178975ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen return set80211param(priv, IEEE80211_PARAM_AUTHMODE, authmode); 179075ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen} 179175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen 17921f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int atheros_set_ap(void *priv, struct wpa_driver_ap_params *params) 17931f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{ 17941f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt /* 17951f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * TODO: Use this to replace set_authmode, set_privacy, set_ieee8021x, 17961f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt * set_generic_elem, and hapd_set_ssid. 17971f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt */ 17981f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 17991f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: set_ap - pairwise_ciphers=0x%x " 18001f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "group_cipher=0x%x key_mgmt_suites=0x%x auth_algs=0x%x " 18011f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt "wpa_version=0x%x privacy=%d interworking=%d", 18021f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->pairwise_ciphers, params->group_cipher, 18031f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->key_mgmt_suites, params->auth_algs, 18041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->wpa_version, params->privacy, params->interworking); 18051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_ascii(MSG_DEBUG, "atheros: SSID", 18061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->ssid, params->ssid_len); 18071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt if (params->hessid) 18081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: HESSID " MACSTR, 18091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt MAC2STR(params->hessid)); 18101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: beacon_ies", 18111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->beacon_ies); 18121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: proberesp_ies", 18131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->proberesp_ies); 18141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt wpa_hexdump_buf(MSG_DEBUG, "atheros: assocresp_ies", 18151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt params->assocresp_ies); 18161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 1817203eadb9eda41a1dde4a583edb4684319e3f399eDmitry Shmidt#if defined(CONFIG_HS20) && (defined(IEEE80211_PARAM_OSEN) || defined(CONFIG_ATHEROS_OSEN)) 18187d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (params->osen) { 18197d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt struct wpa_bss_params bss_params; 18207d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18217d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt os_memset(&bss_params, 0, sizeof(struct wpa_bss_params)); 18227d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.enabled = 1; 18237d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa = 2; 18247d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_pairwise = WPA_CIPHER_CCMP; 18257d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.wpa_group = WPA_CIPHER_CCMP; 18267d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt bss_params.ieee802_1x = 1; 18277d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18287d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt if (atheros_set_privacy(priv, 1) || 18297d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt set80211param(priv, IEEE80211_PARAM_OSEN, 1)) 18307d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return -1; 18317d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18327d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt return atheros_set_ieee8021x(priv, &bss_params); 18337d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt } 18347d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt#endif /* CONFIG_HS20 && IEEE80211_PARAM_OSEN */ 18357d5c8f257a74ac0d12828962a492e8b84ef83923Dmitry Shmidt 18361f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt return 0; 18371f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt} 18381f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt 183904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 184004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 184104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 184204949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_send_mgmt(void *priv, const u8 *frm, size_t data_len, 1843a3dc30964aa24aea2b518246f6812663a1103490Dmitry Shmidt int noack, unsigned int freq) 184404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 184504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 184604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt u8 buf[1510]; 184704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt const struct ieee80211_mgmt *mgmt; 184804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_mgmtbuf *mgmt_frm; 184904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 185004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt = (const struct ieee80211_mgmt *) frm; 185104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s frmlen = %lu " MACSTR, __func__, 185204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt (unsigned long) data_len, MAC2STR(mgmt->da)); 185304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm = (struct ieee80211req_mgmtbuf *) buf; 185404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt memcpy(mgmt_frm->macaddr, (u8 *)mgmt->da, IEEE80211_ADDR_LEN); 185504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt mgmt_frm->buflen = data_len; 185604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (&mgmt_frm->buf[0] + data_len > buf + sizeof(buf)) { 185704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_INFO, "atheros: Too long frame for " 185804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "atheros_send_mgmt (%u)", (unsigned int) data_len); 185904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 186004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 186104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&mgmt_frm->buf[0], frm, data_len); 186204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_SEND_MGMT, mgmt_frm, 186304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_mgmtbuf) + data_len); 186404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 186504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 186604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 186704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_tspec(void *priv, const u8 *addr, u8 *tspec_ie, 186804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt size_t tspec_ielen) 186904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 187004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 187104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt int retv; 187204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 187304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addts *addts = &req.u.addts; 187404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 187504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 187604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDTS; 187704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 187804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(addts->tspecie, tspec_ie, tspec_ielen); 187904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt retv = set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 188004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 188104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt if (retv < 0) { 188204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s IEEE80211_IOCTL_RES_REQ FAILED " 188304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt "retv = %d", __func__, retv); 188404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return -1; 188504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt } 188604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(tspec_ie, addts->tspecie, tspec_ielen); 188704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return addts->status; 188804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 188904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 189004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 189104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int atheros_add_sta_node(void *priv, const u8 *addr, u16 auth_alg) 189204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{ 189304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct atheros_driver_data *drv = priv; 189404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res req; 189504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt struct ieee80211req_res_addnode *addnode = &req.u.addnode; 189604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 189704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt wpa_printf(MSG_DEBUG, "%s", __func__); 189804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt req.type = IEEE80211_RESREQ_ADDNODE; 189904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt os_memcpy(&req.macaddr[0], addr, IEEE80211_ADDR_LEN); 190004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt addnode->auth_alg = auth_alg; 190104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt return set80211priv(drv, IEEE80211_IOCTL_RES_REQ, &req, 190204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt sizeof(struct ieee80211req_res)); 190304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt} 190404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 190604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt 190861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* Use only to set a big param, get will not work. */ 190961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int 191061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtset80211big(struct atheros_driver_data *drv, int op, const void *data, int len) 191161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 191261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct iwreq iwr; 191361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 191461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&iwr, 0, sizeof(iwr)); 191561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_strlcpy(iwr.ifr_name, drv->iface, IFNAMSIZ); 191661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 191761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.pointer = (void *) data; 191861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.length = len; 191961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags = op; 192061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x=%d (%s) len=0x%x", 192161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, op, athr_get_param_name(op), len); 192261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 192361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ioctl(drv->ioctl_sock, IEEE80211_IOCTL_P2P_BIG_PARAM, &iwr) < 0) { 192461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: op=0x%x (%s) subop=0x%x=%d " 192561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "value=0x%x,0x%x failed: %d (%s)", 192661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, op, athr_get_ioctl_name(op), iwr.u.mode, 192761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.mode, iwr.u.data.length, 192861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt iwr.u.data.flags, errno, strerror(errno)); 192961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 193061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 193161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 193261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 193361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 193561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_send_action(void *priv, unsigned int freq, 193661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt unsigned int wait, 193761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *dst, const u8 *src, 193861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *bssid, 193961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *data, size_t data_len, int no_cck) 194061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 194161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 194261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211_p2p_send_action *act; 194361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int res; 194461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 194561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act = os_zalloc(sizeof(*act) + data_len); 194661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (act == NULL) 194761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 194861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act->freq = freq; 194961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->dst_addr, dst, ETH_ALEN); 195061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->src_addr, src, ETH_ALEN); 195161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act->bssid, bssid, ETH_ALEN); 195261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(act + 1, data, data_len); 195361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: freq=%d, wait=%u, dst=" MACSTR ", src=" 195461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MACSTR ", bssid=" MACSTR, 195561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt __func__, act->freq, wait, MAC2STR(act->dst_addr), 195661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MAC2STR(act->src_addr), MAC2STR(act->bssid)); 195761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: act", (u8 *) act, sizeof(*act)); 195861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_hexdump(MSG_MSGDUMP, "athr: data", data, data_len); 195961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 196061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = set80211big(drv, IEEE80211_IOC_P2P_SEND_ACTION, 196161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt act, sizeof(*act) + data_len); 196261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(act); 196361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 196461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 196561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 196661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 19675605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 196861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int athr_wnm_tfs(struct atheros_driver_data *drv, const u8* peer, 196961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *ie, u16 *len, enum wnm_oper oper) 197061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 197161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define IEEE80211_APPIE_MAX 1024 /* max appie buffer size */ 197261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 buf[IEEE80211_APPIE_MAX]; 197361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211req_getset_appiebuf *tfs_ie; 197461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 197561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: ifname=%s, WNM TFS IE oper=%d " MACSTR, 197761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt drv->iface, oper, MAC2STR(peer)); 197861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 197961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 198061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 198161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*len > IEEE80211_APPIE_MAX - 198261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf)) { 198361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) too large"); 198461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 198561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 198661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 198761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 198861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = ETH_ALEN + 2 + 2 + *len; 198961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 199161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 199261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 199361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 199461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = *len; 199561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 199661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 199761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy the ie */ 199861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2 + 2, ie, *len); 199961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 200061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 200161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 200261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 200361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 200461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 200561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 200661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 200761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 200861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 200961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 201061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 201161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 201261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 201361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 201461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 201561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 201661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 201761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 201861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 201961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_GET_APPIEBUF, tfs_ie, 202061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 202161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to get WNM TFS IE: " 202261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 202361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 202461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 202561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 202661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = tfs_ie->app_buflen; 202761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(ie, &(tfs_ie->app_buf[0]), *len); 202861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: %c len=%d", tfs_ie->app_buf[0], 202961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len); 203061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 203161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 203261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt *len = 0; 203361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 203461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 203561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie = (struct ieee80211req_getset_appiebuf *) buf; 203661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_frmtype = IEEE80211_APPIE_FRAME_WNM; 203761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_ie->app_buflen = IEEE80211_APPIE_MAX - 203861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sizeof(struct ieee80211req_getset_appiebuf); 203961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 204061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]), peer, ETH_ALEN); 204161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 204261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN, &val, 2); 204361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 204461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(&(tfs_ie->app_buf[0]) + ETH_ALEN + 2, &val, 2); 204561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 204661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (set80211priv(drv, IEEE80211_IOCTL_SET_APPIEBUF, tfs_ie, 204761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt IEEE80211_APPIE_MAX)) { 204861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: Failed to set WNM TFS IE: " 204961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "%s", __func__, strerror(errno)); 205061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 205161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 205261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 205361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 205461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Unsupported TFS oper %d", oper); 205561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 205661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 205761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 205861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return 0; 205961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 206061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 206161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 206261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_sleep(struct atheros_driver_data *drv, 206361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *peer, enum wnm_oper oper) 206461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 206561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *data, *pos; 206661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t dlen; 206761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int ret; 206861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 val; 206961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: WNM-Sleep Oper %d, " MACSTR, 207161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper, MAC2STR(peer)); 207261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt dlen = ETH_ALEN + 2 + 2; 207461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt data = os_malloc(dlen); 207561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (data == NULL) 207661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 207761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 207861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* Command header for driver */ 207961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = data; 208061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, peer, ETH_ALEN); 208161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ETH_ALEN; 208261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = oper; 208461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 208561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 2; 208661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 208761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt val = 0; 208861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &val, 2); 208961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ret = atheros_set_wps_ie(drv, data, dlen, IEEE80211_APPIE_FRAME_WNM); 209161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(data); 209361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return ret; 209561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 209661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 209861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int atheros_wnm_oper(void *priv, enum wnm_oper oper, const u8 *peer, 209961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len) 210061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 210161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct atheros_driver_data *drv = priv; 210261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 210361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (oper) { 210461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_CONFIRM: 210561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_ENTER_FAIL: 210661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_CONFIRM: 210761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_EXIT_FAIL: 210861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return atheros_wnm_sleep(drv, peer, oper); 210961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_REQ_IE_SET: 211061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_ADD: 211161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_RESP_IE_NONE: 211261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_TFS_IE_DEL: 211361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return athr_wnm_tfs(drv, peer, buf, buf_len, oper); 211461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 211561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "atheros: Unsupported WNM operation %d", 211661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt oper); 211761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 211861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 211961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 21205605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 212161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 212261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst struct wpa_driver_ops wpa_driver_atheros_ops = { 21248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .name = "atheros", 21258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_init = atheros_init, 21268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_deinit = atheros_deinit, 21278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ieee8021x = atheros_set_ieee8021x, 21288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_privacy = atheros_set_privacy, 21298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_key = atheros_set_key, 21308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .get_seqnum = atheros_get_seqnum, 21318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .flush = atheros_flush, 21328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_generic_elem = atheros_set_opt_ie, 21338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_set_flags = atheros_sta_set_flags, 21348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .read_sta_data = atheros_read_sta_driver_data, 21358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_send_eapol = atheros_send_eapol, 21368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_disassoc = atheros_sta_disassoc, 21378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_deauth = atheros_sta_deauth, 21388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_set_ssid = atheros_set_ssid, 21398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .hapd_get_ssid = atheros_get_ssid, 21408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_countermeasures = atheros_set_countermeasures, 21418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .sta_clear_stats = atheros_sta_clear_stats, 21428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .commit = atheros_commit, 21438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt .set_ap_wps_ie = atheros_set_ap_wps_ie, 214475ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen .set_authmode = atheros_set_authmode, 21451f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt .set_ap = atheros_set_ap, 214604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_IEEE80211R 214704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_assoc = atheros_sta_assoc, 214804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .sta_auth = atheros_sta_auth, 214904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .send_mlme = atheros_send_mgmt, 215004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_tspec = atheros_add_tspec, 215104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt .add_sta_node = atheros_add_sta_node, 215204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_IEEE80211R */ 215361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .send_action = atheros_send_action, 21545605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#if defined(CONFIG_WNM) && defined(IEEE80211_APPIE_FRAME_WNM) 215561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt .wnm_oper = atheros_wnm_oper, 21565605286c30e1701491bd3af974ae423727750eddDmitry Shmidt#endif /* CONFIG_WNM && IEEE80211_APPIE_FRAME_WNM */ 2157051af73b8f8014eff33330aead0f36944b3403e6Dmitry Shmidt .set_qos_map = atheros_set_qos_map, 21588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}; 2159