1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19516304b0SJoe Perches 206eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 21c08631c6SRaja Mani #include <linux/inetdevice.h> 22d6a434d6SKalle Valo #include <linux/export.h> 23174cd4b1SIngo Molnar #include <linux/sched/signal.h> 246eb07cafSPaul Gortmaker 25bdcd8170SKalle Valo #include "core.h" 26bdcd8170SKalle Valo #include "cfg80211.h" 27bdcd8170SKalle Valo #include "debug.h" 28abcb344bSKalle Valo #include "hif-ops.h" 29003353b0SKalle Valo #include "testmode.h" 30bdcd8170SKalle Valo 31bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 32bdcd8170SKalle Valo .bitrate = (_rate), \ 33bdcd8170SKalle Valo .flags = (_flags), \ 34bdcd8170SKalle Valo .hw_value = (_rateid), \ 35bdcd8170SKalle Valo } 36bdcd8170SKalle Valo 37bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 3857fbcce3SJohannes Berg .band = NL80211_BAND_2GHZ, \ 39bdcd8170SKalle Valo .hw_value = (_channel), \ 40bdcd8170SKalle Valo .center_freq = (_freq), \ 41bdcd8170SKalle Valo .flags = (_flags), \ 42bdcd8170SKalle Valo .max_antenna_gain = 0, \ 43bdcd8170SKalle Valo .max_power = 30, \ 44bdcd8170SKalle Valo } 45bdcd8170SKalle Valo 46bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 4757fbcce3SJohannes Berg .band = NL80211_BAND_5GHZ, \ 48bdcd8170SKalle Valo .hw_value = (_channel), \ 49bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 50bdcd8170SKalle Valo .flags = (_flags), \ 51bdcd8170SKalle Valo .max_antenna_gain = 0, \ 52bdcd8170SKalle Valo .max_power = 30, \ 53bdcd8170SKalle Valo } 54bdcd8170SKalle Valo 55f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 56f599359cSBala Shanmugam 57dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid { 58dd45b759SNaveen Singh struct cfg80211_ssid ssid; 59dd45b759SNaveen Singh u8 flag; 60dd45b759SNaveen Singh }; 61dd45b759SNaveen Singh 62bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 63bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 64bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 65bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 66bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 67bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 68bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 69bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 70bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 71bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 72bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 73bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 74bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 75bdcd8170SKalle Valo }; 76bdcd8170SKalle Valo 77bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 78bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 79bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 80bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 81bdcd8170SKalle Valo 82bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 83bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 84faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 85faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 86faaf1929SVasanthakumar Thiagarajan 87bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 88bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 89bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 90bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 91bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 92bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 93bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 94bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 95bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 96bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 97bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 98bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 99bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 100bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 101bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 102bdcd8170SKalle Valo }; 103bdcd8170SKalle Valo 104bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 105b51040fcSRostyslav Khudolii CHAN5G(36, 0), CHAN5G(40, 0), 106b51040fcSRostyslav Khudolii CHAN5G(44, 0), CHAN5G(48, 0), 107bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 108bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 109bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 110bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 111bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 112bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 113bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 114bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 115bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 116bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 117bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 118bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 119bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 120bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 121bdcd8170SKalle Valo CHAN5G(216, 0), 122bdcd8170SKalle Valo }; 123bdcd8170SKalle Valo 124bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 125bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 126bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 127bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 128bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 129faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 131bdcd8170SKalle Valo }; 132bdcd8170SKalle Valo 133bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 134bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 135bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 136bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 137bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 138bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 139faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 140bdcd8170SKalle Valo }; 141bdcd8170SKalle Valo 142837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 143837cb97eSJouni Malinen 14410509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14510509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14610509f90SKalle Valo { 14710509f90SKalle Valo struct ath6kl *ar = vif->ar; 14810509f90SKalle Valo 149b1f47e3aSThomas Pedersen if (!test_and_clear_bit(SCHED_SCANNING, &vif->flags)) 15010509f90SKalle Valo return false; 15110509f90SKalle Valo 15210509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 15310509f90SKalle Valo 15458109df6SVasanthakumar Thiagarajan if (ar->state == ATH6KL_STATE_RECOVERY) 15558109df6SVasanthakumar Thiagarajan return true; 15610509f90SKalle Valo 157b1f47e3aSThomas Pedersen ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, false); 15810509f90SKalle Valo 15910509f90SKalle Valo return true; 16010509f90SKalle Valo } 16110509f90SKalle Valo 16210509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 16310509f90SKalle Valo { 16410509f90SKalle Valo struct ath6kl *ar = vif->ar; 16510509f90SKalle Valo bool stopped; 16610509f90SKalle Valo 16710509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16810509f90SKalle Valo 16910509f90SKalle Valo if (!stopped) 17010509f90SKalle Valo return; 17110509f90SKalle Valo 172b34939b9SArend Van Spriel cfg80211_sched_scan_stopped(ar->wiphy, 0); 17310509f90SKalle Valo } 17410509f90SKalle Valo 175240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 176bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 177bdcd8170SKalle Valo { 178bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 179bdcd8170SKalle Valo 180bdcd8170SKalle Valo if (!wpa_version) { 1813450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 182bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1833450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 184bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1853450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 186bdcd8170SKalle Valo } else { 187bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 188bdcd8170SKalle Valo return -ENOTSUPP; 189bdcd8170SKalle Valo } 190bdcd8170SKalle Valo 191bdcd8170SKalle Valo return 0; 192bdcd8170SKalle Valo } 193bdcd8170SKalle Valo 194240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 195bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 196bdcd8170SKalle Valo { 197bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 198bdcd8170SKalle Valo 199bdcd8170SKalle Valo switch (auth_type) { 200bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 2013450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 202bdcd8170SKalle Valo break; 203bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 205bdcd8170SKalle Valo break; 206bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 208bdcd8170SKalle Valo break; 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2113450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 212bdcd8170SKalle Valo break; 213bdcd8170SKalle Valo 214bdcd8170SKalle Valo default: 2153c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 216bdcd8170SKalle Valo return -ENOTSUPP; 217bdcd8170SKalle Valo } 218bdcd8170SKalle Valo 219bdcd8170SKalle Valo return 0; 220bdcd8170SKalle Valo } 221bdcd8170SKalle Valo 222240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 223bdcd8170SKalle Valo { 2243450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2253450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2263450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 227bdcd8170SKalle Valo 228bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 229bdcd8170SKalle Valo __func__, cipher, ucast); 230bdcd8170SKalle Valo 231bdcd8170SKalle Valo switch (cipher) { 232bdcd8170SKalle Valo case 0: 233bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 234bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 235bdcd8170SKalle Valo *ar_cipher_len = 0; 236bdcd8170SKalle Valo break; 237bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 238bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 239bdcd8170SKalle Valo *ar_cipher_len = 5; 240bdcd8170SKalle Valo break; 241bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 242bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 243bdcd8170SKalle Valo *ar_cipher_len = 13; 244bdcd8170SKalle Valo break; 245bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 246bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 247bdcd8170SKalle Valo *ar_cipher_len = 0; 248bdcd8170SKalle Valo break; 249bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 250bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 251bdcd8170SKalle Valo *ar_cipher_len = 0; 252bdcd8170SKalle Valo break; 2535e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2545e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2555e07021eSDai Shuibing *ar_cipher_len = 0; 2565e07021eSDai Shuibing break; 257bdcd8170SKalle Valo default: 258bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 259bdcd8170SKalle Valo return -ENOTSUPP; 260bdcd8170SKalle Valo } 261bdcd8170SKalle Valo 262bdcd8170SKalle Valo return 0; 263bdcd8170SKalle Valo } 264bdcd8170SKalle Valo 265240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 266bdcd8170SKalle Valo { 267bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 268bdcd8170SKalle Valo 269bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2703450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2713450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2723450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2733450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 274837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2753450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2763450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2773450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2783450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 279bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2803450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 281bdcd8170SKalle Valo } 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo 284990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 285bdcd8170SKalle Valo { 286990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28759c98449SVasanthakumar Thiagarajan 288bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 289bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 290bdcd8170SKalle Valo return false; 291bdcd8170SKalle Valo } 292bdcd8170SKalle Valo 29359c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 294bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 295bdcd8170SKalle Valo return false; 296bdcd8170SKalle Valo } 297bdcd8170SKalle Valo 298bdcd8170SKalle Valo return true; 299bdcd8170SKalle Valo } 300bdcd8170SKalle Valo 3016981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 3026981ffdcSKevin Fang { 30304b2312aSArend van Spriel return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 3046981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3056981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3066981ffdcSKevin Fang } 3076981ffdcSKevin Fang 3086981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3096981ffdcSKevin Fang { 3106981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3116981ffdcSKevin Fang } 3126981ffdcSKevin Fang 31363541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31463541212SAarthi Thiruvengadam { 31563541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31663541212SAarthi Thiruvengadam pos[1] >= 4 && 31763541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31863541212SAarthi Thiruvengadam pos[5] == 0x04); 31963541212SAarthi Thiruvengadam } 32063541212SAarthi Thiruvengadam 321334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3226981ffdcSKevin Fang size_t ies_len) 3236981ffdcSKevin Fang { 324334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3256981ffdcSKevin Fang const u8 *pos; 3266981ffdcSKevin Fang u8 *buf = NULL; 3276981ffdcSKevin Fang size_t len = 0; 3286981ffdcSKevin Fang int ret; 3296981ffdcSKevin Fang 3306981ffdcSKevin Fang /* 33163541212SAarthi Thiruvengadam * Clear previously set flag 33263541212SAarthi Thiruvengadam */ 33363541212SAarthi Thiruvengadam 33463541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33563541212SAarthi Thiruvengadam 33663541212SAarthi Thiruvengadam /* 3376981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3386981ffdcSKevin Fang */ 3396981ffdcSKevin Fang 3406981ffdcSKevin Fang if (ies && ies_len) { 3416981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3426981ffdcSKevin Fang if (buf == NULL) 3436981ffdcSKevin Fang return -ENOMEM; 3446981ffdcSKevin Fang pos = ies; 3456981ffdcSKevin Fang 3466981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3476981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3486981ffdcSKevin Fang break; 3496981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3506981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3516981ffdcSKevin Fang len += 2 + pos[1]; 3526981ffdcSKevin Fang } 35363541212SAarthi Thiruvengadam 35463541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35563541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35663541212SAarthi Thiruvengadam 3576981ffdcSKevin Fang pos += 2 + pos[1]; 3586981ffdcSKevin Fang } 3596981ffdcSKevin Fang } 3606981ffdcSKevin Fang 361334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 362334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3636981ffdcSKevin Fang kfree(buf); 3646981ffdcSKevin Fang return ret; 3656981ffdcSKevin Fang } 3666981ffdcSKevin Fang 36755055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36855055976SVasanthakumar Thiagarajan { 36955055976SVasanthakumar Thiagarajan switch (type) { 37055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 37138142644SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 37255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37355055976SVasanthakumar Thiagarajan break; 37455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37655055976SVasanthakumar Thiagarajan break; 37755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37955055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 38055055976SVasanthakumar Thiagarajan break; 38155055976SVasanthakumar Thiagarajan default: 38255055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38355055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38455055976SVasanthakumar Thiagarajan } 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan return 0; 38755055976SVasanthakumar Thiagarajan } 38855055976SVasanthakumar Thiagarajan 38955055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 39055055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 39155055976SVasanthakumar Thiagarajan { 39255055976SVasanthakumar Thiagarajan int i; 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39555055976SVasanthakumar Thiagarajan return false; 39655055976SVasanthakumar Thiagarajan 39755055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39855055976SVasanthakumar Thiagarajan ar->num_vif)) 39955055976SVasanthakumar Thiagarajan return false; 40055055976SVasanthakumar Thiagarajan 40155055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 40255055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40371f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 4040db96de6SMohammed Shafi Shajakhan if ((ar->avail_idx_map) & BIT(i)) { 40555055976SVasanthakumar Thiagarajan *if_idx = i; 40655055976SVasanthakumar Thiagarajan return true; 40755055976SVasanthakumar Thiagarajan } 40855055976SVasanthakumar Thiagarajan } 40955055976SVasanthakumar Thiagarajan } 41055055976SVasanthakumar Thiagarajan 4113226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4123226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41371f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4140db96de6SMohammed Shafi Shajakhan if ((ar->avail_idx_map) & BIT(i)) { 4153226f68aSVasanthakumar Thiagarajan *if_idx = i; 4163226f68aSVasanthakumar Thiagarajan return true; 4173226f68aSVasanthakumar Thiagarajan } 4183226f68aSVasanthakumar Thiagarajan } 4193226f68aSVasanthakumar Thiagarajan } 4203226f68aSVasanthakumar Thiagarajan 42155055976SVasanthakumar Thiagarajan return false; 42255055976SVasanthakumar Thiagarajan } 42355055976SVasanthakumar Thiagarajan 4248c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4258c9bb054SKalle Valo { 4268c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4278c9bb054SKalle Valo } 4288c9bb054SKalle Valo 429355b3a98SMohammed Shafi Shajakhan static void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, 430355b3a98SMohammed Shafi Shajakhan bool enable) 431355b3a98SMohammed Shafi Shajakhan { 432355b3a98SMohammed Shafi Shajakhan int err; 433355b3a98SMohammed Shafi Shajakhan 434355b3a98SMohammed Shafi Shajakhan if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag))) 435355b3a98SMohammed Shafi Shajakhan return; 436355b3a98SMohammed Shafi Shajakhan 437355b3a98SMohammed Shafi Shajakhan if (vif->nw_type != INFRA_NETWORK) 438355b3a98SMohammed Shafi Shajakhan return; 439355b3a98SMohammed Shafi Shajakhan 440355b3a98SMohammed Shafi Shajakhan if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE, 441355b3a98SMohammed Shafi Shajakhan vif->ar->fw_capabilities)) 442355b3a98SMohammed Shafi Shajakhan return; 443355b3a98SMohammed Shafi Shajakhan 444355b3a98SMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n", 445355b3a98SMohammed Shafi Shajakhan enable ? "enable" : "disable"); 446355b3a98SMohammed Shafi Shajakhan 447355b3a98SMohammed Shafi Shajakhan err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi, 448355b3a98SMohammed Shafi Shajakhan vif->fw_vif_idx, enable); 449355b3a98SMohammed Shafi Shajakhan if (err) 450355b3a98SMohammed Shafi Shajakhan ath6kl_err("failed to %s enhanced bmiss detection: %d\n", 451355b3a98SMohammed Shafi Shajakhan enable ? "enable" : "disable", err); 452355b3a98SMohammed Shafi Shajakhan } 4538c9bb054SKalle Valo 454bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 455bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 456bdcd8170SKalle Valo { 457bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 45859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 459bdcd8170SKalle Valo int status; 4603ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 461ce0dc0cfSRaja Mani u16 interval; 462bdcd8170SKalle Valo 46310509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 46410509f90SKalle Valo 46514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 466bdcd8170SKalle Valo 467990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 468bdcd8170SKalle Valo return -EIO; 469bdcd8170SKalle Valo 470bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 471bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 472bdcd8170SKalle Valo return -EBUSY; 473bdcd8170SKalle Valo } 474bdcd8170SKalle Valo 475bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 476bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 477bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 478bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 479bdcd8170SKalle Valo return -EINVAL; 480bdcd8170SKalle Valo } 481bdcd8170SKalle Valo 482bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 483bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 484bdcd8170SKalle Valo return -ERESTARTSYS; 485bdcd8170SKalle Valo } 486bdcd8170SKalle Valo 487bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 488bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 489bdcd8170SKalle Valo up(&ar->sem); 490bdcd8170SKalle Valo return -EBUSY; 491bdcd8170SKalle Valo } 492bdcd8170SKalle Valo 493bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 494bdcd8170SKalle Valo /* 495bdcd8170SKalle Valo * sleep until the command queue drains 496bdcd8170SKalle Valo */ 497bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4988c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 499bdcd8170SKalle Valo WMI_TIMEOUT); 500bdcd8170SKalle Valo if (signal_pending(current)) { 501bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 502bdcd8170SKalle Valo up(&ar->sem); 503bdcd8170SKalle Valo return -EINTR; 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo } 506bdcd8170SKalle Valo 507334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 508743b4518SDan Carpenter if (status) { 509743b4518SDan Carpenter up(&ar->sem); 5106981ffdcSKevin Fang return status; 511743b4518SDan Carpenter } 5126e786cb1SJouni Malinen 5136e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 514542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 5156981ffdcSKevin Fang 51659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 5173450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 5183450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 519cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 520334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 521334234b5SVasanthakumar Thiagarajan vif->req_bssid, 522f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 523bdcd8170SKalle Valo 524bdcd8170SKalle Valo up(&ar->sem); 525bdcd8170SKalle Valo if (status) { 526bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 527bdcd8170SKalle Valo return -EIO; 528bdcd8170SKalle Valo } 529bdcd8170SKalle Valo return 0; 5303450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5313450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 532240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 533bdcd8170SKalle Valo } 534bdcd8170SKalle Valo 5353450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5363450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5373450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 538bdcd8170SKalle Valo 539bdcd8170SKalle Valo if (sme->channel) 540f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 541bdcd8170SKalle Valo 5428c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 543bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5448c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 545bdcd8170SKalle Valo 546240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 547bdcd8170SKalle Valo 548240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 549bdcd8170SKalle Valo if (status) { 550bdcd8170SKalle Valo up(&ar->sem); 551bdcd8170SKalle Valo return status; 552bdcd8170SKalle Valo } 553bdcd8170SKalle Valo 554bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 555240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 556bdcd8170SKalle Valo else 557240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 558bdcd8170SKalle Valo 559240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 560bdcd8170SKalle Valo 561bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 562240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 563bdcd8170SKalle Valo 564bdcd8170SKalle Valo if ((sme->key_len) && 5653450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5663450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 567bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 568bdcd8170SKalle Valo 569792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 570bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 571bdcd8170SKalle Valo sme->key_idx); 572bdcd8170SKalle Valo up(&ar->sem); 573bdcd8170SKalle Valo return -ENOENT; 574bdcd8170SKalle Valo } 575bdcd8170SKalle Valo 5766f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 577bdcd8170SKalle Valo key->key_len = sme->key_len; 578bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5793450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5803450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 581bdcd8170SKalle Valo 582334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5833450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 584bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 585bdcd8170SKalle Valo key->key_len, 586f4bb9a6fSJouni Malinen NULL, 0, 587bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 588bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 589bdcd8170SKalle Valo } 590bdcd8170SKalle Valo 591bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 59259c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 593240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 594240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 595bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 596bdcd8170SKalle Valo up(&ar->sem); 597bdcd8170SKalle Valo return -EIO; 598bdcd8170SKalle Valo } 599bdcd8170SKalle Valo } 600bdcd8170SKalle Valo 601f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 602bdcd8170SKalle Valo 603c422d52dSThomas Pedersen /* enable enhanced bmiss detection if applicable */ 604c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, true); 605c422d52dSThomas Pedersen 6063ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 6073ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 6083ca9d1fcSAarthi Thiruvengadam 609bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 610bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 611bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 612bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 613bdcd8170SKalle Valo __func__, 6143450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 6153450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 616f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 617bdcd8170SKalle Valo 618cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 619ce0dc0cfSRaja Mani 620ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 621b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 622b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 623ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 624ce0dc0cfSRaja Mani interval, 625ce0dc0cfSRaja Mani 0); 626ce0dc0cfSRaja Mani if (status) { 627ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 628ce0dc0cfSRaja Mani up(&ar->sem); 629ce0dc0cfSRaja Mani return status; 630ce0dc0cfSRaja Mani } 631ce0dc0cfSRaja Mani } 632ce0dc0cfSRaja Mani 633334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6343450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6353450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6363450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6373450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6383450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 639f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6403ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 641bdcd8170SKalle Valo 6426f7c1adbSMohammed Shafi Shajakhan if (sme->bg_scan_period == 0) { 643f599359cSBala Shanmugam /* disable background scan if period is 0 */ 644f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 6456f7c1adbSMohammed Shafi Shajakhan } else if (sme->bg_scan_period == -1) { 646f599359cSBala Shanmugam /* configure default value if not specified */ 647f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 6486f7c1adbSMohammed Shafi Shajakhan } 649f599359cSBala Shanmugam 650f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 651f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 652f599359cSBala Shanmugam 653bdcd8170SKalle Valo up(&ar->sem); 654bdcd8170SKalle Valo 655bdcd8170SKalle Valo if (status == -EINVAL) { 6563450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6573450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 658bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 659bdcd8170SKalle Valo return -ENOENT; 660bdcd8170SKalle Valo } else if (status) { 661bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 662bdcd8170SKalle Valo return -EIO; 663bdcd8170SKalle Valo } 664bdcd8170SKalle Valo 665bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 666ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 667ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 668de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 669bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 670bdcd8170SKalle Valo } 671bdcd8170SKalle Valo 672bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 67359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 674bdcd8170SKalle Valo 675bdcd8170SKalle Valo return 0; 676bdcd8170SKalle Valo } 677bdcd8170SKalle Valo 6785e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6795e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6804eab6f4fSRaja Mani enum network_type nw_type, 6814eab6f4fSRaja Mani const u8 *bssid, 68201cac476SJouni Malinen struct ieee80211_channel *chan, 6835e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6845e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 68501cac476SJouni Malinen { 686240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 68701cac476SJouni Malinen struct cfg80211_bss *bss; 6886eb18137SDedy Lansky u16 cap_val; 6896eb18137SDedy Lansky enum ieee80211_bss_type bss_type; 69001cac476SJouni Malinen u8 *ie; 69101cac476SJouni Malinen 6924eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6934eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6946eb18137SDedy Lansky bss_type = IEEE80211_BSS_TYPE_IBSS; 6954eab6f4fSRaja Mani } else { 6964eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6976eb18137SDedy Lansky bss_type = IEEE80211_BSS_TYPE_ESS; 6984eab6f4fSRaja Mani } 6994eab6f4fSRaja Mani 700be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 7014eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 7026eb18137SDedy Lansky bss_type, IEEE80211_PRIVACY_ANY); 70301cac476SJouni Malinen if (bss == NULL) { 70401cac476SJouni Malinen /* 70501cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 70601cac476SJouni Malinen * generate a partial entry until the first BSS info 70701cac476SJouni Malinen * event becomes available. 70801cac476SJouni Malinen * 70901cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 71001cac476SJouni Malinen * IEs from the target. 71101cac476SJouni Malinen */ 7123450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 71301cac476SJouni Malinen if (ie == NULL) 7145e13fd35SVasanthakumar Thiagarajan return NULL; 71501cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 7163450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 7173450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 7183450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 719be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 7205bc8c1f2SJohannes Berg CFG80211_BSS_FTYPE_UNKNOWN, 7214eab6f4fSRaja Mani bssid, 0, cap_val, 100, 7223450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 72301cac476SJouni Malinen 0, GFP_KERNEL); 72401cac476SJouni Malinen if (bss) 725cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 726cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 72701cac476SJouni Malinen kfree(ie); 728a5d8f9dfSKalle Valo } else { 7295e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 730a5d8f9dfSKalle Valo } 73101cac476SJouni Malinen 7325e13fd35SVasanthakumar Thiagarajan return bss; 73301cac476SJouni Malinen } 73401cac476SJouni Malinen 735240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 736bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 737bdcd8170SKalle Valo u16 beacon_intvl, 738bdcd8170SKalle Valo enum network_type nw_type, 739bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 740bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 741bdcd8170SKalle Valo { 74201cac476SJouni Malinen struct ieee80211_channel *chan; 743240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7445e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 745bdcd8170SKalle Valo 746bdcd8170SKalle Valo /* capinfo + listen interval */ 747bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 748bdcd8170SKalle Valo 749bdcd8170SKalle Valo /* capinfo + status code + associd */ 750bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 751bdcd8170SKalle Valo 752bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 753bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 754bdcd8170SKalle Valo assoc_resp_ie_offset; 755bdcd8170SKalle Valo 756bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 757bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 758bdcd8170SKalle Valo 75932c10874SJouni Malinen /* 76032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 76132c10874SJouni Malinen * a Beacon frame from the AP is seen. 76232c10874SJouni Malinen */ 763cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 76459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 76532c10874SJouni Malinen 766bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 767551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 768bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 769bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 770bdcd8170SKalle Valo return; 771bdcd8170SKalle Valo } 772bdcd8170SKalle Valo } 773bdcd8170SKalle Valo 774bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 775551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 776551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 777bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 778bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 779bdcd8170SKalle Valo return; 780bdcd8170SKalle Valo } 781bdcd8170SKalle Valo } 782bdcd8170SKalle Valo 783be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 784bdcd8170SKalle Valo 7855e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7865e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7875e13fd35SVasanthakumar Thiagarajan if (!bss) { 7884eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 789bdcd8170SKalle Valo return; 790bdcd8170SKalle Valo } 791bdcd8170SKalle Valo 7924eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7934eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7944eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 795fe94f3a4SAntonio Quartulli cfg80211_ibss_joined(vif->ndev, bssid, chan, GFP_KERNEL); 7965b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 79701cac476SJouni Malinen return; 79801cac476SJouni Malinen } 79901cac476SJouni Malinen 80014ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 801bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 80214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 803240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 804bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 805bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 806bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 8075b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 80814ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 80929ce6ecbSAvraham Stern struct cfg80211_roam_info roam_info = { 81029ce6ecbSAvraham Stern .bss = bss, 81129ce6ecbSAvraham Stern .req_ie = assoc_req_ie, 81229ce6ecbSAvraham Stern .req_ie_len = assoc_req_len, 81329ce6ecbSAvraham Stern .resp_ie = assoc_resp_ie, 81429ce6ecbSAvraham Stern .resp_ie_len = assoc_resp_len, 81529ce6ecbSAvraham Stern }; 816bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 81729ce6ecbSAvraham Stern cfg80211_roamed(vif->ndev, &roam_info, GFP_KERNEL); 818bdcd8170SKalle Valo } 819bdcd8170SKalle Valo } 820bdcd8170SKalle Valo 821bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 822bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 823bdcd8170SKalle Valo { 824d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 8253450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 826bdcd8170SKalle Valo 827bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 828bdcd8170SKalle Valo reason_code); 829bdcd8170SKalle Valo 83010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 83110509f90SKalle Valo 832990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 833bdcd8170SKalle Valo return -EIO; 834bdcd8170SKalle Valo 835bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 836bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 837bdcd8170SKalle Valo return -EBUSY; 838bdcd8170SKalle Valo } 839bdcd8170SKalle Valo 840bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 841bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 842bdcd8170SKalle Valo return -ERESTARTSYS; 843bdcd8170SKalle Valo } 844bdcd8170SKalle Valo 845cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 846240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8473450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8483450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 849bdcd8170SKalle Valo 850bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8518c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 852bdcd8170SKalle Valo 853bdcd8170SKalle Valo up(&ar->sem); 854bdcd8170SKalle Valo 855bdcd8170SKalle Valo return 0; 856bdcd8170SKalle Valo } 857bdcd8170SKalle Valo 858240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 859bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 860bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 861bdcd8170SKalle Valo { 862240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 86359c98449SVasanthakumar Thiagarajan 86414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 8651d76250bSAvraham Stern struct cfg80211_scan_info info = { 8661d76250bSAvraham Stern .aborted = true, 8671d76250bSAvraham Stern }; 8681d76250bSAvraham Stern 8691d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 87014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 871bdcd8170SKalle Valo } 872bdcd8170SKalle Valo 873f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 874fe94f3a4SAntonio Quartulli if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) 875bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 876bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 877bdcd8170SKalle Valo return; 878bdcd8170SKalle Valo } 879bdcd8170SKalle Valo 880f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 881551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 882551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 883bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 884bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 885bdcd8170SKalle Valo return; 886bdcd8170SKalle Valo } 887bdcd8170SKalle Valo } 888bdcd8170SKalle Valo 88959c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 890bdcd8170SKalle Valo 89114ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 892240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 893bdcd8170SKalle Valo bssid, NULL, 0, 894bdcd8170SKalle Valo NULL, 0, 895bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 896bdcd8170SKalle Valo GFP_KERNEL); 89714ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 89833a6664aSThomas Pedersen cfg80211_disconnected(vif->ndev, proto_reason, 89980279fb7SJohannes Berg NULL, 0, false, GFP_KERNEL); 900bdcd8170SKalle Valo } 901bdcd8170SKalle Valo 90214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 90333a6664aSThomas Pedersen 90433a6664aSThomas Pedersen /* 90533a6664aSThomas Pedersen * Send a disconnect command to target when a disconnect event is 90633a6664aSThomas Pedersen * received with reason code other than 3 (DISCONNECT_CMD - disconnect 90733a6664aSThomas Pedersen * request from host) to make the firmware stop trying to connect even 90833a6664aSThomas Pedersen * after giving disconnect event. There will be one more disconnect 90933a6664aSThomas Pedersen * event for this disconnect command with reason code DISCONNECT_CMD 91033a6664aSThomas Pedersen * which won't be notified to cfg80211. 91133a6664aSThomas Pedersen */ 91233a6664aSThomas Pedersen if (reason != DISCONNECT_CMD) 91333a6664aSThomas Pedersen ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 914bdcd8170SKalle Valo } 915bdcd8170SKalle Valo 9163b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 9173b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 918dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 919dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 920dd45b759SNaveen Singh int n_match_ssid) 9213b8ffc6aSJouni Malinen { 922dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 923dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 9243b8ffc6aSJouni Malinen 925dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 926dd45b759SNaveen Singh 927dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 928dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 9293b8ffc6aSJouni Malinen return -EINVAL; 9303b8ffc6aSJouni Malinen 9313b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 932dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 933dd45b759SNaveen Singh ssids[i].ssid, 934dd45b759SNaveen Singh ssids[i].ssid_len); 935dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 936dd45b759SNaveen Singh 937dd45b759SNaveen Singh if (ssids[i].ssid_len) 938dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 939dd45b759SNaveen Singh else 940dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 941dd45b759SNaveen Singh 942fb376a49SKyle Roeschley if (ar->wiphy->max_match_sets != 0 && n_match_ssid == 0) 943dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 944dd45b759SNaveen Singh } 945dd45b759SNaveen Singh 946dd45b759SNaveen Singh index_to_add = i; 947dd45b759SNaveen Singh 948dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 949dd45b759SNaveen Singh ssid_found = false; 950dd45b759SNaveen Singh 951dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 952dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 953dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 954dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 955dd45b759SNaveen Singh match_set[i].ssid.ssid, 956dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 957dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 958dd45b759SNaveen Singh ssid_found = true; 959dd45b759SNaveen Singh break; 960dd45b759SNaveen Singh } 961dd45b759SNaveen Singh } 962dd45b759SNaveen Singh 963dd45b759SNaveen Singh if (ssid_found) 964dd45b759SNaveen Singh continue; 965dd45b759SNaveen Singh 966dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 967dd45b759SNaveen Singh continue; 968dd45b759SNaveen Singh 969dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 970dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 971dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 972dd45b759SNaveen Singh match_set[i].ssid.ssid, 973dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 974dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 975dd45b759SNaveen Singh index_to_add++; 976dd45b759SNaveen Singh } 977dd45b759SNaveen Singh 978dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9793b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 980dd45b759SNaveen Singh ssid_list[i].flag, 981dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 982dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 9833b8ffc6aSJouni Malinen } 9843b8ffc6aSJouni Malinen 9853b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 986dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9873b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9883b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9893b8ffc6aSJouni Malinen } 9903b8ffc6aSJouni Malinen 9913b8ffc6aSJouni Malinen return 0; 9923b8ffc6aSJouni Malinen } 9933b8ffc6aSJouni Malinen 994fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy, 995bdcd8170SKalle Valo struct cfg80211_scan_request *request) 996bdcd8170SKalle Valo { 997fd014284SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev); 998fd014284SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 9991276c9efSEdward Lu s8 n_channels = 0; 10001276c9efSEdward Lu u16 *channels = NULL; 1001bdcd8170SKalle Valo int ret = 0; 1002f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 1003bdcd8170SKalle Valo 1004990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1005bdcd8170SKalle Valo return -EIO; 1006bdcd8170SKalle Valo 100710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 100810509f90SKalle Valo 1009bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 101059c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 1011954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 1012954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 10131b1e6ee3SJouni Malinen if (ret) { 1014bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 10151b1e6ee3SJouni Malinen return ret; 1016bdcd8170SKalle Valo } 1017bdcd8170SKalle Valo } 1018bdcd8170SKalle Valo 10193b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 1020dd45b759SNaveen Singh request->n_ssids, NULL, 0); 10213b8ffc6aSJouni Malinen if (ret < 0) 10223b8ffc6aSJouni Malinen return ret; 1023bdcd8170SKalle Valo 1024080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 1025334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1026334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 1027b84da8c7SJouni Malinen request->ie, request->ie_len); 1028b84da8c7SJouni Malinen if (ret) { 1029f1ff32e8SJoe Perches ath6kl_err("failed to set Probe Request appie for scan\n"); 1030b84da8c7SJouni Malinen return ret; 1031b84da8c7SJouni Malinen } 1032b84da8c7SJouni Malinen 103311869befSJouni Malinen /* 103411869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 103511869befSJouni Malinen * channels. If the list is longer than the target supports, do not 103611869befSJouni Malinen * configure the list and instead, scan all available channels. 103711869befSJouni Malinen */ 103811869befSJouni Malinen if (request->n_channels > 0 && 103911869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10401276c9efSEdward Lu u8 i; 10411276c9efSEdward Lu 104211869befSJouni Malinen n_channels = request->n_channels; 10431276c9efSEdward Lu 10446396bb22SKees Cook channels = kcalloc(n_channels, sizeof(u16), GFP_KERNEL); 10451276c9efSEdward Lu if (channels == NULL) { 1046cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10471276c9efSEdward Lu n_channels = 0; 10481276c9efSEdward Lu } 10491276c9efSEdward Lu 10501276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10511276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10521276c9efSEdward Lu } 10531276c9efSEdward Lu 105459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1055f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1056f1f92179SVasanthakumar Thiagarajan 10575b35dff0SRaja Mani vif->scan_req = request; 10585b35dff0SRaja Mani 10593ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10603ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 106113423c31SVasanthakumar Thiagarajan false, 0, 106213423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 106313423c31SVasanthakumar Thiagarajan n_channels, channels, 106413423c31SVasanthakumar Thiagarajan request->no_cck, 10653ca9d1fcSAarthi Thiruvengadam request->rates); 10665b35dff0SRaja Mani if (ret) { 106711f0bfcfSKalle Valo ath6kl_err("failed to start scan: %d\n", ret); 10685b35dff0SRaja Mani vif->scan_req = NULL; 10695b35dff0SRaja Mani } 1070bdcd8170SKalle Valo 10711276c9efSEdward Lu kfree(channels); 10721276c9efSEdward Lu 1073bdcd8170SKalle Valo return ret; 1074bdcd8170SKalle Valo } 1075bdcd8170SKalle Valo 10761c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1077bdcd8170SKalle Valo { 1078240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10791d76250bSAvraham Stern struct cfg80211_scan_info info = { 10801d76250bSAvraham Stern .aborted = aborted, 10811d76250bSAvraham Stern }; 10826fd1eaceSKalle Valo int i; 1083bdcd8170SKalle Valo 10841c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10851c17d313SKalle Valo aborted ? " aborted" : ""); 1086bdcd8170SKalle Valo 108714ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10886fd1eaceSKalle Valo return; 10896fd1eaceSKalle Valo 10901c17d313SKalle Valo if (aborted) 10916fd1eaceSKalle Valo goto out; 1092bdcd8170SKalle Valo 109314ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 109414ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1095334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 10965803c128SKyle Roeschley i, DISABLE_SSID_FLAG, 1097bdcd8170SKalle Valo 0, NULL); 1098bdcd8170SKalle Valo } 1099bdcd8170SKalle Valo } 11006fd1eaceSKalle Valo 11016fd1eaceSKalle Valo out: 11021d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 110314ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1104bdcd8170SKalle Valo } 1105bdcd8170SKalle Valo 1106c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1107c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1108c4f7863eSThomas Pedersen { 1109683b6d3bSJohannes Berg struct cfg80211_chan_def chandef; 1110c4f7863eSThomas Pedersen 1111c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1112c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1113c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1114c4f7863eSThomas Pedersen 11153d9d1d66SJohannes Berg cfg80211_chandef_create(&chandef, 11163d9d1d66SJohannes Berg ieee80211_get_channel(vif->ar->wiphy, freq), 1117f3651baeSPierre Le Magourou (mode == WMI_11G_HT20 && 1118f3651baeSPierre Le Magourou ath6kl_band_2ghz.ht_cap.ht_supported) ? 11193d9d1d66SJohannes Berg NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT); 1120c4f7863eSThomas Pedersen 1121e487eaebSSimon Wunderlich mutex_lock(&vif->wdev.mtx); 1122683b6d3bSJohannes Berg cfg80211_ch_switch_notify(vif->ndev, &chandef); 1123e487eaebSSimon Wunderlich mutex_unlock(&vif->wdev.mtx); 1124c4f7863eSThomas Pedersen } 1125c4f7863eSThomas Pedersen 1126bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1127bdcd8170SKalle Valo u8 key_index, bool pairwise, 1128bdcd8170SKalle Valo const u8 *mac_addr, 1129bdcd8170SKalle Valo struct key_params *params) 1130bdcd8170SKalle Valo { 1131d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 113259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1133bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 11344a8ce2fdSSujith Manoharan int seq_len; 1135bdcd8170SKalle Valo u8 key_usage; 1136bdcd8170SKalle Valo u8 key_type; 1137bdcd8170SKalle Valo 1138990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1139bdcd8170SKalle Valo return -EIO; 1140bdcd8170SKalle Valo 1141837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1142837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1143837cb97eSJouni Malinen return -EINVAL; 1144240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1145240d2799SVasanthakumar Thiagarajan params->key); 1146837cb97eSJouni Malinen } 1147837cb97eSJouni Malinen 1148792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1149bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1150bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1151bdcd8170SKalle Valo key_index); 1152bdcd8170SKalle Valo return -ENOENT; 1153bdcd8170SKalle Valo } 1154bdcd8170SKalle Valo 11556f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1156bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo if (pairwise) 1159bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1160bdcd8170SKalle Valo else 1161bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1162bdcd8170SKalle Valo 11634a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11645e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11655e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11665e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11675e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11685e07021eSDai Shuibing } 1169bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11705e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1171bdcd8170SKalle Valo return -EINVAL; 1172bdcd8170SKalle Valo 1173bdcd8170SKalle Valo key->key_len = params->key_len; 1174bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11755e07021eSDai Shuibing key->seq_len = seq_len; 1176bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1177bdcd8170SKalle Valo key->cipher = params->cipher; 1178bdcd8170SKalle Valo 1179bdcd8170SKalle Valo switch (key->cipher) { 1180bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1181bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1182bdcd8170SKalle Valo key_type = WEP_CRYPT; 1183bdcd8170SKalle Valo break; 1184bdcd8170SKalle Valo 1185bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1186bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1187bdcd8170SKalle Valo break; 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1190bdcd8170SKalle Valo key_type = AES_CRYPT; 1191bdcd8170SKalle Valo break; 11925e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11935e07021eSDai Shuibing key_type = WAPI_CRYPT; 11945e07021eSDai Shuibing break; 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo default: 1197bdcd8170SKalle Valo return -ENOTSUPP; 1198bdcd8170SKalle Valo } 1199bdcd8170SKalle Valo 1200ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1201ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1202ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1203de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1206bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1207bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1208bdcd8170SKalle Valo key_usage, key->seq_len); 1209bdcd8170SKalle Valo 1210f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 12114703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1212cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 12139a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 12149a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 12159a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 12169a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 12179a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 121859c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1219cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1220cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 12219a5b1318SJouni Malinen /* 12229a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 12239a5b1318SJouni Malinen * the connected event is received from the target. 12249a5b1318SJouni Malinen */ 12259a5b1318SJouni Malinen return 0; 12269a5b1318SJouni Malinen } 12279a5b1318SJouni Malinen } 12289a5b1318SJouni Malinen 1229f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 123059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1231151411e8SJouni Malinen /* 1232151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1233151411e8SJouni Malinen * the AP mode has properly started 1234151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1235151411e8SJouni Malinen */ 1236cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1237cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 12386f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 12396f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 12406f2a73f9SVasanthakumar Thiagarajan key->key_len); 1241151411e8SJouni Malinen return 0; 1242151411e8SJouni Malinen } 1243151411e8SJouni Malinen 12447cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1245bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1246f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1247f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1248bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1249bdcd8170SKalle Valo } 1250bdcd8170SKalle Valo 1251bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1252bdcd8170SKalle Valo u8 key_index, bool pairwise, 1253bdcd8170SKalle Valo const u8 *mac_addr) 1254bdcd8170SKalle Valo { 1255d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12566f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1257bdcd8170SKalle Valo 1258bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1259bdcd8170SKalle Valo 1260990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1261bdcd8170SKalle Valo return -EIO; 1262bdcd8170SKalle Valo 1263792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1264bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1265bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1266bdcd8170SKalle Valo key_index); 1267bdcd8170SKalle Valo return -ENOENT; 1268bdcd8170SKalle Valo } 1269bdcd8170SKalle Valo 12706f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1271bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1272bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1273bdcd8170SKalle Valo return 0; 1274bdcd8170SKalle Valo } 1275bdcd8170SKalle Valo 12766f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1277bdcd8170SKalle Valo 1278334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1282bdcd8170SKalle Valo u8 key_index, bool pairwise, 1283bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1284bdcd8170SKalle Valo void (*callback) (void *cookie, 1285bdcd8170SKalle Valo struct key_params *)) 1286bdcd8170SKalle Valo { 12876f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1288bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1289bdcd8170SKalle Valo struct key_params params; 1290bdcd8170SKalle Valo 1291bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1292bdcd8170SKalle Valo 1293990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1294bdcd8170SKalle Valo return -EIO; 1295bdcd8170SKalle Valo 1296792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1297bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1298bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1299bdcd8170SKalle Valo key_index); 1300bdcd8170SKalle Valo return -ENOENT; 1301bdcd8170SKalle Valo } 1302bdcd8170SKalle Valo 13036f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1304bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1305bdcd8170SKalle Valo params.cipher = key->cipher; 1306bdcd8170SKalle Valo params.key_len = key->key_len; 1307bdcd8170SKalle Valo params.seq_len = key->seq_len; 1308bdcd8170SKalle Valo params.seq = key->seq; 1309bdcd8170SKalle Valo params.key = key->key; 1310bdcd8170SKalle Valo 1311bdcd8170SKalle Valo callback(cookie, ¶ms); 1312bdcd8170SKalle Valo 1313bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1314bdcd8170SKalle Valo } 1315bdcd8170SKalle Valo 1316bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1317bdcd8170SKalle Valo struct net_device *ndev, 1318bdcd8170SKalle Valo u8 key_index, bool unicast, 1319bdcd8170SKalle Valo bool multicast) 1320bdcd8170SKalle Valo { 1321d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 132259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1323bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1324bdcd8170SKalle Valo u8 key_usage; 1325229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1326bdcd8170SKalle Valo 1327bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1328bdcd8170SKalle Valo 1329990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1330bdcd8170SKalle Valo return -EIO; 1331bdcd8170SKalle Valo 1332792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1333bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1334bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1335bdcd8170SKalle Valo __func__, key_index); 1336bdcd8170SKalle Valo return -ENOENT; 1337bdcd8170SKalle Valo } 1338bdcd8170SKalle Valo 13396f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1340bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1341bdcd8170SKalle Valo __func__, key_index); 1342bdcd8170SKalle Valo return -EINVAL; 1343bdcd8170SKalle Valo } 1344bdcd8170SKalle Valo 13453450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13466f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1347bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13483450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1349bdcd8170SKalle Valo key_usage |= TX_USAGE; 1350229ed6b5SEdward Lu if (unicast) 13513450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1352229ed6b5SEdward Lu if (multicast) 13533450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1354bdcd8170SKalle Valo 1355f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13569a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13579a5b1318SJouni Malinen 1358f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1359334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1360229ed6b5SEdward Lu key_type, key_usage, 1361f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1362f4bb9a6fSJouni Malinen key->key, 1363bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1364bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1365bdcd8170SKalle Valo } 1366bdcd8170SKalle Valo 1367240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1368bdcd8170SKalle Valo bool ismcast) 1369bdcd8170SKalle Valo { 1370bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1371bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1372bdcd8170SKalle Valo 1373240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1374bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1375bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1376bdcd8170SKalle Valo GFP_KERNEL); 1377bdcd8170SKalle Valo } 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1380bdcd8170SKalle Valo { 1381bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1382990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1383bdcd8170SKalle Valo int ret; 1384bdcd8170SKalle Valo 1385bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1386bdcd8170SKalle Valo changed); 1387bdcd8170SKalle Valo 1388990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1389990bd915SVasanthakumar Thiagarajan if (!vif) 1390990bd915SVasanthakumar Thiagarajan return -EIO; 1391990bd915SVasanthakumar Thiagarajan 1392990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1393bdcd8170SKalle Valo return -EIO; 1394bdcd8170SKalle Valo 1395bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1396bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1397bdcd8170SKalle Valo if (ret != 0) { 1398bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1399bdcd8170SKalle Valo return -EIO; 1400bdcd8170SKalle Valo } 1401bdcd8170SKalle Valo } 1402bdcd8170SKalle Valo 1403bdcd8170SKalle Valo return 0; 1404bdcd8170SKalle Valo } 1405bdcd8170SKalle Valo 1406bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1407c8442118SJohannes Berg struct wireless_dev *wdev, 1408bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1409b992a285SLuis R. Rodriguez int mbm) 1410bdcd8170SKalle Valo { 1411bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1412990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1413b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1416bdcd8170SKalle Valo type, dbm); 1417bdcd8170SKalle Valo 1418990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1419990bd915SVasanthakumar Thiagarajan if (!vif) 1420990bd915SVasanthakumar Thiagarajan return -EIO; 1421990bd915SVasanthakumar Thiagarajan 1422990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1423bdcd8170SKalle Valo return -EIO; 1424bdcd8170SKalle Valo 1425bdcd8170SKalle Valo switch (type) { 1426bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1427bdcd8170SKalle Valo return 0; 1428bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1429d0d670abSKalle Valo ar->tx_pwr = dbm; 1430bdcd8170SKalle Valo break; 1431bdcd8170SKalle Valo default: 1432bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1433bdcd8170SKalle Valo __func__, type); 1434bdcd8170SKalle Valo return -EOPNOTSUPP; 1435bdcd8170SKalle Valo } 1436bdcd8170SKalle Valo 1437d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1438bdcd8170SKalle Valo 1439bdcd8170SKalle Valo return 0; 1440bdcd8170SKalle Valo } 1441bdcd8170SKalle Valo 1442c8442118SJohannes Berg static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, 1443c8442118SJohannes Berg struct wireless_dev *wdev, 1444c8442118SJohannes Berg int *dbm) 1445bdcd8170SKalle Valo { 1446bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1447990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1448bdcd8170SKalle Valo 1449990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1450990bd915SVasanthakumar Thiagarajan if (!vif) 1451990bd915SVasanthakumar Thiagarajan return -EIO; 1452990bd915SVasanthakumar Thiagarajan 1453990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1454bdcd8170SKalle Valo return -EIO; 1455bdcd8170SKalle Valo 145659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1457cabd34d0SEric Bentley ar->tx_pwr = 255; 1458bdcd8170SKalle Valo 1459990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1460bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1461bdcd8170SKalle Valo return -EIO; 1462bdcd8170SKalle Valo } 1463bdcd8170SKalle Valo 1464cabd34d0SEric Bentley wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 255, 1465bdcd8170SKalle Valo 5 * HZ); 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo if (signal_pending(current)) { 1468bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1469bdcd8170SKalle Valo return -EINTR; 1470bdcd8170SKalle Valo } 1471bdcd8170SKalle Valo } 1472bdcd8170SKalle Valo 1473bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1474bdcd8170SKalle Valo return 0; 1475bdcd8170SKalle Valo } 1476bdcd8170SKalle Valo 1477bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1478bdcd8170SKalle Valo struct net_device *dev, 1479bdcd8170SKalle Valo bool pmgmt, int timeout) 1480bdcd8170SKalle Valo { 1481bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1482bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1483334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1484bdcd8170SKalle Valo 1485bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1486bdcd8170SKalle Valo __func__, pmgmt, timeout); 1487bdcd8170SKalle Valo 1488990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1489bdcd8170SKalle Valo return -EIO; 1490bdcd8170SKalle Valo 1491bdcd8170SKalle Valo if (pmgmt) { 1492f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1493bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1494bdcd8170SKalle Valo } else { 1495f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1496bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1497bdcd8170SKalle Valo } 1498bdcd8170SKalle Valo 1499334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1500334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1501bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1502bdcd8170SKalle Valo return -EIO; 1503bdcd8170SKalle Valo } 1504bdcd8170SKalle Valo 1505bdcd8170SKalle Valo return 0; 1506bdcd8170SKalle Valo } 1507bdcd8170SKalle Valo 150884efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1509552bff0cSJohannes Berg const char *name, 15106bab2e19STom Gundersen unsigned char name_assign_type, 151155055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 151255055976SVasanthakumar Thiagarajan struct vif_params *params) 151355055976SVasanthakumar Thiagarajan { 151455055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 151584efbb84SJohannes Berg struct wireless_dev *wdev; 151655055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 151755055976SVasanthakumar Thiagarajan 151871f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 151955055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 152055055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 152155055976SVasanthakumar Thiagarajan } 152255055976SVasanthakumar Thiagarajan 152355055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 152455055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 152555055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 152655055976SVasanthakumar Thiagarajan } 152755055976SVasanthakumar Thiagarajan 15286bab2e19STom Gundersen wdev = ath6kl_interface_add(ar, name, name_assign_type, type, if_idx, nw_type); 152984efbb84SJohannes Berg if (!wdev) 153055055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 153155055976SVasanthakumar Thiagarajan 153255055976SVasanthakumar Thiagarajan ar->num_vif++; 153355055976SVasanthakumar Thiagarajan 153484efbb84SJohannes Berg return wdev; 153555055976SVasanthakumar Thiagarajan } 153655055976SVasanthakumar Thiagarajan 153755055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 153884efbb84SJohannes Berg struct wireless_dev *wdev) 153955055976SVasanthakumar Thiagarajan { 154055055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 154184efbb84SJohannes Berg struct ath6kl_vif *vif = netdev_priv(wdev->netdev); 154255055976SVasanthakumar Thiagarajan 154311f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 154455055976SVasanthakumar Thiagarajan list_del(&vif->list); 154511f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 154655055976SVasanthakumar Thiagarajan 1547355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_vif_stop(vif, test_bit(WMI_READY, &ar->flag)); 154855055976SVasanthakumar Thiagarajan 1549bc52aab3SMohammed Shafi Shajakhan rtnl_lock(); 1550c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 1551bc52aab3SMohammed Shafi Shajakhan rtnl_unlock(); 155255055976SVasanthakumar Thiagarajan 155355055976SVasanthakumar Thiagarajan return 0; 155455055976SVasanthakumar Thiagarajan } 155555055976SVasanthakumar Thiagarajan 1556bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1557bdcd8170SKalle Valo struct net_device *ndev, 1558818a986eSJohannes Berg enum nl80211_iftype type, 1559bdcd8170SKalle Valo struct vif_params *params) 1560bdcd8170SKalle Valo { 1561f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15621e8d13b0SVasanthakumar Thiagarajan int i; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1565bdcd8170SKalle Valo 15661e8d13b0SVasanthakumar Thiagarajan /* 15671e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15681e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15691e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15701e8d13b0SVasanthakumar Thiagarajan */ 15711e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15721e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15731e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15741e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15751e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15761e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15771e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15781e8d13b0SVasanthakumar Thiagarajan else 15791e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15801e8d13b0SVasanthakumar Thiagarajan } 15811e8d13b0SVasanthakumar Thiagarajan 15821e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15831e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15841e8d13b0SVasanthakumar Thiagarajan break; 15851e8d13b0SVasanthakumar Thiagarajan } 15861e8d13b0SVasanthakumar Thiagarajan 15871e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15881e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15891e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15901e8d13b0SVasanthakumar Thiagarajan } 15911e8d13b0SVasanthakumar Thiagarajan } 15921e8d13b0SVasanthakumar Thiagarajan 1593c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1594c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1595c422d52dSThomas Pedersen 15961e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1597bdcd8170SKalle Valo switch (type) { 1598bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 15998aa659d2SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 1600f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1601bdcd8170SKalle Valo break; 1602bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1603f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1604bdcd8170SKalle Valo break; 16056e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 16066b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1607f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 16086b5e5d25SJouni Malinen break; 1609bdcd8170SKalle Valo default: 1610bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1611bdcd8170SKalle Valo return -EOPNOTSUPP; 1612bdcd8170SKalle Valo } 1613bdcd8170SKalle Valo 1614551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1615bdcd8170SKalle Valo 1616bdcd8170SKalle Valo return 0; 1617bdcd8170SKalle Valo } 1618bdcd8170SKalle Valo 1619bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1620bdcd8170SKalle Valo struct net_device *dev, 1621bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1622bdcd8170SKalle Valo { 1623bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1625bdcd8170SKalle Valo int status; 1626bdcd8170SKalle Valo 1627990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1628bdcd8170SKalle Valo return -EIO; 1629bdcd8170SKalle Valo 16303450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 16313450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1632bdcd8170SKalle Valo 1633683b6d3bSJohannes Berg if (ibss_param->chandef.chan) 1634683b6d3bSJohannes Berg vif->ch_hint = ibss_param->chandef.chan->center_freq; 1635bdcd8170SKalle Valo 1636bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1637bdcd8170SKalle Valo /* 1638bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1639bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1640bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1641bdcd8170SKalle Valo * updated. 1642bdcd8170SKalle Valo */ 1643bdcd8170SKalle Valo return -EOPNOTSUPP; 1644bdcd8170SKalle Valo } 1645bdcd8170SKalle Valo 16468c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1647bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16488c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16498c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1650bdcd8170SKalle Valo 1651240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1652bdcd8170SKalle Valo 1653240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1654bdcd8170SKalle Valo if (status) 1655bdcd8170SKalle Valo return status; 1656bdcd8170SKalle Valo 1657bdcd8170SKalle Valo if (ibss_param->privacy) { 1658240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1659240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1660bdcd8170SKalle Valo } else { 1661240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1662240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1663bdcd8170SKalle Valo } 1664bdcd8170SKalle Valo 1665f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1666bdcd8170SKalle Valo 1667bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1668bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1669bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1670bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1671bdcd8170SKalle Valo __func__, 16723450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16733450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1674f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1675bdcd8170SKalle Valo 1676334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16773450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16783450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16793450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16803450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16813450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1682f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16833ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 168459c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1685bdcd8170SKalle Valo 1686bdcd8170SKalle Valo return 0; 1687bdcd8170SKalle Valo } 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1690bdcd8170SKalle Valo struct net_device *dev) 1691bdcd8170SKalle Valo { 16923450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1693bdcd8170SKalle Valo 1694990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1695bdcd8170SKalle Valo return -EIO; 1696bdcd8170SKalle Valo 1697240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16983450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16993450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1700bdcd8170SKalle Valo 1701bdcd8170SKalle Valo return 0; 1702bdcd8170SKalle Valo } 1703bdcd8170SKalle Valo 1704bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1705bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1706bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1707bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1708bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1709837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 17105e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1711bdcd8170SKalle Valo }; 1712bdcd8170SKalle Valo 1713bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1714bdcd8170SKalle Valo { 1715bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1716bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1717bdcd8170SKalle Valo 36000, 48000, 54000 1718bdcd8170SKalle Valo }; 1719bdcd8170SKalle Valo u8 i; 1720bdcd8170SKalle Valo 1721bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1722bdcd8170SKalle Valo if (rate == legacy[i]) 1723bdcd8170SKalle Valo return true; 1724bdcd8170SKalle Valo 1725bdcd8170SKalle Valo return false; 1726bdcd8170SKalle Valo } 1727bdcd8170SKalle Valo 1728bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1729bdcd8170SKalle Valo { 1730bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1731bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1732bdcd8170SKalle Valo }; 1733bdcd8170SKalle Valo u8 i; 1734bdcd8170SKalle Valo 1735bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1736bdcd8170SKalle Valo if (rate == ht20[i]) { 1737bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1738bdcd8170SKalle Valo /* last rate uses sgi */ 1739bdcd8170SKalle Valo *sgi = true; 1740bdcd8170SKalle Valo else 1741bdcd8170SKalle Valo *sgi = false; 1742bdcd8170SKalle Valo 1743bdcd8170SKalle Valo *mcs = i; 1744bdcd8170SKalle Valo return true; 1745bdcd8170SKalle Valo } 1746bdcd8170SKalle Valo } 1747bdcd8170SKalle Valo return false; 1748bdcd8170SKalle Valo } 1749bdcd8170SKalle Valo 1750bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1751bdcd8170SKalle Valo { 1752bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1753bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1754bdcd8170SKalle Valo 150000 1755bdcd8170SKalle Valo }; 1756bdcd8170SKalle Valo u8 i; 1757bdcd8170SKalle Valo 1758bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1759bdcd8170SKalle Valo if (rate == ht40[i]) { 1760bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1761bdcd8170SKalle Valo /* last rate uses sgi */ 1762bdcd8170SKalle Valo *sgi = true; 1763bdcd8170SKalle Valo else 1764bdcd8170SKalle Valo *sgi = false; 1765bdcd8170SKalle Valo 1766bdcd8170SKalle Valo *mcs = i; 1767bdcd8170SKalle Valo return true; 1768bdcd8170SKalle Valo } 1769bdcd8170SKalle Valo } 1770bdcd8170SKalle Valo 1771bdcd8170SKalle Valo return false; 1772bdcd8170SKalle Valo } 1773bdcd8170SKalle Valo 1774bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 17753b3a0162SJohannes Berg const u8 *mac, struct station_info *sinfo) 1776bdcd8170SKalle Valo { 1777bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 177859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1779bdcd8170SKalle Valo long left; 1780bdcd8170SKalle Valo bool sgi; 1781bdcd8170SKalle Valo s32 rate; 1782bdcd8170SKalle Valo int ret; 1783bdcd8170SKalle Valo u8 mcs; 1784bdcd8170SKalle Valo 17858c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1786bdcd8170SKalle Valo return -ENOENT; 1787bdcd8170SKalle Valo 1788bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1789bdcd8170SKalle Valo return -EBUSY; 1790bdcd8170SKalle Valo 1791b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1792bdcd8170SKalle Valo 1793334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1794bdcd8170SKalle Valo 1795bdcd8170SKalle Valo if (ret != 0) { 1796bdcd8170SKalle Valo up(&ar->sem); 1797bdcd8170SKalle Valo return -EIO; 1798bdcd8170SKalle Valo } 1799bdcd8170SKalle Valo 1800bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1801bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1802b95907a7SVasanthakumar Thiagarajan &vif->flags), 1803bdcd8170SKalle Valo WMI_TIMEOUT); 1804bdcd8170SKalle Valo 1805bdcd8170SKalle Valo up(&ar->sem); 1806bdcd8170SKalle Valo 1807bdcd8170SKalle Valo if (left == 0) 1808bdcd8170SKalle Valo return -ETIMEDOUT; 1809bdcd8170SKalle Valo else if (left < 0) 1810bdcd8170SKalle Valo return left; 1811bdcd8170SKalle Valo 1812b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1813b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 181422d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_BYTES64); 1815b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 181622d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_RX_PACKETS); 1817bdcd8170SKalle Valo } 1818bdcd8170SKalle Valo 1819b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1820b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 182122d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BYTES64); 1822b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 182322d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_PACKETS); 1824bdcd8170SKalle Valo } 1825bdcd8170SKalle Valo 1826b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 182722d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_SIGNAL); 1828bdcd8170SKalle Valo 1829b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1830bdcd8170SKalle Valo 1831bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1832bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1833bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1834bdcd8170SKalle Valo if (sgi) { 1835bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1836bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1837bdcd8170SKalle Valo } else { 1838bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1839bdcd8170SKalle Valo } 1840bdcd8170SKalle Valo 1841bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1842b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_20; 1843bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1844bdcd8170SKalle Valo if (sgi) { 1845bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1846bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1847bdcd8170SKalle Valo } else { 1848bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1849bdcd8170SKalle Valo } 1850bdcd8170SKalle Valo 1851b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_40; 1852bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1853bdcd8170SKalle Valo } else { 18549a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18559a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18569a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1857bdcd8170SKalle Valo return 0; 1858bdcd8170SKalle Valo } 1859bdcd8170SKalle Valo 186022d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE); 1861bdcd8170SKalle Valo 186259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 186359c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1864f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 186522d0d2faSOmer Efrat sinfo->filled |= BIT_ULL(NL80211_STA_INFO_BSS_PARAM); 186632c10874SJouni Malinen sinfo->bss_param.flags = 0; 1867cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1868cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 186932c10874SJouni Malinen } 187032c10874SJouni Malinen 1871bdcd8170SKalle Valo return 0; 1872bdcd8170SKalle Valo } 1873bdcd8170SKalle Valo 1874bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1875bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1876bdcd8170SKalle Valo { 1877bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1878334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1879334234b5SVasanthakumar Thiagarajan 1880334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1881bdcd8170SKalle Valo pmksa->pmkid, true); 1882bdcd8170SKalle Valo } 1883bdcd8170SKalle Valo 1884bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1885bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1886bdcd8170SKalle Valo { 1887bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1888334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1889334234b5SVasanthakumar Thiagarajan 1890334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1891bdcd8170SKalle Valo pmksa->pmkid, false); 1892bdcd8170SKalle Valo } 1893bdcd8170SKalle Valo 1894bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1895bdcd8170SKalle Valo { 1896bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 189759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 189859c98449SVasanthakumar Thiagarajan 189959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1900334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1901334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1902bdcd8170SKalle Valo return 0; 1903bdcd8170SKalle Valo } 1904bdcd8170SKalle Valo 1905d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1906d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 19076cb3c714SRaja Mani { 1908d91e8eeeSRaja Mani int ret, pos; 19092c07cf44SThomas Pedersen u8 mask[WOW_PATTERN_SIZE]; 19106cb3c714SRaja Mani u16 i; 19116cb3c714SRaja Mani 1912d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 19136cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 19146cb3c714SRaja Mani /* 19156cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 19166cb3c714SRaja Mani * driver specific mask value and send it to the chip along 19176cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 19186cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 19196cb3c714SRaja Mani * then equivalent driver specific mask value is 19206cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 19216cb3c714SRaja Mani */ 19226cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 19236cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 19246cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 19256cb3c714SRaja Mani mask[pos] = 0xFF; 19266cb3c714SRaja Mani } 19276cb3c714SRaja Mani /* 19286cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 19296cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 19306cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 19316cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 19326cb3c714SRaja Mani */ 19336cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 19346cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 19356cb3c714SRaja Mani wow->patterns[i].pattern_len, 19366cb3c714SRaja Mani 0 /* pattern offset */, 19376cb3c714SRaja Mani wow->patterns[i].pattern, mask); 19386cb3c714SRaja Mani if (ret) 19396cb3c714SRaja Mani return ret; 19406cb3c714SRaja Mani } 19416cb3c714SRaja Mani 1942d91e8eeeSRaja Mani if (wow->disconnect) 1943d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1944d91e8eeeSRaja Mani 1945d91e8eeeSRaja Mani if (wow->magic_pkt) 1946d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1947d91e8eeeSRaja Mani 1948d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1949d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1950d91e8eeeSRaja Mani 1951d91e8eeeSRaja Mani if (wow->eap_identity_req) 1952d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1953d91e8eeeSRaja Mani 1954d91e8eeeSRaja Mani if (wow->four_way_handshake) 1955d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1956d91e8eeeSRaja Mani 1957d91e8eeeSRaja Mani return 0; 1958d91e8eeeSRaja Mani } 1959d91e8eeeSRaja Mani 1960d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1961d91e8eeeSRaja Mani { 1962d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1963d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1964d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1965d91e8eeeSRaja Mani 0x00, 0x08 }; 1966d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1967d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1968d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1969d91e8eeeSRaja Mani 0x00, 0x7f }; 1970d91e8eeeSRaja Mani u8 unicst_offset = 0; 1971d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1972d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1973d91e8eeeSRaja Mani u8 arp_offset = 20; 1974d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1975d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1976d91e8eeeSRaja Mani u8 discvr_offset = 38; 1977d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1978d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1979d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1980d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1981d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1982d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1983d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1984d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1985d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1986d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1987d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1988d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1989d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1990d91e8eeeSRaja Mani int ret; 1991d91e8eeeSRaja Mani 1992d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1993d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1994d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1995d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1996d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1997d91e8eeeSRaja Mani if (ret) { 1998d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1999d91e8eeeSRaja Mani return ret; 2000d91e8eeeSRaja Mani } 2001d91e8eeeSRaja Mani 2002d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 2003d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2004d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2005d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 2006d91e8eeeSRaja Mani arp_pattern, arp_mask); 2007d91e8eeeSRaja Mani if (ret) { 2008d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 2009d91e8eeeSRaja Mani return ret; 2010d91e8eeeSRaja Mani } 2011d91e8eeeSRaja Mani 2012d91e8eeeSRaja Mani /* 2013d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2014d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2015d91e8eeeSRaja Mani */ 2016d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2017d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2018d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2019d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2020d91e8eeeSRaja Mani if (ret) { 2021d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2022d91e8eeeSRaja Mani return ret; 2023d91e8eeeSRaja Mani } 2024d91e8eeeSRaja Mani 2025d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 2026d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2027d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2028d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 2029d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 2030d91e8eeeSRaja Mani if (ret) { 2031d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 2032d91e8eeeSRaja Mani return ret; 2033d91e8eeeSRaja Mani } 2034d91e8eeeSRaja Mani 2035d91e8eeeSRaja Mani return 0; 2036d91e8eeeSRaja Mani } 2037d91e8eeeSRaja Mani 2038d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2039d91e8eeeSRaja Mani { 2040d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2041d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2042d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2043d91e8eeeSRaja Mani u8 discvr_offset = 38; 2044d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2045d91e8eeeSRaja Mani int ret; 2046d91e8eeeSRaja Mani 2047d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 204893803b33SJoe Perches eth_broadcast_addr(mac_mask); 2049d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2050d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2051d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2052d91e8eeeSRaja Mani mac_mask); 2053d91e8eeeSRaja Mani if (ret) { 2054d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2055d91e8eeeSRaja Mani return ret; 2056d91e8eeeSRaja Mani } 2057d91e8eeeSRaja Mani 2058d91e8eeeSRaja Mani /* 2059d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2060d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2061d91e8eeeSRaja Mani */ 2062d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2063d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2064d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2065d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2066d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2067d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2068d91e8eeeSRaja Mani if (ret) { 2069cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2070d91e8eeeSRaja Mani return ret; 2071d91e8eeeSRaja Mani } 2072d91e8eeeSRaja Mani } 2073d91e8eeeSRaja Mani 2074d91e8eeeSRaja Mani return 0; 2075d91e8eeeSRaja Mani } 2076d91e8eeeSRaja Mani 2077055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2078055bde49SRaja Mani { 2079055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2080055bde49SRaja Mani } 2081055bde49SRaja Mani 2082055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2083055bde49SRaja Mani { 2084055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2085055bde49SRaja Mani } 2086055bde49SRaja Mani 2087055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2088055bde49SRaja Mani { 2089055bde49SRaja Mani int ret, left; 2090055bde49SRaja Mani 2091055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2092055bde49SRaja Mani 2093055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2094055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2095055bde49SRaja Mani if (ret) 2096055bde49SRaja Mani return ret; 2097055bde49SRaja Mani 2098055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2099055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2100055bde49SRaja Mani WMI_TIMEOUT); 2101055bde49SRaja Mani if (left == 0) { 2102055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2103055bde49SRaja Mani ret = -ETIMEDOUT; 2104055bde49SRaja Mani } else if (left < 0) { 2105055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2106055bde49SRaja Mani left); 2107055bde49SRaja Mani ret = left; 2108055bde49SRaja Mani } 2109055bde49SRaja Mani 2110055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2111055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2112055bde49SRaja Mani is_ctrl_ep_empty(ar), 2113055bde49SRaja Mani WMI_TIMEOUT); 2114055bde49SRaja Mani if (left == 0) { 2115055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2116055bde49SRaja Mani ret = -ETIMEDOUT; 2117055bde49SRaja Mani } else if (left < 0) { 2118055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2119055bde49SRaja Mani ret = left; 2120055bde49SRaja Mani } 2121055bde49SRaja Mani } 2122055bde49SRaja Mani 2123055bde49SRaja Mani return ret; 2124055bde49SRaja Mani } 2125055bde49SRaja Mani 2126fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif, 2127fd4377b6SThomas Pedersen struct cfg80211_wowlan *wow, u32 *filter) 2128d91e8eeeSRaja Mani { 2129fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 2130d91e8eeeSRaja Mani struct in_device *in_dev; 2131d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2132055bde49SRaja Mani int ret; 2133ce0dc0cfSRaja Mani u16 i, bmiss_time; 2134d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2135fd4377b6SThomas Pedersen u8 index = 0; 2136d91e8eeeSRaja Mani 21376821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 21386821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21396821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21406251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21416251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21426251d801SNaveen Gangadharan if (ret) 21436251d801SNaveen Gangadharan return ret; 21446251d801SNaveen Gangadharan } 21456251d801SNaveen Gangadharan 2146d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2147d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2148d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2149d91e8eeeSRaja Mani WOW_LIST_ID, i); 2150d91e8eeeSRaja Mani 2151d91e8eeeSRaja Mani /* 2152d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2153d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2154d91e8eeeSRaja Mani * the user. 2155d91e8eeeSRaja Mani */ 2156d91e8eeeSRaja Mani if (wow) 2157fd4377b6SThomas Pedersen ret = ath6kl_wow_usr(ar, vif, wow, filter); 2158d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2159d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2160d91e8eeeSRaja Mani else 2161d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2162d91e8eeeSRaja Mani 2163d91e8eeeSRaja Mani if (ret) 2164d91e8eeeSRaja Mani return ret; 2165d91e8eeeSRaja Mani 2166390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2167390a8c8fSRaja Mani 2168ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2169ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2170ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2171ce0dc0cfSRaja Mani 0); 2172ce0dc0cfSRaja Mani if (ret) 2173ce0dc0cfSRaja Mani return ret; 2174ce0dc0cfSRaja Mani 2175ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2176ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2177ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2178ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2179ce0dc0cfSRaja Mani 2180ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2181ce0dc0cfSRaja Mani bmiss_time, 0); 2182ce0dc0cfSRaja Mani if (ret) 2183ce0dc0cfSRaja Mani return ret; 2184ce0dc0cfSRaja Mani 2185ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2186ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2187ce0dc0cfSRaja Mani 0, 0, 0, 0); 2188ce0dc0cfSRaja Mani if (ret) 2189ce0dc0cfSRaja Mani return ret; 2190ce0dc0cfSRaja Mani } 2191ce0dc0cfSRaja Mani 2192c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2193c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2194c08631c6SRaja Mani if (!in_dev) 2195fd4377b6SThomas Pedersen return 0; 2196c08631c6SRaja Mani 2197c08631c6SRaja Mani ifa = in_dev->ifa_list; 2198c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2199c08631c6SRaja Mani 2200c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2201c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2202c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2203c08631c6SRaja Mani ifa = ifa->ifa_next; 2204c08631c6SRaja Mani index++; 2205c08631c6SRaja Mani } 2206c08631c6SRaja Mani 2207c08631c6SRaja Mani if (ifa) { 2208c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2209c08631c6SRaja Mani return -EINVAL; 2210c08631c6SRaja Mani } 2211c08631c6SRaja Mani 2212c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2213c08631c6SRaja Mani if (ret) { 2214c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2215c08631c6SRaja Mani return ret; 2216c08631c6SRaja Mani } 2217c08631c6SRaja Mani 2218fd4377b6SThomas Pedersen return ret; 2219fd4377b6SThomas Pedersen } 2220fd4377b6SThomas Pedersen 2221fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2222fd4377b6SThomas Pedersen { 2223fd4377b6SThomas Pedersen struct ath6kl_vif *first_vif, *vif; 2224fd4377b6SThomas Pedersen int ret = 0; 2225fd4377b6SThomas Pedersen u32 filter = 0; 2226fd4377b6SThomas Pedersen bool connected = false; 2227fd4377b6SThomas Pedersen 2228fd4377b6SThomas Pedersen /* enter / leave wow suspend on first vif always */ 2229fd4377b6SThomas Pedersen first_vif = ath6kl_vif_first(ar); 2230bffb7db2SGeliang Tang if (WARN_ON(!first_vif) || 2231fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(first_vif)) 2232fd4377b6SThomas Pedersen return -EIO; 2233fd4377b6SThomas Pedersen 2234fd4377b6SThomas Pedersen if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2235fd4377b6SThomas Pedersen return -EINVAL; 2236fd4377b6SThomas Pedersen 2237fd4377b6SThomas Pedersen /* install filters for each connected vif */ 2238fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2239fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2240fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2241fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2242fd4377b6SThomas Pedersen continue; 2243fd4377b6SThomas Pedersen connected = true; 2244fd4377b6SThomas Pedersen 2245fd4377b6SThomas Pedersen ret = ath6kl_wow_suspend_vif(vif, wow, &filter); 2246fd4377b6SThomas Pedersen if (ret) 2247fd4377b6SThomas Pedersen break; 2248fd4377b6SThomas Pedersen } 2249fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2250fd4377b6SThomas Pedersen 2251fd4377b6SThomas Pedersen if (!connected) 2252fd4377b6SThomas Pedersen return -ENOTCONN; 2253fd4377b6SThomas Pedersen else if (ret) 2254fd4377b6SThomas Pedersen return ret; 2255fd4377b6SThomas Pedersen 2256fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_SUSPENDING; 2257fd4377b6SThomas Pedersen 2258fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx, 22596cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22606cb3c714SRaja Mani filter, 22616cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22626cb3c714SRaja Mani if (ret) 22636cb3c714SRaja Mani return ret; 22646cb3c714SRaja Mani 2265fd4377b6SThomas Pedersen return ath6kl_cfg80211_host_sleep(ar, first_vif); 22666cb3c714SRaja Mani } 22676cb3c714SRaja Mani 2268fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif) 22696cb3c714SRaja Mani { 2270fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 22716cb3c714SRaja Mani int ret; 22726cb3c714SRaja Mani 2273ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2274ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2275ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2276ce0dc0cfSRaja Mani if (ret) 2277ce0dc0cfSRaja Mani return ret; 2278ce0dc0cfSRaja Mani 2279ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2280ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2281ce0dc0cfSRaja Mani if (ret) 2282ce0dc0cfSRaja Mani return ret; 2283ce0dc0cfSRaja Mani 2284ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2285ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2286ce0dc0cfSRaja Mani if (ret) 2287ce0dc0cfSRaja Mani return ret; 2288ce0dc0cfSRaja Mani } 2289ce0dc0cfSRaja Mani 22906821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22916821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22926821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22936251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22946251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22956251d801SNaveen Gangadharan if (ret) 22966251d801SNaveen Gangadharan return ret; 22976251d801SNaveen Gangadharan } 22986251d801SNaveen Gangadharan 2299390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2300390a8c8fSRaja Mani 2301390a8c8fSRaja Mani return 0; 2302390a8c8fSRaja Mani } 2303390a8c8fSRaja Mani 2304fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar) 2305fd4377b6SThomas Pedersen { 2306fd4377b6SThomas Pedersen struct ath6kl_vif *vif; 2307fd4377b6SThomas Pedersen int ret; 2308fd4377b6SThomas Pedersen 2309fd4377b6SThomas Pedersen vif = ath6kl_vif_first(ar); 2310bffb7db2SGeliang Tang if (WARN_ON(!vif) || 2311fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2312fd4377b6SThomas Pedersen return -EIO; 2313fd4377b6SThomas Pedersen 2314fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_RESUMING; 2315fd4377b6SThomas Pedersen 2316fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2317fd4377b6SThomas Pedersen ATH6KL_HOST_MODE_AWAKE); 2318fd4377b6SThomas Pedersen if (ret) { 2319fd4377b6SThomas Pedersen ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2320fd4377b6SThomas Pedersen ret); 2321fd4377b6SThomas Pedersen goto cleanup; 2322fd4377b6SThomas Pedersen } 2323fd4377b6SThomas Pedersen 2324fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2325fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2326fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2327fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2328fd4377b6SThomas Pedersen continue; 2329fd4377b6SThomas Pedersen ret = ath6kl_wow_resume_vif(vif); 2330fd4377b6SThomas Pedersen if (ret) 2331fd4377b6SThomas Pedersen break; 2332fd4377b6SThomas Pedersen } 2333fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2334fd4377b6SThomas Pedersen 2335fd4377b6SThomas Pedersen if (ret) 2336fd4377b6SThomas Pedersen goto cleanup; 2337fd4377b6SThomas Pedersen 2338fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_ON; 2339fd4377b6SThomas Pedersen return 0; 2340fd4377b6SThomas Pedersen 2341fd4377b6SThomas Pedersen cleanup: 2342fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_WOW; 2343fd4377b6SThomas Pedersen return ret; 2344fd4377b6SThomas Pedersen } 2345fd4377b6SThomas Pedersen 234640abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 234740abc2deSRaja Mani { 234840abc2deSRaja Mani struct ath6kl_vif *vif; 234940abc2deSRaja Mani int ret; 235040abc2deSRaja Mani 235140abc2deSRaja Mani vif = ath6kl_vif_first(ar); 235240abc2deSRaja Mani if (!vif) 235340abc2deSRaja Mani return -EIO; 235440abc2deSRaja Mani 235548f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 235648f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 235740abc2deSRaja Mani return -EIO; 235848f27587SMing Jiang } 235940abc2deSRaja Mani 236040abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 236140abc2deSRaja Mani 236240abc2deSRaja Mani /* Save the current power mode before enabling power save */ 236340abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 236440abc2deSRaja Mani 236540abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 236640abc2deSRaja Mani if (ret) 236740abc2deSRaja Mani return ret; 236840abc2deSRaja Mani 236940abc2deSRaja Mani /* Disable WOW mode */ 237040abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 237140abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 237240abc2deSRaja Mani 0, 0); 237340abc2deSRaja Mani if (ret) 237440abc2deSRaja Mani return ret; 237540abc2deSRaja Mani 237640abc2deSRaja Mani /* Flush all non control pkts in TX path */ 237740abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 237840abc2deSRaja Mani 237940abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 238040abc2deSRaja Mani if (ret) 238140abc2deSRaja Mani return ret; 238240abc2deSRaja Mani 238340abc2deSRaja Mani return 0; 238440abc2deSRaja Mani } 238540abc2deSRaja Mani 238640abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 238740abc2deSRaja Mani { 238840abc2deSRaja Mani struct ath6kl_vif *vif; 238940abc2deSRaja Mani int ret; 239040abc2deSRaja Mani 239140abc2deSRaja Mani vif = ath6kl_vif_first(ar); 239240abc2deSRaja Mani 239340abc2deSRaja Mani if (!vif) 239440abc2deSRaja Mani return -EIO; 239540abc2deSRaja Mani 239640abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 239740abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 239840abc2deSRaja Mani ar->wmi->saved_pwr_mode); 239940abc2deSRaja Mani if (ret) 240040abc2deSRaja Mani return ret; 240140abc2deSRaja Mani } 240240abc2deSRaja Mani 240340abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 240440abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 240540abc2deSRaja Mani if (ret) 240640abc2deSRaja Mani return ret; 240740abc2deSRaja Mani 240840abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 240940abc2deSRaja Mani 241040abc2deSRaja Mani /* Reset scan parameter to default values */ 241140abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 241240abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 241340abc2deSRaja Mani if (ret) 241440abc2deSRaja Mani return ret; 241540abc2deSRaja Mani 241640abc2deSRaja Mani return 0; 241740abc2deSRaja Mani } 241840abc2deSRaja Mani 241952d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 24200f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 24210f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 242252d81a68SKalle Valo { 24233d79499cSVivek Natarajan struct ath6kl_vif *vif; 2424390a8c8fSRaja Mani enum ath6kl_state prev_state; 242552d81a68SKalle Valo int ret; 242652d81a68SKalle Valo 242752d81a68SKalle Valo switch (mode) { 2428d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2429d7c44e0bSRaja Mani 2430d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2431d7c44e0bSRaja Mani 2432d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2433d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2434d7c44e0bSRaja Mani 2435390a8c8fSRaja Mani prev_state = ar->state; 2436390a8c8fSRaja Mani 2437d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2438390a8c8fSRaja Mani if (ret) { 2439390a8c8fSRaja Mani ar->state = prev_state; 2440d7c44e0bSRaja Mani return ret; 2441390a8c8fSRaja Mani } 24421e9a905dSRaja Mani 2443d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2444d7c44e0bSRaja Mani break; 2445d7c44e0bSRaja Mani 244652d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2447524441e3SRaja Mani 244840abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2449524441e3SRaja Mani 245040abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 245152d81a68SKalle Valo if (ret) { 245240abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 245340abc2deSRaja Mani return ret; 245452d81a68SKalle Valo } 245552d81a68SKalle Valo 245676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 245776a9fbe2SKalle Valo 245852d81a68SKalle Valo break; 2459b4b2a0b1SKalle Valo 2460b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2461524441e3SRaja Mani 24627125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2463524441e3SRaja Mani 2464b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2465b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2466b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2467b4b2a0b1SKalle Valo break; 2468b4b2a0b1SKalle Valo } 2469b4b2a0b1SKalle Valo 2470b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2471b4b2a0b1SKalle Valo 2472b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2473b4b2a0b1SKalle Valo if (ret) { 2474b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2475b4b2a0b1SKalle Valo ret); 2476b4b2a0b1SKalle Valo } 2477b4b2a0b1SKalle Valo 2478b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2479b4b2a0b1SKalle Valo 2480b4b2a0b1SKalle Valo break; 2481b4b2a0b1SKalle Valo 2482b4b2a0b1SKalle Valo default: 2483b4b2a0b1SKalle Valo break; 248452d81a68SKalle Valo } 248552d81a68SKalle Valo 24863d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24873d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24883d79499cSVivek Natarajan 248952d81a68SKalle Valo return 0; 249052d81a68SKalle Valo } 2491d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 249252d81a68SKalle Valo 249352d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 249452d81a68SKalle Valo { 249576a9fbe2SKalle Valo int ret; 249676a9fbe2SKalle Valo 249776a9fbe2SKalle Valo switch (ar->state) { 2498d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2499d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2500d7c44e0bSRaja Mani 2501d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2502d7c44e0bSRaja Mani if (ret) { 2503d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2504d7c44e0bSRaja Mani return ret; 2505d7c44e0bSRaja Mani } 2506d7c44e0bSRaja Mani 2507d7c44e0bSRaja Mani break; 2508d7c44e0bSRaja Mani 250976a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 251040abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 251140abc2deSRaja Mani 251240abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 251376a9fbe2SKalle Valo if (ret) { 251440abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 251540abc2deSRaja Mani return ret; 251676a9fbe2SKalle Valo } 251776a9fbe2SKalle Valo break; 251876a9fbe2SKalle Valo 2519b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2520b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2521b4b2a0b1SKalle Valo 2522b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2523b4b2a0b1SKalle Valo if (ret) { 2524b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2525b4b2a0b1SKalle Valo return ret; 2526b4b2a0b1SKalle Valo } 2527d7c44e0bSRaja Mani break; 2528b4b2a0b1SKalle Valo 252976a9fbe2SKalle Valo default: 253076a9fbe2SKalle Valo break; 253152d81a68SKalle Valo } 253252d81a68SKalle Valo 253352d81a68SKalle Valo return 0; 253452d81a68SKalle Valo } 2535d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 253652d81a68SKalle Valo 2537abcb344bSKalle Valo #ifdef CONFIG_PM 253852d81a68SKalle Valo 253952d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 254052d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2541abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2542abcb344bSKalle Valo { 2543abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2544abcb344bSKalle Valo 254584caf800SVasanthakumar Thiagarajan ath6kl_recovery_suspend(ar); 254684caf800SVasanthakumar Thiagarajan 25470f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2548abcb344bSKalle Valo } 2549aa6cffc1SChilam Ng 255052d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2551aa6cffc1SChilam Ng { 2552aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 255384caf800SVasanthakumar Thiagarajan int err; 2554aa6cffc1SChilam Ng 255584caf800SVasanthakumar Thiagarajan err = ath6kl_hif_resume(ar); 255684caf800SVasanthakumar Thiagarajan if (err) 255784caf800SVasanthakumar Thiagarajan return err; 255884caf800SVasanthakumar Thiagarajan 255992332993SVasanthakumar Thiagarajan ath6kl_recovery_resume(ar); 256084caf800SVasanthakumar Thiagarajan 256184caf800SVasanthakumar Thiagarajan return 0; 2562aa6cffc1SChilam Ng } 2563a918fb3cSRaja Mani 2564a918fb3cSRaja Mani /* 2565a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2566a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2567a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2568a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2569a918fb3cSRaja Mani * 2570a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2571a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2572a918fb3cSRaja Mani * 2573a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2574a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2575a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2576a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2577a918fb3cSRaja Mani * 2578a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2579a918fb3cSRaja Mani */ 2580a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2581a918fb3cSRaja Mani { 2582390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2583390a8c8fSRaja Mani return; 2584390a8c8fSRaja Mani 2585a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2586a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2587a918fb3cSRaja Mani } 2588a918fb3cSRaja Mani 2589a918fb3cSRaja Mani #else 2590a918fb3cSRaja Mani 2591a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2592a918fb3cSRaja Mani { 2593a918fb3cSRaja Mani } 2594abcb344bSKalle Valo #endif 2595abcb344bSKalle Valo 259657fbcce3SJohannes Berg static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum nl80211_band band, 2597df90b369SVasanthakumar Thiagarajan bool ht_enable) 25986a7c9badSJouni Malinen { 259967b3f129SKiran Reddy struct ath6kl_htcap *htcap = &vif->htcap[band]; 2600e68f6750SSujith Manoharan 2601df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 26026a7c9badSJouni Malinen return 0; 2603df90b369SVasanthakumar Thiagarajan 2604df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2605df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2606df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 260757fbcce3SJohannes Berg htcap->cap_info = (band == NL80211_BAND_2GHZ) ? 2608df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2609df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2610df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2611df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2612df90b369SVasanthakumar Thiagarajan 2613df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2614df90b369SVasanthakumar Thiagarajan band, htcap); 26156a7c9badSJouni Malinen } 26166a7c9badSJouni Malinen 261737a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 261837a2f950SThomas Pedersen { 261937a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 262037a2f950SThomas Pedersen int band, ret = 0; 262137a2f950SThomas Pedersen 262257fbcce3SJohannes Berg for (band = 0; band < NUM_NL80211_BANDS; band++) { 262337a2f950SThomas Pedersen if (!wiphy->bands[band]) 262437a2f950SThomas Pedersen continue; 262537a2f950SThomas Pedersen 262637a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 262737a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 262837a2f950SThomas Pedersen if (ret) 262937a2f950SThomas Pedersen return ret; 263037a2f950SThomas Pedersen } 263137a2f950SThomas Pedersen 263237a2f950SThomas Pedersen return ret; 263337a2f950SThomas Pedersen } 263437a2f950SThomas Pedersen 26358bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 26368bdfbf40SJouni Malinen { 26378bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 26388bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 26398bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 26408bdfbf40SJouni Malinen } 26418bdfbf40SJouni Malinen 2642334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2643334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 26448bdfbf40SJouni Malinen { 2645334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26468bdfbf40SJouni Malinen const u8 *pos; 26478bdfbf40SJouni Malinen u8 *buf = NULL; 26488bdfbf40SJouni Malinen size_t len = 0; 26498bdfbf40SJouni Malinen int ret; 26508bdfbf40SJouni Malinen 26518bdfbf40SJouni Malinen /* 26528bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26538bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26548bdfbf40SJouni Malinen */ 26558bdfbf40SJouni Malinen 26568bdfbf40SJouni Malinen if (ies && ies_len) { 26578bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26588bdfbf40SJouni Malinen if (buf == NULL) 26598bdfbf40SJouni Malinen return -ENOMEM; 26608bdfbf40SJouni Malinen pos = ies; 26618bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26628bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26638bdfbf40SJouni Malinen break; 26648bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26658bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26668bdfbf40SJouni Malinen len += 2 + pos[1]; 26678bdfbf40SJouni Malinen } 26688bdfbf40SJouni Malinen pos += 2 + pos[1]; 26698bdfbf40SJouni Malinen } 26708bdfbf40SJouni Malinen } 26718bdfbf40SJouni Malinen 2672334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2673334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26748bdfbf40SJouni Malinen kfree(buf); 26758bdfbf40SJouni Malinen return ret; 26768bdfbf40SJouni Malinen } 26778bdfbf40SJouni Malinen 26788860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26798860020eSJohannes Berg struct cfg80211_beacon_data *info) 26808860020eSJohannes Berg { 26818860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26828860020eSJohannes Berg int res; 26838860020eSJohannes Berg 268417a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26858860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26868860020eSJohannes Berg WMI_FRAME_BEACON, 26878860020eSJohannes Berg info->beacon_ies, 26888860020eSJohannes Berg info->beacon_ies_len); 26898860020eSJohannes Berg if (res) 26908860020eSJohannes Berg return res; 26918860020eSJohannes Berg 269217a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26938860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26948860020eSJohannes Berg info->proberesp_ies_len); 26958860020eSJohannes Berg if (res) 26968860020eSJohannes Berg return res; 26978860020eSJohannes Berg 269817a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26998860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 27008860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 27018860020eSJohannes Berg info->assocresp_ies, 27028860020eSJohannes Berg info->assocresp_ies_len); 27038860020eSJohannes Berg if (res) 27048860020eSJohannes Berg return res; 27058860020eSJohannes Berg 27068860020eSJohannes Berg return 0; 27078860020eSJohannes Berg } 27088860020eSJohannes Berg 2709d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2710d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2711d97c121bSVasanthakumar Thiagarajan { 2712d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2713d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2714d97c121bSVasanthakumar Thiagarajan u16 cnt; 2715d97c121bSVasanthakumar Thiagarajan 2716d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2717d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2718d97c121bSVasanthakumar Thiagarajan 2719d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2720d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2721d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2722d97c121bSVasanthakumar Thiagarajan 2723d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2724d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2725d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2726d97c121bSVasanthakumar Thiagarajan 27279e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27289e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2729d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27309e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27319e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27329e8b16dbSVasanthakumar Thiagarajan 27339e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27349e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27359e8b16dbSVasanthakumar Thiagarajan return 0; 27369e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27379e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2738d97c121bSVasanthakumar Thiagarajan 2739d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2740d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27419e8b16dbSVasanthakumar Thiagarajan return 0; 2742798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2743d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2744d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2745d97c121bSVasanthakumar Thiagarajan 2746d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2747d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27489e8b16dbSVasanthakumar Thiagarajan return 0; 2749798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2750d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2751d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2752d97c121bSVasanthakumar Thiagarajan 2753d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27549e8b16dbSVasanthakumar Thiagarajan return 0; 2755d97c121bSVasanthakumar Thiagarajan 2756d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2757d97c121bSVasanthakumar Thiagarajan 2758d97c121bSVasanthakumar Thiagarajan return 0; 2759d97c121bSVasanthakumar Thiagarajan } 2760d97c121bSVasanthakumar Thiagarajan 27618860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27628860020eSJohannes Berg struct cfg80211_ap_settings *info) 27636a7c9badSJouni Malinen { 27646a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27653450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27666a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 276767cd22e4SThomas Pedersen bool hidden = false; 27686a7c9badSJouni Malinen u8 *ies; 27696a7c9badSJouni Malinen struct wmi_connect_cmd p; 27706a7c9badSJouni Malinen int res; 2771be5abaafSVasanthakumar Thiagarajan int i, ret; 2772d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27737ac25eacSMohammed Shafi Shajakhan int inactivity_timeout = 0; 27746a7c9badSJouni Malinen 27758860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27766a7c9badSJouni Malinen 2777990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27786a7c9badSJouni Malinen return -EIO; 27796a7c9badSJouni Malinen 2780f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27816a7c9badSJouni Malinen return -EOPNOTSUPP; 27826a7c9badSJouni Malinen 27838860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27846a7c9badSJouni Malinen 27859a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27869a5b1318SJouni Malinen 2787eb922e4bSMohammed Shafi Shajakhan ret = ath6kl_wmi_ap_set_beacon_intvl_cmd(ar->wmi, vif->fw_vif_idx, 2788eb922e4bSMohammed Shafi Shajakhan info->beacon_interval); 2789eb922e4bSMohammed Shafi Shajakhan 2790eb922e4bSMohammed Shafi Shajakhan if (ret) 2791eb922e4bSMohammed Shafi Shajakhan ath6kl_warn("Failed to set beacon interval: %d\n", ret); 27926a7c9badSJouni Malinen 2793d154f32eSEtay Luz ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx, 2794d154f32eSEtay Luz info->dtim_period); 2795d154f32eSEtay Luz 2796d154f32eSEtay Luz /* ignore error, just print a warning and continue normally */ 2797d154f32eSEtay Luz if (ret) 2798d154f32eSEtay Luz ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret); 2799d154f32eSEtay Luz 28008860020eSJohannes Berg if (info->beacon.head == NULL) 28016a7c9badSJouni Malinen return -EINVAL; 28028860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 28036a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 28048860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 28056a7c9badSJouni Malinen return -EINVAL; 28066a7c9badSJouni Malinen 28076a7c9badSJouni Malinen if (info->ssid == NULL) 28086a7c9badSJouni Malinen return -EINVAL; 28093450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 28103450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 28116a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 281267cd22e4SThomas Pedersen hidden = true; 281367cd22e4SThomas Pedersen 281467cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 281567cd22e4SThomas Pedersen if (res) 281667cd22e4SThomas Pedersen return res; 28176a7c9badSJouni Malinen 2818be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2819be5abaafSVasanthakumar Thiagarajan if (ret) 2820be5abaafSVasanthakumar Thiagarajan return ret; 28216a7c9badSJouni Malinen 28226a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28236a7c9badSJouni Malinen 28246a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28256a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28266a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28276a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28286a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28296a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28306a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28316a7c9badSJouni Malinen break; 28326a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28336a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28346a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28356a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28366a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28376a7c9badSJouni Malinen break; 28386a7c9badSJouni Malinen } 28396a7c9badSJouni Malinen } 28406a7c9badSJouni Malinen if (p.auth_mode == 0) 28416a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28423450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28436a7c9badSJouni Malinen 28446a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28456a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28466a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28476a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28486a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28496a7c9badSJouni Malinen break; 28506a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28516a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28526a7c9badSJouni Malinen break; 28536a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28546a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28556a7c9badSJouni Malinen break; 2856b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2857b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2858b8214df1SDai Shuibing break; 28596a7c9badSJouni Malinen } 28606a7c9badSJouni Malinen } 2861229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28626a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2863240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2864a5d8f9dfSKalle Valo } else if (info->crypto.n_ciphers_pairwise == 1) { 2865240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 2866a5d8f9dfSKalle Valo } 28676a7c9badSJouni Malinen 28686a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28706a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28716a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28726a7c9badSJouni Malinen break; 28736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28746a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28756a7c9badSJouni Malinen break; 28766a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28776a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28786a7c9badSJouni Malinen break; 2879b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2880b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2881b8214df1SDai Shuibing break; 28826a7c9badSJouni Malinen default: 28836a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28846a7c9badSJouni Malinen break; 28856a7c9badSJouni Malinen } 2886240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28876a7c9badSJouni Malinen 28886a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2889f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28906a7c9badSJouni Malinen 28913450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28923450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28933450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2894683b6d3bSJohannes Berg p.ch = cpu_to_le16(info->chandef.chan->center_freq); 28956a7c9badSJouni Malinen 2896c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2897c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2898c1762a3fSThirumalai Pachamuthu if (res < 0) 2899c1762a3fSThirumalai Pachamuthu return res; 2900c1762a3fSThirumalai Pachamuthu 29013ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 29023ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 29033ca9d1fcSAarthi Thiruvengadam } else { 29043ca9d1fcSAarthi Thiruvengadam /* 29053ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 29063ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 29073ca9d1fcSAarthi Thiruvengadam */ 29083ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 29093ca9d1fcSAarthi Thiruvengadam } 29103ca9d1fcSAarthi Thiruvengadam 291103bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 29127ac25eacSMohammed Shafi Shajakhan inactivity_timeout = info->inactivity_timeout; 29137ac25eacSMohammed Shafi Shajakhan 2914eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_AP_INACTIVITY_MINS, 2915eba95bceSKalle Valo ar->fw_capabilities)) 29167ac25eacSMohammed Shafi Shajakhan inactivity_timeout = DIV_ROUND_UP(inactivity_timeout, 29177ac25eacSMohammed Shafi Shajakhan 60); 29187ac25eacSMohammed Shafi Shajakhan 291903bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 29207ac25eacSMohammed Shafi Shajakhan inactivity_timeout); 292103bdeb0dSVasanthakumar Thiagarajan if (res < 0) 292203bdeb0dSVasanthakumar Thiagarajan return res; 292303bdeb0dSVasanthakumar Thiagarajan } 292403bdeb0dSVasanthakumar Thiagarajan 2925683b6d3bSJohannes Berg if (ath6kl_set_htcap(vif, info->chandef.chan->band, 2926683b6d3bSJohannes Berg cfg80211_get_chandef_type(&info->chandef) 2927683b6d3bSJohannes Berg != NL80211_CHAN_NO_HT)) 2928df90b369SVasanthakumar Thiagarajan return -EIO; 2929df90b369SVasanthakumar Thiagarajan 2930d97c121bSVasanthakumar Thiagarajan /* 2931d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2932d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2933d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2934d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2935d97c121bSVasanthakumar Thiagarajan */ 2936d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2937d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2938d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2939d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2940d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2941d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2942d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2943f21243a8SThomas Pedersen vif->rsn_capab = rsn_capab; 2944d97c121bSVasanthakumar Thiagarajan if (res < 0) 2945d97c121bSVasanthakumar Thiagarajan return res; 2946d97c121bSVasanthakumar Thiagarajan } 2947d97c121bSVasanthakumar Thiagarajan 2948c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2949334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29509a5b1318SJouni Malinen if (res < 0) 29519a5b1318SJouni Malinen return res; 29529a5b1318SJouni Malinen 29539a5b1318SJouni Malinen return 0; 29546a7c9badSJouni Malinen } 29556a7c9badSJouni Malinen 29568860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29578860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29586a7c9badSJouni Malinen { 29598860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29608860020eSJohannes Berg 29618860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29628860020eSJohannes Berg return -EIO; 29638860020eSJohannes Berg 29648860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29658860020eSJohannes Berg return -EOPNOTSUPP; 29668860020eSJohannes Berg 29678860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29686a7c9badSJouni Malinen } 29696a7c9badSJouni Malinen 29708860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29716a7c9badSJouni Malinen { 29726a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 297359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29746a7c9badSJouni Malinen 2975f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29766a7c9badSJouni Malinen return -EOPNOTSUPP; 297759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29786a7c9badSJouni Malinen return -ENOTCONN; 29796a7c9badSJouni Malinen 2980334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 298159c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 298276b817f6SPierre Le Magourou netif_carrier_off(vif->ndev); 29836a7c9badSJouni Malinen 2984df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 298537a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29866a7c9badSJouni Malinen } 29876a7c9badSJouni Malinen 298833e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 298933e5308dSJouni Malinen 299033e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 299189c771e5SJouni Malinen struct station_del_parameters *params) 299233e5308dSJouni Malinen { 299333e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 299433e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 299589c771e5SJouni Malinen const u8 *addr = params->mac ? params->mac : bcast_addr; 299633e5308dSJouni Malinen 299733e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 299833e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 299933e5308dSJouni Malinen } 300033e5308dSJouni Malinen 300123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 30023b3a0162SJohannes Berg const u8 *mac, 30033b3a0162SJohannes Berg struct station_parameters *params) 300423875136SJouni Malinen { 300523875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 3006f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 300777ee7c89SJohannes Berg int err; 300823875136SJouni Malinen 3009f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 301023875136SJouni Malinen return -EOPNOTSUPP; 301123875136SJouni Malinen 301277ee7c89SJohannes Berg err = cfg80211_check_station_change(wiphy, params, 301377ee7c89SJohannes Berg CFG80211_STA_AP_MLME_CLIENT); 301477ee7c89SJohannes Berg if (err) 301577ee7c89SJohannes Berg return err; 301623875136SJouni Malinen 301723875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 3018334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3019334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 3020334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3021334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 302223875136SJouni Malinen } 302323875136SJouni Malinen 302463fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 302571bbc994SJohannes Berg struct wireless_dev *wdev, 302663fa1e0cSJouni Malinen struct ieee80211_channel *chan, 302763fa1e0cSJouni Malinen unsigned int duration, 302863fa1e0cSJouni Malinen u64 *cookie) 302963fa1e0cSJouni Malinen { 303071bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 303171bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 30321052261eSJouni Malinen u32 id; 303363fa1e0cSJouni Malinen 303463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 303563fa1e0cSJouni Malinen * return -EBUSY */ 30361052261eSJouni Malinen id = ++vif->last_roc_id; 30371052261eSJouni Malinen if (id == 0) { 30381052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30391052261eSJouni Malinen id = ++vif->last_roc_id; 30401052261eSJouni Malinen } 30411052261eSJouni Malinen *cookie = id; 304263fa1e0cSJouni Malinen 3043334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3044334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 304563fa1e0cSJouni Malinen } 304663fa1e0cSJouni Malinen 304763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 304871bbc994SJohannes Berg struct wireless_dev *wdev, 304963fa1e0cSJouni Malinen u64 cookie) 305063fa1e0cSJouni Malinen { 305171bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 305271bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 305363fa1e0cSJouni Malinen 30541052261eSJouni Malinen if (cookie != vif->last_roc_id) 305563fa1e0cSJouni Malinen return -ENOENT; 30561052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 305763fa1e0cSJouni Malinen 3058334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 305963fa1e0cSJouni Malinen } 306063fa1e0cSJouni Malinen 3061334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3062334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3063334234b5SVasanthakumar Thiagarajan unsigned int freq) 30648bdfbf40SJouni Malinen { 3065334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30668bdfbf40SJouni Malinen const u8 *pos; 30678bdfbf40SJouni Malinen u8 *p2p; 30688bdfbf40SJouni Malinen int p2p_len; 30698bdfbf40SJouni Malinen int ret; 30708bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30718bdfbf40SJouni Malinen 30728bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30738bdfbf40SJouni Malinen 30748bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30758bdfbf40SJouni Malinen 30768bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30778bdfbf40SJouni Malinen if (p2p == NULL) 30788bdfbf40SJouni Malinen return -ENOMEM; 30798bdfbf40SJouni Malinen p2p_len = 0; 30808bdfbf40SJouni Malinen 30818bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30828bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30838bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30848bdfbf40SJouni Malinen break; 30858bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30868bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30878bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30888bdfbf40SJouni Malinen } 30898bdfbf40SJouni Malinen pos += 2 + pos[1]; 30908bdfbf40SJouni Malinen } 30918bdfbf40SJouni Malinen 3092334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3093334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30948bdfbf40SJouni Malinen kfree(p2p); 30958bdfbf40SJouni Malinen return ret; 30968bdfbf40SJouni Malinen } 30978bdfbf40SJouni Malinen 3098d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3099d0ff7383SNaveen Gangadharan u32 id, 3100d0ff7383SNaveen Gangadharan u32 freq, 3101d0ff7383SNaveen Gangadharan u32 wait, 3102d0ff7383SNaveen Gangadharan const u8 *buf, 3103d0ff7383SNaveen Gangadharan size_t len, 3104d0ff7383SNaveen Gangadharan bool *more_data, 3105d0ff7383SNaveen Gangadharan bool no_cck) 3106d0ff7383SNaveen Gangadharan { 3107d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3108d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3109d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3110d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3111d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3112d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3113d0ff7383SNaveen Gangadharan 3114d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3115d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3116d0ff7383SNaveen Gangadharan return false; 3117d0ff7383SNaveen Gangadharan 3118d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3119d0ff7383SNaveen Gangadharan if (!conn) 3120d0ff7383SNaveen Gangadharan return false; 3121d0ff7383SNaveen Gangadharan 3122d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3123d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3124d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3125d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3126d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3127d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3128d0ff7383SNaveen Gangadharan return false; 3129d0ff7383SNaveen Gangadharan 3130d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3131d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3132d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3133d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3134d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3135d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3136d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3137d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3138d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3139d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3140d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3141d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3142d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3143d0ff7383SNaveen Gangadharan 3144d0ff7383SNaveen Gangadharan /* 3145d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3146d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3147d0ff7383SNaveen Gangadharan * STA. 3148d0ff7383SNaveen Gangadharan */ 3149d0ff7383SNaveen Gangadharan if (is_psq_empty) 3150d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3151d0ff7383SNaveen Gangadharan conn->aid, 1); 3152d0ff7383SNaveen Gangadharan return true; 3153d0ff7383SNaveen Gangadharan } 3154d0ff7383SNaveen Gangadharan 3155d0ff7383SNaveen Gangadharan /* 3156d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3157d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3158d0ff7383SNaveen Gangadharan */ 3159d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3160d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3161d0ff7383SNaveen Gangadharan *more_data = true; 3162d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3163d0ff7383SNaveen Gangadharan } 3164d0ff7383SNaveen Gangadharan 3165d0ff7383SNaveen Gangadharan return false; 3166d0ff7383SNaveen Gangadharan } 3167d0ff7383SNaveen Gangadharan 3168c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3169c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3170c86e4f44SAarthi Thiruvengadam { 3171c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3172c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3173c86e4f44SAarthi Thiruvengadam 3174c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3175c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3176c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3177c86e4f44SAarthi Thiruvengadam return true; 3178c86e4f44SAarthi Thiruvengadam } 3179c86e4f44SAarthi Thiruvengadam 3180c86e4f44SAarthi Thiruvengadam return false; 3181c86e4f44SAarthi Thiruvengadam } 3182c86e4f44SAarthi Thiruvengadam 318371bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 3184b176e629SAndrei Otcheretianski struct cfg80211_mgmt_tx_params *params, u64 *cookie) 31858a6c8060SJouni Malinen { 318671bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 318771bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 3188b176e629SAndrei Otcheretianski struct ieee80211_channel *chan = params->chan; 3189b176e629SAndrei Otcheretianski const u8 *buf = params->buf; 3190b176e629SAndrei Otcheretianski size_t len = params->len; 3191b176e629SAndrei Otcheretianski unsigned int wait = params->wait; 3192b176e629SAndrei Otcheretianski bool no_cck = params->no_cck; 3193bfd634d0SAntonio Quartulli u32 id, freq; 31948bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3195d0ff7383SNaveen Gangadharan bool more_data, queued; 31968bdfbf40SJouni Malinen 3197bfd634d0SAntonio Quartulli /* default to the current channel, but use the one specified as argument 3198bfd634d0SAntonio Quartulli * if any 3199bfd634d0SAntonio Quartulli */ 3200bfd634d0SAntonio Quartulli freq = vif->ch_hint; 3201bfd634d0SAntonio Quartulli if (chan) 3202bfd634d0SAntonio Quartulli freq = chan->center_freq; 3203bfd634d0SAntonio Quartulli 3204bfd634d0SAntonio Quartulli /* never send freq zero to the firmware */ 3205bfd634d0SAntonio Quartulli if (WARN_ON(freq == 0)) 3206bfd634d0SAntonio Quartulli return -EINVAL; 3207bfd634d0SAntonio Quartulli 32088bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3209c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3210c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3211c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 32128bdfbf40SJouni Malinen /* 3213c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 32148bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 32158bdfbf40SJouni Malinen */ 32168bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3217bfd634d0SAntonio Quartulli return ath6kl_send_go_probe_resp(vif, buf, len, freq); 32188bdfbf40SJouni Malinen } 32198a6c8060SJouni Malinen 3220cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32218a6c8060SJouni Malinen if (id == 0) { 32228a6c8060SJouni Malinen /* 32238a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 32248a6c8060SJouni Malinen * used for the command. 32258a6c8060SJouni Malinen */ 3226cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32278a6c8060SJouni Malinen } 32288a6c8060SJouni Malinen 32298a6c8060SJouni Malinen *cookie = id; 32303ca9d1fcSAarthi Thiruvengadam 3231d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3232d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3233bfd634d0SAntonio Quartulli queued = ath6kl_mgmt_powersave_ap(vif, id, freq, wait, buf, len, 3234bfd634d0SAntonio Quartulli &more_data, no_cck); 3235d0ff7383SNaveen Gangadharan if (queued) 3236d0ff7383SNaveen Gangadharan return 0; 3237d0ff7383SNaveen Gangadharan } 3238d0ff7383SNaveen Gangadharan 3239bfd634d0SAntonio Quartulli return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, freq, 3240bfd634d0SAntonio Quartulli wait, buf, len, no_cck); 32413ca9d1fcSAarthi Thiruvengadam } 32428a6c8060SJouni Malinen 32439c2e90ffSBen Greear static int ath6kl_get_antenna(struct wiphy *wiphy, 32449c2e90ffSBen Greear u32 *tx_ant, u32 *rx_ant) 32459c2e90ffSBen Greear { 32469c2e90ffSBen Greear struct ath6kl *ar = wiphy_priv(wiphy); 32479c2e90ffSBen Greear *tx_ant = ar->hw.tx_ant; 32489c2e90ffSBen Greear *rx_ant = ar->hw.rx_ant; 32499c2e90ffSBen Greear return 0; 32509c2e90ffSBen Greear } 32519c2e90ffSBen Greear 3252ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 325371bbc994SJohannes Berg struct wireless_dev *wdev, 3254ae32c30aSJouni Malinen u16 frame_type, bool reg) 3255ae32c30aSJouni Malinen { 325671bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 3257ae32c30aSJouni Malinen 3258ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3259ae32c30aSJouni Malinen __func__, frame_type, reg); 3260ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3261ae32c30aSJouni Malinen /* 3262ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3263ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3264ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3265ae32c30aSJouni Malinen */ 3266cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3267ae32c30aSJouni Malinen } 3268ae32c30aSJouni Malinen } 3269ae32c30aSJouni Malinen 327010509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 327110509f90SKalle Valo struct net_device *dev, 327210509f90SKalle Valo struct cfg80211_sched_scan_request *request) 327310509f90SKalle Valo { 327410509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 327510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 327610509f90SKalle Valo u16 interval; 327785b20fc2SThomas Pedersen int ret, rssi_thold; 3278ea73cbceSJohannes Berg int n_match_sets = request->n_match_sets; 3279ea73cbceSJohannes Berg 3280ea73cbceSJohannes Berg /* 3281ea73cbceSJohannes Berg * If there's a matchset w/o an SSID, then assume it's just for 3282ea73cbceSJohannes Berg * the RSSI (nothing else is currently supported) and ignore it. 3283ea73cbceSJohannes Berg * The device only supports a global RSSI filter that we set below. 3284ea73cbceSJohannes Berg */ 3285ea73cbceSJohannes Berg if (n_match_sets == 1 && !request->match_sets[0].ssid.ssid_len) 3286ea73cbceSJohannes Berg n_match_sets = 0; 328710509f90SKalle Valo 328810509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 328910509f90SKalle Valo return -EIO; 329010509f90SKalle Valo 329110509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 329210509f90SKalle Valo return -EBUSY; 329310509f90SKalle Valo 3294b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3295b4d13d3bSKalle Valo 32963b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3297dd45b759SNaveen Singh request->n_ssids, 3298dd45b759SNaveen Singh request->match_sets, 3299ea73cbceSJohannes Berg n_match_sets); 33003b8ffc6aSJouni Malinen if (ret < 0) 33013b8ffc6aSJouni Malinen return ret; 330210509f90SKalle Valo 3303ea73cbceSJohannes Berg if (!n_match_sets) { 3304dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3305dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3306dd45b759SNaveen Singh if (ret < 0) 3307dd45b759SNaveen Singh return ret; 3308dd45b759SNaveen Singh } else { 3309dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3310dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3311dd45b759SNaveen Singh if (ret < 0) 3312dd45b759SNaveen Singh return ret; 3313dd45b759SNaveen Singh } 3314dd45b759SNaveen Singh 331585b20fc2SThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD, 331685b20fc2SThomas Pedersen ar->fw_capabilities)) { 3317ea73cbceSJohannes Berg if (request->min_rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF) 331885b20fc2SThomas Pedersen rssi_thold = 0; 3319ea73cbceSJohannes Berg else if (request->min_rssi_thold < -127) 332085b20fc2SThomas Pedersen rssi_thold = -127; 332185b20fc2SThomas Pedersen else 3322ea73cbceSJohannes Berg rssi_thold = request->min_rssi_thold; 332385b20fc2SThomas Pedersen 332485b20fc2SThomas Pedersen ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx, 332585b20fc2SThomas Pedersen rssi_thold); 332685b20fc2SThomas Pedersen if (ret) { 332785b20fc2SThomas Pedersen ath6kl_err("failed to set RSSI threshold for scan\n"); 332885b20fc2SThomas Pedersen return ret; 332985b20fc2SThomas Pedersen } 333085b20fc2SThomas Pedersen } 333185b20fc2SThomas Pedersen 333210509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 33333b06d277SAvraham Stern interval = max_t(u16, 1, request->scan_plans[0].interval); 333410509f90SKalle Valo 333510509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 333610509f90SKalle Valo interval, interval, 3337d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 333810509f90SKalle Valo 333910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 334010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 334110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 334210509f90SKalle Valo request->ie, request->ie_len); 334310509f90SKalle Valo if (ret) { 3344f1ff32e8SJoe Perches ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n", 334510509f90SKalle Valo ret); 334610509f90SKalle Valo return ret; 334710509f90SKalle Valo } 334810509f90SKalle Valo 3349b1f47e3aSThomas Pedersen ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true); 3350b1f47e3aSThomas Pedersen if (ret) 335110509f90SKalle Valo return ret; 335210509f90SKalle Valo 3353b1f47e3aSThomas Pedersen set_bit(SCHED_SCANNING, &vif->flags); 335410509f90SKalle Valo 3355b1f47e3aSThomas Pedersen return 0; 335610509f90SKalle Valo } 335710509f90SKalle Valo 335810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 33593a3ecf1dSArend Van Spriel struct net_device *dev, u64 reqid) 336010509f90SKalle Valo { 336110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 336210509f90SKalle Valo bool stopped; 336310509f90SKalle Valo 336410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 336510509f90SKalle Valo 336610509f90SKalle Valo if (!stopped) 336710509f90SKalle Valo return -EIO; 336810509f90SKalle Valo 336910509f90SKalle Valo return 0; 337010509f90SKalle Valo } 337110509f90SKalle Valo 337206e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy, 337306e360acSBala Shanmugam struct net_device *dev, 337406e360acSBala Shanmugam const u8 *addr, 337506e360acSBala Shanmugam const struct cfg80211_bitrate_mask *mask) 337606e360acSBala Shanmugam { 337706e360acSBala Shanmugam struct ath6kl *ar = ath6kl_priv(dev); 337806e360acSBala Shanmugam struct ath6kl_vif *vif = netdev_priv(dev); 337906e360acSBala Shanmugam 338006e360acSBala Shanmugam return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx, 338106e360acSBala Shanmugam mask); 338206e360acSBala Shanmugam } 338306e360acSBala Shanmugam 3384279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy, 3385279b2862SThomas Pedersen struct net_device *dev, 3386279b2862SThomas Pedersen u32 rate, u32 pkts, u32 intvl) 3387279b2862SThomas Pedersen { 3388279b2862SThomas Pedersen struct ath6kl *ar = ath6kl_priv(dev); 3389279b2862SThomas Pedersen struct ath6kl_vif *vif = netdev_priv(dev); 3390279b2862SThomas Pedersen 3391279b2862SThomas Pedersen if (vif->nw_type != INFRA_NETWORK || 3392279b2862SThomas Pedersen !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities)) 3393279b2862SThomas Pedersen return -EOPNOTSUPP; 3394279b2862SThomas Pedersen 3395279b2862SThomas Pedersen if (vif->sme_state != SME_CONNECTED) 3396279b2862SThomas Pedersen return -ENOTCONN; 3397279b2862SThomas Pedersen 3398279b2862SThomas Pedersen /* save this since the firmware won't report the interval */ 3399279b2862SThomas Pedersen vif->txe_intvl = intvl; 3400279b2862SThomas Pedersen 3401279b2862SThomas Pedersen return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx, 3402279b2862SThomas Pedersen rate, pkts, intvl); 3403279b2862SThomas Pedersen } 3404279b2862SThomas Pedersen 3405f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3406f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3407f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3408f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3409f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3410f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3411f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3412f80574aeSJouni Malinen }, 3413ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3414ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3415ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3416ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3417ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3418ba1f6fe3SJouni Malinen }, 3419f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3420f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3421f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3422f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3423f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3424f80574aeSJouni Malinen }, 3425f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3426f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3427f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3428f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3429f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3430f80574aeSJouni Malinen }, 3431f80574aeSJouni Malinen }; 3432f80574aeSJouni Malinen 3433bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 343455055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 343555055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3436bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3437bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3438bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3439bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3440bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3441bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3442bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3443bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3444bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3445bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3446bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3447bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3448bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3449bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3450bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3451bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3452bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3453bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3454003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3455abcb344bSKalle Valo #ifdef CONFIG_PM 345652d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 345752d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3458abcb344bSKalle Valo #endif 34598860020eSJohannes Berg .start_ap = ath6kl_start_ap, 34608860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 34618860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 346233e5308dSJouni Malinen .del_station = ath6kl_del_station, 346323875136SJouni Malinen .change_station = ath6kl_change_station, 346463fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 346563fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 34668a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3467ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 34689c2e90ffSBen Greear .get_antenna = ath6kl_get_antenna, 346910509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 347010509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 347106e360acSBala Shanmugam .set_bitrate_mask = ath6kl_cfg80211_set_bitrate, 3472279b2862SThomas Pedersen .set_cqm_txe_config = ath6kl_cfg80211_set_txe_config, 3473bdcd8170SKalle Valo }; 3474bdcd8170SKalle Valo 34757125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3476ec4b7f60SKalle Valo { 347710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 347810509f90SKalle Valo 3479ec4b7f60SKalle Valo switch (vif->sme_state) { 3480c97a31b0SKalle Valo case SME_DISCONNECTED: 3481c97a31b0SKalle Valo break; 3482ec4b7f60SKalle Valo case SME_CONNECTING: 3483ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3484ec4b7f60SKalle Valo NULL, 0, 3485ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3486ec4b7f60SKalle Valo GFP_KERNEL); 3487ec4b7f60SKalle Valo break; 3488ec4b7f60SKalle Valo case SME_CONNECTED: 348980279fb7SJohannes Berg cfg80211_disconnected(vif->ndev, 0, NULL, 0, true, GFP_KERNEL); 3490ec4b7f60SKalle Valo break; 3491ec4b7f60SKalle Valo } 3492ec4b7f60SKalle Valo 349358109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 349458109df6SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) || 349558109df6SVasanthakumar Thiagarajan test_bit(CONNECT_PEND, &vif->flags))) 34967125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3497ec4b7f60SKalle Valo 3498ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34991f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 35001f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3501ec4b7f60SKalle Valo 350284caf800SVasanthakumar Thiagarajan /* Stop netdev queues, needed during recovery */ 350384caf800SVasanthakumar Thiagarajan netif_stop_queue(vif->ndev); 350484caf800SVasanthakumar Thiagarajan netif_carrier_off(vif->ndev); 350584caf800SVasanthakumar Thiagarajan 3506ec4b7f60SKalle Valo /* disable scanning */ 350758109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 350858109df6SVasanthakumar Thiagarajan ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 35097125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 35107125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3511ec4b7f60SKalle Valo 3512ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3513ec4b7f60SKalle Valo } 3514ec4b7f60SKalle Valo 35157125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 35167125f01dSKalle Valo { 35177125f01dSKalle Valo struct ath6kl_vif *vif; 35187125f01dSKalle Valo 35197125f01dSKalle Valo vif = ath6kl_vif_first(ar); 352084caf800SVasanthakumar Thiagarajan if (!vif && ar->state != ATH6KL_STATE_RECOVERY) { 35217125f01dSKalle Valo /* save the current power mode before enabling power save */ 35227125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 35237125f01dSKalle Valo 35247125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3525cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 35267125f01dSKalle Valo return; 35277125f01dSKalle Valo } 35287125f01dSKalle Valo 35297125f01dSKalle Valo /* 35307125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 35317125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 35327125f01dSKalle Valo * sleeps. 35337125f01dSKalle Valo */ 35347125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 35357125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 35367125f01dSKalle Valo } 35377125f01dSKalle Valo 35380c0280bdSLuis R. Rodriguez static void ath6kl_cfg80211_reg_notify(struct wiphy *wiphy, 353984841ba2SKalle Valo struct regulatory_request *request) 354084841ba2SKalle Valo { 354184841ba2SKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 354257fbcce3SJohannes Berg u32 rates[NUM_NL80211_BANDS]; 354384841ba2SKalle Valo int ret, i; 354484841ba2SKalle Valo 354584841ba2SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 3546ff7e6867SKalle Valo "cfg reg_notify %c%c%s%s initiator %d hint_type %d\n", 354784841ba2SKalle Valo request->alpha2[0], request->alpha2[1], 354884841ba2SKalle Valo request->intersect ? " intersect" : "", 354984841ba2SKalle Valo request->processed ? " processed" : "", 3550ff7e6867SKalle Valo request->initiator, request->user_reg_hint_type); 3551ff7e6867SKalle Valo 3552ff7e6867SKalle Valo if (request->user_reg_hint_type != NL80211_USER_REG_HINT_CELL_BASE) 35530c0280bdSLuis R. Rodriguez return; 355484841ba2SKalle Valo 355584841ba2SKalle Valo ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2); 355684841ba2SKalle Valo if (ret) { 355784841ba2SKalle Valo ath6kl_err("failed to set regdomain: %d\n", ret); 35580c0280bdSLuis R. Rodriguez return; 355984841ba2SKalle Valo } 356084841ba2SKalle Valo 356184841ba2SKalle Valo /* 356284841ba2SKalle Valo * Firmware will apply the regdomain change only after a scan is 356384841ba2SKalle Valo * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been 356484841ba2SKalle Valo * changed. 356584841ba2SKalle Valo */ 356684841ba2SKalle Valo 356757fbcce3SJohannes Berg for (i = 0; i < NUM_NL80211_BANDS; i++) 356884841ba2SKalle Valo if (wiphy->bands[i]) 356984841ba2SKalle Valo rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1; 357084841ba2SKalle Valo 357184841ba2SKalle Valo 357284841ba2SKalle Valo ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false, 357384841ba2SKalle Valo false, 0, ATH6KL_FG_SCAN_INTERVAL, 357484841ba2SKalle Valo 0, NULL, false, rates); 357584841ba2SKalle Valo if (ret) { 357684841ba2SKalle Valo ath6kl_err("failed to start scan for a regdomain change: %d\n", 357784841ba2SKalle Valo ret); 35780c0280bdSLuis R. Rodriguez return; 357984841ba2SKalle Valo } 358084841ba2SKalle Valo } 358184841ba2SKalle Valo 3582c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 35838dafb70eSVasanthakumar Thiagarajan { 35847baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 35852132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 35868dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 35878dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 35888dafb70eSVasanthakumar Thiagarajan } 35898dafb70eSVasanthakumar Thiagarajan 35907ac76764SKees Cook timer_setup(&vif->disconnect_timer, disconnect_timer_handler, 0); 35917ac76764SKees Cook timer_setup(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 0); 359210509f90SKalle Valo 3593de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3594478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 35958dafb70eSVasanthakumar Thiagarajan 359680abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 359780abaf9bSVasanthakumar Thiagarajan 35988dafb70eSVasanthakumar Thiagarajan return 0; 35998dafb70eSVasanthakumar Thiagarajan } 36008dafb70eSVasanthakumar Thiagarajan 3601355b3a98SMohammed Shafi Shajakhan void ath6kl_cfg80211_vif_stop(struct ath6kl_vif *vif, bool wmi_ready) 3602355b3a98SMohammed Shafi Shajakhan { 3603355b3a98SMohammed Shafi Shajakhan static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; 3604355b3a98SMohammed Shafi Shajakhan bool discon_issued; 3605355b3a98SMohammed Shafi Shajakhan 3606355b3a98SMohammed Shafi Shajakhan netif_stop_queue(vif->ndev); 3607355b3a98SMohammed Shafi Shajakhan 3608355b3a98SMohammed Shafi Shajakhan clear_bit(WLAN_ENABLED, &vif->flags); 3609355b3a98SMohammed Shafi Shajakhan 3610355b3a98SMohammed Shafi Shajakhan if (wmi_ready) { 3611355b3a98SMohammed Shafi Shajakhan discon_issued = test_bit(CONNECTED, &vif->flags) || 3612355b3a98SMohammed Shafi Shajakhan test_bit(CONNECT_PEND, &vif->flags); 3613355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect(vif); 3614355b3a98SMohammed Shafi Shajakhan del_timer(&vif->disconnect_timer); 3615355b3a98SMohammed Shafi Shajakhan 3616355b3a98SMohammed Shafi Shajakhan if (discon_issued) 3617355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect_event(vif, DISCONNECT_CMD, 3618355b3a98SMohammed Shafi Shajakhan (vif->nw_type & AP_NETWORK) ? 3619355b3a98SMohammed Shafi Shajakhan bcast_mac : vif->bssid, 3620355b3a98SMohammed Shafi Shajakhan 0, NULL, 0); 3621355b3a98SMohammed Shafi Shajakhan } 3622355b3a98SMohammed Shafi Shajakhan 3623355b3a98SMohammed Shafi Shajakhan if (vif->scan_req) { 36241d76250bSAvraham Stern struct cfg80211_scan_info info = { 36251d76250bSAvraham Stern .aborted = true, 36261d76250bSAvraham Stern }; 36271d76250bSAvraham Stern 36281d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 3629355b3a98SMohammed Shafi Shajakhan vif->scan_req = NULL; 3630355b3a98SMohammed Shafi Shajakhan } 3631355b3a98SMohammed Shafi Shajakhan 3632355b3a98SMohammed Shafi Shajakhan /* need to clean up enhanced bmiss detection fw state */ 3633355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 3634355b3a98SMohammed Shafi Shajakhan } 3635355b3a98SMohammed Shafi Shajakhan 3636c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 36378dafb70eSVasanthakumar Thiagarajan { 363855055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 363980abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 364055055976SVasanthakumar Thiagarajan 36412132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3642108438bcSVasanthakumar Thiagarajan 364355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 364455055976SVasanthakumar Thiagarajan 364555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 364655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 364755055976SVasanthakumar Thiagarajan 364880abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 364980abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 365080abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 365180abaf9bSVasanthakumar Thiagarajan } 365280abaf9bSVasanthakumar Thiagarajan 365327929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 365455055976SVasanthakumar Thiagarajan 365555055976SVasanthakumar Thiagarajan ar->num_vif--; 36568dafb70eSVasanthakumar Thiagarajan } 36578dafb70eSVasanthakumar Thiagarajan 365813eff531SBen Greear static const char ath6kl_gstrings_sta_stats[][ETH_GSTRING_LEN] = { 365913eff531SBen Greear /* Common stats names used by many drivers. */ 366013eff531SBen Greear "tx_pkts_nic", "tx_bytes_nic", "rx_pkts_nic", "rx_bytes_nic", 366113eff531SBen Greear 366213eff531SBen Greear /* TX stats. */ 366313eff531SBen Greear "d_tx_ucast_pkts", "d_tx_bcast_pkts", 366413eff531SBen Greear "d_tx_ucast_bytes", "d_tx_bcast_bytes", 366513eff531SBen Greear "d_tx_rts_ok", "d_tx_error", "d_tx_fail", 366613eff531SBen Greear "d_tx_retry", "d_tx_multi_retry", "d_tx_rts_fail", 366713eff531SBen Greear "d_tx_tkip_counter_measures", 366813eff531SBen Greear 366913eff531SBen Greear /* RX Stats. */ 367013eff531SBen Greear "d_rx_ucast_pkts", "d_rx_ucast_rate", "d_rx_bcast_pkts", 367113eff531SBen Greear "d_rx_ucast_bytes", "d_rx_bcast_bytes", "d_rx_frag_pkt", 367213eff531SBen Greear "d_rx_error", "d_rx_crc_err", "d_rx_keycache_miss", 367313eff531SBen Greear "d_rx_decrypt_crc_err", "d_rx_duplicate_frames", 367413eff531SBen Greear "d_rx_mic_err", "d_rx_tkip_format_err", "d_rx_ccmp_format_err", 367513eff531SBen Greear "d_rx_ccmp_replay_err", 367613eff531SBen Greear 367713eff531SBen Greear /* Misc stats. */ 367813eff531SBen Greear "d_beacon_miss", "d_num_connects", "d_num_disconnects", 367913eff531SBen Greear "d_beacon_avg_rssi", "d_arp_received", "d_arp_matched", 368013eff531SBen Greear "d_arp_replied" 368113eff531SBen Greear }; 368213eff531SBen Greear 368313eff531SBen Greear #define ATH6KL_STATS_LEN ARRAY_SIZE(ath6kl_gstrings_sta_stats) 368413eff531SBen Greear 368513eff531SBen Greear static int ath6kl_get_sset_count(struct net_device *dev, int sset) 368613eff531SBen Greear { 368713eff531SBen Greear int rv = 0; 368813eff531SBen Greear 368913eff531SBen Greear if (sset == ETH_SS_STATS) 369013eff531SBen Greear rv += ATH6KL_STATS_LEN; 369113eff531SBen Greear 369213eff531SBen Greear if (rv == 0) 369313eff531SBen Greear return -EOPNOTSUPP; 369413eff531SBen Greear return rv; 369513eff531SBen Greear } 369613eff531SBen Greear 369713eff531SBen Greear static void ath6kl_get_stats(struct net_device *dev, 369813eff531SBen Greear struct ethtool_stats *stats, 369913eff531SBen Greear u64 *data) 370013eff531SBen Greear { 370113eff531SBen Greear struct ath6kl_vif *vif = netdev_priv(dev); 370213eff531SBen Greear struct ath6kl *ar = vif->ar; 370313eff531SBen Greear int i = 0; 370413eff531SBen Greear struct target_stats *tgt_stats; 370513eff531SBen Greear 370613eff531SBen Greear memset(data, 0, sizeof(u64) * ATH6KL_STATS_LEN); 370713eff531SBen Greear 370813eff531SBen Greear ath6kl_read_tgt_stats(ar, vif); 370913eff531SBen Greear 371013eff531SBen Greear tgt_stats = &vif->target_stats; 371113eff531SBen Greear 371213eff531SBen Greear data[i++] = tgt_stats->tx_ucast_pkt + tgt_stats->tx_bcast_pkt; 371313eff531SBen Greear data[i++] = tgt_stats->tx_ucast_byte + tgt_stats->tx_bcast_byte; 371413eff531SBen Greear data[i++] = tgt_stats->rx_ucast_pkt + tgt_stats->rx_bcast_pkt; 371513eff531SBen Greear data[i++] = tgt_stats->rx_ucast_byte + tgt_stats->rx_bcast_byte; 371613eff531SBen Greear 371713eff531SBen Greear data[i++] = tgt_stats->tx_ucast_pkt; 371813eff531SBen Greear data[i++] = tgt_stats->tx_bcast_pkt; 371913eff531SBen Greear data[i++] = tgt_stats->tx_ucast_byte; 372013eff531SBen Greear data[i++] = tgt_stats->tx_bcast_byte; 372113eff531SBen Greear data[i++] = tgt_stats->tx_rts_success_cnt; 372213eff531SBen Greear data[i++] = tgt_stats->tx_err; 372313eff531SBen Greear data[i++] = tgt_stats->tx_fail_cnt; 372413eff531SBen Greear data[i++] = tgt_stats->tx_retry_cnt; 372513eff531SBen Greear data[i++] = tgt_stats->tx_mult_retry_cnt; 372613eff531SBen Greear data[i++] = tgt_stats->tx_rts_fail_cnt; 372713eff531SBen Greear data[i++] = tgt_stats->tkip_cnter_measures_invoked; 372813eff531SBen Greear 372913eff531SBen Greear data[i++] = tgt_stats->rx_ucast_pkt; 373013eff531SBen Greear data[i++] = tgt_stats->rx_ucast_rate; 373113eff531SBen Greear data[i++] = tgt_stats->rx_bcast_pkt; 373213eff531SBen Greear data[i++] = tgt_stats->rx_ucast_byte; 373313eff531SBen Greear data[i++] = tgt_stats->rx_bcast_byte; 373413eff531SBen Greear data[i++] = tgt_stats->rx_frgment_pkt; 373513eff531SBen Greear data[i++] = tgt_stats->rx_err; 373613eff531SBen Greear data[i++] = tgt_stats->rx_crc_err; 373713eff531SBen Greear data[i++] = tgt_stats->rx_key_cache_miss; 373813eff531SBen Greear data[i++] = tgt_stats->rx_decrypt_err; 373913eff531SBen Greear data[i++] = tgt_stats->rx_dupl_frame; 374013eff531SBen Greear data[i++] = tgt_stats->tkip_local_mic_fail; 374113eff531SBen Greear data[i++] = tgt_stats->tkip_fmt_err; 374213eff531SBen Greear data[i++] = tgt_stats->ccmp_fmt_err; 374313eff531SBen Greear data[i++] = tgt_stats->ccmp_replays; 374413eff531SBen Greear 374513eff531SBen Greear data[i++] = tgt_stats->cs_bmiss_cnt; 374613eff531SBen Greear data[i++] = tgt_stats->cs_connect_cnt; 374713eff531SBen Greear data[i++] = tgt_stats->cs_discon_cnt; 374813eff531SBen Greear data[i++] = tgt_stats->cs_ave_beacon_rssi; 374913eff531SBen Greear data[i++] = tgt_stats->arp_received; 375013eff531SBen Greear data[i++] = tgt_stats->arp_matched; 375113eff531SBen Greear data[i++] = tgt_stats->arp_replied; 375213eff531SBen Greear 375313eff531SBen Greear if (i != ATH6KL_STATS_LEN) { 375413eff531SBen Greear WARN_ON_ONCE(1); 375513eff531SBen Greear ath6kl_err("ethtool stats error, i: %d STATS_LEN: %d\n", 375613eff531SBen Greear i, (int)ATH6KL_STATS_LEN); 375713eff531SBen Greear } 375813eff531SBen Greear } 375913eff531SBen Greear 376013eff531SBen Greear /* These stats are per NIC, not really per vdev, so we just ignore dev. */ 376113eff531SBen Greear static void ath6kl_get_strings(struct net_device *dev, u32 sset, u8 *data) 376213eff531SBen Greear { 376313eff531SBen Greear int sz_sta_stats = 0; 376413eff531SBen Greear 376513eff531SBen Greear if (sset == ETH_SS_STATS) { 376613eff531SBen Greear sz_sta_stats = sizeof(ath6kl_gstrings_sta_stats); 376713eff531SBen Greear memcpy(data, ath6kl_gstrings_sta_stats, sz_sta_stats); 376813eff531SBen Greear } 376913eff531SBen Greear } 377013eff531SBen Greear 377113eff531SBen Greear static const struct ethtool_ops ath6kl_ethtool_ops = { 377213eff531SBen Greear .get_drvinfo = cfg80211_get_drvinfo, 377313eff531SBen Greear .get_link = ethtool_op_get_link, 377413eff531SBen Greear .get_strings = ath6kl_get_strings, 377513eff531SBen Greear .get_ethtool_stats = ath6kl_get_stats, 377613eff531SBen Greear .get_sset_count = ath6kl_get_sset_count, 377713eff531SBen Greear }; 377813eff531SBen Greear 3779552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name, 37806bab2e19STom Gundersen unsigned char name_assign_type, 378184efbb84SJohannes Berg enum nl80211_iftype type, 378284efbb84SJohannes Berg u8 fw_vif_idx, u8 nw_type) 37838dafb70eSVasanthakumar Thiagarajan { 37848dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3785108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 37868dafb70eSVasanthakumar Thiagarajan 37876bab2e19STom Gundersen ndev = alloc_netdev(sizeof(*vif), name, name_assign_type, ether_setup); 37888dafb70eSVasanthakumar Thiagarajan if (!ndev) 37898dafb70eSVasanthakumar Thiagarajan return NULL; 37908dafb70eSVasanthakumar Thiagarajan 3791108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3792108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3793108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3794108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3795108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3796108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3797108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3798108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3799334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3800d0d670abSKalle Valo vif->nw_type = nw_type; 3801d0d670abSKalle Valo vif->next_mode = nw_type; 38028f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3803ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3804eb38987eSRaja Mani vif->bg_scan_period = 0; 380557fbcce3SJohannes Berg vif->htcap[NL80211_BAND_2GHZ].ht_enable = true; 380657fbcce3SJohannes Berg vif->htcap[NL80211_BAND_5GHZ].ht_enable = true; 38078dafb70eSVasanthakumar Thiagarajan 380855055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3809c95dcb59SAarthi Thiruvengadam if (fw_vif_idx != 0) { 381055055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 381155055976SVasanthakumar Thiagarajan 0x2; 3812c95dcb59SAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR, 3813c95dcb59SAarthi Thiruvengadam ar->fw_capabilities)) 3814c95dcb59SAarthi Thiruvengadam ndev->dev_addr[4] ^= 0x80; 3815c95dcb59SAarthi Thiruvengadam } 381655055976SVasanthakumar Thiagarajan 38178dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 38188dafb70eSVasanthakumar Thiagarajan 3819e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 38208dafb70eSVasanthakumar Thiagarajan 3821c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 38228dafb70eSVasanthakumar Thiagarajan goto err; 38238dafb70eSVasanthakumar Thiagarajan 382413eff531SBen Greear netdev_set_default_ethtool_ops(ndev, &ath6kl_ethtool_ops); 382513eff531SBen Greear 382627929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 38278dafb70eSVasanthakumar Thiagarajan goto err; 38288dafb70eSVasanthakumar Thiagarajan 382955055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 383014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 383159c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 38328dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 38338dafb70eSVasanthakumar Thiagarajan 383455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 383555055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 383655055976SVasanthakumar Thiagarajan 383711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3838990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 383911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3840990bd915SVasanthakumar Thiagarajan 384184efbb84SJohannes Berg return &vif->wdev; 38428dafb70eSVasanthakumar Thiagarajan 38438dafb70eSVasanthakumar Thiagarajan err: 384427929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 384527929723SVasanthakumar Thiagarajan free_netdev(ndev); 3846bdcd8170SKalle Valo return NULL; 3847bdcd8170SKalle Valo } 3848bdcd8170SKalle Valo 3849964dc9e2SJohannes Berg #ifdef CONFIG_PM 3850964dc9e2SJohannes Berg static const struct wiphy_wowlan_support ath6kl_wowlan_support = { 3851964dc9e2SJohannes Berg .flags = WIPHY_WOWLAN_MAGIC_PKT | 3852964dc9e2SJohannes Berg WIPHY_WOWLAN_DISCONNECT | 3853964dc9e2SJohannes Berg WIPHY_WOWLAN_GTK_REKEY_FAILURE | 3854964dc9e2SJohannes Berg WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 3855964dc9e2SJohannes Berg WIPHY_WOWLAN_EAP_IDENTITY_REQ | 3856964dc9e2SJohannes Berg WIPHY_WOWLAN_4WAY_HANDSHAKE, 3857964dc9e2SJohannes Berg .n_patterns = WOW_MAX_FILTERS_PER_LIST, 3858964dc9e2SJohannes Berg .pattern_min_len = 1, 3859964dc9e2SJohannes Berg .pattern_max_len = WOW_PATTERN_SIZE, 3860964dc9e2SJohannes Berg }; 3861964dc9e2SJohannes Berg #endif 3862964dc9e2SJohannes Berg 386346d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 386446d33a21SKalle Valo { 386546d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3866d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 386746d33a21SKalle Valo int ret; 386846d33a21SKalle Valo 386946d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 387046d33a21SKalle Valo 387146d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 387246d33a21SKalle Valo 387346d33a21SKalle Valo /* set device pointer for wiphy */ 387446d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 387546d33a21SKalle Valo 387646d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 387746d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 387846d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 387946d33a21SKalle Valo if (ar->p2p) { 388046d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 388146d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 388246d33a21SKalle Valo } 388346d33a21SKalle Valo 388497f2645fSMasahiro Yamada if (IS_ENABLED(CONFIG_ATH6KL_REGDOMAIN) && 3885ff7e6867SKalle Valo test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) { 388684841ba2SKalle Valo wiphy->reg_notifier = ath6kl_cfg80211_reg_notify; 3887ff7e6867SKalle Valo ar->wiphy->features |= NL80211_FEATURE_CELL_BASE_REG_HINTS; 3888ff7e6867SKalle Valo } 388984841ba2SKalle Valo 389046d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 38918ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3892dd45b759SNaveen Singh 3893dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3894dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3895dd45b759SNaveen Singh ar->fw_capabilities)) 3896dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3897dd45b759SNaveen Singh 389846d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3899d92917e4SThomas Pedersen switch (ar->hw.cap) { 3900d92917e4SThomas Pedersen case WMI_11AN_CAP: 3901d92917e4SThomas Pedersen ht = true; 39024de30c90SGustavo A. R. Silva /* fall through */ 3903d92917e4SThomas Pedersen case WMI_11A_CAP: 3904d92917e4SThomas Pedersen band_5gig = true; 3905d92917e4SThomas Pedersen break; 3906d92917e4SThomas Pedersen case WMI_11GN_CAP: 3907d92917e4SThomas Pedersen ht = true; 39084de30c90SGustavo A. R. Silva /* fall through */ 3909d92917e4SThomas Pedersen case WMI_11G_CAP: 3910d92917e4SThomas Pedersen band_2gig = true; 3911d92917e4SThomas Pedersen break; 3912d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3913d92917e4SThomas Pedersen ht = true; 39144de30c90SGustavo A. R. Silva /* fall through */ 3915d92917e4SThomas Pedersen case WMI_11AG_CAP: 3916d92917e4SThomas Pedersen band_2gig = true; 3917d92917e4SThomas Pedersen band_5gig = true; 3918d92917e4SThomas Pedersen break; 3919d92917e4SThomas Pedersen default: 3920d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3921d92917e4SThomas Pedersen return -EINVAL; 3922d92917e4SThomas Pedersen } 3923d92917e4SThomas Pedersen 39247fd1ce7eSVasanthakumar Thiagarajan /* 39257fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 39267fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 39277fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 39287fd1ce7eSVasanthakumar Thiagarajan */ 39297fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 39307fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 39317fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3932d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3933d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3934d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3935d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 39367fd98524SBen Greear 39377fd98524SBen Greear if (ht) 39387fd98524SBen Greear ath6kl_err("Firmware lacks RSN-CAP-OVERRIDE, so HT (802.11n) is disabled."); 3939d92917e4SThomas Pedersen } 394006e360acSBala Shanmugam 3941eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_64BIT_RATES, 3942eba95bceSKalle Valo ar->fw_capabilities)) { 394306e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 394406e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 394506e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff; 394606e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff; 394726ca14d4SBen Greear ar->hw.tx_ant = 0x3; /* mask, 2 antenna */ 394826ca14d4SBen Greear ar->hw.rx_ant = 0x3; 394906e360acSBala Shanmugam } else { 395006e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 395106e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 39529c2e90ffSBen Greear ar->hw.tx_ant = 1; 39539c2e90ffSBen Greear ar->hw.rx_ant = 1; 395406e360acSBala Shanmugam } 395506e360acSBala Shanmugam 39569c2e90ffSBen Greear wiphy->available_antennas_tx = ar->hw.tx_ant; 39579c2e90ffSBen Greear wiphy->available_antennas_rx = ar->hw.rx_ant; 39589c2e90ffSBen Greear 3959d92917e4SThomas Pedersen if (band_2gig) 396057fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3961d92917e4SThomas Pedersen if (band_5gig) 396257fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3963d92917e4SThomas Pedersen 396446d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 396546d33a21SKalle Valo 396646d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 396746d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 396846d33a21SKalle Valo 3969dfb89c56SJohannes Berg #ifdef CONFIG_PM 3970964dc9e2SJohannes Berg wiphy->wowlan = &ath6kl_wowlan_support; 3971dfb89c56SJohannes Berg #endif 397246d33a21SKalle Valo 39738ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 397446d33a21SKalle Valo 3975f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3976f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3977f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3978f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3979f2afdac7SVasanthakumar Thiagarajan 3980b1f47e3aSThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities)) 3981ca986ad9SArend Van Spriel ar->wiphy->max_sched_scan_reqs = 1; 3982f2afdac7SVasanthakumar Thiagarajan 398303bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 398403bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 3985b292219fSJohannes Berg ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER; 398603bdeb0dSVasanthakumar Thiagarajan 3987f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3988f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3989f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3990a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3991f2afdac7SVasanthakumar Thiagarajan 399246d33a21SKalle Valo ret = wiphy_register(wiphy); 399346d33a21SKalle Valo if (ret < 0) { 399446d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 399546d33a21SKalle Valo return ret; 399646d33a21SKalle Valo } 399746d33a21SKalle Valo 3998e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3999e5348a1eSVasanthakumar Thiagarajan 400046d33a21SKalle Valo return 0; 400146d33a21SKalle Valo } 400246d33a21SKalle Valo 400346d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 4004bdcd8170SKalle Valo { 4005be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 4006e5348a1eSVasanthakumar Thiagarajan 4007e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 400845eaa78fSKalle Valo } 400946d33a21SKalle Valo 401045eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 401145eaa78fSKalle Valo { 401245eaa78fSKalle Valo struct ath6kl *ar; 401345eaa78fSKalle Valo struct wiphy *wiphy; 401445eaa78fSKalle Valo 401545eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 401645eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 401745eaa78fSKalle Valo 401845eaa78fSKalle Valo if (!wiphy) { 401945eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 402045eaa78fSKalle Valo return NULL; 402145eaa78fSKalle Valo } 402245eaa78fSKalle Valo 402345eaa78fSKalle Valo ar = wiphy_priv(wiphy); 402445eaa78fSKalle Valo ar->wiphy = wiphy; 402545eaa78fSKalle Valo 402645eaa78fSKalle Valo return ar; 402745eaa78fSKalle Valo } 402845eaa78fSKalle Valo 402945eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 403045eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 403145eaa78fSKalle Valo { 40321d2a4456SVasanthakumar Thiagarajan int i; 40331d2a4456SVasanthakumar Thiagarajan 40341d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 40351d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 40361d2a4456SVasanthakumar Thiagarajan 4037be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 4038bdcd8170SKalle Valo } 403945eaa78fSKalle Valo 4040