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> 236eb07cafSPaul Gortmaker 24bdcd8170SKalle Valo #include "core.h" 25bdcd8170SKalle Valo #include "cfg80211.h" 26bdcd8170SKalle Valo #include "debug.h" 27abcb344bSKalle Valo #include "hif-ops.h" 28003353b0SKalle Valo #include "testmode.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 55f599359cSBala Shanmugam 56bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 57bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 58bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 59bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 60bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 61bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 62bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 63bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 64bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 65bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 66bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 67bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 68bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 69bdcd8170SKalle Valo }; 70bdcd8170SKalle Valo 71bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 72bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 73bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 74bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 75bdcd8170SKalle Valo 76bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 77bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 78faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 79faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 80faaf1929SVasanthakumar Thiagarajan 81bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 82bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 83bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 84bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 85bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 86bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 87bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 88bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 89bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 90bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 91bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 92bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 93bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 94bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 95bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 96bdcd8170SKalle Valo }; 97bdcd8170SKalle Valo 98bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 99bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 100bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 101bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 102bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 103bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 104bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 105bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 106bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 107bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 108bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 109bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 110bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 111bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 112bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 113bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 114bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 115bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 116bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 117bdcd8170SKalle Valo CHAN5G(216, 0), 118bdcd8170SKalle Valo }; 119bdcd8170SKalle Valo 120bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 121bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 122bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 123bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 124bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 125faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 126faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 127bdcd8170SKalle Valo }; 128bdcd8170SKalle Valo 129bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 130bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 131bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 132bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 133bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 134bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 135faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 136bdcd8170SKalle Valo }; 137bdcd8170SKalle Valo 138837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 139837cb97eSJouni Malinen 14010509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14110509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14210509f90SKalle Valo { 14310509f90SKalle Valo struct ath6kl *ar = vif->ar; 14410509f90SKalle Valo 14510509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14610509f90SKalle Valo return false; 14710509f90SKalle Valo 14810509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14910509f90SKalle Valo 15010509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 15110509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 15210509f90SKalle Valo 15310509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 15410509f90SKalle Valo 15510509f90SKalle Valo return true; 15610509f90SKalle Valo } 15710509f90SKalle Valo 15810509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15910509f90SKalle Valo { 16010509f90SKalle Valo struct ath6kl *ar = vif->ar; 16110509f90SKalle Valo bool stopped; 16210509f90SKalle Valo 16310509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16410509f90SKalle Valo 16510509f90SKalle Valo if (!stopped) 16610509f90SKalle Valo return; 16710509f90SKalle Valo 16810509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16910509f90SKalle Valo } 17010509f90SKalle Valo 171240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 172bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 173bdcd8170SKalle Valo { 174bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 175bdcd8170SKalle Valo 176bdcd8170SKalle Valo if (!wpa_version) { 1773450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 178bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1793450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 180bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1813450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 182bdcd8170SKalle Valo } else { 183bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 184bdcd8170SKalle Valo return -ENOTSUPP; 185bdcd8170SKalle Valo } 186bdcd8170SKalle Valo 187bdcd8170SKalle Valo return 0; 188bdcd8170SKalle Valo } 189bdcd8170SKalle Valo 190240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 191bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 192bdcd8170SKalle Valo { 193bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 194bdcd8170SKalle Valo 195bdcd8170SKalle Valo switch (auth_type) { 196bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1973450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 198bdcd8170SKalle Valo break; 199bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2003450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 201bdcd8170SKalle Valo break; 202bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2033450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 204bdcd8170SKalle Valo break; 205bdcd8170SKalle Valo 206bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 208bdcd8170SKalle Valo break; 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo default: 2113c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 212bdcd8170SKalle Valo return -ENOTSUPP; 213bdcd8170SKalle Valo } 214bdcd8170SKalle Valo 215bdcd8170SKalle Valo return 0; 216bdcd8170SKalle Valo } 217bdcd8170SKalle Valo 218240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 219bdcd8170SKalle Valo { 2203450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2213450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2223450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 223bdcd8170SKalle Valo 224bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 225bdcd8170SKalle Valo __func__, cipher, ucast); 226bdcd8170SKalle Valo 227bdcd8170SKalle Valo switch (cipher) { 228bdcd8170SKalle Valo case 0: 229bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 230bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 231bdcd8170SKalle Valo *ar_cipher_len = 0; 232bdcd8170SKalle Valo break; 233bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 234bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 235bdcd8170SKalle Valo *ar_cipher_len = 5; 236bdcd8170SKalle Valo break; 237bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 238bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 239bdcd8170SKalle Valo *ar_cipher_len = 13; 240bdcd8170SKalle Valo break; 241bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 242bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 243bdcd8170SKalle Valo *ar_cipher_len = 0; 244bdcd8170SKalle Valo break; 245bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 246bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 247bdcd8170SKalle Valo *ar_cipher_len = 0; 248bdcd8170SKalle Valo break; 2495e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2505e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2515e07021eSDai Shuibing *ar_cipher_len = 0; 2525e07021eSDai Shuibing break; 253bdcd8170SKalle Valo default: 254bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 255bdcd8170SKalle Valo return -ENOTSUPP; 256bdcd8170SKalle Valo } 257bdcd8170SKalle Valo 258bdcd8170SKalle Valo return 0; 259bdcd8170SKalle Valo } 260bdcd8170SKalle Valo 261240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 262bdcd8170SKalle Valo { 263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 264bdcd8170SKalle Valo 265bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2663450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2673450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2683450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 270837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2713450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2723450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2733450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 275bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2763450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 277bdcd8170SKalle Valo } 278bdcd8170SKalle Valo } 279bdcd8170SKalle Valo 280990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 281bdcd8170SKalle Valo { 282990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28359c98449SVasanthakumar Thiagarajan 284bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 285bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 286bdcd8170SKalle Valo return false; 287bdcd8170SKalle Valo } 288bdcd8170SKalle Valo 28959c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 290bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 291bdcd8170SKalle Valo return false; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 294bdcd8170SKalle Valo return true; 295bdcd8170SKalle Valo } 296bdcd8170SKalle Valo 2976981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2986981ffdcSKevin Fang { 2996981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 3006981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3016981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3026981ffdcSKevin Fang } 3036981ffdcSKevin Fang 3046981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3056981ffdcSKevin Fang { 3066981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3076981ffdcSKevin Fang } 3086981ffdcSKevin Fang 30963541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31063541212SAarthi Thiruvengadam { 31163541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31263541212SAarthi Thiruvengadam pos[1] >= 4 && 31363541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31463541212SAarthi Thiruvengadam pos[5] == 0x04); 31563541212SAarthi Thiruvengadam } 31663541212SAarthi Thiruvengadam 317334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3186981ffdcSKevin Fang size_t ies_len) 3196981ffdcSKevin Fang { 320334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3216981ffdcSKevin Fang const u8 *pos; 3226981ffdcSKevin Fang u8 *buf = NULL; 3236981ffdcSKevin Fang size_t len = 0; 3246981ffdcSKevin Fang int ret; 3256981ffdcSKevin Fang 3266981ffdcSKevin Fang /* 32763541212SAarthi Thiruvengadam * Clear previously set flag 32863541212SAarthi Thiruvengadam */ 32963541212SAarthi Thiruvengadam 33063541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33163541212SAarthi Thiruvengadam 33263541212SAarthi Thiruvengadam /* 3336981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3346981ffdcSKevin Fang */ 3356981ffdcSKevin Fang 3366981ffdcSKevin Fang if (ies && ies_len) { 3376981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3386981ffdcSKevin Fang if (buf == NULL) 3396981ffdcSKevin Fang return -ENOMEM; 3406981ffdcSKevin Fang pos = ies; 3416981ffdcSKevin Fang 3426981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3436981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3446981ffdcSKevin Fang break; 3456981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3466981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3476981ffdcSKevin Fang len += 2 + pos[1]; 3486981ffdcSKevin Fang } 34963541212SAarthi Thiruvengadam 35063541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35163541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35263541212SAarthi Thiruvengadam 3536981ffdcSKevin Fang pos += 2 + pos[1]; 3546981ffdcSKevin Fang } 3556981ffdcSKevin Fang } 3566981ffdcSKevin Fang 357334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 358334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3596981ffdcSKevin Fang kfree(buf); 3606981ffdcSKevin Fang return ret; 3616981ffdcSKevin Fang } 3626981ffdcSKevin Fang 36355055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36455055976SVasanthakumar Thiagarajan { 36555055976SVasanthakumar Thiagarajan switch (type) { 36655055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36755055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36855055976SVasanthakumar Thiagarajan break; 36955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37055055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37155055976SVasanthakumar Thiagarajan break; 37255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37355055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37655055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 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++) { 40455055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 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++) { 4143226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 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 4298c9bb054SKalle Valo 430bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 431bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 432bdcd8170SKalle Valo { 433bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 435bdcd8170SKalle Valo int status; 4363ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 437ce0dc0cfSRaja Mani u16 interval; 438bdcd8170SKalle Valo 43910509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 44010509f90SKalle Valo 44114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 442bdcd8170SKalle Valo 443990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 444bdcd8170SKalle Valo return -EIO; 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 447bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 448bdcd8170SKalle Valo return -EBUSY; 449bdcd8170SKalle Valo } 450bdcd8170SKalle Valo 451bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 452bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 453bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 454bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 455bdcd8170SKalle Valo return -EINVAL; 456bdcd8170SKalle Valo } 457bdcd8170SKalle Valo 458bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 459bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 460bdcd8170SKalle Valo return -ERESTARTSYS; 461bdcd8170SKalle Valo } 462bdcd8170SKalle Valo 463bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 464bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 465bdcd8170SKalle Valo up(&ar->sem); 466bdcd8170SKalle Valo return -EBUSY; 467bdcd8170SKalle Valo } 468bdcd8170SKalle Valo 469bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 470bdcd8170SKalle Valo /* 471bdcd8170SKalle Valo * sleep until the command queue drains 472bdcd8170SKalle Valo */ 473bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4748c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 475bdcd8170SKalle Valo WMI_TIMEOUT); 476bdcd8170SKalle Valo if (signal_pending(current)) { 477bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 478bdcd8170SKalle Valo up(&ar->sem); 479bdcd8170SKalle Valo return -EINTR; 480bdcd8170SKalle Valo } 481bdcd8170SKalle Valo } 482bdcd8170SKalle Valo 483334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 484743b4518SDan Carpenter if (status) { 485743b4518SDan Carpenter up(&ar->sem); 4866981ffdcSKevin Fang return status; 487743b4518SDan Carpenter } 4886e786cb1SJouni Malinen 4896e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 490542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4916981ffdcSKevin Fang 49259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4933450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4943450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 495cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 496334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 497334234b5SVasanthakumar Thiagarajan vif->req_bssid, 498f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 499bdcd8170SKalle Valo 500bdcd8170SKalle Valo up(&ar->sem); 501bdcd8170SKalle Valo if (status) { 502bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 503bdcd8170SKalle Valo return -EIO; 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo return 0; 5063450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5073450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 508240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 509bdcd8170SKalle Valo } 510bdcd8170SKalle Valo 5113450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5123450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5133450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 514bdcd8170SKalle Valo 515bdcd8170SKalle Valo if (sme->channel) 516f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 517bdcd8170SKalle Valo 5188c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 519bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5208c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 521bdcd8170SKalle Valo 522240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 523bdcd8170SKalle Valo 524240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 525bdcd8170SKalle Valo if (status) { 526bdcd8170SKalle Valo up(&ar->sem); 527bdcd8170SKalle Valo return status; 528bdcd8170SKalle Valo } 529bdcd8170SKalle Valo 530bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 531240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 532bdcd8170SKalle Valo else 533240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 534bdcd8170SKalle Valo 535240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 538240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 539bdcd8170SKalle Valo 540bdcd8170SKalle Valo if ((sme->key_len) && 5413450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5423450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 543bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 544bdcd8170SKalle Valo 545792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 546bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 547bdcd8170SKalle Valo sme->key_idx); 548bdcd8170SKalle Valo up(&ar->sem); 549bdcd8170SKalle Valo return -ENOENT; 550bdcd8170SKalle Valo } 551bdcd8170SKalle Valo 5526f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 553bdcd8170SKalle Valo key->key_len = sme->key_len; 554bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5553450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5563450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 557bdcd8170SKalle Valo 558334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5593450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 560bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 561bdcd8170SKalle Valo key->key_len, 562f4bb9a6fSJouni Malinen NULL, 0, 563bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 564bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 565bdcd8170SKalle Valo } 566bdcd8170SKalle Valo 567bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 569240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 570240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 571bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 572bdcd8170SKalle Valo up(&ar->sem); 573bdcd8170SKalle Valo return -EIO; 574bdcd8170SKalle Valo } 575bdcd8170SKalle Valo } 576bdcd8170SKalle Valo 577f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 578bdcd8170SKalle Valo 5793ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5803ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5813ca9d1fcSAarthi Thiruvengadam 582bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 583bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 584bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 585bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 586bdcd8170SKalle Valo __func__, 5873450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5883450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 589f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 590bdcd8170SKalle Valo 591cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 592ce0dc0cfSRaja Mani 593ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 594b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 595b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 596ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 597ce0dc0cfSRaja Mani interval, 598ce0dc0cfSRaja Mani 0); 599ce0dc0cfSRaja Mani if (status) { 600ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 601ce0dc0cfSRaja Mani up(&ar->sem); 602ce0dc0cfSRaja Mani return status; 603ce0dc0cfSRaja Mani } 604ce0dc0cfSRaja Mani } 605ce0dc0cfSRaja Mani 606334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6083450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6093450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6103450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6113450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 612f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6133ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 614bdcd8170SKalle Valo 615f599359cSBala Shanmugam /* disable background scan if period is 0 */ 616f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 617f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 618f599359cSBala Shanmugam 619f599359cSBala Shanmugam /* configure default value if not specified */ 620f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 621f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 622f599359cSBala Shanmugam 623f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 624f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 625f599359cSBala Shanmugam 626bdcd8170SKalle Valo up(&ar->sem); 627bdcd8170SKalle Valo 628bdcd8170SKalle Valo if (status == -EINVAL) { 6293450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6303450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 631bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 632bdcd8170SKalle Valo return -ENOENT; 633bdcd8170SKalle Valo } else if (status) { 634bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 635bdcd8170SKalle Valo return -EIO; 636bdcd8170SKalle Valo } 637bdcd8170SKalle Valo 638bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 639ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 640ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 641de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 642bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 643bdcd8170SKalle Valo } 644bdcd8170SKalle Valo 645bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 64659c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 647bdcd8170SKalle Valo 648bdcd8170SKalle Valo return 0; 649bdcd8170SKalle Valo } 650bdcd8170SKalle Valo 6515e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6525e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6534eab6f4fSRaja Mani enum network_type nw_type, 6544eab6f4fSRaja Mani const u8 *bssid, 65501cac476SJouni Malinen struct ieee80211_channel *chan, 6565e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6575e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 65801cac476SJouni Malinen { 659240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 66001cac476SJouni Malinen struct cfg80211_bss *bss; 6614eab6f4fSRaja Mani u16 cap_mask, cap_val; 66201cac476SJouni Malinen u8 *ie; 66301cac476SJouni Malinen 6644eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6654eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6664eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6674eab6f4fSRaja Mani } else { 6684eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6694eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6704eab6f4fSRaja Mani } 6714eab6f4fSRaja Mani 672be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6734eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6744eab6f4fSRaja Mani cap_mask, cap_val); 67501cac476SJouni Malinen if (bss == NULL) { 67601cac476SJouni Malinen /* 67701cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 67801cac476SJouni Malinen * generate a partial entry until the first BSS info 67901cac476SJouni Malinen * event becomes available. 68001cac476SJouni Malinen * 68101cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 68201cac476SJouni Malinen * IEs from the target. 68301cac476SJouni Malinen */ 6843450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 68501cac476SJouni Malinen if (ie == NULL) 6865e13fd35SVasanthakumar Thiagarajan return NULL; 68701cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6883450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6893450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6903450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 691be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6924eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6933450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 69401cac476SJouni Malinen 0, GFP_KERNEL); 69501cac476SJouni Malinen if (bss) 696cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 697cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 69801cac476SJouni Malinen kfree(ie); 69901cac476SJouni Malinen } else 7005e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 70101cac476SJouni Malinen 7025e13fd35SVasanthakumar Thiagarajan return bss; 70301cac476SJouni Malinen } 70401cac476SJouni Malinen 705240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 706bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 707bdcd8170SKalle Valo u16 beacon_intvl, 708bdcd8170SKalle Valo enum network_type nw_type, 709bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 710bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 711bdcd8170SKalle Valo { 71201cac476SJouni Malinen struct ieee80211_channel *chan; 713240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7145e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo /* capinfo + listen interval */ 717bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo /* capinfo + status code + associd */ 720bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 723bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 724bdcd8170SKalle Valo assoc_resp_ie_offset; 725bdcd8170SKalle Valo 726bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 727bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 728bdcd8170SKalle Valo 72932c10874SJouni Malinen /* 73032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 73132c10874SJouni Malinen * a Beacon frame from the AP is seen. 73232c10874SJouni Malinen */ 733cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 73459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 73532c10874SJouni Malinen 736bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 737551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 738bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 739bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 740bdcd8170SKalle Valo return; 741bdcd8170SKalle Valo } 742bdcd8170SKalle Valo } 743bdcd8170SKalle Valo 744bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 745551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 746551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 747bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 748bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 749bdcd8170SKalle Valo return; 750bdcd8170SKalle Valo } 751bdcd8170SKalle Valo } 752bdcd8170SKalle Valo 753be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 754bdcd8170SKalle Valo 7555e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7565e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7575e13fd35SVasanthakumar Thiagarajan if (!bss) { 7584eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 759bdcd8170SKalle Valo return; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 7624eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7634eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7644eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7654eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7665e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76701cac476SJouni Malinen return; 76801cac476SJouni Malinen } 76901cac476SJouni Malinen 77014ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 771bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 77214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 773240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 774bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 775bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 776bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7775e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77814ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 779bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7805e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 781bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo } 784bdcd8170SKalle Valo 785bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 786bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 787bdcd8170SKalle Valo { 788d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7893450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 790bdcd8170SKalle Valo 791bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 792bdcd8170SKalle Valo reason_code); 793bdcd8170SKalle Valo 79410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 79510509f90SKalle Valo 796990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 797bdcd8170SKalle Valo return -EIO; 798bdcd8170SKalle Valo 799bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 800bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 801bdcd8170SKalle Valo return -EBUSY; 802bdcd8170SKalle Valo } 803bdcd8170SKalle Valo 804bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 805bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 806bdcd8170SKalle Valo return -ERESTARTSYS; 807bdcd8170SKalle Valo } 808bdcd8170SKalle Valo 809cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 810240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8113450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8123450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 813bdcd8170SKalle Valo 814bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 816bdcd8170SKalle Valo 817bdcd8170SKalle Valo up(&ar->sem); 818bdcd8170SKalle Valo 81914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 820170826ddSVasanthakumar Thiagarajan 821bdcd8170SKalle Valo return 0; 822bdcd8170SKalle Valo } 823bdcd8170SKalle Valo 824240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 825bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 826bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 827bdcd8170SKalle Valo { 828240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 82959c98449SVasanthakumar Thiagarajan 83014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 83114ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 83214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 833bdcd8170SKalle Valo } 834bdcd8170SKalle Valo 835f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 836551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 837bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 838bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 839bdcd8170SKalle Valo return; 840bdcd8170SKalle Valo } 841bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 842240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 843bdcd8170SKalle Valo return; 844bdcd8170SKalle Valo } 845bdcd8170SKalle Valo 846f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 847551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 848551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 849bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 850bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 851bdcd8170SKalle Valo return; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo } 854bdcd8170SKalle Valo 8551de547d6SVasanthakumar Thiagarajan /* 8561de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8571de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8581de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8591de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8601de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8611de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8621de547d6SVasanthakumar Thiagarajan */ 863bdcd8170SKalle Valo 8641de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 865334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 866bdcd8170SKalle Valo return; 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo 86959c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 870bdcd8170SKalle Valo 87114ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 872240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 873bdcd8170SKalle Valo bssid, NULL, 0, 874bdcd8170SKalle Valo NULL, 0, 875bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 876bdcd8170SKalle Valo GFP_KERNEL); 87714ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 878240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 879bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 88214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 883bdcd8170SKalle Valo } 884bdcd8170SKalle Valo 885bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 886bdcd8170SKalle Valo struct cfg80211_scan_request *request) 887bdcd8170SKalle Valo { 888d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 88959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8901276c9efSEdward Lu s8 n_channels = 0; 8911276c9efSEdward Lu u16 *channels = NULL; 892bdcd8170SKalle Valo int ret = 0; 893f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 894bdcd8170SKalle Valo 895990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 896bdcd8170SKalle Valo return -EIO; 897bdcd8170SKalle Valo 89810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 89910509f90SKalle Valo 900bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 90159c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 9021b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 903240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 90459c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 9051b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 9061b1e6ee3SJouni Malinen if (ret) { 907bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9081b1e6ee3SJouni Malinen return ret; 909bdcd8170SKalle Valo } 910bdcd8170SKalle Valo } 911bdcd8170SKalle Valo 912bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 913bdcd8170SKalle Valo u8 i; 914bdcd8170SKalle Valo 915bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 916bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 917bdcd8170SKalle Valo 918bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 919334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 920334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 921bdcd8170SKalle Valo request->ssids[i].ssid_len, 922bdcd8170SKalle Valo request->ssids[i].ssid); 923bdcd8170SKalle Valo } 924bdcd8170SKalle Valo 925080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 926334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 927334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 928b84da8c7SJouni Malinen request->ie, request->ie_len); 929b84da8c7SJouni Malinen if (ret) { 930cdeb8602SKalle Valo ath6kl_err("failed to set Probe Request appie for scan"); 931b84da8c7SJouni Malinen return ret; 932b84da8c7SJouni Malinen } 933b84da8c7SJouni Malinen 93411869befSJouni Malinen /* 93511869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 93611869befSJouni Malinen * channels. If the list is longer than the target supports, do not 93711869befSJouni Malinen * configure the list and instead, scan all available channels. 93811869befSJouni Malinen */ 93911869befSJouni Malinen if (request->n_channels > 0 && 94011869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9411276c9efSEdward Lu u8 i; 9421276c9efSEdward Lu 94311869befSJouni Malinen n_channels = request->n_channels; 9441276c9efSEdward Lu 9451276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9461276c9efSEdward Lu if (channels == NULL) { 947cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 9481276c9efSEdward Lu n_channels = 0; 9491276c9efSEdward Lu } 9501276c9efSEdward Lu 9511276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9521276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9531276c9efSEdward Lu } 9541276c9efSEdward Lu 95559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 956f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 957f1f92179SVasanthakumar Thiagarajan 9585b35dff0SRaja Mani vif->scan_req = request; 9595b35dff0SRaja Mani 9603ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9613ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9623ca9d1fcSAarthi Thiruvengadam /* 9633ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9643ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9653ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9663ca9d1fcSAarthi Thiruvengadam * probe requests 9673ca9d1fcSAarthi Thiruvengadam */ 9683ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9693ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 97013423c31SVasanthakumar Thiagarajan false, 0, 97113423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 97213423c31SVasanthakumar Thiagarajan n_channels, channels, 97313423c31SVasanthakumar Thiagarajan request->no_cck, 9743ca9d1fcSAarthi Thiruvengadam request->rates); 9753ca9d1fcSAarthi Thiruvengadam } else { 9763ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9773ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 97813423c31SVasanthakumar Thiagarajan false, 0, 97913423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 98013423c31SVasanthakumar Thiagarajan n_channels, channels); 9813ca9d1fcSAarthi Thiruvengadam } 9825b35dff0SRaja Mani if (ret) { 983bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 9845b35dff0SRaja Mani vif->scan_req = NULL; 9855b35dff0SRaja Mani } 986bdcd8170SKalle Valo 9871276c9efSEdward Lu kfree(channels); 9881276c9efSEdward Lu 989bdcd8170SKalle Valo return ret; 990bdcd8170SKalle Valo } 991bdcd8170SKalle Valo 9921c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 993bdcd8170SKalle Valo { 994240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9956fd1eaceSKalle Valo int i; 996bdcd8170SKalle Valo 9971c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9981c17d313SKalle Valo aborted ? " aborted" : ""); 999bdcd8170SKalle Valo 100014ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10016fd1eaceSKalle Valo return; 10026fd1eaceSKalle Valo 10031c17d313SKalle Valo if (aborted) 10046fd1eaceSKalle Valo goto out; 1005bdcd8170SKalle Valo 100614ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 100714ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1008334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1009334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1010bdcd8170SKalle Valo 0, NULL); 1011bdcd8170SKalle Valo } 1012bdcd8170SKalle Valo } 10136fd1eaceSKalle Valo 10146fd1eaceSKalle Valo out: 1015cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 101614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1017bdcd8170SKalle Valo } 1018bdcd8170SKalle Valo 1019c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1020c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1021c4f7863eSThomas Pedersen { 1022c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1023c4f7863eSThomas Pedersen 1024c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1025c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1026c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1027c4f7863eSThomas Pedersen 1028c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1029c4f7863eSThomas Pedersen 1030c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1031c4f7863eSThomas Pedersen } 1032c4f7863eSThomas Pedersen 1033bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1034bdcd8170SKalle Valo u8 key_index, bool pairwise, 1035bdcd8170SKalle Valo const u8 *mac_addr, 1036bdcd8170SKalle Valo struct key_params *params) 1037bdcd8170SKalle Valo { 1038d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 103959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1040bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10414a8ce2fdSSujith Manoharan int seq_len; 1042bdcd8170SKalle Valo u8 key_usage; 1043bdcd8170SKalle Valo u8 key_type; 1044bdcd8170SKalle Valo 1045990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1046bdcd8170SKalle Valo return -EIO; 1047bdcd8170SKalle Valo 1048837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1049837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1050837cb97eSJouni Malinen return -EINVAL; 1051240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1052240d2799SVasanthakumar Thiagarajan params->key); 1053837cb97eSJouni Malinen } 1054837cb97eSJouni Malinen 1055792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1056bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1057bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1058bdcd8170SKalle Valo key_index); 1059bdcd8170SKalle Valo return -ENOENT; 1060bdcd8170SKalle Valo } 1061bdcd8170SKalle Valo 10626f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1063bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1064bdcd8170SKalle Valo 1065bdcd8170SKalle Valo if (pairwise) 1066bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1067bdcd8170SKalle Valo else 1068bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1069bdcd8170SKalle Valo 10704a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10715e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10725e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10735e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10745e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10755e07021eSDai Shuibing } 1076bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10775e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1078bdcd8170SKalle Valo return -EINVAL; 1079bdcd8170SKalle Valo 1080bdcd8170SKalle Valo key->key_len = params->key_len; 1081bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10825e07021eSDai Shuibing key->seq_len = seq_len; 1083bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1084bdcd8170SKalle Valo key->cipher = params->cipher; 1085bdcd8170SKalle Valo 1086bdcd8170SKalle Valo switch (key->cipher) { 1087bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1088bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1089bdcd8170SKalle Valo key_type = WEP_CRYPT; 1090bdcd8170SKalle Valo break; 1091bdcd8170SKalle Valo 1092bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1093bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1094bdcd8170SKalle Valo break; 1095bdcd8170SKalle Valo 1096bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1097bdcd8170SKalle Valo key_type = AES_CRYPT; 1098bdcd8170SKalle Valo break; 10995e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11005e07021eSDai Shuibing key_type = WAPI_CRYPT; 11015e07021eSDai Shuibing break; 1102bdcd8170SKalle Valo 1103bdcd8170SKalle Valo default: 1104bdcd8170SKalle Valo return -ENOTSUPP; 1105bdcd8170SKalle Valo } 1106bdcd8170SKalle Valo 1107ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1108ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1109ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1110de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1111bdcd8170SKalle Valo 1112bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1113bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1114bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1115bdcd8170SKalle Valo key_usage, key->seq_len); 1116bdcd8170SKalle Valo 1117f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11184703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1119cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11209a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11219a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11229a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11239a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11249a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 112559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1126cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1127cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 11289a5b1318SJouni Malinen /* 11299a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11309a5b1318SJouni Malinen * the connected event is received from the target. 11319a5b1318SJouni Malinen */ 11329a5b1318SJouni Malinen return 0; 11339a5b1318SJouni Malinen } 11349a5b1318SJouni Malinen } 11359a5b1318SJouni Malinen 1136f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 113759c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1138151411e8SJouni Malinen /* 1139151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1140151411e8SJouni Malinen * the AP mode has properly started 1141151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1142151411e8SJouni Malinen */ 1143cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1144cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 11456f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11466f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11476f2a73f9SVasanthakumar Thiagarajan key->key_len); 1148151411e8SJouni Malinen return 0; 1149151411e8SJouni Malinen } 1150151411e8SJouni Malinen 11517cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1152bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1153f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1154f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1155bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1156bdcd8170SKalle Valo } 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1159bdcd8170SKalle Valo u8 key_index, bool pairwise, 1160bdcd8170SKalle Valo const u8 *mac_addr) 1161bdcd8170SKalle Valo { 1162d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11636f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1164bdcd8170SKalle Valo 1165bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1166bdcd8170SKalle Valo 1167990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1168bdcd8170SKalle Valo return -EIO; 1169bdcd8170SKalle Valo 1170792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1171bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1172bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1173bdcd8170SKalle Valo key_index); 1174bdcd8170SKalle Valo return -ENOENT; 1175bdcd8170SKalle Valo } 1176bdcd8170SKalle Valo 11776f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1178bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1179bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1180bdcd8170SKalle Valo return 0; 1181bdcd8170SKalle Valo } 1182bdcd8170SKalle Valo 11836f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1184bdcd8170SKalle Valo 1185334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1186bdcd8170SKalle Valo } 1187bdcd8170SKalle Valo 1188bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1189bdcd8170SKalle Valo u8 key_index, bool pairwise, 1190bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1191bdcd8170SKalle Valo void (*callback) (void *cookie, 1192bdcd8170SKalle Valo struct key_params *)) 1193bdcd8170SKalle Valo { 11946f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1195bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1196bdcd8170SKalle Valo struct key_params params; 1197bdcd8170SKalle Valo 1198bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1199bdcd8170SKalle Valo 1200990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1201bdcd8170SKalle Valo return -EIO; 1202bdcd8170SKalle Valo 1203792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1204bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1205bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1206bdcd8170SKalle Valo key_index); 1207bdcd8170SKalle Valo return -ENOENT; 1208bdcd8170SKalle Valo } 1209bdcd8170SKalle Valo 12106f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1211bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1212bdcd8170SKalle Valo params.cipher = key->cipher; 1213bdcd8170SKalle Valo params.key_len = key->key_len; 1214bdcd8170SKalle Valo params.seq_len = key->seq_len; 1215bdcd8170SKalle Valo params.seq = key->seq; 1216bdcd8170SKalle Valo params.key = key->key; 1217bdcd8170SKalle Valo 1218bdcd8170SKalle Valo callback(cookie, ¶ms); 1219bdcd8170SKalle Valo 1220bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1221bdcd8170SKalle Valo } 1222bdcd8170SKalle Valo 1223bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1224bdcd8170SKalle Valo struct net_device *ndev, 1225bdcd8170SKalle Valo u8 key_index, bool unicast, 1226bdcd8170SKalle Valo bool multicast) 1227bdcd8170SKalle Valo { 1228d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 122959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1230bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1231bdcd8170SKalle Valo u8 key_usage; 1232229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1235bdcd8170SKalle Valo 1236990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1237bdcd8170SKalle Valo return -EIO; 1238bdcd8170SKalle Valo 1239792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1240bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1241bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1242bdcd8170SKalle Valo __func__, key_index); 1243bdcd8170SKalle Valo return -ENOENT; 1244bdcd8170SKalle Valo } 1245bdcd8170SKalle Valo 12466f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1247bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1248bdcd8170SKalle Valo __func__, key_index); 1249bdcd8170SKalle Valo return -EINVAL; 1250bdcd8170SKalle Valo } 1251bdcd8170SKalle Valo 12523450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12536f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1254bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12553450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1256bdcd8170SKalle Valo key_usage |= TX_USAGE; 1257229ed6b5SEdward Lu if (unicast) 12583450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1259229ed6b5SEdward Lu if (multicast) 12603450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1261bdcd8170SKalle Valo 1262f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12639a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12649a5b1318SJouni Malinen 1265f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1266334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1267229ed6b5SEdward Lu key_type, key_usage, 1268f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1269f4bb9a6fSJouni Malinen key->key, 1270bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1271bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1272bdcd8170SKalle Valo } 1273bdcd8170SKalle Valo 1274240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1275bdcd8170SKalle Valo bool ismcast) 1276bdcd8170SKalle Valo { 1277bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1278bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1279bdcd8170SKalle Valo 1280240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1281bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1282bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1283bdcd8170SKalle Valo GFP_KERNEL); 1284bdcd8170SKalle Valo } 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1287bdcd8170SKalle Valo { 1288bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1289990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1290bdcd8170SKalle Valo int ret; 1291bdcd8170SKalle Valo 1292bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1293bdcd8170SKalle Valo changed); 1294bdcd8170SKalle Valo 1295990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1296990bd915SVasanthakumar Thiagarajan if (!vif) 1297990bd915SVasanthakumar Thiagarajan return -EIO; 1298990bd915SVasanthakumar Thiagarajan 1299990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1300bdcd8170SKalle Valo return -EIO; 1301bdcd8170SKalle Valo 1302bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1303bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1304bdcd8170SKalle Valo if (ret != 0) { 1305bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1306bdcd8170SKalle Valo return -EIO; 1307bdcd8170SKalle Valo } 1308bdcd8170SKalle Valo } 1309bdcd8170SKalle Valo 1310bdcd8170SKalle Valo return 0; 1311bdcd8170SKalle Valo } 1312bdcd8170SKalle Valo 1313bdcd8170SKalle Valo /* 1314bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1315bdcd8170SKalle Valo * data type from 2.6.36 onwards 1316bdcd8170SKalle Valo */ 1317bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1318bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1319b992a285SLuis R. Rodriguez int mbm) 1320bdcd8170SKalle Valo { 1321bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1322990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1323b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1326bdcd8170SKalle Valo type, dbm); 1327bdcd8170SKalle Valo 1328990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1329990bd915SVasanthakumar Thiagarajan if (!vif) 1330990bd915SVasanthakumar Thiagarajan return -EIO; 1331990bd915SVasanthakumar Thiagarajan 1332990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1333bdcd8170SKalle Valo return -EIO; 1334bdcd8170SKalle Valo 1335bdcd8170SKalle Valo switch (type) { 1336bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1337bdcd8170SKalle Valo return 0; 1338bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1339d0d670abSKalle Valo ar->tx_pwr = dbm; 1340bdcd8170SKalle Valo break; 1341bdcd8170SKalle Valo default: 1342bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1343bdcd8170SKalle Valo __func__, type); 1344bdcd8170SKalle Valo return -EOPNOTSUPP; 1345bdcd8170SKalle Valo } 1346bdcd8170SKalle Valo 1347d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1348bdcd8170SKalle Valo 1349bdcd8170SKalle Valo return 0; 1350bdcd8170SKalle Valo } 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1353bdcd8170SKalle Valo { 1354bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1355990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1356bdcd8170SKalle Valo 1357990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1358990bd915SVasanthakumar Thiagarajan if (!vif) 1359990bd915SVasanthakumar Thiagarajan return -EIO; 1360990bd915SVasanthakumar Thiagarajan 1361990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1362bdcd8170SKalle Valo return -EIO; 1363bdcd8170SKalle Valo 136459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1365bdcd8170SKalle Valo ar->tx_pwr = 0; 1366bdcd8170SKalle Valo 1367990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1368bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1369bdcd8170SKalle Valo return -EIO; 1370bdcd8170SKalle Valo } 1371bdcd8170SKalle Valo 1372bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1373bdcd8170SKalle Valo 5 * HZ); 1374bdcd8170SKalle Valo 1375bdcd8170SKalle Valo if (signal_pending(current)) { 1376bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1377bdcd8170SKalle Valo return -EINTR; 1378bdcd8170SKalle Valo } 1379bdcd8170SKalle Valo } 1380bdcd8170SKalle Valo 1381bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1382bdcd8170SKalle Valo return 0; 1383bdcd8170SKalle Valo } 1384bdcd8170SKalle Valo 1385bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1386bdcd8170SKalle Valo struct net_device *dev, 1387bdcd8170SKalle Valo bool pmgmt, int timeout) 1388bdcd8170SKalle Valo { 1389bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1390bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1391334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1392bdcd8170SKalle Valo 1393bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1394bdcd8170SKalle Valo __func__, pmgmt, timeout); 1395bdcd8170SKalle Valo 1396990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1397bdcd8170SKalle Valo return -EIO; 1398bdcd8170SKalle Valo 1399bdcd8170SKalle Valo if (pmgmt) { 1400bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1401bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1402bdcd8170SKalle Valo } else { 1403bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1404bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1405bdcd8170SKalle Valo } 1406bdcd8170SKalle Valo 1407334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1408334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1409bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1410bdcd8170SKalle Valo return -EIO; 1411bdcd8170SKalle Valo } 1412bdcd8170SKalle Valo 1413bdcd8170SKalle Valo return 0; 1414bdcd8170SKalle Valo } 1415bdcd8170SKalle Valo 141655055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 141755055976SVasanthakumar Thiagarajan char *name, 141855055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 141955055976SVasanthakumar Thiagarajan u32 *flags, 142055055976SVasanthakumar Thiagarajan struct vif_params *params) 142155055976SVasanthakumar Thiagarajan { 142255055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 142355055976SVasanthakumar Thiagarajan struct net_device *ndev; 142455055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 142555055976SVasanthakumar Thiagarajan 142671f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 142755055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 142855055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 142955055976SVasanthakumar Thiagarajan } 143055055976SVasanthakumar Thiagarajan 143155055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 143255055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 143355055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 143455055976SVasanthakumar Thiagarajan } 143555055976SVasanthakumar Thiagarajan 143655055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 143755055976SVasanthakumar Thiagarajan if (!ndev) 143855055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 143955055976SVasanthakumar Thiagarajan 144055055976SVasanthakumar Thiagarajan ar->num_vif++; 144155055976SVasanthakumar Thiagarajan 144255055976SVasanthakumar Thiagarajan return ndev; 144355055976SVasanthakumar Thiagarajan } 144455055976SVasanthakumar Thiagarajan 144555055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 144655055976SVasanthakumar Thiagarajan struct net_device *ndev) 144755055976SVasanthakumar Thiagarajan { 144855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 144955055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 145055055976SVasanthakumar Thiagarajan 145111f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 145255055976SVasanthakumar Thiagarajan list_del(&vif->list); 145311f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 145455055976SVasanthakumar Thiagarajan 145555055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 145655055976SVasanthakumar Thiagarajan 1457c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 145855055976SVasanthakumar Thiagarajan 145955055976SVasanthakumar Thiagarajan return 0; 146055055976SVasanthakumar Thiagarajan } 146155055976SVasanthakumar Thiagarajan 1462bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1463bdcd8170SKalle Valo struct net_device *ndev, 1464bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1465bdcd8170SKalle Valo struct vif_params *params) 1466bdcd8170SKalle Valo { 1467f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 14681e8d13b0SVasanthakumar Thiagarajan int i; 1469bdcd8170SKalle Valo 1470bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1471bdcd8170SKalle Valo 14721e8d13b0SVasanthakumar Thiagarajan /* 14731e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 14741e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 14751e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 14761e8d13b0SVasanthakumar Thiagarajan */ 14771e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 14781e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 14791e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 14801e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 14811e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 14821e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 14831e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 14841e8d13b0SVasanthakumar Thiagarajan else 14851e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 14861e8d13b0SVasanthakumar Thiagarajan } 14871e8d13b0SVasanthakumar Thiagarajan 14881e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 14891e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 14901e8d13b0SVasanthakumar Thiagarajan break; 14911e8d13b0SVasanthakumar Thiagarajan } 14921e8d13b0SVasanthakumar Thiagarajan 14931e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 14941e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 14951e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 14961e8d13b0SVasanthakumar Thiagarajan } 14971e8d13b0SVasanthakumar Thiagarajan } 14981e8d13b0SVasanthakumar Thiagarajan 14991e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1500bdcd8170SKalle Valo switch (type) { 1501bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1502f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1503bdcd8170SKalle Valo break; 1504bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1505f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1506bdcd8170SKalle Valo break; 15076e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1508f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15096e4604c8SJouni Malinen break; 15106b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1511f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15126b5e5d25SJouni Malinen break; 15136b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1514f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15156b5e5d25SJouni Malinen break; 1516bdcd8170SKalle Valo default: 1517bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1518bdcd8170SKalle Valo return -EOPNOTSUPP; 1519bdcd8170SKalle Valo } 1520bdcd8170SKalle Valo 1521551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1522bdcd8170SKalle Valo 1523bdcd8170SKalle Valo return 0; 1524bdcd8170SKalle Valo } 1525bdcd8170SKalle Valo 1526bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1527bdcd8170SKalle Valo struct net_device *dev, 1528bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1529bdcd8170SKalle Valo { 1530bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 153159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1532bdcd8170SKalle Valo int status; 1533bdcd8170SKalle Valo 1534990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1535bdcd8170SKalle Valo return -EIO; 1536bdcd8170SKalle Valo 15373450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 15383450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1539bdcd8170SKalle Valo 1540bdcd8170SKalle Valo if (ibss_param->channel) 1541f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1542bdcd8170SKalle Valo 1543bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1544bdcd8170SKalle Valo /* 1545bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1546bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1547bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1548bdcd8170SKalle Valo * updated. 1549bdcd8170SKalle Valo */ 1550bdcd8170SKalle Valo return -EOPNOTSUPP; 1551bdcd8170SKalle Valo } 1552bdcd8170SKalle Valo 15538c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1554bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 15558c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15568c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1557bdcd8170SKalle Valo 1558240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1559bdcd8170SKalle Valo 1560240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1561bdcd8170SKalle Valo if (status) 1562bdcd8170SKalle Valo return status; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo if (ibss_param->privacy) { 1565240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1566240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1567bdcd8170SKalle Valo } else { 1568240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1569240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1570bdcd8170SKalle Valo } 1571bdcd8170SKalle Valo 1572f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1573bdcd8170SKalle Valo 1574bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1575bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1576bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1577bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1578bdcd8170SKalle Valo __func__, 15793450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15803450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1581f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1582bdcd8170SKalle Valo 1583334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15843450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15853450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15863450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15873450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15883450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1589f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15903ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 159159c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1592bdcd8170SKalle Valo 1593bdcd8170SKalle Valo return 0; 1594bdcd8170SKalle Valo } 1595bdcd8170SKalle Valo 1596bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1597bdcd8170SKalle Valo struct net_device *dev) 1598bdcd8170SKalle Valo { 15993450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1600bdcd8170SKalle Valo 1601990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1602bdcd8170SKalle Valo return -EIO; 1603bdcd8170SKalle Valo 1604240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16053450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16063450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1607bdcd8170SKalle Valo 1608bdcd8170SKalle Valo return 0; 1609bdcd8170SKalle Valo } 1610bdcd8170SKalle Valo 1611bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1612bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1613bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1614bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1615bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1616837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16175e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1618bdcd8170SKalle Valo }; 1619bdcd8170SKalle Valo 1620bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1621bdcd8170SKalle Valo { 1622bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1623bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1624bdcd8170SKalle Valo 36000, 48000, 54000 1625bdcd8170SKalle Valo }; 1626bdcd8170SKalle Valo u8 i; 1627bdcd8170SKalle Valo 1628bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1629bdcd8170SKalle Valo if (rate == legacy[i]) 1630bdcd8170SKalle Valo return true; 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo return false; 1633bdcd8170SKalle Valo } 1634bdcd8170SKalle Valo 1635bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1636bdcd8170SKalle Valo { 1637bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1638bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1639bdcd8170SKalle Valo }; 1640bdcd8170SKalle Valo u8 i; 1641bdcd8170SKalle Valo 1642bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1643bdcd8170SKalle Valo if (rate == ht20[i]) { 1644bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1645bdcd8170SKalle Valo /* last rate uses sgi */ 1646bdcd8170SKalle Valo *sgi = true; 1647bdcd8170SKalle Valo else 1648bdcd8170SKalle Valo *sgi = false; 1649bdcd8170SKalle Valo 1650bdcd8170SKalle Valo *mcs = i; 1651bdcd8170SKalle Valo return true; 1652bdcd8170SKalle Valo } 1653bdcd8170SKalle Valo } 1654bdcd8170SKalle Valo return false; 1655bdcd8170SKalle Valo } 1656bdcd8170SKalle Valo 1657bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1658bdcd8170SKalle Valo { 1659bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1660bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1661bdcd8170SKalle Valo 150000 1662bdcd8170SKalle Valo }; 1663bdcd8170SKalle Valo u8 i; 1664bdcd8170SKalle Valo 1665bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1666bdcd8170SKalle Valo if (rate == ht40[i]) { 1667bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1668bdcd8170SKalle Valo /* last rate uses sgi */ 1669bdcd8170SKalle Valo *sgi = true; 1670bdcd8170SKalle Valo else 1671bdcd8170SKalle Valo *sgi = false; 1672bdcd8170SKalle Valo 1673bdcd8170SKalle Valo *mcs = i; 1674bdcd8170SKalle Valo return true; 1675bdcd8170SKalle Valo } 1676bdcd8170SKalle Valo } 1677bdcd8170SKalle Valo 1678bdcd8170SKalle Valo return false; 1679bdcd8170SKalle Valo } 1680bdcd8170SKalle Valo 1681bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1682bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1683bdcd8170SKalle Valo { 1684bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 168559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1686bdcd8170SKalle Valo long left; 1687bdcd8170SKalle Valo bool sgi; 1688bdcd8170SKalle Valo s32 rate; 1689bdcd8170SKalle Valo int ret; 1690bdcd8170SKalle Valo u8 mcs; 1691bdcd8170SKalle Valo 16928c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1693bdcd8170SKalle Valo return -ENOENT; 1694bdcd8170SKalle Valo 1695bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1696bdcd8170SKalle Valo return -EBUSY; 1697bdcd8170SKalle Valo 1698b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1699bdcd8170SKalle Valo 1700334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1701bdcd8170SKalle Valo 1702bdcd8170SKalle Valo if (ret != 0) { 1703bdcd8170SKalle Valo up(&ar->sem); 1704bdcd8170SKalle Valo return -EIO; 1705bdcd8170SKalle Valo } 1706bdcd8170SKalle Valo 1707bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1708bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1709b95907a7SVasanthakumar Thiagarajan &vif->flags), 1710bdcd8170SKalle Valo WMI_TIMEOUT); 1711bdcd8170SKalle Valo 1712bdcd8170SKalle Valo up(&ar->sem); 1713bdcd8170SKalle Valo 1714bdcd8170SKalle Valo if (left == 0) 1715bdcd8170SKalle Valo return -ETIMEDOUT; 1716bdcd8170SKalle Valo else if (left < 0) 1717bdcd8170SKalle Valo return left; 1718bdcd8170SKalle Valo 1719b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1720b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1721bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1722b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1723bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1724bdcd8170SKalle Valo } 1725bdcd8170SKalle Valo 1726b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1727b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1728bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1729b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1730bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1731bdcd8170SKalle Valo } 1732bdcd8170SKalle Valo 1733b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1734bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1735bdcd8170SKalle Valo 1736b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1737bdcd8170SKalle Valo 1738bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1739bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1740bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1741bdcd8170SKalle Valo if (sgi) { 1742bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1743bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1744bdcd8170SKalle Valo } else { 1745bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1746bdcd8170SKalle Valo } 1747bdcd8170SKalle Valo 1748bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1749bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1750bdcd8170SKalle Valo if (sgi) { 1751bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1752bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1753bdcd8170SKalle Valo } else { 1754bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1755bdcd8170SKalle Valo } 1756bdcd8170SKalle Valo 1757bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1758bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1759bdcd8170SKalle Valo } else { 17609a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17619a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17629a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1763bdcd8170SKalle Valo return 0; 1764bdcd8170SKalle Valo } 1765bdcd8170SKalle Valo 1766bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1767bdcd8170SKalle Valo 176859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 176959c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1770f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 177132c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 177232c10874SJouni Malinen sinfo->bss_param.flags = 0; 1773cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1774cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 177532c10874SJouni Malinen } 177632c10874SJouni Malinen 1777bdcd8170SKalle Valo return 0; 1778bdcd8170SKalle Valo } 1779bdcd8170SKalle Valo 1780bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1781bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1782bdcd8170SKalle Valo { 1783bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1784334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1785334234b5SVasanthakumar Thiagarajan 1786334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1787bdcd8170SKalle Valo pmksa->pmkid, true); 1788bdcd8170SKalle Valo } 1789bdcd8170SKalle Valo 1790bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1791bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1792bdcd8170SKalle Valo { 1793bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1794334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1795334234b5SVasanthakumar Thiagarajan 1796334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1797bdcd8170SKalle Valo pmksa->pmkid, false); 1798bdcd8170SKalle Valo } 1799bdcd8170SKalle Valo 1800bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1801bdcd8170SKalle Valo { 1802bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 180359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 180459c98449SVasanthakumar Thiagarajan 180559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1806334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1807334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1808bdcd8170SKalle Valo return 0; 1809bdcd8170SKalle Valo } 1810bdcd8170SKalle Valo 1811d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1812d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18136cb3c714SRaja Mani { 1814d91e8eeeSRaja Mani int ret, pos; 1815d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 18166cb3c714SRaja Mani u16 i; 18176cb3c714SRaja Mani 1818d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18196cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 18206cb3c714SRaja Mani 18216cb3c714SRaja Mani /* 18226cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 18236cb3c714SRaja Mani * driver specific mask value and send it to the chip along 18246cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 18256cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 18266cb3c714SRaja Mani * then equivalent driver specific mask value is 18276cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 18286cb3c714SRaja Mani */ 18296cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 18306cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 18316cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 18326cb3c714SRaja Mani mask[pos] = 0xFF; 18336cb3c714SRaja Mani } 18346cb3c714SRaja Mani /* 18356cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 18366cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 18376cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 18386cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 18396cb3c714SRaja Mani */ 18406cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 18416cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 18426cb3c714SRaja Mani wow->patterns[i].pattern_len, 18436cb3c714SRaja Mani 0 /* pattern offset */, 18446cb3c714SRaja Mani wow->patterns[i].pattern, mask); 18456cb3c714SRaja Mani if (ret) 18466cb3c714SRaja Mani return ret; 18476cb3c714SRaja Mani } 18486cb3c714SRaja Mani 1849d91e8eeeSRaja Mani if (wow->disconnect) 1850d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1851d91e8eeeSRaja Mani 1852d91e8eeeSRaja Mani if (wow->magic_pkt) 1853d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1854d91e8eeeSRaja Mani 1855d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1856d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1857d91e8eeeSRaja Mani 1858d91e8eeeSRaja Mani if (wow->eap_identity_req) 1859d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1860d91e8eeeSRaja Mani 1861d91e8eeeSRaja Mani if (wow->four_way_handshake) 1862d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1863d91e8eeeSRaja Mani 1864d91e8eeeSRaja Mani return 0; 1865d91e8eeeSRaja Mani } 1866d91e8eeeSRaja Mani 1867d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1868d91e8eeeSRaja Mani { 1869d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1870d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1871d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1872d91e8eeeSRaja Mani 0x00, 0x08 }; 1873d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1874d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1875d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1876d91e8eeeSRaja Mani 0x00, 0x7f }; 1877d91e8eeeSRaja Mani u8 unicst_offset = 0; 1878d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1879d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1880d91e8eeeSRaja Mani u8 arp_offset = 20; 1881d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1882d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1883d91e8eeeSRaja Mani u8 discvr_offset = 38; 1884d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1885d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1886d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1887d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1888d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1889d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1890d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1891d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1892d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1893d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1894d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1895d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1896d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1897d91e8eeeSRaja Mani int ret; 1898d91e8eeeSRaja Mani 1899d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1900d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1901d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1902d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1903d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1904d91e8eeeSRaja Mani if (ret) { 1905d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1906d91e8eeeSRaja Mani return ret; 1907d91e8eeeSRaja Mani } 1908d91e8eeeSRaja Mani 1909d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1910d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1911d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1912d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1913d91e8eeeSRaja Mani arp_pattern, arp_mask); 1914d91e8eeeSRaja Mani if (ret) { 1915d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1916d91e8eeeSRaja Mani return ret; 1917d91e8eeeSRaja Mani } 1918d91e8eeeSRaja Mani 1919d91e8eeeSRaja Mani /* 1920d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1921d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1922d91e8eeeSRaja Mani */ 1923d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1924d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1925d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1926d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1927d91e8eeeSRaja Mani if (ret) { 1928d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1929d91e8eeeSRaja Mani return ret; 1930d91e8eeeSRaja Mani } 1931d91e8eeeSRaja Mani 1932d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1933d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1934d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1935d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1936d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1937d91e8eeeSRaja Mani if (ret) { 1938d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1939d91e8eeeSRaja Mani return ret; 1940d91e8eeeSRaja Mani } 1941d91e8eeeSRaja Mani 1942d91e8eeeSRaja Mani return 0; 1943d91e8eeeSRaja Mani } 1944d91e8eeeSRaja Mani 1945d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1946d91e8eeeSRaja Mani { 1947d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1948d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1949d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1950d91e8eeeSRaja Mani u8 discvr_offset = 38; 1951d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1952d91e8eeeSRaja Mani int ret; 1953d91e8eeeSRaja Mani 1954d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1955d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1956d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1957d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1958d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1959d91e8eeeSRaja Mani mac_mask); 1960d91e8eeeSRaja Mani if (ret) { 1961d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1962d91e8eeeSRaja Mani return ret; 1963d91e8eeeSRaja Mani } 1964d91e8eeeSRaja Mani 1965d91e8eeeSRaja Mani /* 1966d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1967d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1968d91e8eeeSRaja Mani */ 1969d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1970d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1971d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1972d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1973d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1974d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1975d91e8eeeSRaja Mani if (ret) { 1976cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1977d91e8eeeSRaja Mani return ret; 1978d91e8eeeSRaja Mani } 1979d91e8eeeSRaja Mani } 1980d91e8eeeSRaja Mani 1981d91e8eeeSRaja Mani return 0; 1982d91e8eeeSRaja Mani } 1983d91e8eeeSRaja Mani 1984055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 1985055bde49SRaja Mani { 1986055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1987055bde49SRaja Mani } 1988055bde49SRaja Mani 1989055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 1990055bde49SRaja Mani { 1991055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 1992055bde49SRaja Mani } 1993055bde49SRaja Mani 1994055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 1995055bde49SRaja Mani { 1996055bde49SRaja Mani int ret, left; 1997055bde49SRaja Mani 1998055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1999055bde49SRaja Mani 2000055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2001055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2002055bde49SRaja Mani if (ret) 2003055bde49SRaja Mani return ret; 2004055bde49SRaja Mani 2005055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2006055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2007055bde49SRaja Mani WMI_TIMEOUT); 2008055bde49SRaja Mani if (left == 0) { 2009055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2010055bde49SRaja Mani ret = -ETIMEDOUT; 2011055bde49SRaja Mani } else if (left < 0) { 2012055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2013055bde49SRaja Mani left); 2014055bde49SRaja Mani ret = left; 2015055bde49SRaja Mani } 2016055bde49SRaja Mani 2017055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2018055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2019055bde49SRaja Mani is_ctrl_ep_empty(ar), 2020055bde49SRaja Mani WMI_TIMEOUT); 2021055bde49SRaja Mani if (left == 0) { 2022055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2023055bde49SRaja Mani ret = -ETIMEDOUT; 2024055bde49SRaja Mani } else if (left < 0) { 2025055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2026055bde49SRaja Mani ret = left; 2027055bde49SRaja Mani } 2028055bde49SRaja Mani } 2029055bde49SRaja Mani 2030055bde49SRaja Mani return ret; 2031055bde49SRaja Mani } 2032055bde49SRaja Mani 2033d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2034d91e8eeeSRaja Mani { 2035d91e8eeeSRaja Mani struct in_device *in_dev; 2036d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2037d91e8eeeSRaja Mani struct ath6kl_vif *vif; 2038055bde49SRaja Mani int ret; 2039d91e8eeeSRaja Mani u32 filter = 0; 2040ce0dc0cfSRaja Mani u16 i, bmiss_time; 2041d91e8eeeSRaja Mani u8 index = 0; 2042d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2043d91e8eeeSRaja Mani 2044d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2045d91e8eeeSRaja Mani if (!vif) 2046d91e8eeeSRaja Mani return -EIO; 2047d91e8eeeSRaja Mani 2048d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2049d91e8eeeSRaja Mani return -EIO; 2050d91e8eeeSRaja Mani 2051d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 20523c411a43SRaja Mani return -ENOTCONN; 2053d91e8eeeSRaja Mani 2054d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2055d91e8eeeSRaja Mani return -EINVAL; 2056d91e8eeeSRaja Mani 2057d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2058d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2059d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2060d91e8eeeSRaja Mani WOW_LIST_ID, i); 2061d91e8eeeSRaja Mani 2062d91e8eeeSRaja Mani /* 2063d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2064d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2065d91e8eeeSRaja Mani * the user. 2066d91e8eeeSRaja Mani */ 2067d91e8eeeSRaja Mani if (wow) 2068d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2069d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2070d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2071d91e8eeeSRaja Mani else 2072d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2073d91e8eeeSRaja Mani 2074d91e8eeeSRaja Mani if (ret) 2075d91e8eeeSRaja Mani return ret; 2076d91e8eeeSRaja Mani 2077390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2078390a8c8fSRaja Mani 2079ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2080ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2081ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2082ce0dc0cfSRaja Mani 0); 2083ce0dc0cfSRaja Mani if (ret) 2084ce0dc0cfSRaja Mani return ret; 2085ce0dc0cfSRaja Mani 2086ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2087ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2088ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2089ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2090ce0dc0cfSRaja Mani 2091ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2092ce0dc0cfSRaja Mani bmiss_time, 0); 2093ce0dc0cfSRaja Mani if (ret) 2094ce0dc0cfSRaja Mani return ret; 2095ce0dc0cfSRaja Mani 2096ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2097ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2098ce0dc0cfSRaja Mani 0, 0, 0, 0); 2099ce0dc0cfSRaja Mani if (ret) 2100ce0dc0cfSRaja Mani return ret; 2101ce0dc0cfSRaja Mani } 2102ce0dc0cfSRaja Mani 2103390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2104390a8c8fSRaja Mani 2105c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2106c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2107c08631c6SRaja Mani if (!in_dev) 2108c08631c6SRaja Mani goto skip_arp; 2109c08631c6SRaja Mani 2110c08631c6SRaja Mani ifa = in_dev->ifa_list; 2111c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2112c08631c6SRaja Mani 2113c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2114c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2115c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2116c08631c6SRaja Mani ifa = ifa->ifa_next; 2117c08631c6SRaja Mani index++; 2118c08631c6SRaja Mani } 2119c08631c6SRaja Mani 2120c08631c6SRaja Mani if (ifa) { 2121c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2122c08631c6SRaja Mani return -EINVAL; 2123c08631c6SRaja Mani } 2124c08631c6SRaja Mani 2125c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2126c08631c6SRaja Mani if (ret) { 2127c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2128c08631c6SRaja Mani return ret; 2129c08631c6SRaja Mani } 2130c08631c6SRaja Mani 2131c08631c6SRaja Mani skip_arp: 21326cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 21336cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 21346cb3c714SRaja Mani filter, 21356cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 21366cb3c714SRaja Mani if (ret) 21376cb3c714SRaja Mani return ret; 21386cb3c714SRaja Mani 2139055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 21406cb3c714SRaja Mani if (ret) 21416cb3c714SRaja Mani return ret; 21426cb3c714SRaja Mani 2143055bde49SRaja Mani return 0; 21446cb3c714SRaja Mani } 21456cb3c714SRaja Mani 21466cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 21476cb3c714SRaja Mani { 21486cb3c714SRaja Mani struct ath6kl_vif *vif; 21496cb3c714SRaja Mani int ret; 21506cb3c714SRaja Mani 21516cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 21526cb3c714SRaja Mani if (!vif) 21536cb3c714SRaja Mani return -EIO; 21546cb3c714SRaja Mani 2155390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2156390a8c8fSRaja Mani 21576cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21586cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2159390a8c8fSRaja Mani if (ret) { 2160cdeb8602SKalle Valo ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2161cdeb8602SKalle Valo ret); 2162390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21636cb3c714SRaja Mani return ret; 21646cb3c714SRaja Mani } 21656cb3c714SRaja Mani 2166ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2167ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2168ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2169ce0dc0cfSRaja Mani if (ret) 2170ce0dc0cfSRaja Mani return ret; 2171ce0dc0cfSRaja Mani 2172ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2173ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2174ce0dc0cfSRaja Mani if (ret) 2175ce0dc0cfSRaja Mani return ret; 2176ce0dc0cfSRaja Mani 2177ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2178ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2179ce0dc0cfSRaja Mani if (ret) 2180ce0dc0cfSRaja Mani return ret; 2181ce0dc0cfSRaja Mani } 2182ce0dc0cfSRaja Mani 2183390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2184390a8c8fSRaja Mani 2185390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2186390a8c8fSRaja Mani 2187390a8c8fSRaja Mani return 0; 2188390a8c8fSRaja Mani } 2189390a8c8fSRaja Mani 219040abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 219140abc2deSRaja Mani { 219240abc2deSRaja Mani struct ath6kl_vif *vif; 219340abc2deSRaja Mani int ret; 219440abc2deSRaja Mani 219540abc2deSRaja Mani vif = ath6kl_vif_first(ar); 219640abc2deSRaja Mani if (!vif) 219740abc2deSRaja Mani return -EIO; 219840abc2deSRaja Mani 219940abc2deSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 220040abc2deSRaja Mani return -EIO; 220140abc2deSRaja Mani 220240abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 220340abc2deSRaja Mani 220440abc2deSRaja Mani /* Save the current power mode before enabling power save */ 220540abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 220640abc2deSRaja Mani 220740abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 220840abc2deSRaja Mani if (ret) 220940abc2deSRaja Mani return ret; 221040abc2deSRaja Mani 221140abc2deSRaja Mani /* Disable WOW mode */ 221240abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 221340abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 221440abc2deSRaja Mani 0, 0); 221540abc2deSRaja Mani if (ret) 221640abc2deSRaja Mani return ret; 221740abc2deSRaja Mani 221840abc2deSRaja Mani /* Flush all non control pkts in TX path */ 221940abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 222040abc2deSRaja Mani 222140abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 222240abc2deSRaja Mani if (ret) 222340abc2deSRaja Mani return ret; 222440abc2deSRaja Mani 222540abc2deSRaja Mani return 0; 222640abc2deSRaja Mani } 222740abc2deSRaja Mani 222840abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 222940abc2deSRaja Mani { 223040abc2deSRaja Mani struct ath6kl_vif *vif; 223140abc2deSRaja Mani int ret; 223240abc2deSRaja Mani 223340abc2deSRaja Mani vif = ath6kl_vif_first(ar); 223440abc2deSRaja Mani 223540abc2deSRaja Mani if (!vif) 223640abc2deSRaja Mani return -EIO; 223740abc2deSRaja Mani 223840abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 223940abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 224040abc2deSRaja Mani ar->wmi->saved_pwr_mode); 224140abc2deSRaja Mani if (ret) 224240abc2deSRaja Mani return ret; 224340abc2deSRaja Mani } 224440abc2deSRaja Mani 224540abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 224640abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 224740abc2deSRaja Mani if (ret) 224840abc2deSRaja Mani return ret; 224940abc2deSRaja Mani 225040abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 225140abc2deSRaja Mani 225240abc2deSRaja Mani /* Reset scan parameter to default values */ 225340abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 225440abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 225540abc2deSRaja Mani if (ret) 225640abc2deSRaja Mani return ret; 225740abc2deSRaja Mani 225840abc2deSRaja Mani return 0; 225940abc2deSRaja Mani } 226040abc2deSRaja Mani 226152d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22620f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22630f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 226452d81a68SKalle Valo { 22653d79499cSVivek Natarajan struct ath6kl_vif *vif; 2266390a8c8fSRaja Mani enum ath6kl_state prev_state; 226752d81a68SKalle Valo int ret; 226852d81a68SKalle Valo 226952d81a68SKalle Valo switch (mode) { 2270d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2271d7c44e0bSRaja Mani 2272d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2273d7c44e0bSRaja Mani 2274d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2275d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2276d7c44e0bSRaja Mani 2277390a8c8fSRaja Mani prev_state = ar->state; 2278390a8c8fSRaja Mani 2279d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2280390a8c8fSRaja Mani if (ret) { 2281390a8c8fSRaja Mani ar->state = prev_state; 2282d7c44e0bSRaja Mani return ret; 2283390a8c8fSRaja Mani } 22841e9a905dSRaja Mani 2285d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2286d7c44e0bSRaja Mani break; 2287d7c44e0bSRaja Mani 228852d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2289524441e3SRaja Mani 229040abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2291524441e3SRaja Mani 229240abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 229352d81a68SKalle Valo if (ret) { 229440abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 229540abc2deSRaja Mani return ret; 229652d81a68SKalle Valo } 229752d81a68SKalle Valo 229876a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 229976a9fbe2SKalle Valo 230052d81a68SKalle Valo break; 2301b4b2a0b1SKalle Valo 2302b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2303524441e3SRaja Mani 23047125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2305524441e3SRaja Mani 2306b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2307b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2308b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2309b4b2a0b1SKalle Valo break; 2310b4b2a0b1SKalle Valo } 2311b4b2a0b1SKalle Valo 2312b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2313b4b2a0b1SKalle Valo 2314b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2315b4b2a0b1SKalle Valo if (ret) { 2316b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2317b4b2a0b1SKalle Valo ret); 2318b4b2a0b1SKalle Valo } 2319b4b2a0b1SKalle Valo 2320b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2321b4b2a0b1SKalle Valo 2322b4b2a0b1SKalle Valo break; 2323b4b2a0b1SKalle Valo 232410509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 232510509f90SKalle Valo /* 232610509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 232710509f90SKalle Valo * wow mode and sleeping most of the time. 232810509f90SKalle Valo */ 232910509f90SKalle Valo break; 233010509f90SKalle Valo 2331b4b2a0b1SKalle Valo default: 2332b4b2a0b1SKalle Valo break; 233352d81a68SKalle Valo } 233452d81a68SKalle Valo 23353d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 23363d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 23373d79499cSVivek Natarajan 233852d81a68SKalle Valo return 0; 233952d81a68SKalle Valo } 2340d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 234152d81a68SKalle Valo 234252d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 234352d81a68SKalle Valo { 234476a9fbe2SKalle Valo int ret; 234576a9fbe2SKalle Valo 234676a9fbe2SKalle Valo switch (ar->state) { 2347d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2348d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2349d7c44e0bSRaja Mani 2350d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2351d7c44e0bSRaja Mani if (ret) { 2352d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2353d7c44e0bSRaja Mani return ret; 2354d7c44e0bSRaja Mani } 2355d7c44e0bSRaja Mani 2356d7c44e0bSRaja Mani break; 2357d7c44e0bSRaja Mani 235876a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 235940abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 236040abc2deSRaja Mani 236140abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 236276a9fbe2SKalle Valo if (ret) { 236340abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 236440abc2deSRaja Mani return ret; 236576a9fbe2SKalle Valo } 236676a9fbe2SKalle Valo break; 236776a9fbe2SKalle Valo 2368b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2369b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2370b4b2a0b1SKalle Valo 2371b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2372b4b2a0b1SKalle Valo if (ret) { 2373b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2374b4b2a0b1SKalle Valo return ret; 2375b4b2a0b1SKalle Valo } 2376d7c44e0bSRaja Mani break; 2377b4b2a0b1SKalle Valo 237810509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 237910509f90SKalle Valo break; 238010509f90SKalle Valo 238176a9fbe2SKalle Valo default: 238276a9fbe2SKalle Valo break; 238352d81a68SKalle Valo } 238452d81a68SKalle Valo 238552d81a68SKalle Valo return 0; 238652d81a68SKalle Valo } 2387d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 238852d81a68SKalle Valo 2389abcb344bSKalle Valo #ifdef CONFIG_PM 239052d81a68SKalle Valo 239152d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 239252d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2393abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2394abcb344bSKalle Valo { 2395abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2396abcb344bSKalle Valo 23970f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2398abcb344bSKalle Valo } 2399aa6cffc1SChilam Ng 240052d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2401aa6cffc1SChilam Ng { 2402aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2403aa6cffc1SChilam Ng 2404aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2405aa6cffc1SChilam Ng } 2406a918fb3cSRaja Mani 2407a918fb3cSRaja Mani /* 2408a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2409a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2410a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2411a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2412a918fb3cSRaja Mani * 2413a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2414a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2415a918fb3cSRaja Mani * 2416a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2417a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2418a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2419a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2420a918fb3cSRaja Mani * 2421a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2422a918fb3cSRaja Mani */ 2423a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2424a918fb3cSRaja Mani { 2425390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2426390a8c8fSRaja Mani return; 2427390a8c8fSRaja Mani 2428a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2429a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2430a918fb3cSRaja Mani } 2431a918fb3cSRaja Mani 2432a918fb3cSRaja Mani #else 2433a918fb3cSRaja Mani 2434a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2435a918fb3cSRaja Mani { 2436a918fb3cSRaja Mani } 2437abcb344bSKalle Valo #endif 2438abcb344bSKalle Valo 2439df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2440df90b369SVasanthakumar Thiagarajan bool ht_enable) 24416a7c9badSJouni Malinen { 2442df90b369SVasanthakumar Thiagarajan struct ath6kl_htcap *htcap = &vif->htcap; 2443e68f6750SSujith Manoharan 2444df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 24456a7c9badSJouni Malinen return 0; 2446df90b369SVasanthakumar Thiagarajan 2447df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2448df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2449df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2450df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2451df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2452df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2453df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2454df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2455df90b369SVasanthakumar Thiagarajan 2456df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2457df90b369SVasanthakumar Thiagarajan band, htcap); 24586a7c9badSJouni Malinen } 24596a7c9badSJouni Malinen 24608bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 24618bdfbf40SJouni Malinen { 24628bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 24638bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 24648bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 24658bdfbf40SJouni Malinen } 24668bdfbf40SJouni Malinen 2467334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2468334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 24698bdfbf40SJouni Malinen { 2470334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24718bdfbf40SJouni Malinen const u8 *pos; 24728bdfbf40SJouni Malinen u8 *buf = NULL; 24738bdfbf40SJouni Malinen size_t len = 0; 24748bdfbf40SJouni Malinen int ret; 24758bdfbf40SJouni Malinen 24768bdfbf40SJouni Malinen /* 24778bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 24788bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 24798bdfbf40SJouni Malinen */ 24808bdfbf40SJouni Malinen 24818bdfbf40SJouni Malinen if (ies && ies_len) { 24828bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 24838bdfbf40SJouni Malinen if (buf == NULL) 24848bdfbf40SJouni Malinen return -ENOMEM; 24858bdfbf40SJouni Malinen pos = ies; 24868bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 24878bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 24888bdfbf40SJouni Malinen break; 24898bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 24908bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 24918bdfbf40SJouni Malinen len += 2 + pos[1]; 24928bdfbf40SJouni Malinen } 24938bdfbf40SJouni Malinen pos += 2 + pos[1]; 24948bdfbf40SJouni Malinen } 24958bdfbf40SJouni Malinen } 24968bdfbf40SJouni Malinen 2497334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2498334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 24998bdfbf40SJouni Malinen kfree(buf); 25008bdfbf40SJouni Malinen return ret; 25018bdfbf40SJouni Malinen } 25028bdfbf40SJouni Malinen 25038860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 25048860020eSJohannes Berg struct cfg80211_beacon_data *info) 25058860020eSJohannes Berg { 25068860020eSJohannes Berg struct ath6kl *ar = vif->ar; 25078860020eSJohannes Berg int res; 25088860020eSJohannes Berg 250917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25108860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25118860020eSJohannes Berg WMI_FRAME_BEACON, 25128860020eSJohannes Berg info->beacon_ies, 25138860020eSJohannes Berg info->beacon_ies_len); 25148860020eSJohannes Berg if (res) 25158860020eSJohannes Berg return res; 25168860020eSJohannes Berg 251717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25188860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 25198860020eSJohannes Berg info->proberesp_ies_len); 25208860020eSJohannes Berg if (res) 25218860020eSJohannes Berg return res; 25228860020eSJohannes Berg 252317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25248860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25258860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 25268860020eSJohannes Berg info->assocresp_ies, 25278860020eSJohannes Berg info->assocresp_ies_len); 25288860020eSJohannes Berg if (res) 25298860020eSJohannes Berg return res; 25308860020eSJohannes Berg 25318860020eSJohannes Berg return 0; 25328860020eSJohannes Berg } 25338860020eSJohannes Berg 2534df90b369SVasanthakumar Thiagarajan static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2535df90b369SVasanthakumar Thiagarajan struct ieee80211_channel *chan, 2536df90b369SVasanthakumar Thiagarajan enum nl80211_channel_type channel_type) 2537df90b369SVasanthakumar Thiagarajan { 2538df90b369SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 2539df90b369SVasanthakumar Thiagarajan 2540df90b369SVasanthakumar Thiagarajan /* 2541df90b369SVasanthakumar Thiagarajan * 'dev' could be NULL if a channel change is required for the hardware 2542df90b369SVasanthakumar Thiagarajan * device itself, instead of a particular VIF. 2543df90b369SVasanthakumar Thiagarajan * 2544df90b369SVasanthakumar Thiagarajan * FIXME: To be handled properly when monitor mode is supported. 2545df90b369SVasanthakumar Thiagarajan */ 2546df90b369SVasanthakumar Thiagarajan if (!dev) 2547df90b369SVasanthakumar Thiagarajan return -EBUSY; 2548df90b369SVasanthakumar Thiagarajan 2549df90b369SVasanthakumar Thiagarajan vif = netdev_priv(dev); 2550df90b369SVasanthakumar Thiagarajan 2551df90b369SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 2552df90b369SVasanthakumar Thiagarajan return -EIO; 2553df90b369SVasanthakumar Thiagarajan 2554df90b369SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2555df90b369SVasanthakumar Thiagarajan __func__, chan->center_freq, chan->hw_value); 2556df90b369SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 2557df90b369SVasanthakumar Thiagarajan vif->next_ch_type = channel_type; 2558df90b369SVasanthakumar Thiagarajan vif->next_ch_band = chan->band; 2559df90b369SVasanthakumar Thiagarajan 2560df90b369SVasanthakumar Thiagarajan return 0; 2561df90b369SVasanthakumar Thiagarajan } 2562df90b369SVasanthakumar Thiagarajan 2563d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2564d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2565d97c121bSVasanthakumar Thiagarajan { 2566d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2567d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2568d97c121bSVasanthakumar Thiagarajan u16 cnt; 2569d97c121bSVasanthakumar Thiagarajan 2570d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2571d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2572d97c121bSVasanthakumar Thiagarajan 2573d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2574d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2575d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2576d97c121bSVasanthakumar Thiagarajan 2577d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2578d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2579d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2580d97c121bSVasanthakumar Thiagarajan 25819e8b16dbSVasanthakumar Thiagarajan /* skip version */ 25829e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2583d97c121bSVasanthakumar Thiagarajan return -EINVAL; 25849e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 25859e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 25869e8b16dbSVasanthakumar Thiagarajan 25879e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 25889e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 25899e8b16dbSVasanthakumar Thiagarajan return 0; 25909e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 25919e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2592d97c121bSVasanthakumar Thiagarajan 2593d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2594d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 25959e8b16dbSVasanthakumar Thiagarajan return 0; 2596798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2597d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2598d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2599d97c121bSVasanthakumar Thiagarajan 2600d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2601d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26029e8b16dbSVasanthakumar Thiagarajan return 0; 2603798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2604d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2605d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2606d97c121bSVasanthakumar Thiagarajan 2607d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26089e8b16dbSVasanthakumar Thiagarajan return 0; 2609d97c121bSVasanthakumar Thiagarajan 2610d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2611d97c121bSVasanthakumar Thiagarajan 2612d97c121bSVasanthakumar Thiagarajan return 0; 2613d97c121bSVasanthakumar Thiagarajan } 2614d97c121bSVasanthakumar Thiagarajan 26158860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 26168860020eSJohannes Berg struct cfg80211_ap_settings *info) 26176a7c9badSJouni Malinen { 26186a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 26193450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26206a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 262167cd22e4SThomas Pedersen bool hidden = false; 26226a7c9badSJouni Malinen u8 *ies; 26236a7c9badSJouni Malinen int ies_len; 26246a7c9badSJouni Malinen struct wmi_connect_cmd p; 26256a7c9badSJouni Malinen int res; 2626be5abaafSVasanthakumar Thiagarajan int i, ret; 2627d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 26286a7c9badSJouni Malinen 26298860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 26306a7c9badSJouni Malinen 2631990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 26326a7c9badSJouni Malinen return -EIO; 26336a7c9badSJouni Malinen 2634f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 26356a7c9badSJouni Malinen return -EOPNOTSUPP; 26366a7c9badSJouni Malinen 26378860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 26386a7c9badSJouni Malinen 26399a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 26409a5b1318SJouni Malinen 26416a7c9badSJouni Malinen /* TODO: 26426a7c9badSJouni Malinen * info->interval 26436a7c9badSJouni Malinen * info->dtim_period 26446a7c9badSJouni Malinen */ 26456a7c9badSJouni Malinen 26468860020eSJohannes Berg if (info->beacon.head == NULL) 26476a7c9badSJouni Malinen return -EINVAL; 26488860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 26496a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 26508860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 26516a7c9badSJouni Malinen return -EINVAL; 26528860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 26536a7c9badSJouni Malinen 26546a7c9badSJouni Malinen if (info->ssid == NULL) 26556a7c9badSJouni Malinen return -EINVAL; 26563450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 26573450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 26586a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 265967cd22e4SThomas Pedersen hidden = true; 266067cd22e4SThomas Pedersen 266167cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 266267cd22e4SThomas Pedersen if (res) 266367cd22e4SThomas Pedersen return res; 26646a7c9badSJouni Malinen 2665be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2666be5abaafSVasanthakumar Thiagarajan if (ret) 2667be5abaafSVasanthakumar Thiagarajan return ret; 26686a7c9badSJouni Malinen 26696a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 26706a7c9badSJouni Malinen 26716a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 26726a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 26736a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 26746a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 26756a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 26766a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 26776a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 26786a7c9badSJouni Malinen break; 26796a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 26806a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 26816a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 26826a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 26836a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 26846a7c9badSJouni Malinen break; 26856a7c9badSJouni Malinen } 26866a7c9badSJouni Malinen } 26876a7c9badSJouni Malinen if (p.auth_mode == 0) 26886a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 26893450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 26906a7c9badSJouni Malinen 26916a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 26926a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 26936a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 26946a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 26956a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 26966a7c9badSJouni Malinen break; 26976a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 26986a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 26996a7c9badSJouni Malinen break; 27006a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27016a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 27026a7c9badSJouni Malinen break; 2703b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2704b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2705b8214df1SDai Shuibing break; 27066a7c9badSJouni Malinen } 27076a7c9badSJouni Malinen } 2708229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 27096a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2710240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2711229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2712240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 27136a7c9badSJouni Malinen 27146a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 27156a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27166a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27176a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 27186a7c9badSJouni Malinen break; 27196a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27206a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 27216a7c9badSJouni Malinen break; 27226a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27236a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 27246a7c9badSJouni Malinen break; 2725b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2726b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2727b8214df1SDai Shuibing break; 27286a7c9badSJouni Malinen default: 27296a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 27306a7c9badSJouni Malinen break; 27316a7c9badSJouni Malinen } 2732240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 27336a7c9badSJouni Malinen 27346a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2735f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 27366a7c9badSJouni Malinen 27373450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 27383450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 27393450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2740cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 27416a7c9badSJouni Malinen 2742c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2743c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2744c1762a3fSThirumalai Pachamuthu if (res < 0) 2745c1762a3fSThirumalai Pachamuthu return res; 2746c1762a3fSThirumalai Pachamuthu 27473ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 27483ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 27493ca9d1fcSAarthi Thiruvengadam } else { 27503ca9d1fcSAarthi Thiruvengadam /* 27513ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 27523ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 27533ca9d1fcSAarthi Thiruvengadam */ 27543ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 27553ca9d1fcSAarthi Thiruvengadam } 27563ca9d1fcSAarthi Thiruvengadam 275703bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 275803bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 275903bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 276003bdeb0dSVasanthakumar Thiagarajan if (res < 0) 276103bdeb0dSVasanthakumar Thiagarajan return res; 276203bdeb0dSVasanthakumar Thiagarajan } 276303bdeb0dSVasanthakumar Thiagarajan 2764df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, vif->next_ch_band, 2765df90b369SVasanthakumar Thiagarajan vif->next_ch_type != NL80211_CHAN_NO_HT)) 2766df90b369SVasanthakumar Thiagarajan return -EIO; 2767df90b369SVasanthakumar Thiagarajan 2768d97c121bSVasanthakumar Thiagarajan /* 2769d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2770d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2771d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2772d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2773d97c121bSVasanthakumar Thiagarajan */ 2774d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2775d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2776d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2777d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2778d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2779d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2780d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2781d97c121bSVasanthakumar Thiagarajan if (res < 0) 2782d97c121bSVasanthakumar Thiagarajan return res; 2783d97c121bSVasanthakumar Thiagarajan } 2784d97c121bSVasanthakumar Thiagarajan 2785c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2786334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 27879a5b1318SJouni Malinen if (res < 0) 27889a5b1318SJouni Malinen return res; 27899a5b1318SJouni Malinen 27909a5b1318SJouni Malinen return 0; 27916a7c9badSJouni Malinen } 27926a7c9badSJouni Malinen 27938860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 27948860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 27956a7c9badSJouni Malinen { 27968860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 27978860020eSJohannes Berg 27988860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 27998860020eSJohannes Berg return -EIO; 28008860020eSJohannes Berg 28018860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 28028860020eSJohannes Berg return -EOPNOTSUPP; 28038860020eSJohannes Berg 28048860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 28056a7c9badSJouni Malinen } 28066a7c9badSJouni Malinen 28078860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 28086a7c9badSJouni Malinen { 28096a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 281059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28116a7c9badSJouni Malinen 2812f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 28136a7c9badSJouni Malinen return -EOPNOTSUPP; 281459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 28156a7c9badSJouni Malinen return -ENOTCONN; 28166a7c9badSJouni Malinen 2817334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 281859c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 28196a7c9badSJouni Malinen 2820df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 2821df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, IEEE80211_BAND_2GHZ, true)) 2822df90b369SVasanthakumar Thiagarajan return -EIO; 2823df90b369SVasanthakumar Thiagarajan 2824df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, IEEE80211_BAND_5GHZ, true)) 2825df90b369SVasanthakumar Thiagarajan return -EIO; 2826df90b369SVasanthakumar Thiagarajan 28276a7c9badSJouni Malinen return 0; 28286a7c9badSJouni Malinen } 28296a7c9badSJouni Malinen 283033e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 283133e5308dSJouni Malinen 283233e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 283333e5308dSJouni Malinen u8 *mac) 283433e5308dSJouni Malinen { 283533e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 283633e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 283733e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 283833e5308dSJouni Malinen 283933e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 284033e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 284133e5308dSJouni Malinen } 284233e5308dSJouni Malinen 284323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 284423875136SJouni Malinen u8 *mac, struct station_parameters *params) 284523875136SJouni Malinen { 284623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2847f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 284823875136SJouni Malinen 2849f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 285023875136SJouni Malinen return -EOPNOTSUPP; 285123875136SJouni Malinen 285223875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 285323875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 285423875136SJouni Malinen return -EOPNOTSUPP; 285523875136SJouni Malinen 285623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2857334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2858334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2859334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2860334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 286123875136SJouni Malinen } 286223875136SJouni Malinen 286363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 286463fa1e0cSJouni Malinen struct net_device *dev, 286563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 286663fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 286763fa1e0cSJouni Malinen unsigned int duration, 286863fa1e0cSJouni Malinen u64 *cookie) 286963fa1e0cSJouni Malinen { 287063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2871334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28721052261eSJouni Malinen u32 id; 287363fa1e0cSJouni Malinen 287463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 287563fa1e0cSJouni Malinen * return -EBUSY */ 28761052261eSJouni Malinen id = ++vif->last_roc_id; 28771052261eSJouni Malinen if (id == 0) { 28781052261eSJouni Malinen /* Do not use 0 as the cookie value */ 28791052261eSJouni Malinen id = ++vif->last_roc_id; 28801052261eSJouni Malinen } 28811052261eSJouni Malinen *cookie = id; 288263fa1e0cSJouni Malinen 2883334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2884334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 288563fa1e0cSJouni Malinen } 288663fa1e0cSJouni Malinen 288763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 288863fa1e0cSJouni Malinen struct net_device *dev, 288963fa1e0cSJouni Malinen u64 cookie) 289063fa1e0cSJouni Malinen { 289163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2892334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 289363fa1e0cSJouni Malinen 28941052261eSJouni Malinen if (cookie != vif->last_roc_id) 289563fa1e0cSJouni Malinen return -ENOENT; 28961052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 289763fa1e0cSJouni Malinen 2898334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 289963fa1e0cSJouni Malinen } 290063fa1e0cSJouni Malinen 2901334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2902334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2903334234b5SVasanthakumar Thiagarajan unsigned int freq) 29048bdfbf40SJouni Malinen { 2905334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 29068bdfbf40SJouni Malinen const u8 *pos; 29078bdfbf40SJouni Malinen u8 *p2p; 29088bdfbf40SJouni Malinen int p2p_len; 29098bdfbf40SJouni Malinen int ret; 29108bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 29118bdfbf40SJouni Malinen 29128bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 29138bdfbf40SJouni Malinen 29148bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 29158bdfbf40SJouni Malinen 29168bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 29178bdfbf40SJouni Malinen if (p2p == NULL) 29188bdfbf40SJouni Malinen return -ENOMEM; 29198bdfbf40SJouni Malinen p2p_len = 0; 29208bdfbf40SJouni Malinen 29218bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 29228bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 29238bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 29248bdfbf40SJouni Malinen break; 29258bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 29268bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 29278bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 29288bdfbf40SJouni Malinen } 29298bdfbf40SJouni Malinen pos += 2 + pos[1]; 29308bdfbf40SJouni Malinen } 29318bdfbf40SJouni Malinen 2932334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2933334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 29348bdfbf40SJouni Malinen kfree(p2p); 29358bdfbf40SJouni Malinen return ret; 29368bdfbf40SJouni Malinen } 29378bdfbf40SJouni Malinen 2938d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2939d0ff7383SNaveen Gangadharan u32 id, 2940d0ff7383SNaveen Gangadharan u32 freq, 2941d0ff7383SNaveen Gangadharan u32 wait, 2942d0ff7383SNaveen Gangadharan const u8 *buf, 2943d0ff7383SNaveen Gangadharan size_t len, 2944d0ff7383SNaveen Gangadharan bool *more_data, 2945d0ff7383SNaveen Gangadharan bool no_cck) 2946d0ff7383SNaveen Gangadharan { 2947d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2948d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2949d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2950d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2951d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2952d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2953d0ff7383SNaveen Gangadharan 2954d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2955d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2956d0ff7383SNaveen Gangadharan return false; 2957d0ff7383SNaveen Gangadharan 2958d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2959d0ff7383SNaveen Gangadharan if (!conn) 2960d0ff7383SNaveen Gangadharan return false; 2961d0ff7383SNaveen Gangadharan 2962d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2963d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2964d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2965d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2966d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2967d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2968d0ff7383SNaveen Gangadharan return false; 2969d0ff7383SNaveen Gangadharan 2970d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2971d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2972d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2973d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2974d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2975d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2976d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2977d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2978d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2979d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2980d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2981d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2982d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2983d0ff7383SNaveen Gangadharan 2984d0ff7383SNaveen Gangadharan /* 2985d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2986d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2987d0ff7383SNaveen Gangadharan * STA. 2988d0ff7383SNaveen Gangadharan */ 2989d0ff7383SNaveen Gangadharan if (is_psq_empty) 2990d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2991d0ff7383SNaveen Gangadharan conn->aid, 1); 2992d0ff7383SNaveen Gangadharan return true; 2993d0ff7383SNaveen Gangadharan } 2994d0ff7383SNaveen Gangadharan 2995d0ff7383SNaveen Gangadharan /* 2996d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2997d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2998d0ff7383SNaveen Gangadharan */ 2999d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3000d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3001d0ff7383SNaveen Gangadharan *more_data = true; 3002d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3003d0ff7383SNaveen Gangadharan } 3004d0ff7383SNaveen Gangadharan 3005d0ff7383SNaveen Gangadharan return false; 3006d0ff7383SNaveen Gangadharan } 3007d0ff7383SNaveen Gangadharan 3008c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3009c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3010c86e4f44SAarthi Thiruvengadam { 3011c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3012c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3013c86e4f44SAarthi Thiruvengadam 3014c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3015c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3016c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3017c86e4f44SAarthi Thiruvengadam return true; 3018c86e4f44SAarthi Thiruvengadam } 3019c86e4f44SAarthi Thiruvengadam 3020c86e4f44SAarthi Thiruvengadam return false; 3021c86e4f44SAarthi Thiruvengadam } 3022c86e4f44SAarthi Thiruvengadam 30238a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 30248a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 30258a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 30268a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3027e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3028e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 30298a6c8060SJouni Malinen { 30308a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 303159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30328a6c8060SJouni Malinen u32 id; 30338bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3034d0ff7383SNaveen Gangadharan bool more_data, queued; 30358bdfbf40SJouni Malinen 30368bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3037c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3038c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3039c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 30408bdfbf40SJouni Malinen /* 3041c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 30428bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 30438bdfbf40SJouni Malinen */ 30448bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3045334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 30468bdfbf40SJouni Malinen chan->center_freq); 30478bdfbf40SJouni Malinen } 30488a6c8060SJouni Malinen 3049cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30508a6c8060SJouni Malinen if (id == 0) { 30518a6c8060SJouni Malinen /* 30528a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 30538a6c8060SJouni Malinen * used for the command. 30548a6c8060SJouni Malinen */ 3055cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30568a6c8060SJouni Malinen } 30578a6c8060SJouni Malinen 30588a6c8060SJouni Malinen *cookie = id; 30593ca9d1fcSAarthi Thiruvengadam 3060d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3061d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3062d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3063d0ff7383SNaveen Gangadharan id, chan->center_freq, 3064d0ff7383SNaveen Gangadharan wait, buf, 3065d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3066d0ff7383SNaveen Gangadharan if (queued) 3067d0ff7383SNaveen Gangadharan return 0; 3068d0ff7383SNaveen Gangadharan } 3069d0ff7383SNaveen Gangadharan 30703ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 30713ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 30723ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 30733ca9d1fcSAarthi Thiruvengadam } 30748a6c8060SJouni Malinen 3075ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3076ae32c30aSJouni Malinen struct net_device *dev, 3077ae32c30aSJouni Malinen u16 frame_type, bool reg) 3078ae32c30aSJouni Malinen { 3079cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3080ae32c30aSJouni Malinen 3081ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3082ae32c30aSJouni Malinen __func__, frame_type, reg); 3083ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3084ae32c30aSJouni Malinen /* 3085ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3086ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3087ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3088ae32c30aSJouni Malinen */ 3089cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3090ae32c30aSJouni Malinen } 3091ae32c30aSJouni Malinen } 3092ae32c30aSJouni Malinen 309310509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 309410509f90SKalle Valo struct net_device *dev, 309510509f90SKalle Valo struct cfg80211_sched_scan_request *request) 309610509f90SKalle Valo { 309710509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 309810509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 309910509f90SKalle Valo u16 interval; 310010509f90SKalle Valo int ret; 310110509f90SKalle Valo u8 i; 310210509f90SKalle Valo 310310509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 310410509f90SKalle Valo return -EIO; 310510509f90SKalle Valo 310610509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 310710509f90SKalle Valo return -EBUSY; 310810509f90SKalle Valo 3109b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3110b4d13d3bSKalle Valo 311110509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 311210509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 311310509f90SKalle Valo i, DISABLE_SSID_FLAG, 311410509f90SKalle Valo 0, NULL); 311510509f90SKalle Valo } 311610509f90SKalle Valo 311710509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 311810509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 311910509f90SKalle Valo 312010509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 312110509f90SKalle Valo interval, interval, 312210509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 312310509f90SKalle Valo 312410509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 312510509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 312610509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 312710509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 312810509f90SKalle Valo request->ssids[i].ssid_len, 312910509f90SKalle Valo request->ssids[i].ssid); 313010509f90SKalle Valo } 313110509f90SKalle Valo } 313210509f90SKalle Valo 313310509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 313410509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 313510509f90SKalle Valo WOW_FILTER_SSID, 313610509f90SKalle Valo WOW_HOST_REQ_DELAY); 313710509f90SKalle Valo if (ret) { 313810509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 313910509f90SKalle Valo return ret; 314010509f90SKalle Valo } 314110509f90SKalle Valo 314210509f90SKalle Valo /* this also clears IE in fw if it's not set */ 314310509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 314410509f90SKalle Valo WMI_FRAME_PROBE_REQ, 314510509f90SKalle Valo request->ie, request->ie_len); 314610509f90SKalle Valo if (ret) { 314710509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 314810509f90SKalle Valo ret); 314910509f90SKalle Valo return ret; 315010509f90SKalle Valo } 315110509f90SKalle Valo 315210509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 315310509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 315410509f90SKalle Valo if (ret) { 315510509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 315610509f90SKalle Valo ret); 315710509f90SKalle Valo return ret; 315810509f90SKalle Valo } 315910509f90SKalle Valo 316010509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 316110509f90SKalle Valo 316210509f90SKalle Valo return ret; 316310509f90SKalle Valo } 316410509f90SKalle Valo 316510509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 316610509f90SKalle Valo struct net_device *dev) 316710509f90SKalle Valo { 316810509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 316910509f90SKalle Valo bool stopped; 317010509f90SKalle Valo 317110509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 317210509f90SKalle Valo 317310509f90SKalle Valo if (!stopped) 317410509f90SKalle Valo return -EIO; 317510509f90SKalle Valo 317610509f90SKalle Valo return 0; 317710509f90SKalle Valo } 317810509f90SKalle Valo 3179f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3180f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3181f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3182f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3183f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3184f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3185f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3186f80574aeSJouni Malinen }, 3187ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3188ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3189ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3190ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3191ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3192ba1f6fe3SJouni Malinen }, 3193f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3194f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3195f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3196f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3197f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3198f80574aeSJouni Malinen }, 3199f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3200f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3201f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3202f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3203f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3204f80574aeSJouni Malinen }, 3205f80574aeSJouni Malinen }; 3206f80574aeSJouni Malinen 3207bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 320855055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 320955055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3210bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3211bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3212bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3213bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3214bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3215bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3216bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3217bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3218bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3219bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3220bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3221bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3222bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3223bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3224bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3225bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3226bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3227bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3228003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3229abcb344bSKalle Valo #ifdef CONFIG_PM 323052d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 323152d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3232abcb344bSKalle Valo #endif 32336a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 32348860020eSJohannes Berg .start_ap = ath6kl_start_ap, 32358860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 32368860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 323733e5308dSJouni Malinen .del_station = ath6kl_del_station, 323823875136SJouni Malinen .change_station = ath6kl_change_station, 323963fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 324063fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 32418a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3242ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 324310509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 324410509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3245bdcd8170SKalle Valo }; 3246bdcd8170SKalle Valo 32477125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3248ec4b7f60SKalle Valo { 324910509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 325010509f90SKalle Valo 3251ec4b7f60SKalle Valo switch (vif->sme_state) { 3252c97a31b0SKalle Valo case SME_DISCONNECTED: 3253c97a31b0SKalle Valo break; 3254ec4b7f60SKalle Valo case SME_CONNECTING: 3255ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3256ec4b7f60SKalle Valo NULL, 0, 3257ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3258ec4b7f60SKalle Valo GFP_KERNEL); 3259ec4b7f60SKalle Valo break; 3260ec4b7f60SKalle Valo case SME_CONNECTED: 3261ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3262ec4b7f60SKalle Valo break; 3263ec4b7f60SKalle Valo } 3264ec4b7f60SKalle Valo 3265ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3266ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 32677125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3268ec4b7f60SKalle Valo 3269ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 32701f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 32711f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3272ec4b7f60SKalle Valo 3273ec4b7f60SKalle Valo /* disable scanning */ 32747125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 32757125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 32767125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3277ec4b7f60SKalle Valo 3278ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3279ec4b7f60SKalle Valo } 3280ec4b7f60SKalle Valo 32817125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 32827125f01dSKalle Valo { 32837125f01dSKalle Valo struct ath6kl_vif *vif; 32847125f01dSKalle Valo 32857125f01dSKalle Valo vif = ath6kl_vif_first(ar); 32867125f01dSKalle Valo if (!vif) { 32877125f01dSKalle Valo /* save the current power mode before enabling power save */ 32887125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 32897125f01dSKalle Valo 32907125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3291cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 32927125f01dSKalle Valo return; 32937125f01dSKalle Valo } 32947125f01dSKalle Valo 32957125f01dSKalle Valo /* 32967125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 32977125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 32987125f01dSKalle Valo * sleeps. 32997125f01dSKalle Valo */ 33007125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 33017125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 33027125f01dSKalle Valo } 33037125f01dSKalle Valo 3304c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 33058dafb70eSVasanthakumar Thiagarajan { 33067baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 33072132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 33088dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 33098dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 33108dafb70eSVasanthakumar Thiagarajan } 33118dafb70eSVasanthakumar Thiagarajan 3312de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3313108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 331410509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 331510509f90SKalle Valo (unsigned long) vif); 331610509f90SKalle Valo 3317de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3318478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 33198dafb70eSVasanthakumar Thiagarajan 332080abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 332180abaf9bSVasanthakumar Thiagarajan 33228dafb70eSVasanthakumar Thiagarajan return 0; 33238dafb70eSVasanthakumar Thiagarajan } 33248dafb70eSVasanthakumar Thiagarajan 3325c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 33268dafb70eSVasanthakumar Thiagarajan { 332755055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 332880abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 332955055976SVasanthakumar Thiagarajan 33302132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3331108438bcSVasanthakumar Thiagarajan 333255055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 333355055976SVasanthakumar Thiagarajan 333455055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 333555055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 333655055976SVasanthakumar Thiagarajan 333780abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 333880abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 333980abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 334080abaf9bSVasanthakumar Thiagarajan } 334180abaf9bSVasanthakumar Thiagarajan 334227929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 334355055976SVasanthakumar Thiagarajan 334455055976SVasanthakumar Thiagarajan ar->num_vif--; 33458dafb70eSVasanthakumar Thiagarajan } 33468dafb70eSVasanthakumar Thiagarajan 33478dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 334855055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 334955055976SVasanthakumar Thiagarajan u8 nw_type) 33508dafb70eSVasanthakumar Thiagarajan { 33518dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3352108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 33538dafb70eSVasanthakumar Thiagarajan 335455055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 33558dafb70eSVasanthakumar Thiagarajan if (!ndev) 33568dafb70eSVasanthakumar Thiagarajan return NULL; 33578dafb70eSVasanthakumar Thiagarajan 3358108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3359108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3360108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3361108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3362108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3363108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3364108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3365108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3366334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3367d0d670abSKalle Valo vif->nw_type = nw_type; 3368d0d670abSKalle Valo vif->next_mode = nw_type; 33698f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3370ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3371df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 33728dafb70eSVasanthakumar Thiagarajan 337355055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 337455055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 337555055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 337655055976SVasanthakumar Thiagarajan 0x2; 337755055976SVasanthakumar Thiagarajan 33788dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 33798dafb70eSVasanthakumar Thiagarajan 3380e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 33818dafb70eSVasanthakumar Thiagarajan 3382c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 33838dafb70eSVasanthakumar Thiagarajan goto err; 33848dafb70eSVasanthakumar Thiagarajan 338527929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 33868dafb70eSVasanthakumar Thiagarajan goto err; 33878dafb70eSVasanthakumar Thiagarajan 338855055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 338914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 339059c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 33918dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 339259c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 33938dafb70eSVasanthakumar Thiagarajan 339455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 339555055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 339655055976SVasanthakumar Thiagarajan 339711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3398990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 339911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3400990bd915SVasanthakumar Thiagarajan 34018dafb70eSVasanthakumar Thiagarajan return ndev; 34028dafb70eSVasanthakumar Thiagarajan 34038dafb70eSVasanthakumar Thiagarajan err: 340427929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 340527929723SVasanthakumar Thiagarajan free_netdev(ndev); 3406bdcd8170SKalle Valo return NULL; 3407bdcd8170SKalle Valo } 3408bdcd8170SKalle Valo 340946d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 341046d33a21SKalle Valo { 341146d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 341246d33a21SKalle Valo int ret; 341346d33a21SKalle Valo 341446d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 341546d33a21SKalle Valo 341646d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 341746d33a21SKalle Valo 341846d33a21SKalle Valo /* set device pointer for wiphy */ 341946d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 342046d33a21SKalle Valo 342146d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 342246d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 342346d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 342446d33a21SKalle Valo if (ar->p2p) { 342546d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 342646d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 342746d33a21SKalle Valo } 342846d33a21SKalle Valo 342946d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 343046d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 343146d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 343246d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 343346d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 343446d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 343546d33a21SKalle Valo 343646d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 343746d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 343846d33a21SKalle Valo 343946d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 344046d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 344146d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 344246d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 344346d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 344446d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 344546d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 344646d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 344746d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 344846d33a21SKalle Valo 344946d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 345046d33a21SKalle Valo 3451f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3452f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3453f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3454f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3455f2afdac7SVasanthakumar Thiagarajan 3456f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3457f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3458f2afdac7SVasanthakumar Thiagarajan 345903bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 346003bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 346103bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 346203bdeb0dSVasanthakumar Thiagarajan 3463f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3464f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3465f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3466f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3467f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3468f2afdac7SVasanthakumar Thiagarajan 346946d33a21SKalle Valo ret = wiphy_register(wiphy); 347046d33a21SKalle Valo if (ret < 0) { 347146d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 347246d33a21SKalle Valo return ret; 347346d33a21SKalle Valo } 347446d33a21SKalle Valo 3475e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3476e5348a1eSVasanthakumar Thiagarajan 347746d33a21SKalle Valo return 0; 347846d33a21SKalle Valo } 347946d33a21SKalle Valo 348046d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3481bdcd8170SKalle Valo { 3482be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3483e5348a1eSVasanthakumar Thiagarajan 3484e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 348545eaa78fSKalle Valo } 348646d33a21SKalle Valo 348745eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 348845eaa78fSKalle Valo { 348945eaa78fSKalle Valo struct ath6kl *ar; 349045eaa78fSKalle Valo struct wiphy *wiphy; 349145eaa78fSKalle Valo 349245eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 349345eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 349445eaa78fSKalle Valo 349545eaa78fSKalle Valo if (!wiphy) { 349645eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 349745eaa78fSKalle Valo return NULL; 349845eaa78fSKalle Valo } 349945eaa78fSKalle Valo 350045eaa78fSKalle Valo ar = wiphy_priv(wiphy); 350145eaa78fSKalle Valo ar->wiphy = wiphy; 350245eaa78fSKalle Valo 350345eaa78fSKalle Valo return ar; 350445eaa78fSKalle Valo } 350545eaa78fSKalle Valo 350645eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 350745eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 350845eaa78fSKalle Valo { 35091d2a4456SVasanthakumar Thiagarajan int i; 35101d2a4456SVasanthakumar Thiagarajan 35111d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 35121d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 35131d2a4456SVasanthakumar Thiagarajan 3514be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3515bdcd8170SKalle Valo } 351645eaa78fSKalle Valo 3517