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 8853b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 8863b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 8873b8ffc6aSJouni Malinen struct cfg80211_ssid *ssids, int n_ssids) 8883b8ffc6aSJouni Malinen { 8893b8ffc6aSJouni Malinen u8 i; 8903b8ffc6aSJouni Malinen 8913b8ffc6aSJouni Malinen if (n_ssids > MAX_PROBED_SSID_INDEX) 8923b8ffc6aSJouni Malinen return -EINVAL; 8933b8ffc6aSJouni Malinen 8943b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 8953b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 8963b8ffc6aSJouni Malinen ssids[i].ssid_len ? 8973b8ffc6aSJouni Malinen SPECIFIC_SSID_FLAG : ANY_SSID_FLAG, 8983b8ffc6aSJouni Malinen ssids[i].ssid_len, 8993b8ffc6aSJouni Malinen ssids[i].ssid); 9003b8ffc6aSJouni Malinen } 9013b8ffc6aSJouni Malinen 9023b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 9033b8ffc6aSJouni Malinen for (i = n_ssids; i < MAX_PROBED_SSID_INDEX; i++) { 9043b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9053b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9063b8ffc6aSJouni Malinen } 9073b8ffc6aSJouni Malinen 9083b8ffc6aSJouni Malinen return 0; 9093b8ffc6aSJouni Malinen } 9103b8ffc6aSJouni Malinen 911bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 912bdcd8170SKalle Valo struct cfg80211_scan_request *request) 913bdcd8170SKalle Valo { 914d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 91559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 9161276c9efSEdward Lu s8 n_channels = 0; 9171276c9efSEdward Lu u16 *channels = NULL; 918bdcd8170SKalle Valo int ret = 0; 919f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 920bdcd8170SKalle Valo 921990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 922bdcd8170SKalle Valo return -EIO; 923bdcd8170SKalle Valo 92410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 92510509f90SKalle Valo 926bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 92759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 928954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 929954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 9301b1e6ee3SJouni Malinen if (ret) { 931bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9321b1e6ee3SJouni Malinen return ret; 933bdcd8170SKalle Valo } 934bdcd8170SKalle Valo } 935bdcd8170SKalle Valo 9363b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 9373b8ffc6aSJouni Malinen request->n_ssids); 9383b8ffc6aSJouni Malinen if (ret < 0) 9393b8ffc6aSJouni Malinen return ret; 940bdcd8170SKalle Valo 941080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 942334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 943334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 944b84da8c7SJouni Malinen request->ie, request->ie_len); 945b84da8c7SJouni Malinen if (ret) { 946cdeb8602SKalle Valo ath6kl_err("failed to set Probe Request appie for scan"); 947b84da8c7SJouni Malinen return ret; 948b84da8c7SJouni Malinen } 949b84da8c7SJouni Malinen 95011869befSJouni Malinen /* 95111869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 95211869befSJouni Malinen * channels. If the list is longer than the target supports, do not 95311869befSJouni Malinen * configure the list and instead, scan all available channels. 95411869befSJouni Malinen */ 95511869befSJouni Malinen if (request->n_channels > 0 && 95611869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9571276c9efSEdward Lu u8 i; 9581276c9efSEdward Lu 95911869befSJouni Malinen n_channels = request->n_channels; 9601276c9efSEdward Lu 9611276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9621276c9efSEdward Lu if (channels == NULL) { 963cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 9641276c9efSEdward Lu n_channels = 0; 9651276c9efSEdward Lu } 9661276c9efSEdward Lu 9671276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9681276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9691276c9efSEdward Lu } 9701276c9efSEdward Lu 97159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 972f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 973f1f92179SVasanthakumar Thiagarajan 9745b35dff0SRaja Mani vif->scan_req = request; 9755b35dff0SRaja Mani 9763ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9773ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9783ca9d1fcSAarthi Thiruvengadam /* 9793ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9803ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9813ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9823ca9d1fcSAarthi Thiruvengadam * probe requests 9833ca9d1fcSAarthi Thiruvengadam */ 9843ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9853ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 98613423c31SVasanthakumar Thiagarajan false, 0, 98713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 98813423c31SVasanthakumar Thiagarajan n_channels, channels, 98913423c31SVasanthakumar Thiagarajan request->no_cck, 9903ca9d1fcSAarthi Thiruvengadam request->rates); 9913ca9d1fcSAarthi Thiruvengadam } else { 9923ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9933ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 99413423c31SVasanthakumar Thiagarajan false, 0, 99513423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 99613423c31SVasanthakumar Thiagarajan n_channels, channels); 9973ca9d1fcSAarthi Thiruvengadam } 9985b35dff0SRaja Mani if (ret) { 999bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 10005b35dff0SRaja Mani vif->scan_req = NULL; 10015b35dff0SRaja Mani } 1002bdcd8170SKalle Valo 10031276c9efSEdward Lu kfree(channels); 10041276c9efSEdward Lu 1005bdcd8170SKalle Valo return ret; 1006bdcd8170SKalle Valo } 1007bdcd8170SKalle Valo 10081c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1009bdcd8170SKalle Valo { 1010240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10116fd1eaceSKalle Valo int i; 1012bdcd8170SKalle Valo 10131c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10141c17d313SKalle Valo aborted ? " aborted" : ""); 1015bdcd8170SKalle Valo 101614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10176fd1eaceSKalle Valo return; 10186fd1eaceSKalle Valo 10191c17d313SKalle Valo if (aborted) 10206fd1eaceSKalle Valo goto out; 1021bdcd8170SKalle Valo 102214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 102314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1024334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1025334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1026bdcd8170SKalle Valo 0, NULL); 1027bdcd8170SKalle Valo } 1028bdcd8170SKalle Valo } 10296fd1eaceSKalle Valo 10306fd1eaceSKalle Valo out: 1031cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 103214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1033bdcd8170SKalle Valo } 1034bdcd8170SKalle Valo 1035c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1036c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1037c4f7863eSThomas Pedersen { 1038c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1039c4f7863eSThomas Pedersen 1040c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1041c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1042c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1043c4f7863eSThomas Pedersen 1044c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1045c4f7863eSThomas Pedersen 1046c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1047c4f7863eSThomas Pedersen } 1048c4f7863eSThomas Pedersen 1049bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1050bdcd8170SKalle Valo u8 key_index, bool pairwise, 1051bdcd8170SKalle Valo const u8 *mac_addr, 1052bdcd8170SKalle Valo struct key_params *params) 1053bdcd8170SKalle Valo { 1054d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 105559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1056bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10574a8ce2fdSSujith Manoharan int seq_len; 1058bdcd8170SKalle Valo u8 key_usage; 1059bdcd8170SKalle Valo u8 key_type; 1060bdcd8170SKalle Valo 1061990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1062bdcd8170SKalle Valo return -EIO; 1063bdcd8170SKalle Valo 1064837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1065837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1066837cb97eSJouni Malinen return -EINVAL; 1067240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1068240d2799SVasanthakumar Thiagarajan params->key); 1069837cb97eSJouni Malinen } 1070837cb97eSJouni Malinen 1071792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1072bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1073bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1074bdcd8170SKalle Valo key_index); 1075bdcd8170SKalle Valo return -ENOENT; 1076bdcd8170SKalle Valo } 1077bdcd8170SKalle Valo 10786f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1079bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1080bdcd8170SKalle Valo 1081bdcd8170SKalle Valo if (pairwise) 1082bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1083bdcd8170SKalle Valo else 1084bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1085bdcd8170SKalle Valo 10864a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10875e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10885e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10895e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10905e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10915e07021eSDai Shuibing } 1092bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10935e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1094bdcd8170SKalle Valo return -EINVAL; 1095bdcd8170SKalle Valo 1096bdcd8170SKalle Valo key->key_len = params->key_len; 1097bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10985e07021eSDai Shuibing key->seq_len = seq_len; 1099bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1100bdcd8170SKalle Valo key->cipher = params->cipher; 1101bdcd8170SKalle Valo 1102bdcd8170SKalle Valo switch (key->cipher) { 1103bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1104bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1105bdcd8170SKalle Valo key_type = WEP_CRYPT; 1106bdcd8170SKalle Valo break; 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1109bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1110bdcd8170SKalle Valo break; 1111bdcd8170SKalle Valo 1112bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1113bdcd8170SKalle Valo key_type = AES_CRYPT; 1114bdcd8170SKalle Valo break; 11155e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11165e07021eSDai Shuibing key_type = WAPI_CRYPT; 11175e07021eSDai Shuibing break; 1118bdcd8170SKalle Valo 1119bdcd8170SKalle Valo default: 1120bdcd8170SKalle Valo return -ENOTSUPP; 1121bdcd8170SKalle Valo } 1122bdcd8170SKalle Valo 1123ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1124ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1125ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1126de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1127bdcd8170SKalle Valo 1128bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1129bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1130bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1131bdcd8170SKalle Valo key_usage, key->seq_len); 1132bdcd8170SKalle Valo 1133f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11344703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1135cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11369a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11379a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11389a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11399a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11409a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 114159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1142cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1143cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 11449a5b1318SJouni Malinen /* 11459a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11469a5b1318SJouni Malinen * the connected event is received from the target. 11479a5b1318SJouni Malinen */ 11489a5b1318SJouni Malinen return 0; 11499a5b1318SJouni Malinen } 11509a5b1318SJouni Malinen } 11519a5b1318SJouni Malinen 1152f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 115359c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1154151411e8SJouni Malinen /* 1155151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1156151411e8SJouni Malinen * the AP mode has properly started 1157151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1158151411e8SJouni Malinen */ 1159cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1160cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 11616f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11626f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11636f2a73f9SVasanthakumar Thiagarajan key->key_len); 1164151411e8SJouni Malinen return 0; 1165151411e8SJouni Malinen } 1166151411e8SJouni Malinen 11677cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1168bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1169f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1170f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1171bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1172bdcd8170SKalle Valo } 1173bdcd8170SKalle Valo 1174bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1175bdcd8170SKalle Valo u8 key_index, bool pairwise, 1176bdcd8170SKalle Valo const u8 *mac_addr) 1177bdcd8170SKalle Valo { 1178d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11796f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1182bdcd8170SKalle Valo 1183990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1184bdcd8170SKalle Valo return -EIO; 1185bdcd8170SKalle Valo 1186792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1187bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1188bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1189bdcd8170SKalle Valo key_index); 1190bdcd8170SKalle Valo return -ENOENT; 1191bdcd8170SKalle Valo } 1192bdcd8170SKalle Valo 11936f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1194bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1195bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1196bdcd8170SKalle Valo return 0; 1197bdcd8170SKalle Valo } 1198bdcd8170SKalle Valo 11996f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1200bdcd8170SKalle Valo 1201334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1202bdcd8170SKalle Valo } 1203bdcd8170SKalle Valo 1204bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1205bdcd8170SKalle Valo u8 key_index, bool pairwise, 1206bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1207bdcd8170SKalle Valo void (*callback) (void *cookie, 1208bdcd8170SKalle Valo struct key_params *)) 1209bdcd8170SKalle Valo { 12106f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1211bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1212bdcd8170SKalle Valo struct key_params params; 1213bdcd8170SKalle Valo 1214bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1215bdcd8170SKalle Valo 1216990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1217bdcd8170SKalle Valo return -EIO; 1218bdcd8170SKalle Valo 1219792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1221bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1222bdcd8170SKalle Valo key_index); 1223bdcd8170SKalle Valo return -ENOENT; 1224bdcd8170SKalle Valo } 1225bdcd8170SKalle Valo 12266f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1227bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1228bdcd8170SKalle Valo params.cipher = key->cipher; 1229bdcd8170SKalle Valo params.key_len = key->key_len; 1230bdcd8170SKalle Valo params.seq_len = key->seq_len; 1231bdcd8170SKalle Valo params.seq = key->seq; 1232bdcd8170SKalle Valo params.key = key->key; 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo callback(cookie, ¶ms); 1235bdcd8170SKalle Valo 1236bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1237bdcd8170SKalle Valo } 1238bdcd8170SKalle Valo 1239bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1240bdcd8170SKalle Valo struct net_device *ndev, 1241bdcd8170SKalle Valo u8 key_index, bool unicast, 1242bdcd8170SKalle Valo bool multicast) 1243bdcd8170SKalle Valo { 1244d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 124559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1246bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1247bdcd8170SKalle Valo u8 key_usage; 1248229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1249bdcd8170SKalle Valo 1250bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1251bdcd8170SKalle Valo 1252990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1253bdcd8170SKalle Valo return -EIO; 1254bdcd8170SKalle Valo 1255792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1256bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1257bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1258bdcd8170SKalle Valo __func__, key_index); 1259bdcd8170SKalle Valo return -ENOENT; 1260bdcd8170SKalle Valo } 1261bdcd8170SKalle Valo 12626f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1264bdcd8170SKalle Valo __func__, key_index); 1265bdcd8170SKalle Valo return -EINVAL; 1266bdcd8170SKalle Valo } 1267bdcd8170SKalle Valo 12683450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12696f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1270bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12713450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1272bdcd8170SKalle Valo key_usage |= TX_USAGE; 1273229ed6b5SEdward Lu if (unicast) 12743450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1275229ed6b5SEdward Lu if (multicast) 12763450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1277bdcd8170SKalle Valo 1278f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12799a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12809a5b1318SJouni Malinen 1281f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1282334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1283229ed6b5SEdward Lu key_type, key_usage, 1284f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1285f4bb9a6fSJouni Malinen key->key, 1286bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1287bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo 1290240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1291bdcd8170SKalle Valo bool ismcast) 1292bdcd8170SKalle Valo { 1293bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1294bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1295bdcd8170SKalle Valo 1296240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1297bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1298bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1299bdcd8170SKalle Valo GFP_KERNEL); 1300bdcd8170SKalle Valo } 1301bdcd8170SKalle Valo 1302bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1303bdcd8170SKalle Valo { 1304bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1305990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1306bdcd8170SKalle Valo int ret; 1307bdcd8170SKalle Valo 1308bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1309bdcd8170SKalle Valo changed); 1310bdcd8170SKalle Valo 1311990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1312990bd915SVasanthakumar Thiagarajan if (!vif) 1313990bd915SVasanthakumar Thiagarajan return -EIO; 1314990bd915SVasanthakumar Thiagarajan 1315990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1316bdcd8170SKalle Valo return -EIO; 1317bdcd8170SKalle Valo 1318bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1319bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1320bdcd8170SKalle Valo if (ret != 0) { 1321bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1322bdcd8170SKalle Valo return -EIO; 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo } 1325bdcd8170SKalle Valo 1326bdcd8170SKalle Valo return 0; 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo 1329bdcd8170SKalle Valo /* 1330bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1331bdcd8170SKalle Valo * data type from 2.6.36 onwards 1332bdcd8170SKalle Valo */ 1333bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1334bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1335b992a285SLuis R. Rodriguez int mbm) 1336bdcd8170SKalle Valo { 1337bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1338990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1339b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1340bdcd8170SKalle Valo 1341bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1342bdcd8170SKalle Valo type, dbm); 1343bdcd8170SKalle Valo 1344990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1345990bd915SVasanthakumar Thiagarajan if (!vif) 1346990bd915SVasanthakumar Thiagarajan return -EIO; 1347990bd915SVasanthakumar Thiagarajan 1348990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1349bdcd8170SKalle Valo return -EIO; 1350bdcd8170SKalle Valo 1351bdcd8170SKalle Valo switch (type) { 1352bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1353bdcd8170SKalle Valo return 0; 1354bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1355d0d670abSKalle Valo ar->tx_pwr = dbm; 1356bdcd8170SKalle Valo break; 1357bdcd8170SKalle Valo default: 1358bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1359bdcd8170SKalle Valo __func__, type); 1360bdcd8170SKalle Valo return -EOPNOTSUPP; 1361bdcd8170SKalle Valo } 1362bdcd8170SKalle Valo 1363d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1364bdcd8170SKalle Valo 1365bdcd8170SKalle Valo return 0; 1366bdcd8170SKalle Valo } 1367bdcd8170SKalle Valo 1368bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1369bdcd8170SKalle Valo { 1370bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1371990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1372bdcd8170SKalle Valo 1373990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1374990bd915SVasanthakumar Thiagarajan if (!vif) 1375990bd915SVasanthakumar Thiagarajan return -EIO; 1376990bd915SVasanthakumar Thiagarajan 1377990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1378bdcd8170SKalle Valo return -EIO; 1379bdcd8170SKalle Valo 138059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1381bdcd8170SKalle Valo ar->tx_pwr = 0; 1382bdcd8170SKalle Valo 1383990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1384bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1385bdcd8170SKalle Valo return -EIO; 1386bdcd8170SKalle Valo } 1387bdcd8170SKalle Valo 1388bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1389bdcd8170SKalle Valo 5 * HZ); 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo if (signal_pending(current)) { 1392bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1393bdcd8170SKalle Valo return -EINTR; 1394bdcd8170SKalle Valo } 1395bdcd8170SKalle Valo } 1396bdcd8170SKalle Valo 1397bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1398bdcd8170SKalle Valo return 0; 1399bdcd8170SKalle Valo } 1400bdcd8170SKalle Valo 1401bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1402bdcd8170SKalle Valo struct net_device *dev, 1403bdcd8170SKalle Valo bool pmgmt, int timeout) 1404bdcd8170SKalle Valo { 1405bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1406bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1407334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1408bdcd8170SKalle Valo 1409bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1410bdcd8170SKalle Valo __func__, pmgmt, timeout); 1411bdcd8170SKalle Valo 1412990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1413bdcd8170SKalle Valo return -EIO; 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo if (pmgmt) { 1416bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1417bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1418bdcd8170SKalle Valo } else { 1419bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1420bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1421bdcd8170SKalle Valo } 1422bdcd8170SKalle Valo 1423334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1424334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1425bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1426bdcd8170SKalle Valo return -EIO; 1427bdcd8170SKalle Valo } 1428bdcd8170SKalle Valo 1429bdcd8170SKalle Valo return 0; 1430bdcd8170SKalle Valo } 1431bdcd8170SKalle Valo 143255055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 143355055976SVasanthakumar Thiagarajan char *name, 143455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 143555055976SVasanthakumar Thiagarajan u32 *flags, 143655055976SVasanthakumar Thiagarajan struct vif_params *params) 143755055976SVasanthakumar Thiagarajan { 143855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 143955055976SVasanthakumar Thiagarajan struct net_device *ndev; 144055055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 144155055976SVasanthakumar Thiagarajan 144271f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 144355055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 144455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 144555055976SVasanthakumar Thiagarajan } 144655055976SVasanthakumar Thiagarajan 144755055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 144855055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 144955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 145055055976SVasanthakumar Thiagarajan } 145155055976SVasanthakumar Thiagarajan 145255055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 145355055976SVasanthakumar Thiagarajan if (!ndev) 145455055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 145555055976SVasanthakumar Thiagarajan 145655055976SVasanthakumar Thiagarajan ar->num_vif++; 145755055976SVasanthakumar Thiagarajan 145855055976SVasanthakumar Thiagarajan return ndev; 145955055976SVasanthakumar Thiagarajan } 146055055976SVasanthakumar Thiagarajan 146155055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 146255055976SVasanthakumar Thiagarajan struct net_device *ndev) 146355055976SVasanthakumar Thiagarajan { 146455055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 146555055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 146655055976SVasanthakumar Thiagarajan 146711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 146855055976SVasanthakumar Thiagarajan list_del(&vif->list); 146911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 147055055976SVasanthakumar Thiagarajan 147155055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 147255055976SVasanthakumar Thiagarajan 1473c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 147455055976SVasanthakumar Thiagarajan 147555055976SVasanthakumar Thiagarajan return 0; 147655055976SVasanthakumar Thiagarajan } 147755055976SVasanthakumar Thiagarajan 1478bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1479bdcd8170SKalle Valo struct net_device *ndev, 1480bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1481bdcd8170SKalle Valo struct vif_params *params) 1482bdcd8170SKalle Valo { 1483f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 14841e8d13b0SVasanthakumar Thiagarajan int i; 1485bdcd8170SKalle Valo 1486bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1487bdcd8170SKalle Valo 14881e8d13b0SVasanthakumar Thiagarajan /* 14891e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 14901e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 14911e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 14921e8d13b0SVasanthakumar Thiagarajan */ 14931e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 14941e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 14951e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 14961e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 14971e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 14981e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 14991e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15001e8d13b0SVasanthakumar Thiagarajan else 15011e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15021e8d13b0SVasanthakumar Thiagarajan } 15031e8d13b0SVasanthakumar Thiagarajan 15041e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15051e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15061e8d13b0SVasanthakumar Thiagarajan break; 15071e8d13b0SVasanthakumar Thiagarajan } 15081e8d13b0SVasanthakumar Thiagarajan 15091e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15101e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15111e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15121e8d13b0SVasanthakumar Thiagarajan } 15131e8d13b0SVasanthakumar Thiagarajan } 15141e8d13b0SVasanthakumar Thiagarajan 15151e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1516bdcd8170SKalle Valo switch (type) { 1517bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1518f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1519bdcd8170SKalle Valo break; 1520bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1521f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1522bdcd8170SKalle Valo break; 15236e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1524f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15256e4604c8SJouni Malinen break; 15266b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1527f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15286b5e5d25SJouni Malinen break; 15296b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1530f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15316b5e5d25SJouni Malinen break; 1532bdcd8170SKalle Valo default: 1533bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1534bdcd8170SKalle Valo return -EOPNOTSUPP; 1535bdcd8170SKalle Valo } 1536bdcd8170SKalle Valo 1537551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1538bdcd8170SKalle Valo 1539bdcd8170SKalle Valo return 0; 1540bdcd8170SKalle Valo } 1541bdcd8170SKalle Valo 1542bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1543bdcd8170SKalle Valo struct net_device *dev, 1544bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1545bdcd8170SKalle Valo { 1546bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 154759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1548bdcd8170SKalle Valo int status; 1549bdcd8170SKalle Valo 1550990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1551bdcd8170SKalle Valo return -EIO; 1552bdcd8170SKalle Valo 15533450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 15543450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1555bdcd8170SKalle Valo 1556bdcd8170SKalle Valo if (ibss_param->channel) 1557f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1558bdcd8170SKalle Valo 1559bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1560bdcd8170SKalle Valo /* 1561bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1562bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1563bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1564bdcd8170SKalle Valo * updated. 1565bdcd8170SKalle Valo */ 1566bdcd8170SKalle Valo return -EOPNOTSUPP; 1567bdcd8170SKalle Valo } 1568bdcd8170SKalle Valo 15698c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1570bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 15718c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15728c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1573bdcd8170SKalle Valo 1574240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1575bdcd8170SKalle Valo 1576240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1577bdcd8170SKalle Valo if (status) 1578bdcd8170SKalle Valo return status; 1579bdcd8170SKalle Valo 1580bdcd8170SKalle Valo if (ibss_param->privacy) { 1581240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1582240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1583bdcd8170SKalle Valo } else { 1584240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1585240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1586bdcd8170SKalle Valo } 1587bdcd8170SKalle Valo 1588f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1589bdcd8170SKalle Valo 1590bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1591bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1592bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1593bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1594bdcd8170SKalle Valo __func__, 15953450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15963450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1597f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1598bdcd8170SKalle Valo 1599334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16003450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16013450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16023450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16033450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16043450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1605f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16063ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 160759c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1608bdcd8170SKalle Valo 1609bdcd8170SKalle Valo return 0; 1610bdcd8170SKalle Valo } 1611bdcd8170SKalle Valo 1612bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1613bdcd8170SKalle Valo struct net_device *dev) 1614bdcd8170SKalle Valo { 16153450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1616bdcd8170SKalle Valo 1617990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1618bdcd8170SKalle Valo return -EIO; 1619bdcd8170SKalle Valo 1620240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16213450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16223450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1623bdcd8170SKalle Valo 1624bdcd8170SKalle Valo return 0; 1625bdcd8170SKalle Valo } 1626bdcd8170SKalle Valo 1627bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1628bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1629bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1630bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1631bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1632837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16335e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1634bdcd8170SKalle Valo }; 1635bdcd8170SKalle Valo 1636bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1637bdcd8170SKalle Valo { 1638bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1639bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1640bdcd8170SKalle Valo 36000, 48000, 54000 1641bdcd8170SKalle Valo }; 1642bdcd8170SKalle Valo u8 i; 1643bdcd8170SKalle Valo 1644bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1645bdcd8170SKalle Valo if (rate == legacy[i]) 1646bdcd8170SKalle Valo return true; 1647bdcd8170SKalle Valo 1648bdcd8170SKalle Valo return false; 1649bdcd8170SKalle Valo } 1650bdcd8170SKalle Valo 1651bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1652bdcd8170SKalle Valo { 1653bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1654bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1655bdcd8170SKalle Valo }; 1656bdcd8170SKalle Valo u8 i; 1657bdcd8170SKalle Valo 1658bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1659bdcd8170SKalle Valo if (rate == ht20[i]) { 1660bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1661bdcd8170SKalle Valo /* last rate uses sgi */ 1662bdcd8170SKalle Valo *sgi = true; 1663bdcd8170SKalle Valo else 1664bdcd8170SKalle Valo *sgi = false; 1665bdcd8170SKalle Valo 1666bdcd8170SKalle Valo *mcs = i; 1667bdcd8170SKalle Valo return true; 1668bdcd8170SKalle Valo } 1669bdcd8170SKalle Valo } 1670bdcd8170SKalle Valo return false; 1671bdcd8170SKalle Valo } 1672bdcd8170SKalle Valo 1673bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1674bdcd8170SKalle Valo { 1675bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1676bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1677bdcd8170SKalle Valo 150000 1678bdcd8170SKalle Valo }; 1679bdcd8170SKalle Valo u8 i; 1680bdcd8170SKalle Valo 1681bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1682bdcd8170SKalle Valo if (rate == ht40[i]) { 1683bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1684bdcd8170SKalle Valo /* last rate uses sgi */ 1685bdcd8170SKalle Valo *sgi = true; 1686bdcd8170SKalle Valo else 1687bdcd8170SKalle Valo *sgi = false; 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo *mcs = i; 1690bdcd8170SKalle Valo return true; 1691bdcd8170SKalle Valo } 1692bdcd8170SKalle Valo } 1693bdcd8170SKalle Valo 1694bdcd8170SKalle Valo return false; 1695bdcd8170SKalle Valo } 1696bdcd8170SKalle Valo 1697bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1698bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1699bdcd8170SKalle Valo { 1700bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 170159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1702bdcd8170SKalle Valo long left; 1703bdcd8170SKalle Valo bool sgi; 1704bdcd8170SKalle Valo s32 rate; 1705bdcd8170SKalle Valo int ret; 1706bdcd8170SKalle Valo u8 mcs; 1707bdcd8170SKalle Valo 17088c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1709bdcd8170SKalle Valo return -ENOENT; 1710bdcd8170SKalle Valo 1711bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1712bdcd8170SKalle Valo return -EBUSY; 1713bdcd8170SKalle Valo 1714b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1715bdcd8170SKalle Valo 1716334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1717bdcd8170SKalle Valo 1718bdcd8170SKalle Valo if (ret != 0) { 1719bdcd8170SKalle Valo up(&ar->sem); 1720bdcd8170SKalle Valo return -EIO; 1721bdcd8170SKalle Valo } 1722bdcd8170SKalle Valo 1723bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1724bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1725b95907a7SVasanthakumar Thiagarajan &vif->flags), 1726bdcd8170SKalle Valo WMI_TIMEOUT); 1727bdcd8170SKalle Valo 1728bdcd8170SKalle Valo up(&ar->sem); 1729bdcd8170SKalle Valo 1730bdcd8170SKalle Valo if (left == 0) 1731bdcd8170SKalle Valo return -ETIMEDOUT; 1732bdcd8170SKalle Valo else if (left < 0) 1733bdcd8170SKalle Valo return left; 1734bdcd8170SKalle Valo 1735b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1736b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1737bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1738b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1739bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1740bdcd8170SKalle Valo } 1741bdcd8170SKalle Valo 1742b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1743b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1744bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1745b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1746bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1747bdcd8170SKalle Valo } 1748bdcd8170SKalle Valo 1749b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1750bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1751bdcd8170SKalle Valo 1752b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1753bdcd8170SKalle Valo 1754bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1755bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1756bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1757bdcd8170SKalle Valo if (sgi) { 1758bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1759bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1760bdcd8170SKalle Valo } else { 1761bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1762bdcd8170SKalle Valo } 1763bdcd8170SKalle Valo 1764bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1765bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1766bdcd8170SKalle Valo if (sgi) { 1767bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1768bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1769bdcd8170SKalle Valo } else { 1770bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1771bdcd8170SKalle Valo } 1772bdcd8170SKalle Valo 1773bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1774bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1775bdcd8170SKalle Valo } else { 17769a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17779a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17789a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1779bdcd8170SKalle Valo return 0; 1780bdcd8170SKalle Valo } 1781bdcd8170SKalle Valo 1782bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1783bdcd8170SKalle Valo 178459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 178559c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1786f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 178732c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 178832c10874SJouni Malinen sinfo->bss_param.flags = 0; 1789cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1790cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 179132c10874SJouni Malinen } 179232c10874SJouni Malinen 1793bdcd8170SKalle Valo return 0; 1794bdcd8170SKalle Valo } 1795bdcd8170SKalle Valo 1796bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1797bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1798bdcd8170SKalle Valo { 1799bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1800334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1801334234b5SVasanthakumar Thiagarajan 1802334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1803bdcd8170SKalle Valo pmksa->pmkid, true); 1804bdcd8170SKalle Valo } 1805bdcd8170SKalle Valo 1806bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1807bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1808bdcd8170SKalle Valo { 1809bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1810334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1811334234b5SVasanthakumar Thiagarajan 1812334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1813bdcd8170SKalle Valo pmksa->pmkid, false); 1814bdcd8170SKalle Valo } 1815bdcd8170SKalle Valo 1816bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1817bdcd8170SKalle Valo { 1818bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 181959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 182059c98449SVasanthakumar Thiagarajan 182159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1822334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1823334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1824bdcd8170SKalle Valo return 0; 1825bdcd8170SKalle Valo } 1826bdcd8170SKalle Valo 1827d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1828d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18296cb3c714SRaja Mani { 1830d91e8eeeSRaja Mani int ret, pos; 1831d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 18326cb3c714SRaja Mani u16 i; 18336cb3c714SRaja Mani 1834d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18356cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 18366cb3c714SRaja Mani 18376cb3c714SRaja Mani /* 18386cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 18396cb3c714SRaja Mani * driver specific mask value and send it to the chip along 18406cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 18416cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 18426cb3c714SRaja Mani * then equivalent driver specific mask value is 18436cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 18446cb3c714SRaja Mani */ 18456cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 18466cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 18476cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 18486cb3c714SRaja Mani mask[pos] = 0xFF; 18496cb3c714SRaja Mani } 18506cb3c714SRaja Mani /* 18516cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 18526cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 18536cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 18546cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 18556cb3c714SRaja Mani */ 18566cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 18576cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 18586cb3c714SRaja Mani wow->patterns[i].pattern_len, 18596cb3c714SRaja Mani 0 /* pattern offset */, 18606cb3c714SRaja Mani wow->patterns[i].pattern, mask); 18616cb3c714SRaja Mani if (ret) 18626cb3c714SRaja Mani return ret; 18636cb3c714SRaja Mani } 18646cb3c714SRaja Mani 1865d91e8eeeSRaja Mani if (wow->disconnect) 1866d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1867d91e8eeeSRaja Mani 1868d91e8eeeSRaja Mani if (wow->magic_pkt) 1869d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1870d91e8eeeSRaja Mani 1871d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1872d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1873d91e8eeeSRaja Mani 1874d91e8eeeSRaja Mani if (wow->eap_identity_req) 1875d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1876d91e8eeeSRaja Mani 1877d91e8eeeSRaja Mani if (wow->four_way_handshake) 1878d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1879d91e8eeeSRaja Mani 1880d91e8eeeSRaja Mani return 0; 1881d91e8eeeSRaja Mani } 1882d91e8eeeSRaja Mani 1883d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1884d91e8eeeSRaja Mani { 1885d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1886d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1887d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1888d91e8eeeSRaja Mani 0x00, 0x08 }; 1889d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1890d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1891d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1892d91e8eeeSRaja Mani 0x00, 0x7f }; 1893d91e8eeeSRaja Mani u8 unicst_offset = 0; 1894d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1895d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1896d91e8eeeSRaja Mani u8 arp_offset = 20; 1897d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1898d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1899d91e8eeeSRaja Mani u8 discvr_offset = 38; 1900d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1901d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1902d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1903d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1904d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1905d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1906d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1907d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1908d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1909d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1910d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1911d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1912d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1913d91e8eeeSRaja Mani int ret; 1914d91e8eeeSRaja Mani 1915d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1916d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1917d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1918d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1919d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1920d91e8eeeSRaja Mani if (ret) { 1921d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1922d91e8eeeSRaja Mani return ret; 1923d91e8eeeSRaja Mani } 1924d91e8eeeSRaja Mani 1925d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1926d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1927d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1928d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1929d91e8eeeSRaja Mani arp_pattern, arp_mask); 1930d91e8eeeSRaja Mani if (ret) { 1931d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1932d91e8eeeSRaja Mani return ret; 1933d91e8eeeSRaja Mani } 1934d91e8eeeSRaja Mani 1935d91e8eeeSRaja Mani /* 1936d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1937d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1938d91e8eeeSRaja Mani */ 1939d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1940d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1941d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1942d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1943d91e8eeeSRaja Mani if (ret) { 1944d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1945d91e8eeeSRaja Mani return ret; 1946d91e8eeeSRaja Mani } 1947d91e8eeeSRaja Mani 1948d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1949d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1950d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1951d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1952d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1953d91e8eeeSRaja Mani if (ret) { 1954d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1955d91e8eeeSRaja Mani return ret; 1956d91e8eeeSRaja Mani } 1957d91e8eeeSRaja Mani 1958d91e8eeeSRaja Mani return 0; 1959d91e8eeeSRaja Mani } 1960d91e8eeeSRaja Mani 1961d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1962d91e8eeeSRaja Mani { 1963d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1964d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1965d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1966d91e8eeeSRaja Mani u8 discvr_offset = 38; 1967d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1968d91e8eeeSRaja Mani int ret; 1969d91e8eeeSRaja Mani 1970d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1971d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1972d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1973d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1974d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1975d91e8eeeSRaja Mani mac_mask); 1976d91e8eeeSRaja Mani if (ret) { 1977d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1978d91e8eeeSRaja Mani return ret; 1979d91e8eeeSRaja Mani } 1980d91e8eeeSRaja Mani 1981d91e8eeeSRaja Mani /* 1982d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1983d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1984d91e8eeeSRaja Mani */ 1985d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1986d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1987d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1988d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1989d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1990d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1991d91e8eeeSRaja Mani if (ret) { 1992cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1993d91e8eeeSRaja Mani return ret; 1994d91e8eeeSRaja Mani } 1995d91e8eeeSRaja Mani } 1996d91e8eeeSRaja Mani 1997d91e8eeeSRaja Mani return 0; 1998d91e8eeeSRaja Mani } 1999d91e8eeeSRaja Mani 2000055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2001055bde49SRaja Mani { 2002055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2003055bde49SRaja Mani } 2004055bde49SRaja Mani 2005055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2006055bde49SRaja Mani { 2007055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2008055bde49SRaja Mani } 2009055bde49SRaja Mani 2010055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2011055bde49SRaja Mani { 2012055bde49SRaja Mani int ret, left; 2013055bde49SRaja Mani 2014055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2015055bde49SRaja Mani 2016055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2017055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2018055bde49SRaja Mani if (ret) 2019055bde49SRaja Mani return ret; 2020055bde49SRaja Mani 2021055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2022055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2023055bde49SRaja Mani WMI_TIMEOUT); 2024055bde49SRaja Mani if (left == 0) { 2025055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2026055bde49SRaja Mani ret = -ETIMEDOUT; 2027055bde49SRaja Mani } else if (left < 0) { 2028055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2029055bde49SRaja Mani left); 2030055bde49SRaja Mani ret = left; 2031055bde49SRaja Mani } 2032055bde49SRaja Mani 2033055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2034055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2035055bde49SRaja Mani is_ctrl_ep_empty(ar), 2036055bde49SRaja Mani WMI_TIMEOUT); 2037055bde49SRaja Mani if (left == 0) { 2038055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2039055bde49SRaja Mani ret = -ETIMEDOUT; 2040055bde49SRaja Mani } else if (left < 0) { 2041055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2042055bde49SRaja Mani ret = left; 2043055bde49SRaja Mani } 2044055bde49SRaja Mani } 2045055bde49SRaja Mani 2046055bde49SRaja Mani return ret; 2047055bde49SRaja Mani } 2048055bde49SRaja Mani 2049d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2050d91e8eeeSRaja Mani { 2051d91e8eeeSRaja Mani struct in_device *in_dev; 2052d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2053d91e8eeeSRaja Mani struct ath6kl_vif *vif; 2054055bde49SRaja Mani int ret; 2055d91e8eeeSRaja Mani u32 filter = 0; 2056ce0dc0cfSRaja Mani u16 i, bmiss_time; 2057d91e8eeeSRaja Mani u8 index = 0; 2058d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2059d91e8eeeSRaja Mani 206077ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 206177ed4e45SThomas Pedersen if (ar->num_vif > 1) 206277ed4e45SThomas Pedersen return -EIO; 206377ed4e45SThomas Pedersen 2064d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2065d91e8eeeSRaja Mani if (!vif) 2066d91e8eeeSRaja Mani return -EIO; 2067d91e8eeeSRaja Mani 2068d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2069d91e8eeeSRaja Mani return -EIO; 2070d91e8eeeSRaja Mani 2071d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 20723c411a43SRaja Mani return -ENOTCONN; 2073d91e8eeeSRaja Mani 2074d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2075d91e8eeeSRaja Mani return -EINVAL; 2076d91e8eeeSRaja Mani 20776251d801SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags)) { 20786251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 20796251d801SNaveen Gangadharan vif->fw_vif_idx, false); 20806251d801SNaveen Gangadharan if (ret) 20816251d801SNaveen Gangadharan return ret; 20826251d801SNaveen Gangadharan } 20836251d801SNaveen Gangadharan 2084d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2085d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2086d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2087d91e8eeeSRaja Mani WOW_LIST_ID, i); 2088d91e8eeeSRaja Mani 2089d91e8eeeSRaja Mani /* 2090d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2091d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2092d91e8eeeSRaja Mani * the user. 2093d91e8eeeSRaja Mani */ 2094d91e8eeeSRaja Mani if (wow) 2095d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2096d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2097d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2098d91e8eeeSRaja Mani else 2099d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2100d91e8eeeSRaja Mani 2101d91e8eeeSRaja Mani if (ret) 2102d91e8eeeSRaja Mani return ret; 2103d91e8eeeSRaja Mani 2104390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2105390a8c8fSRaja Mani 2106ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2107ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2108ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2109ce0dc0cfSRaja Mani 0); 2110ce0dc0cfSRaja Mani if (ret) 2111ce0dc0cfSRaja Mani return ret; 2112ce0dc0cfSRaja Mani 2113ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2114ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2115ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2116ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2117ce0dc0cfSRaja Mani 2118ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2119ce0dc0cfSRaja Mani bmiss_time, 0); 2120ce0dc0cfSRaja Mani if (ret) 2121ce0dc0cfSRaja Mani return ret; 2122ce0dc0cfSRaja Mani 2123ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2124ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2125ce0dc0cfSRaja Mani 0, 0, 0, 0); 2126ce0dc0cfSRaja Mani if (ret) 2127ce0dc0cfSRaja Mani return ret; 2128ce0dc0cfSRaja Mani } 2129ce0dc0cfSRaja Mani 2130390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2131390a8c8fSRaja Mani 2132c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2133c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2134c08631c6SRaja Mani if (!in_dev) 2135c08631c6SRaja Mani goto skip_arp; 2136c08631c6SRaja Mani 2137c08631c6SRaja Mani ifa = in_dev->ifa_list; 2138c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2139c08631c6SRaja Mani 2140c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2141c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2142c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2143c08631c6SRaja Mani ifa = ifa->ifa_next; 2144c08631c6SRaja Mani index++; 2145c08631c6SRaja Mani } 2146c08631c6SRaja Mani 2147c08631c6SRaja Mani if (ifa) { 2148c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2149c08631c6SRaja Mani return -EINVAL; 2150c08631c6SRaja Mani } 2151c08631c6SRaja Mani 2152c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2153c08631c6SRaja Mani if (ret) { 2154c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2155c08631c6SRaja Mani return ret; 2156c08631c6SRaja Mani } 2157c08631c6SRaja Mani 2158c08631c6SRaja Mani skip_arp: 21596cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 21606cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 21616cb3c714SRaja Mani filter, 21626cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 21636cb3c714SRaja Mani if (ret) 21646cb3c714SRaja Mani return ret; 21656cb3c714SRaja Mani 2166055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 21676cb3c714SRaja Mani if (ret) 21686cb3c714SRaja Mani return ret; 21696cb3c714SRaja Mani 2170055bde49SRaja Mani return 0; 21716cb3c714SRaja Mani } 21726cb3c714SRaja Mani 21736cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 21746cb3c714SRaja Mani { 21756cb3c714SRaja Mani struct ath6kl_vif *vif; 21766cb3c714SRaja Mani int ret; 21776cb3c714SRaja Mani 21786cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 21796cb3c714SRaja Mani if (!vif) 21806cb3c714SRaja Mani return -EIO; 21816cb3c714SRaja Mani 2182390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2183390a8c8fSRaja Mani 21846cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21856cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2186390a8c8fSRaja Mani if (ret) { 2187cdeb8602SKalle Valo ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2188cdeb8602SKalle Valo ret); 2189390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21906cb3c714SRaja Mani return ret; 21916cb3c714SRaja Mani } 21926cb3c714SRaja Mani 2193ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2194ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2195ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2196ce0dc0cfSRaja Mani if (ret) 2197ce0dc0cfSRaja Mani return ret; 2198ce0dc0cfSRaja Mani 2199ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2200ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2201ce0dc0cfSRaja Mani if (ret) 2202ce0dc0cfSRaja Mani return ret; 2203ce0dc0cfSRaja Mani 2204ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2205ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2206ce0dc0cfSRaja Mani if (ret) 2207ce0dc0cfSRaja Mani return ret; 2208ce0dc0cfSRaja Mani } 2209ce0dc0cfSRaja Mani 2210390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2211390a8c8fSRaja Mani 22126251d801SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags)) { 22136251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22146251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22156251d801SNaveen Gangadharan if (ret) 22166251d801SNaveen Gangadharan return ret; 22176251d801SNaveen Gangadharan } 22186251d801SNaveen Gangadharan 2219390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2220390a8c8fSRaja Mani 2221390a8c8fSRaja Mani return 0; 2222390a8c8fSRaja Mani } 2223390a8c8fSRaja Mani 222440abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 222540abc2deSRaja Mani { 222640abc2deSRaja Mani struct ath6kl_vif *vif; 222740abc2deSRaja Mani int ret; 222840abc2deSRaja Mani 222940abc2deSRaja Mani vif = ath6kl_vif_first(ar); 223040abc2deSRaja Mani if (!vif) 223140abc2deSRaja Mani return -EIO; 223240abc2deSRaja Mani 223348f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 223448f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 223540abc2deSRaja Mani return -EIO; 223648f27587SMing Jiang } 223740abc2deSRaja Mani 223840abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 223940abc2deSRaja Mani 224040abc2deSRaja Mani /* Save the current power mode before enabling power save */ 224140abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 224240abc2deSRaja Mani 224340abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 224440abc2deSRaja Mani if (ret) 224540abc2deSRaja Mani return ret; 224640abc2deSRaja Mani 224740abc2deSRaja Mani /* Disable WOW mode */ 224840abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 224940abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 225040abc2deSRaja Mani 0, 0); 225140abc2deSRaja Mani if (ret) 225240abc2deSRaja Mani return ret; 225340abc2deSRaja Mani 225440abc2deSRaja Mani /* Flush all non control pkts in TX path */ 225540abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 225640abc2deSRaja Mani 225740abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 225840abc2deSRaja Mani if (ret) 225940abc2deSRaja Mani return ret; 226040abc2deSRaja Mani 226140abc2deSRaja Mani return 0; 226240abc2deSRaja Mani } 226340abc2deSRaja Mani 226440abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 226540abc2deSRaja Mani { 226640abc2deSRaja Mani struct ath6kl_vif *vif; 226740abc2deSRaja Mani int ret; 226840abc2deSRaja Mani 226940abc2deSRaja Mani vif = ath6kl_vif_first(ar); 227040abc2deSRaja Mani 227140abc2deSRaja Mani if (!vif) 227240abc2deSRaja Mani return -EIO; 227340abc2deSRaja Mani 227440abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 227540abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 227640abc2deSRaja Mani ar->wmi->saved_pwr_mode); 227740abc2deSRaja Mani if (ret) 227840abc2deSRaja Mani return ret; 227940abc2deSRaja Mani } 228040abc2deSRaja Mani 228140abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 228240abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 228340abc2deSRaja Mani if (ret) 228440abc2deSRaja Mani return ret; 228540abc2deSRaja Mani 228640abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 228740abc2deSRaja Mani 228840abc2deSRaja Mani /* Reset scan parameter to default values */ 228940abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 229040abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 229140abc2deSRaja Mani if (ret) 229240abc2deSRaja Mani return ret; 229340abc2deSRaja Mani 229440abc2deSRaja Mani return 0; 229540abc2deSRaja Mani } 229640abc2deSRaja Mani 229752d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22980f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22990f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 230052d81a68SKalle Valo { 23013d79499cSVivek Natarajan struct ath6kl_vif *vif; 2302390a8c8fSRaja Mani enum ath6kl_state prev_state; 230352d81a68SKalle Valo int ret; 230452d81a68SKalle Valo 230552d81a68SKalle Valo switch (mode) { 2306d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2307d7c44e0bSRaja Mani 2308d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2309d7c44e0bSRaja Mani 2310d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2311d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2312d7c44e0bSRaja Mani 2313390a8c8fSRaja Mani prev_state = ar->state; 2314390a8c8fSRaja Mani 2315d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2316390a8c8fSRaja Mani if (ret) { 2317390a8c8fSRaja Mani ar->state = prev_state; 2318d7c44e0bSRaja Mani return ret; 2319390a8c8fSRaja Mani } 23201e9a905dSRaja Mani 2321d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2322d7c44e0bSRaja Mani break; 2323d7c44e0bSRaja Mani 232452d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2325524441e3SRaja Mani 232640abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2327524441e3SRaja Mani 232840abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 232952d81a68SKalle Valo if (ret) { 233040abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 233140abc2deSRaja Mani return ret; 233252d81a68SKalle Valo } 233352d81a68SKalle Valo 233476a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 233576a9fbe2SKalle Valo 233652d81a68SKalle Valo break; 2337b4b2a0b1SKalle Valo 2338b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2339524441e3SRaja Mani 23407125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2341524441e3SRaja Mani 2342b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2343b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2344b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2345b4b2a0b1SKalle Valo break; 2346b4b2a0b1SKalle Valo } 2347b4b2a0b1SKalle Valo 2348b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2349b4b2a0b1SKalle Valo 2350b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2351b4b2a0b1SKalle Valo if (ret) { 2352b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2353b4b2a0b1SKalle Valo ret); 2354b4b2a0b1SKalle Valo } 2355b4b2a0b1SKalle Valo 2356b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2357b4b2a0b1SKalle Valo 2358b4b2a0b1SKalle Valo break; 2359b4b2a0b1SKalle Valo 236010509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 236110509f90SKalle Valo /* 236210509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 236310509f90SKalle Valo * wow mode and sleeping most of the time. 236410509f90SKalle Valo */ 236510509f90SKalle Valo break; 236610509f90SKalle Valo 2367b4b2a0b1SKalle Valo default: 2368b4b2a0b1SKalle Valo break; 236952d81a68SKalle Valo } 237052d81a68SKalle Valo 23713d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 23723d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 23733d79499cSVivek Natarajan 237452d81a68SKalle Valo return 0; 237552d81a68SKalle Valo } 2376d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 237752d81a68SKalle Valo 237852d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 237952d81a68SKalle Valo { 238076a9fbe2SKalle Valo int ret; 238176a9fbe2SKalle Valo 238276a9fbe2SKalle Valo switch (ar->state) { 2383d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2384d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2385d7c44e0bSRaja Mani 2386d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2387d7c44e0bSRaja Mani if (ret) { 2388d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2389d7c44e0bSRaja Mani return ret; 2390d7c44e0bSRaja Mani } 2391d7c44e0bSRaja Mani 2392d7c44e0bSRaja Mani break; 2393d7c44e0bSRaja Mani 239476a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 239540abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 239640abc2deSRaja Mani 239740abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 239876a9fbe2SKalle Valo if (ret) { 239940abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 240040abc2deSRaja Mani return ret; 240176a9fbe2SKalle Valo } 240276a9fbe2SKalle Valo break; 240376a9fbe2SKalle Valo 2404b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2405b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2406b4b2a0b1SKalle Valo 2407b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2408b4b2a0b1SKalle Valo if (ret) { 2409b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2410b4b2a0b1SKalle Valo return ret; 2411b4b2a0b1SKalle Valo } 2412d7c44e0bSRaja Mani break; 2413b4b2a0b1SKalle Valo 241410509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 241510509f90SKalle Valo break; 241610509f90SKalle Valo 241776a9fbe2SKalle Valo default: 241876a9fbe2SKalle Valo break; 241952d81a68SKalle Valo } 242052d81a68SKalle Valo 242152d81a68SKalle Valo return 0; 242252d81a68SKalle Valo } 2423d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 242452d81a68SKalle Valo 2425abcb344bSKalle Valo #ifdef CONFIG_PM 242652d81a68SKalle Valo 242752d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 242852d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2429abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2430abcb344bSKalle Valo { 2431abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2432abcb344bSKalle Valo 24330f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2434abcb344bSKalle Valo } 2435aa6cffc1SChilam Ng 243652d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2437aa6cffc1SChilam Ng { 2438aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2439aa6cffc1SChilam Ng 2440aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2441aa6cffc1SChilam Ng } 2442a918fb3cSRaja Mani 2443a918fb3cSRaja Mani /* 2444a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2445a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2446a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2447a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2448a918fb3cSRaja Mani * 2449a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2450a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2451a918fb3cSRaja Mani * 2452a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2453a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2454a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2455a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2456a918fb3cSRaja Mani * 2457a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2458a918fb3cSRaja Mani */ 2459a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2460a918fb3cSRaja Mani { 2461390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2462390a8c8fSRaja Mani return; 2463390a8c8fSRaja Mani 2464a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2465a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2466a918fb3cSRaja Mani } 2467a918fb3cSRaja Mani 2468a918fb3cSRaja Mani #else 2469a918fb3cSRaja Mani 2470a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2471a918fb3cSRaja Mani { 2472a918fb3cSRaja Mani } 2473abcb344bSKalle Valo #endif 2474abcb344bSKalle Valo 2475df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2476df90b369SVasanthakumar Thiagarajan bool ht_enable) 24776a7c9badSJouni Malinen { 2478df90b369SVasanthakumar Thiagarajan struct ath6kl_htcap *htcap = &vif->htcap; 2479e68f6750SSujith Manoharan 2480df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 24816a7c9badSJouni Malinen return 0; 2482df90b369SVasanthakumar Thiagarajan 2483df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2484df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2485df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2486df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2487df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2488df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2489df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2490df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2491df90b369SVasanthakumar Thiagarajan 2492df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2493df90b369SVasanthakumar Thiagarajan band, htcap); 24946a7c9badSJouni Malinen } 24956a7c9badSJouni Malinen 249637a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 249737a2f950SThomas Pedersen { 249837a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 249937a2f950SThomas Pedersen int band, ret = 0; 250037a2f950SThomas Pedersen 250137a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 250237a2f950SThomas Pedersen if (!wiphy->bands[band]) 250337a2f950SThomas Pedersen continue; 250437a2f950SThomas Pedersen 250537a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 250637a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 250737a2f950SThomas Pedersen if (ret) 250837a2f950SThomas Pedersen return ret; 250937a2f950SThomas Pedersen } 251037a2f950SThomas Pedersen 251137a2f950SThomas Pedersen return ret; 251237a2f950SThomas Pedersen } 251337a2f950SThomas Pedersen 25148bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 25158bdfbf40SJouni Malinen { 25168bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 25178bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 25188bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 25198bdfbf40SJouni Malinen } 25208bdfbf40SJouni Malinen 2521334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2522334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 25238bdfbf40SJouni Malinen { 2524334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 25258bdfbf40SJouni Malinen const u8 *pos; 25268bdfbf40SJouni Malinen u8 *buf = NULL; 25278bdfbf40SJouni Malinen size_t len = 0; 25288bdfbf40SJouni Malinen int ret; 25298bdfbf40SJouni Malinen 25308bdfbf40SJouni Malinen /* 25318bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 25328bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 25338bdfbf40SJouni Malinen */ 25348bdfbf40SJouni Malinen 25358bdfbf40SJouni Malinen if (ies && ies_len) { 25368bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 25378bdfbf40SJouni Malinen if (buf == NULL) 25388bdfbf40SJouni Malinen return -ENOMEM; 25398bdfbf40SJouni Malinen pos = ies; 25408bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 25418bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 25428bdfbf40SJouni Malinen break; 25438bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 25448bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 25458bdfbf40SJouni Malinen len += 2 + pos[1]; 25468bdfbf40SJouni Malinen } 25478bdfbf40SJouni Malinen pos += 2 + pos[1]; 25488bdfbf40SJouni Malinen } 25498bdfbf40SJouni Malinen } 25508bdfbf40SJouni Malinen 2551334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2552334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 25538bdfbf40SJouni Malinen kfree(buf); 25548bdfbf40SJouni Malinen return ret; 25558bdfbf40SJouni Malinen } 25568bdfbf40SJouni Malinen 25578860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 25588860020eSJohannes Berg struct cfg80211_beacon_data *info) 25598860020eSJohannes Berg { 25608860020eSJohannes Berg struct ath6kl *ar = vif->ar; 25618860020eSJohannes Berg int res; 25628860020eSJohannes Berg 256317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25648860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25658860020eSJohannes Berg WMI_FRAME_BEACON, 25668860020eSJohannes Berg info->beacon_ies, 25678860020eSJohannes Berg info->beacon_ies_len); 25688860020eSJohannes Berg if (res) 25698860020eSJohannes Berg return res; 25708860020eSJohannes Berg 257117a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25728860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 25738860020eSJohannes Berg info->proberesp_ies_len); 25748860020eSJohannes Berg if (res) 25758860020eSJohannes Berg return res; 25768860020eSJohannes Berg 257717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25788860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25798860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 25808860020eSJohannes Berg info->assocresp_ies, 25818860020eSJohannes Berg info->assocresp_ies_len); 25828860020eSJohannes Berg if (res) 25838860020eSJohannes Berg return res; 25848860020eSJohannes Berg 25858860020eSJohannes Berg return 0; 25868860020eSJohannes Berg } 25878860020eSJohannes Berg 2588d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2589d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2590d97c121bSVasanthakumar Thiagarajan { 2591d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2592d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2593d97c121bSVasanthakumar Thiagarajan u16 cnt; 2594d97c121bSVasanthakumar Thiagarajan 2595d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2596d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2597d97c121bSVasanthakumar Thiagarajan 2598d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2599d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2600d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2601d97c121bSVasanthakumar Thiagarajan 2602d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2603d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2604d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2605d97c121bSVasanthakumar Thiagarajan 26069e8b16dbSVasanthakumar Thiagarajan /* skip version */ 26079e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2608d97c121bSVasanthakumar Thiagarajan return -EINVAL; 26099e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 26109e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 26119e8b16dbSVasanthakumar Thiagarajan 26129e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 26139e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 26149e8b16dbSVasanthakumar Thiagarajan return 0; 26159e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 26169e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2617d97c121bSVasanthakumar Thiagarajan 2618d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2619d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26209e8b16dbSVasanthakumar Thiagarajan return 0; 2621798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2622d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2623d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2624d97c121bSVasanthakumar Thiagarajan 2625d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2626d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26279e8b16dbSVasanthakumar Thiagarajan return 0; 2628798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2629d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2630d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2631d97c121bSVasanthakumar Thiagarajan 2632d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26339e8b16dbSVasanthakumar Thiagarajan return 0; 2634d97c121bSVasanthakumar Thiagarajan 2635d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2636d97c121bSVasanthakumar Thiagarajan 2637d97c121bSVasanthakumar Thiagarajan return 0; 2638d97c121bSVasanthakumar Thiagarajan } 2639d97c121bSVasanthakumar Thiagarajan 26408860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 26418860020eSJohannes Berg struct cfg80211_ap_settings *info) 26426a7c9badSJouni Malinen { 26436a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 26443450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26456a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 264667cd22e4SThomas Pedersen bool hidden = false; 26476a7c9badSJouni Malinen u8 *ies; 26486a7c9badSJouni Malinen int ies_len; 26496a7c9badSJouni Malinen struct wmi_connect_cmd p; 26506a7c9badSJouni Malinen int res; 2651be5abaafSVasanthakumar Thiagarajan int i, ret; 2652d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 26536a7c9badSJouni Malinen 26548860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 26556a7c9badSJouni Malinen 2656990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 26576a7c9badSJouni Malinen return -EIO; 26586a7c9badSJouni Malinen 2659f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 26606a7c9badSJouni Malinen return -EOPNOTSUPP; 26616a7c9badSJouni Malinen 26628860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 26636a7c9badSJouni Malinen 26649a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 26659a5b1318SJouni Malinen 26666a7c9badSJouni Malinen /* TODO: 26676a7c9badSJouni Malinen * info->interval 26686a7c9badSJouni Malinen * info->dtim_period 26696a7c9badSJouni Malinen */ 26706a7c9badSJouni Malinen 26718860020eSJohannes Berg if (info->beacon.head == NULL) 26726a7c9badSJouni Malinen return -EINVAL; 26738860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 26746a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 26758860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 26766a7c9badSJouni Malinen return -EINVAL; 26778860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 26786a7c9badSJouni Malinen 26796a7c9badSJouni Malinen if (info->ssid == NULL) 26806a7c9badSJouni Malinen return -EINVAL; 26813450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 26823450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 26836a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 268467cd22e4SThomas Pedersen hidden = true; 268567cd22e4SThomas Pedersen 268667cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 268767cd22e4SThomas Pedersen if (res) 268867cd22e4SThomas Pedersen return res; 26896a7c9badSJouni Malinen 2690be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2691be5abaafSVasanthakumar Thiagarajan if (ret) 2692be5abaafSVasanthakumar Thiagarajan return ret; 26936a7c9badSJouni Malinen 26946a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 26956a7c9badSJouni Malinen 26966a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 26976a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 26986a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 26996a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27006a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 27016a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27026a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 27036a7c9badSJouni Malinen break; 27046a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 27056a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27066a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 27076a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27086a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 27096a7c9badSJouni Malinen break; 27106a7c9badSJouni Malinen } 27116a7c9badSJouni Malinen } 27126a7c9badSJouni Malinen if (p.auth_mode == 0) 27136a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 27143450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 27156a7c9badSJouni Malinen 27166a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 27176a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 27186a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27196a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27206a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 27216a7c9badSJouni Malinen break; 27226a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27236a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 27246a7c9badSJouni Malinen break; 27256a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27266a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 27276a7c9badSJouni Malinen break; 2728b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2729b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2730b8214df1SDai Shuibing break; 27316a7c9badSJouni Malinen } 27326a7c9badSJouni Malinen } 2733229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 27346a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2735240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2736229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2737240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 27386a7c9badSJouni Malinen 27396a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 27406a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27416a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27426a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 27436a7c9badSJouni Malinen break; 27446a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27456a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 27466a7c9badSJouni Malinen break; 27476a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27486a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 27496a7c9badSJouni Malinen break; 2750b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2751b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2752b8214df1SDai Shuibing break; 27536a7c9badSJouni Malinen default: 27546a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 27556a7c9badSJouni Malinen break; 27566a7c9badSJouni Malinen } 2757240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 27586a7c9badSJouni Malinen 27596a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2760f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 27616a7c9badSJouni Malinen 27623450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 27633450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 27643450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2765aa430da4SJohannes Berg p.ch = cpu_to_le16(info->channel->center_freq); 27666a7c9badSJouni Malinen 2767c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2768c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2769c1762a3fSThirumalai Pachamuthu if (res < 0) 2770c1762a3fSThirumalai Pachamuthu return res; 2771c1762a3fSThirumalai Pachamuthu 27723ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 27733ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 27743ca9d1fcSAarthi Thiruvengadam } else { 27753ca9d1fcSAarthi Thiruvengadam /* 27763ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 27773ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 27783ca9d1fcSAarthi Thiruvengadam */ 27793ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 27803ca9d1fcSAarthi Thiruvengadam } 27813ca9d1fcSAarthi Thiruvengadam 278203bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 278303bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 278403bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 278503bdeb0dSVasanthakumar Thiagarajan if (res < 0) 278603bdeb0dSVasanthakumar Thiagarajan return res; 278703bdeb0dSVasanthakumar Thiagarajan } 278803bdeb0dSVasanthakumar Thiagarajan 2789aa430da4SJohannes Berg if (ath6kl_set_htcap(vif, info->channel->band, 2790aa430da4SJohannes Berg info->channel_type != NL80211_CHAN_NO_HT)) 2791df90b369SVasanthakumar Thiagarajan return -EIO; 2792df90b369SVasanthakumar Thiagarajan 2793d97c121bSVasanthakumar Thiagarajan /* 2794d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2795d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2796d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2797d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2798d97c121bSVasanthakumar Thiagarajan */ 2799d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2800d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2801d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2802d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2803d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2804d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2805d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2806d97c121bSVasanthakumar Thiagarajan if (res < 0) 2807d97c121bSVasanthakumar Thiagarajan return res; 2808d97c121bSVasanthakumar Thiagarajan } 2809d97c121bSVasanthakumar Thiagarajan 2810c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2811334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 28129a5b1318SJouni Malinen if (res < 0) 28139a5b1318SJouni Malinen return res; 28149a5b1318SJouni Malinen 28159a5b1318SJouni Malinen return 0; 28166a7c9badSJouni Malinen } 28176a7c9badSJouni Malinen 28188860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 28198860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 28206a7c9badSJouni Malinen { 28218860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 28228860020eSJohannes Berg 28238860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 28248860020eSJohannes Berg return -EIO; 28258860020eSJohannes Berg 28268860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 28278860020eSJohannes Berg return -EOPNOTSUPP; 28288860020eSJohannes Berg 28298860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 28306a7c9badSJouni Malinen } 28316a7c9badSJouni Malinen 28328860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 28336a7c9badSJouni Malinen { 28346a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 283559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28366a7c9badSJouni Malinen 2837f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 28386a7c9badSJouni Malinen return -EOPNOTSUPP; 283959c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 28406a7c9badSJouni Malinen return -ENOTCONN; 28416a7c9badSJouni Malinen 2842334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 284359c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 28446a7c9badSJouni Malinen 2845df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 284637a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 28476a7c9badSJouni Malinen } 28486a7c9badSJouni Malinen 284933e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 285033e5308dSJouni Malinen 285133e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 285233e5308dSJouni Malinen u8 *mac) 285333e5308dSJouni Malinen { 285433e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 285533e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 285633e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 285733e5308dSJouni Malinen 285833e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 285933e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 286033e5308dSJouni Malinen } 286133e5308dSJouni Malinen 286223875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 286323875136SJouni Malinen u8 *mac, struct station_parameters *params) 286423875136SJouni Malinen { 286523875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2866f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 286723875136SJouni Malinen 2868f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 286923875136SJouni Malinen return -EOPNOTSUPP; 287023875136SJouni Malinen 287123875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 287223875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 287323875136SJouni Malinen return -EOPNOTSUPP; 287423875136SJouni Malinen 287523875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2876334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2877334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2878334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2879334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 288023875136SJouni Malinen } 288123875136SJouni Malinen 288263fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 288363fa1e0cSJouni Malinen struct net_device *dev, 288463fa1e0cSJouni Malinen struct ieee80211_channel *chan, 288563fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 288663fa1e0cSJouni Malinen unsigned int duration, 288763fa1e0cSJouni Malinen u64 *cookie) 288863fa1e0cSJouni Malinen { 288963fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2890334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28911052261eSJouni Malinen u32 id; 289263fa1e0cSJouni Malinen 289363fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 289463fa1e0cSJouni Malinen * return -EBUSY */ 28951052261eSJouni Malinen id = ++vif->last_roc_id; 28961052261eSJouni Malinen if (id == 0) { 28971052261eSJouni Malinen /* Do not use 0 as the cookie value */ 28981052261eSJouni Malinen id = ++vif->last_roc_id; 28991052261eSJouni Malinen } 29001052261eSJouni Malinen *cookie = id; 290163fa1e0cSJouni Malinen 2902334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2903334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 290463fa1e0cSJouni Malinen } 290563fa1e0cSJouni Malinen 290663fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 290763fa1e0cSJouni Malinen struct net_device *dev, 290863fa1e0cSJouni Malinen u64 cookie) 290963fa1e0cSJouni Malinen { 291063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2911334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 291263fa1e0cSJouni Malinen 29131052261eSJouni Malinen if (cookie != vif->last_roc_id) 291463fa1e0cSJouni Malinen return -ENOENT; 29151052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 291663fa1e0cSJouni Malinen 2917334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 291863fa1e0cSJouni Malinen } 291963fa1e0cSJouni Malinen 2920334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2921334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2922334234b5SVasanthakumar Thiagarajan unsigned int freq) 29238bdfbf40SJouni Malinen { 2924334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 29258bdfbf40SJouni Malinen const u8 *pos; 29268bdfbf40SJouni Malinen u8 *p2p; 29278bdfbf40SJouni Malinen int p2p_len; 29288bdfbf40SJouni Malinen int ret; 29298bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 29308bdfbf40SJouni Malinen 29318bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 29328bdfbf40SJouni Malinen 29338bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 29348bdfbf40SJouni Malinen 29358bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 29368bdfbf40SJouni Malinen if (p2p == NULL) 29378bdfbf40SJouni Malinen return -ENOMEM; 29388bdfbf40SJouni Malinen p2p_len = 0; 29398bdfbf40SJouni Malinen 29408bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 29418bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 29428bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 29438bdfbf40SJouni Malinen break; 29448bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 29458bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 29468bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 29478bdfbf40SJouni Malinen } 29488bdfbf40SJouni Malinen pos += 2 + pos[1]; 29498bdfbf40SJouni Malinen } 29508bdfbf40SJouni Malinen 2951334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2952334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 29538bdfbf40SJouni Malinen kfree(p2p); 29548bdfbf40SJouni Malinen return ret; 29558bdfbf40SJouni Malinen } 29568bdfbf40SJouni Malinen 2957d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2958d0ff7383SNaveen Gangadharan u32 id, 2959d0ff7383SNaveen Gangadharan u32 freq, 2960d0ff7383SNaveen Gangadharan u32 wait, 2961d0ff7383SNaveen Gangadharan const u8 *buf, 2962d0ff7383SNaveen Gangadharan size_t len, 2963d0ff7383SNaveen Gangadharan bool *more_data, 2964d0ff7383SNaveen Gangadharan bool no_cck) 2965d0ff7383SNaveen Gangadharan { 2966d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2967d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2968d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2969d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2970d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2971d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2972d0ff7383SNaveen Gangadharan 2973d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2974d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2975d0ff7383SNaveen Gangadharan return false; 2976d0ff7383SNaveen Gangadharan 2977d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2978d0ff7383SNaveen Gangadharan if (!conn) 2979d0ff7383SNaveen Gangadharan return false; 2980d0ff7383SNaveen Gangadharan 2981d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2982d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2983d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2984d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2985d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2986d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2987d0ff7383SNaveen Gangadharan return false; 2988d0ff7383SNaveen Gangadharan 2989d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2990d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2991d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2992d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2993d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2994d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2995d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2996d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2997d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2998d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2999d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3000d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3001d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3002d0ff7383SNaveen Gangadharan 3003d0ff7383SNaveen Gangadharan /* 3004d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3005d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3006d0ff7383SNaveen Gangadharan * STA. 3007d0ff7383SNaveen Gangadharan */ 3008d0ff7383SNaveen Gangadharan if (is_psq_empty) 3009d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3010d0ff7383SNaveen Gangadharan conn->aid, 1); 3011d0ff7383SNaveen Gangadharan return true; 3012d0ff7383SNaveen Gangadharan } 3013d0ff7383SNaveen Gangadharan 3014d0ff7383SNaveen Gangadharan /* 3015d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3016d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3017d0ff7383SNaveen Gangadharan */ 3018d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3019d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3020d0ff7383SNaveen Gangadharan *more_data = true; 3021d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3022d0ff7383SNaveen Gangadharan } 3023d0ff7383SNaveen Gangadharan 3024d0ff7383SNaveen Gangadharan return false; 3025d0ff7383SNaveen Gangadharan } 3026d0ff7383SNaveen Gangadharan 3027c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3028c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3029c86e4f44SAarthi Thiruvengadam { 3030c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3031c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3032c86e4f44SAarthi Thiruvengadam 3033c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3034c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3035c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3036c86e4f44SAarthi Thiruvengadam return true; 3037c86e4f44SAarthi Thiruvengadam } 3038c86e4f44SAarthi Thiruvengadam 3039c86e4f44SAarthi Thiruvengadam return false; 3040c86e4f44SAarthi Thiruvengadam } 3041c86e4f44SAarthi Thiruvengadam 30428a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 30438a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 30448a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 30458a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3046e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3047e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 30488a6c8060SJouni Malinen { 30498a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 305059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30518a6c8060SJouni Malinen u32 id; 30528bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3053d0ff7383SNaveen Gangadharan bool more_data, queued; 30548bdfbf40SJouni Malinen 30558bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3056c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3057c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3058c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 30598bdfbf40SJouni Malinen /* 3060c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 30618bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 30628bdfbf40SJouni Malinen */ 30638bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3064334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 30658bdfbf40SJouni Malinen chan->center_freq); 30668bdfbf40SJouni Malinen } 30678a6c8060SJouni Malinen 3068cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30698a6c8060SJouni Malinen if (id == 0) { 30708a6c8060SJouni Malinen /* 30718a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 30728a6c8060SJouni Malinen * used for the command. 30738a6c8060SJouni Malinen */ 3074cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30758a6c8060SJouni Malinen } 30768a6c8060SJouni Malinen 30778a6c8060SJouni Malinen *cookie = id; 30783ca9d1fcSAarthi Thiruvengadam 3079d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3080d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3081d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3082d0ff7383SNaveen Gangadharan id, chan->center_freq, 3083d0ff7383SNaveen Gangadharan wait, buf, 3084d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3085d0ff7383SNaveen Gangadharan if (queued) 3086d0ff7383SNaveen Gangadharan return 0; 3087d0ff7383SNaveen Gangadharan } 3088d0ff7383SNaveen Gangadharan 30893ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 30903ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 30913ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 30923ca9d1fcSAarthi Thiruvengadam } 30938a6c8060SJouni Malinen 3094ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3095ae32c30aSJouni Malinen struct net_device *dev, 3096ae32c30aSJouni Malinen u16 frame_type, bool reg) 3097ae32c30aSJouni Malinen { 3098cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3099ae32c30aSJouni Malinen 3100ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3101ae32c30aSJouni Malinen __func__, frame_type, reg); 3102ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3103ae32c30aSJouni Malinen /* 3104ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3105ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3106ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3107ae32c30aSJouni Malinen */ 3108cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3109ae32c30aSJouni Malinen } 3110ae32c30aSJouni Malinen } 3111ae32c30aSJouni Malinen 311210509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 311310509f90SKalle Valo struct net_device *dev, 311410509f90SKalle Valo struct cfg80211_sched_scan_request *request) 311510509f90SKalle Valo { 311610509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 311710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 311810509f90SKalle Valo u16 interval; 311910509f90SKalle Valo int ret; 312010509f90SKalle Valo 312110509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 312210509f90SKalle Valo return -EIO; 312310509f90SKalle Valo 312410509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 312510509f90SKalle Valo return -EBUSY; 312610509f90SKalle Valo 312777ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 312877ed4e45SThomas Pedersen if (ar->num_vif > 1) 312977ed4e45SThomas Pedersen return -EIO; 313077ed4e45SThomas Pedersen 3131b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3132b4d13d3bSKalle Valo 31333b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 31343b8ffc6aSJouni Malinen request->n_ssids); 31353b8ffc6aSJouni Malinen if (ret < 0) 31363b8ffc6aSJouni Malinen return ret; 313710509f90SKalle Valo 313810509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 313910509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 314010509f90SKalle Valo 314110509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 314210509f90SKalle Valo interval, interval, 3143d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 314410509f90SKalle Valo 314510509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 314610509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 314710509f90SKalle Valo WOW_FILTER_SSID, 314810509f90SKalle Valo WOW_HOST_REQ_DELAY); 314910509f90SKalle Valo if (ret) { 315010509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 315110509f90SKalle Valo return ret; 315210509f90SKalle Valo } 315310509f90SKalle Valo 315410509f90SKalle Valo /* this also clears IE in fw if it's not set */ 315510509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 315610509f90SKalle Valo WMI_FRAME_PROBE_REQ, 315710509f90SKalle Valo request->ie, request->ie_len); 315810509f90SKalle Valo if (ret) { 315910509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 316010509f90SKalle Valo ret); 316110509f90SKalle Valo return ret; 316210509f90SKalle Valo } 316310509f90SKalle Valo 316410509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 316510509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 316610509f90SKalle Valo if (ret) { 316710509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 316810509f90SKalle Valo ret); 316910509f90SKalle Valo return ret; 317010509f90SKalle Valo } 317110509f90SKalle Valo 317210509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 317310509f90SKalle Valo 317410509f90SKalle Valo return ret; 317510509f90SKalle Valo } 317610509f90SKalle Valo 317710509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 317810509f90SKalle Valo struct net_device *dev) 317910509f90SKalle Valo { 318010509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 318110509f90SKalle Valo bool stopped; 318210509f90SKalle Valo 318310509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 318410509f90SKalle Valo 318510509f90SKalle Valo if (!stopped) 318610509f90SKalle Valo return -EIO; 318710509f90SKalle Valo 318810509f90SKalle Valo return 0; 318910509f90SKalle Valo } 319010509f90SKalle Valo 3191f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3192f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3193f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 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 }, 3199ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3200ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3201ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3202ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3203ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3204ba1f6fe3SJouni Malinen }, 3205f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3206f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3207f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3208f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3209f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3210f80574aeSJouni Malinen }, 3211f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3212f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3213f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3214f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3215f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3216f80574aeSJouni Malinen }, 3217f80574aeSJouni Malinen }; 3218f80574aeSJouni Malinen 3219bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 322055055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 322155055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3222bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3223bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3224bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3225bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3226bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3227bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3228bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3229bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3230bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3231bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3232bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3233bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3234bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3235bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3236bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3237bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3238bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3239bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3240003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3241abcb344bSKalle Valo #ifdef CONFIG_PM 324252d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 324352d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3244abcb344bSKalle Valo #endif 32458860020eSJohannes Berg .start_ap = ath6kl_start_ap, 32468860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 32478860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 324833e5308dSJouni Malinen .del_station = ath6kl_del_station, 324923875136SJouni Malinen .change_station = ath6kl_change_station, 325063fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 325163fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 32528a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3253ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 325410509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 325510509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3256bdcd8170SKalle Valo }; 3257bdcd8170SKalle Valo 32587125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3259ec4b7f60SKalle Valo { 326010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 326110509f90SKalle Valo 3262ec4b7f60SKalle Valo switch (vif->sme_state) { 3263c97a31b0SKalle Valo case SME_DISCONNECTED: 3264c97a31b0SKalle Valo break; 3265ec4b7f60SKalle Valo case SME_CONNECTING: 3266ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3267ec4b7f60SKalle Valo NULL, 0, 3268ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3269ec4b7f60SKalle Valo GFP_KERNEL); 3270ec4b7f60SKalle Valo break; 3271ec4b7f60SKalle Valo case SME_CONNECTED: 3272ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3273ec4b7f60SKalle Valo break; 3274ec4b7f60SKalle Valo } 3275ec4b7f60SKalle Valo 3276ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3277ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 32787125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3279ec4b7f60SKalle Valo 3280ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 32811f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 32821f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3283ec4b7f60SKalle Valo 3284ec4b7f60SKalle Valo /* disable scanning */ 32857125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 32867125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 32877125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3288ec4b7f60SKalle Valo 3289ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3290ec4b7f60SKalle Valo } 3291ec4b7f60SKalle Valo 32927125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 32937125f01dSKalle Valo { 32947125f01dSKalle Valo struct ath6kl_vif *vif; 32957125f01dSKalle Valo 32967125f01dSKalle Valo vif = ath6kl_vif_first(ar); 32977125f01dSKalle Valo if (!vif) { 32987125f01dSKalle Valo /* save the current power mode before enabling power save */ 32997125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 33007125f01dSKalle Valo 33017125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3302cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 33037125f01dSKalle Valo return; 33047125f01dSKalle Valo } 33057125f01dSKalle Valo 33067125f01dSKalle Valo /* 33077125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 33087125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 33097125f01dSKalle Valo * sleeps. 33107125f01dSKalle Valo */ 33117125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 33127125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 33137125f01dSKalle Valo } 33147125f01dSKalle Valo 3315c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 33168dafb70eSVasanthakumar Thiagarajan { 33177baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 33182132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 33198dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 33208dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 33218dafb70eSVasanthakumar Thiagarajan } 33228dafb70eSVasanthakumar Thiagarajan 3323de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3324108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 332510509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 332610509f90SKalle Valo (unsigned long) vif); 332710509f90SKalle Valo 3328de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3329478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 33308dafb70eSVasanthakumar Thiagarajan 333180abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 333280abaf9bSVasanthakumar Thiagarajan 33338dafb70eSVasanthakumar Thiagarajan return 0; 33348dafb70eSVasanthakumar Thiagarajan } 33358dafb70eSVasanthakumar Thiagarajan 3336c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 33378dafb70eSVasanthakumar Thiagarajan { 333855055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 333980abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 334055055976SVasanthakumar Thiagarajan 33412132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3342108438bcSVasanthakumar Thiagarajan 334355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 334455055976SVasanthakumar Thiagarajan 334555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 334655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 334755055976SVasanthakumar Thiagarajan 334880abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 334980abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 335080abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 335180abaf9bSVasanthakumar Thiagarajan } 335280abaf9bSVasanthakumar Thiagarajan 335327929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 335455055976SVasanthakumar Thiagarajan 335555055976SVasanthakumar Thiagarajan ar->num_vif--; 33568dafb70eSVasanthakumar Thiagarajan } 33578dafb70eSVasanthakumar Thiagarajan 33588dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 335955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 336055055976SVasanthakumar Thiagarajan u8 nw_type) 33618dafb70eSVasanthakumar Thiagarajan { 33628dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3363108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 33648dafb70eSVasanthakumar Thiagarajan 336555055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 33668dafb70eSVasanthakumar Thiagarajan if (!ndev) 33678dafb70eSVasanthakumar Thiagarajan return NULL; 33688dafb70eSVasanthakumar Thiagarajan 3369108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3370108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3371108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3372108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3373108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3374108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3375108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3376108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3377334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3378d0d670abSKalle Valo vif->nw_type = nw_type; 3379d0d670abSKalle Valo vif->next_mode = nw_type; 33808f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3381ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3382eb38987eSRaja Mani vif->bg_scan_period = 0; 3383df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 33848dafb70eSVasanthakumar Thiagarajan 338555055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 338655055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 338755055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 338855055976SVasanthakumar Thiagarajan 0x2; 338955055976SVasanthakumar Thiagarajan 33908dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 33918dafb70eSVasanthakumar Thiagarajan 3392e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 33938dafb70eSVasanthakumar Thiagarajan 3394c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 33958dafb70eSVasanthakumar Thiagarajan goto err; 33968dafb70eSVasanthakumar Thiagarajan 339727929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 33988dafb70eSVasanthakumar Thiagarajan goto err; 33998dafb70eSVasanthakumar Thiagarajan 340055055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 340114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 340259c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 34038dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 340459c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 34058dafb70eSVasanthakumar Thiagarajan 340655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 340755055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 340855055976SVasanthakumar Thiagarajan 340911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3410990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 341111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3412990bd915SVasanthakumar Thiagarajan 34138dafb70eSVasanthakumar Thiagarajan return ndev; 34148dafb70eSVasanthakumar Thiagarajan 34158dafb70eSVasanthakumar Thiagarajan err: 341627929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 341727929723SVasanthakumar Thiagarajan free_netdev(ndev); 3418bdcd8170SKalle Valo return NULL; 3419bdcd8170SKalle Valo } 3420bdcd8170SKalle Valo 342146d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 342246d33a21SKalle Valo { 342346d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3424d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 342546d33a21SKalle Valo int ret; 342646d33a21SKalle Valo 342746d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 342846d33a21SKalle Valo 342946d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 343046d33a21SKalle Valo 343146d33a21SKalle Valo /* set device pointer for wiphy */ 343246d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 343346d33a21SKalle Valo 343446d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 343546d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 343646d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 343746d33a21SKalle Valo if (ar->p2p) { 343846d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 343946d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 344046d33a21SKalle Valo } 344146d33a21SKalle Valo 344246d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 344346d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 344446d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3445d92917e4SThomas Pedersen switch (ar->hw.cap) { 3446d92917e4SThomas Pedersen case WMI_11AN_CAP: 3447d92917e4SThomas Pedersen ht = true; 3448d92917e4SThomas Pedersen case WMI_11A_CAP: 3449d92917e4SThomas Pedersen band_5gig = true; 3450d92917e4SThomas Pedersen break; 3451d92917e4SThomas Pedersen case WMI_11GN_CAP: 3452d92917e4SThomas Pedersen ht = true; 3453d92917e4SThomas Pedersen case WMI_11G_CAP: 3454d92917e4SThomas Pedersen band_2gig = true; 3455d92917e4SThomas Pedersen break; 3456d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3457d92917e4SThomas Pedersen ht = true; 3458d92917e4SThomas Pedersen case WMI_11AG_CAP: 3459d92917e4SThomas Pedersen band_2gig = true; 3460d92917e4SThomas Pedersen band_5gig = true; 3461d92917e4SThomas Pedersen break; 3462d92917e4SThomas Pedersen default: 3463d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3464d92917e4SThomas Pedersen return -EINVAL; 3465d92917e4SThomas Pedersen } 3466d92917e4SThomas Pedersen 34677fd1ce7eSVasanthakumar Thiagarajan /* 34687fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 34697fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 34707fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 34717fd1ce7eSVasanthakumar Thiagarajan */ 34727fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 34737fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 34747fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3475d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3476d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3477d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3478d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3479d92917e4SThomas Pedersen } 3480d92917e4SThomas Pedersen if (band_2gig) 348146d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3482d92917e4SThomas Pedersen if (band_5gig) 348346d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3484d92917e4SThomas Pedersen 348546d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 348646d33a21SKalle Valo 348746d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 348846d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 348946d33a21SKalle Valo 3490dfb89c56SJohannes Berg #ifdef CONFIG_PM 349146d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 349246d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 349346d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 349446d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 349546d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 349646d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 349746d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 349846d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 349946d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 3500dfb89c56SJohannes Berg #endif 350146d33a21SKalle Valo 35023b8ffc6aSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSID_INDEX; 350346d33a21SKalle Valo 3504f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3505f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3506f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3507f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3508f2afdac7SVasanthakumar Thiagarajan 3509f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3510f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3511f2afdac7SVasanthakumar Thiagarajan 351203bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 351303bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 351403bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 351503bdeb0dSVasanthakumar Thiagarajan 3516f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3517f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3518f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3519a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3520f2afdac7SVasanthakumar Thiagarajan 352146d33a21SKalle Valo ret = wiphy_register(wiphy); 352246d33a21SKalle Valo if (ret < 0) { 352346d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 352446d33a21SKalle Valo return ret; 352546d33a21SKalle Valo } 352646d33a21SKalle Valo 3527e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3528e5348a1eSVasanthakumar Thiagarajan 352946d33a21SKalle Valo return 0; 353046d33a21SKalle Valo } 353146d33a21SKalle Valo 353246d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3533bdcd8170SKalle Valo { 3534be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3535e5348a1eSVasanthakumar Thiagarajan 3536e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 353745eaa78fSKalle Valo } 353846d33a21SKalle Valo 353945eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 354045eaa78fSKalle Valo { 354145eaa78fSKalle Valo struct ath6kl *ar; 354245eaa78fSKalle Valo struct wiphy *wiphy; 354345eaa78fSKalle Valo 354445eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 354545eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 354645eaa78fSKalle Valo 354745eaa78fSKalle Valo if (!wiphy) { 354845eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 354945eaa78fSKalle Valo return NULL; 355045eaa78fSKalle Valo } 355145eaa78fSKalle Valo 355245eaa78fSKalle Valo ar = wiphy_priv(wiphy); 355345eaa78fSKalle Valo ar->wiphy = wiphy; 355445eaa78fSKalle Valo 355545eaa78fSKalle Valo return ar; 355645eaa78fSKalle Valo } 355745eaa78fSKalle Valo 355845eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 355945eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 356045eaa78fSKalle Valo { 35611d2a4456SVasanthakumar Thiagarajan int i; 35621d2a4456SVasanthakumar Thiagarajan 35631d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 35641d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 35651d2a4456SVasanthakumar Thiagarajan 3566be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3567bdcd8170SKalle Valo } 356845eaa78fSKalle Valo 3569