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 8918ab5415dSJouni Malinen if (n_ssids > MAX_PROBED_SSIDS) 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 */ 9038ab5415dSJouni Malinen for (i = n_ssids; i < MAX_PROBED_SSIDS; 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 2588df90b369SVasanthakumar Thiagarajan static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2589df90b369SVasanthakumar Thiagarajan struct ieee80211_channel *chan, 2590df90b369SVasanthakumar Thiagarajan enum nl80211_channel_type channel_type) 2591df90b369SVasanthakumar Thiagarajan { 2592df90b369SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 2593df90b369SVasanthakumar Thiagarajan 2594df90b369SVasanthakumar Thiagarajan /* 2595df90b369SVasanthakumar Thiagarajan * 'dev' could be NULL if a channel change is required for the hardware 2596df90b369SVasanthakumar Thiagarajan * device itself, instead of a particular VIF. 2597df90b369SVasanthakumar Thiagarajan * 2598df90b369SVasanthakumar Thiagarajan * FIXME: To be handled properly when monitor mode is supported. 2599df90b369SVasanthakumar Thiagarajan */ 2600df90b369SVasanthakumar Thiagarajan if (!dev) 2601df90b369SVasanthakumar Thiagarajan return -EBUSY; 2602df90b369SVasanthakumar Thiagarajan 2603df90b369SVasanthakumar Thiagarajan vif = netdev_priv(dev); 2604df90b369SVasanthakumar Thiagarajan 2605df90b369SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 2606df90b369SVasanthakumar Thiagarajan return -EIO; 2607df90b369SVasanthakumar Thiagarajan 2608df90b369SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2609df90b369SVasanthakumar Thiagarajan __func__, chan->center_freq, chan->hw_value); 2610df90b369SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 2611df90b369SVasanthakumar Thiagarajan vif->next_ch_type = channel_type; 2612df90b369SVasanthakumar Thiagarajan vif->next_ch_band = chan->band; 2613df90b369SVasanthakumar Thiagarajan 2614df90b369SVasanthakumar Thiagarajan return 0; 2615df90b369SVasanthakumar Thiagarajan } 2616df90b369SVasanthakumar Thiagarajan 2617d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2618d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2619d97c121bSVasanthakumar Thiagarajan { 2620d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2621d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2622d97c121bSVasanthakumar Thiagarajan u16 cnt; 2623d97c121bSVasanthakumar Thiagarajan 2624d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2625d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2626d97c121bSVasanthakumar Thiagarajan 2627d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2628d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2629d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2630d97c121bSVasanthakumar Thiagarajan 2631d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2632d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2633d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2634d97c121bSVasanthakumar Thiagarajan 26359e8b16dbSVasanthakumar Thiagarajan /* skip version */ 26369e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2637d97c121bSVasanthakumar Thiagarajan return -EINVAL; 26389e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 26399e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 26409e8b16dbSVasanthakumar Thiagarajan 26419e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 26429e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 26439e8b16dbSVasanthakumar Thiagarajan return 0; 26449e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 26459e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2646d97c121bSVasanthakumar Thiagarajan 2647d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2648d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26499e8b16dbSVasanthakumar Thiagarajan return 0; 2650798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2651d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2652d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2653d97c121bSVasanthakumar Thiagarajan 2654d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2655d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26569e8b16dbSVasanthakumar Thiagarajan return 0; 2657798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2658d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2659d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2660d97c121bSVasanthakumar Thiagarajan 2661d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26629e8b16dbSVasanthakumar Thiagarajan return 0; 2663d97c121bSVasanthakumar Thiagarajan 2664d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2665d97c121bSVasanthakumar Thiagarajan 2666d97c121bSVasanthakumar Thiagarajan return 0; 2667d97c121bSVasanthakumar Thiagarajan } 2668d97c121bSVasanthakumar Thiagarajan 26698860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 26708860020eSJohannes Berg struct cfg80211_ap_settings *info) 26716a7c9badSJouni Malinen { 26726a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 26733450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26746a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 267567cd22e4SThomas Pedersen bool hidden = false; 26766a7c9badSJouni Malinen u8 *ies; 26776a7c9badSJouni Malinen int ies_len; 26786a7c9badSJouni Malinen struct wmi_connect_cmd p; 26796a7c9badSJouni Malinen int res; 2680be5abaafSVasanthakumar Thiagarajan int i, ret; 2681d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 26826a7c9badSJouni Malinen 26838860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 26846a7c9badSJouni Malinen 2685990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 26866a7c9badSJouni Malinen return -EIO; 26876a7c9badSJouni Malinen 2688f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 26896a7c9badSJouni Malinen return -EOPNOTSUPP; 26906a7c9badSJouni Malinen 26918860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 26926a7c9badSJouni Malinen 26939a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 26949a5b1318SJouni Malinen 26956a7c9badSJouni Malinen /* TODO: 26966a7c9badSJouni Malinen * info->interval 26976a7c9badSJouni Malinen * info->dtim_period 26986a7c9badSJouni Malinen */ 26996a7c9badSJouni Malinen 27008860020eSJohannes Berg if (info->beacon.head == NULL) 27016a7c9badSJouni Malinen return -EINVAL; 27028860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 27036a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 27048860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 27056a7c9badSJouni Malinen return -EINVAL; 27068860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 27076a7c9badSJouni Malinen 27086a7c9badSJouni Malinen if (info->ssid == NULL) 27096a7c9badSJouni Malinen return -EINVAL; 27103450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 27113450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 27126a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 271367cd22e4SThomas Pedersen hidden = true; 271467cd22e4SThomas Pedersen 271567cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 271667cd22e4SThomas Pedersen if (res) 271767cd22e4SThomas Pedersen return res; 27186a7c9badSJouni Malinen 2719be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2720be5abaafSVasanthakumar Thiagarajan if (ret) 2721be5abaafSVasanthakumar Thiagarajan return ret; 27226a7c9badSJouni Malinen 27236a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 27246a7c9badSJouni Malinen 27256a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 27266a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 27276a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 27286a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27296a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 27306a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27316a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 27326a7c9badSJouni Malinen break; 27336a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 27346a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27356a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 27366a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27376a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 27386a7c9badSJouni Malinen break; 27396a7c9badSJouni Malinen } 27406a7c9badSJouni Malinen } 27416a7c9badSJouni Malinen if (p.auth_mode == 0) 27426a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 27433450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 27446a7c9badSJouni Malinen 27456a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 27466a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 27476a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27486a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27496a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 27506a7c9badSJouni Malinen break; 27516a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27526a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 27536a7c9badSJouni Malinen break; 27546a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27556a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 27566a7c9badSJouni Malinen break; 2757b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2758b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2759b8214df1SDai Shuibing break; 27606a7c9badSJouni Malinen } 27616a7c9badSJouni Malinen } 2762229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 27636a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2764240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2765229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2766240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 27676a7c9badSJouni Malinen 27686a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 27696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27706a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27716a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 27726a7c9badSJouni Malinen break; 27736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27746a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 27756a7c9badSJouni Malinen break; 27766a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27776a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 27786a7c9badSJouni Malinen break; 2779b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2780b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2781b8214df1SDai Shuibing break; 27826a7c9badSJouni Malinen default: 27836a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 27846a7c9badSJouni Malinen break; 27856a7c9badSJouni Malinen } 2786240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 27876a7c9badSJouni Malinen 27886a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2789f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 27906a7c9badSJouni Malinen 27913450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 27923450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 27933450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2794cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 27956a7c9badSJouni Malinen 2796c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2797c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2798c1762a3fSThirumalai Pachamuthu if (res < 0) 2799c1762a3fSThirumalai Pachamuthu return res; 2800c1762a3fSThirumalai Pachamuthu 28013ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 28023ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 28033ca9d1fcSAarthi Thiruvengadam } else { 28043ca9d1fcSAarthi Thiruvengadam /* 28053ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 28063ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 28073ca9d1fcSAarthi Thiruvengadam */ 28083ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 28093ca9d1fcSAarthi Thiruvengadam } 28103ca9d1fcSAarthi Thiruvengadam 281103bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 281203bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 281303bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 281403bdeb0dSVasanthakumar Thiagarajan if (res < 0) 281503bdeb0dSVasanthakumar Thiagarajan return res; 281603bdeb0dSVasanthakumar Thiagarajan } 281703bdeb0dSVasanthakumar Thiagarajan 2818df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, vif->next_ch_band, 2819df90b369SVasanthakumar Thiagarajan vif->next_ch_type != NL80211_CHAN_NO_HT)) 2820df90b369SVasanthakumar Thiagarajan return -EIO; 2821df90b369SVasanthakumar Thiagarajan 2822d97c121bSVasanthakumar Thiagarajan /* 2823d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2824d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2825d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2826d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2827d97c121bSVasanthakumar Thiagarajan */ 2828d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2829d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2830d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2831d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2832d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2833d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2834d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2835d97c121bSVasanthakumar Thiagarajan if (res < 0) 2836d97c121bSVasanthakumar Thiagarajan return res; 2837d97c121bSVasanthakumar Thiagarajan } 2838d97c121bSVasanthakumar Thiagarajan 2839c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2840334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 28419a5b1318SJouni Malinen if (res < 0) 28429a5b1318SJouni Malinen return res; 28439a5b1318SJouni Malinen 28449a5b1318SJouni Malinen return 0; 28456a7c9badSJouni Malinen } 28466a7c9badSJouni Malinen 28478860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 28488860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 28496a7c9badSJouni Malinen { 28508860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 28518860020eSJohannes Berg 28528860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 28538860020eSJohannes Berg return -EIO; 28548860020eSJohannes Berg 28558860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 28568860020eSJohannes Berg return -EOPNOTSUPP; 28578860020eSJohannes Berg 28588860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 28596a7c9badSJouni Malinen } 28606a7c9badSJouni Malinen 28618860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 28626a7c9badSJouni Malinen { 28636a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 286459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28656a7c9badSJouni Malinen 2866f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 28676a7c9badSJouni Malinen return -EOPNOTSUPP; 286859c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 28696a7c9badSJouni Malinen return -ENOTCONN; 28706a7c9badSJouni Malinen 2871334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 287259c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 28736a7c9badSJouni Malinen 2874df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 287537a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 28766a7c9badSJouni Malinen } 28776a7c9badSJouni Malinen 287833e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 287933e5308dSJouni Malinen 288033e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 288133e5308dSJouni Malinen u8 *mac) 288233e5308dSJouni Malinen { 288333e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 288433e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 288533e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 288633e5308dSJouni Malinen 288733e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 288833e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 288933e5308dSJouni Malinen } 289033e5308dSJouni Malinen 289123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 289223875136SJouni Malinen u8 *mac, struct station_parameters *params) 289323875136SJouni Malinen { 289423875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2895f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 289623875136SJouni Malinen 2897f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 289823875136SJouni Malinen return -EOPNOTSUPP; 289923875136SJouni Malinen 290023875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 290123875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 290223875136SJouni Malinen return -EOPNOTSUPP; 290323875136SJouni Malinen 290423875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2905334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2906334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2907334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2908334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 290923875136SJouni Malinen } 291023875136SJouni Malinen 291163fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 291263fa1e0cSJouni Malinen struct net_device *dev, 291363fa1e0cSJouni Malinen struct ieee80211_channel *chan, 291463fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 291563fa1e0cSJouni Malinen unsigned int duration, 291663fa1e0cSJouni Malinen u64 *cookie) 291763fa1e0cSJouni Malinen { 291863fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2919334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29201052261eSJouni Malinen u32 id; 292163fa1e0cSJouni Malinen 292263fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 292363fa1e0cSJouni Malinen * return -EBUSY */ 29241052261eSJouni Malinen id = ++vif->last_roc_id; 29251052261eSJouni Malinen if (id == 0) { 29261052261eSJouni Malinen /* Do not use 0 as the cookie value */ 29271052261eSJouni Malinen id = ++vif->last_roc_id; 29281052261eSJouni Malinen } 29291052261eSJouni Malinen *cookie = id; 293063fa1e0cSJouni Malinen 2931334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2932334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 293363fa1e0cSJouni Malinen } 293463fa1e0cSJouni Malinen 293563fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 293663fa1e0cSJouni Malinen struct net_device *dev, 293763fa1e0cSJouni Malinen u64 cookie) 293863fa1e0cSJouni Malinen { 293963fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2940334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 294163fa1e0cSJouni Malinen 29421052261eSJouni Malinen if (cookie != vif->last_roc_id) 294363fa1e0cSJouni Malinen return -ENOENT; 29441052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 294563fa1e0cSJouni Malinen 2946334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 294763fa1e0cSJouni Malinen } 294863fa1e0cSJouni Malinen 2949334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2950334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2951334234b5SVasanthakumar Thiagarajan unsigned int freq) 29528bdfbf40SJouni Malinen { 2953334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 29548bdfbf40SJouni Malinen const u8 *pos; 29558bdfbf40SJouni Malinen u8 *p2p; 29568bdfbf40SJouni Malinen int p2p_len; 29578bdfbf40SJouni Malinen int ret; 29588bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 29598bdfbf40SJouni Malinen 29608bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 29618bdfbf40SJouni Malinen 29628bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 29638bdfbf40SJouni Malinen 29648bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 29658bdfbf40SJouni Malinen if (p2p == NULL) 29668bdfbf40SJouni Malinen return -ENOMEM; 29678bdfbf40SJouni Malinen p2p_len = 0; 29688bdfbf40SJouni Malinen 29698bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 29708bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 29718bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 29728bdfbf40SJouni Malinen break; 29738bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 29748bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 29758bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 29768bdfbf40SJouni Malinen } 29778bdfbf40SJouni Malinen pos += 2 + pos[1]; 29788bdfbf40SJouni Malinen } 29798bdfbf40SJouni Malinen 2980334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2981334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 29828bdfbf40SJouni Malinen kfree(p2p); 29838bdfbf40SJouni Malinen return ret; 29848bdfbf40SJouni Malinen } 29858bdfbf40SJouni Malinen 2986d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2987d0ff7383SNaveen Gangadharan u32 id, 2988d0ff7383SNaveen Gangadharan u32 freq, 2989d0ff7383SNaveen Gangadharan u32 wait, 2990d0ff7383SNaveen Gangadharan const u8 *buf, 2991d0ff7383SNaveen Gangadharan size_t len, 2992d0ff7383SNaveen Gangadharan bool *more_data, 2993d0ff7383SNaveen Gangadharan bool no_cck) 2994d0ff7383SNaveen Gangadharan { 2995d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2996d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2997d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2998d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2999d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3000d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3001d0ff7383SNaveen Gangadharan 3002d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3003d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3004d0ff7383SNaveen Gangadharan return false; 3005d0ff7383SNaveen Gangadharan 3006d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3007d0ff7383SNaveen Gangadharan if (!conn) 3008d0ff7383SNaveen Gangadharan return false; 3009d0ff7383SNaveen Gangadharan 3010d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3011d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3012d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3013d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3014d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3015d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3016d0ff7383SNaveen Gangadharan return false; 3017d0ff7383SNaveen Gangadharan 3018d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3019d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3020d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3021d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3022d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3023d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3024d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3025d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3026d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3027d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3028d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3029d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3030d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3031d0ff7383SNaveen Gangadharan 3032d0ff7383SNaveen Gangadharan /* 3033d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3034d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3035d0ff7383SNaveen Gangadharan * STA. 3036d0ff7383SNaveen Gangadharan */ 3037d0ff7383SNaveen Gangadharan if (is_psq_empty) 3038d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3039d0ff7383SNaveen Gangadharan conn->aid, 1); 3040d0ff7383SNaveen Gangadharan return true; 3041d0ff7383SNaveen Gangadharan } 3042d0ff7383SNaveen Gangadharan 3043d0ff7383SNaveen Gangadharan /* 3044d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3045d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3046d0ff7383SNaveen Gangadharan */ 3047d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3048d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3049d0ff7383SNaveen Gangadharan *more_data = true; 3050d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3051d0ff7383SNaveen Gangadharan } 3052d0ff7383SNaveen Gangadharan 3053d0ff7383SNaveen Gangadharan return false; 3054d0ff7383SNaveen Gangadharan } 3055d0ff7383SNaveen Gangadharan 3056c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3057c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3058c86e4f44SAarthi Thiruvengadam { 3059c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3060c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3061c86e4f44SAarthi Thiruvengadam 3062c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3063c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3064c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3065c86e4f44SAarthi Thiruvengadam return true; 3066c86e4f44SAarthi Thiruvengadam } 3067c86e4f44SAarthi Thiruvengadam 3068c86e4f44SAarthi Thiruvengadam return false; 3069c86e4f44SAarthi Thiruvengadam } 3070c86e4f44SAarthi Thiruvengadam 30718a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 30728a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 30738a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 30748a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3075e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3076e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 30778a6c8060SJouni Malinen { 30788a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 307959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30808a6c8060SJouni Malinen u32 id; 30818bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3082d0ff7383SNaveen Gangadharan bool more_data, queued; 30838bdfbf40SJouni Malinen 30848bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3085c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3086c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3087c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 30888bdfbf40SJouni Malinen /* 3089c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 30908bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 30918bdfbf40SJouni Malinen */ 30928bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3093334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 30948bdfbf40SJouni Malinen chan->center_freq); 30958bdfbf40SJouni Malinen } 30968a6c8060SJouni Malinen 3097cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30988a6c8060SJouni Malinen if (id == 0) { 30998a6c8060SJouni Malinen /* 31008a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 31018a6c8060SJouni Malinen * used for the command. 31028a6c8060SJouni Malinen */ 3103cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31048a6c8060SJouni Malinen } 31058a6c8060SJouni Malinen 31068a6c8060SJouni Malinen *cookie = id; 31073ca9d1fcSAarthi Thiruvengadam 3108d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3109d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3110d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3111d0ff7383SNaveen Gangadharan id, chan->center_freq, 3112d0ff7383SNaveen Gangadharan wait, buf, 3113d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3114d0ff7383SNaveen Gangadharan if (queued) 3115d0ff7383SNaveen Gangadharan return 0; 3116d0ff7383SNaveen Gangadharan } 3117d0ff7383SNaveen Gangadharan 31183ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 31193ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 31203ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 31213ca9d1fcSAarthi Thiruvengadam } 31228a6c8060SJouni Malinen 3123ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3124ae32c30aSJouni Malinen struct net_device *dev, 3125ae32c30aSJouni Malinen u16 frame_type, bool reg) 3126ae32c30aSJouni Malinen { 3127cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3128ae32c30aSJouni Malinen 3129ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3130ae32c30aSJouni Malinen __func__, frame_type, reg); 3131ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3132ae32c30aSJouni Malinen /* 3133ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3134ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3135ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3136ae32c30aSJouni Malinen */ 3137cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3138ae32c30aSJouni Malinen } 3139ae32c30aSJouni Malinen } 3140ae32c30aSJouni Malinen 314110509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 314210509f90SKalle Valo struct net_device *dev, 314310509f90SKalle Valo struct cfg80211_sched_scan_request *request) 314410509f90SKalle Valo { 314510509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 314610509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 314710509f90SKalle Valo u16 interval; 314810509f90SKalle Valo int ret; 314910509f90SKalle Valo 315010509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 315110509f90SKalle Valo return -EIO; 315210509f90SKalle Valo 315310509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 315410509f90SKalle Valo return -EBUSY; 315510509f90SKalle Valo 315677ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 315777ed4e45SThomas Pedersen if (ar->num_vif > 1) 315877ed4e45SThomas Pedersen return -EIO; 315977ed4e45SThomas Pedersen 3160b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3161b4d13d3bSKalle Valo 31623b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 31633b8ffc6aSJouni Malinen request->n_ssids); 31643b8ffc6aSJouni Malinen if (ret < 0) 31653b8ffc6aSJouni Malinen return ret; 316610509f90SKalle Valo 316710509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 316810509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 316910509f90SKalle Valo 317010509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 317110509f90SKalle Valo interval, interval, 3172d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 317310509f90SKalle Valo 317410509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 317510509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 317610509f90SKalle Valo WOW_FILTER_SSID, 317710509f90SKalle Valo WOW_HOST_REQ_DELAY); 317810509f90SKalle Valo if (ret) { 317910509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 318010509f90SKalle Valo return ret; 318110509f90SKalle Valo } 318210509f90SKalle Valo 318310509f90SKalle Valo /* this also clears IE in fw if it's not set */ 318410509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 318510509f90SKalle Valo WMI_FRAME_PROBE_REQ, 318610509f90SKalle Valo request->ie, request->ie_len); 318710509f90SKalle Valo if (ret) { 318810509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 318910509f90SKalle Valo ret); 319010509f90SKalle Valo return ret; 319110509f90SKalle Valo } 319210509f90SKalle Valo 319310509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 319410509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 319510509f90SKalle Valo if (ret) { 319610509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 319710509f90SKalle Valo ret); 319810509f90SKalle Valo return ret; 319910509f90SKalle Valo } 320010509f90SKalle Valo 320110509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 320210509f90SKalle Valo 320310509f90SKalle Valo return ret; 320410509f90SKalle Valo } 320510509f90SKalle Valo 320610509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 320710509f90SKalle Valo struct net_device *dev) 320810509f90SKalle Valo { 320910509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 321010509f90SKalle Valo bool stopped; 321110509f90SKalle Valo 321210509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 321310509f90SKalle Valo 321410509f90SKalle Valo if (!stopped) 321510509f90SKalle Valo return -EIO; 321610509f90SKalle Valo 321710509f90SKalle Valo return 0; 321810509f90SKalle Valo } 321910509f90SKalle Valo 3220f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3221f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3222f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3223f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3224f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3225f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3226f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3227f80574aeSJouni Malinen }, 3228ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3229ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3230ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3231ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3232ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3233ba1f6fe3SJouni Malinen }, 3234f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3235f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3236f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3237f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3238f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3239f80574aeSJouni Malinen }, 3240f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3241f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3242f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3243f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3244f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3245f80574aeSJouni Malinen }, 3246f80574aeSJouni Malinen }; 3247f80574aeSJouni Malinen 3248bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 324955055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 325055055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3251bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3252bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3253bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3254bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3255bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3256bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3257bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3258bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3259bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3260bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3261bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3262bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3263bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3264bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3265bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3266bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3267bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3268bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3269003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3270abcb344bSKalle Valo #ifdef CONFIG_PM 327152d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 327252d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3273abcb344bSKalle Valo #endif 32746a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 32758860020eSJohannes Berg .start_ap = ath6kl_start_ap, 32768860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 32778860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 327833e5308dSJouni Malinen .del_station = ath6kl_del_station, 327923875136SJouni Malinen .change_station = ath6kl_change_station, 328063fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 328163fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 32828a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3283ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 328410509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 328510509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3286bdcd8170SKalle Valo }; 3287bdcd8170SKalle Valo 32887125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3289ec4b7f60SKalle Valo { 329010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 329110509f90SKalle Valo 3292ec4b7f60SKalle Valo switch (vif->sme_state) { 3293c97a31b0SKalle Valo case SME_DISCONNECTED: 3294c97a31b0SKalle Valo break; 3295ec4b7f60SKalle Valo case SME_CONNECTING: 3296ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3297ec4b7f60SKalle Valo NULL, 0, 3298ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3299ec4b7f60SKalle Valo GFP_KERNEL); 3300ec4b7f60SKalle Valo break; 3301ec4b7f60SKalle Valo case SME_CONNECTED: 3302ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3303ec4b7f60SKalle Valo break; 3304ec4b7f60SKalle Valo } 3305ec4b7f60SKalle Valo 3306ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3307ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 33087125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3309ec4b7f60SKalle Valo 3310ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 33111f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 33121f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3313ec4b7f60SKalle Valo 3314ec4b7f60SKalle Valo /* disable scanning */ 33157125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 33167125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 33177125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3318ec4b7f60SKalle Valo 3319ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3320ec4b7f60SKalle Valo } 3321ec4b7f60SKalle Valo 33227125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 33237125f01dSKalle Valo { 33247125f01dSKalle Valo struct ath6kl_vif *vif; 33257125f01dSKalle Valo 33267125f01dSKalle Valo vif = ath6kl_vif_first(ar); 33277125f01dSKalle Valo if (!vif) { 33287125f01dSKalle Valo /* save the current power mode before enabling power save */ 33297125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 33307125f01dSKalle Valo 33317125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3332cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 33337125f01dSKalle Valo return; 33347125f01dSKalle Valo } 33357125f01dSKalle Valo 33367125f01dSKalle Valo /* 33377125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 33387125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 33397125f01dSKalle Valo * sleeps. 33407125f01dSKalle Valo */ 33417125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 33427125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 33437125f01dSKalle Valo } 33447125f01dSKalle Valo 3345c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 33468dafb70eSVasanthakumar Thiagarajan { 33477baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 33482132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 33498dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 33508dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 33518dafb70eSVasanthakumar Thiagarajan } 33528dafb70eSVasanthakumar Thiagarajan 3353de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3354108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 335510509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 335610509f90SKalle Valo (unsigned long) vif); 335710509f90SKalle Valo 3358de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3359478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 33608dafb70eSVasanthakumar Thiagarajan 336180abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 336280abaf9bSVasanthakumar Thiagarajan 33638dafb70eSVasanthakumar Thiagarajan return 0; 33648dafb70eSVasanthakumar Thiagarajan } 33658dafb70eSVasanthakumar Thiagarajan 3366c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 33678dafb70eSVasanthakumar Thiagarajan { 336855055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 336980abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 337055055976SVasanthakumar Thiagarajan 33712132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3372108438bcSVasanthakumar Thiagarajan 337355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 337455055976SVasanthakumar Thiagarajan 337555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 337655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 337755055976SVasanthakumar Thiagarajan 337880abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 337980abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 338080abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 338180abaf9bSVasanthakumar Thiagarajan } 338280abaf9bSVasanthakumar Thiagarajan 338327929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 338455055976SVasanthakumar Thiagarajan 338555055976SVasanthakumar Thiagarajan ar->num_vif--; 33868dafb70eSVasanthakumar Thiagarajan } 33878dafb70eSVasanthakumar Thiagarajan 33888dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 338955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 339055055976SVasanthakumar Thiagarajan u8 nw_type) 33918dafb70eSVasanthakumar Thiagarajan { 33928dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3393108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 33948dafb70eSVasanthakumar Thiagarajan 339555055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 33968dafb70eSVasanthakumar Thiagarajan if (!ndev) 33978dafb70eSVasanthakumar Thiagarajan return NULL; 33988dafb70eSVasanthakumar Thiagarajan 3399108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3400108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3401108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3402108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3403108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3404108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3405108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3406108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3407334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3408d0d670abSKalle Valo vif->nw_type = nw_type; 3409d0d670abSKalle Valo vif->next_mode = nw_type; 34108f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3411ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3412eb38987eSRaja Mani vif->bg_scan_period = 0; 3413df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 34148dafb70eSVasanthakumar Thiagarajan 341555055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 341655055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 341755055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 341855055976SVasanthakumar Thiagarajan 0x2; 341955055976SVasanthakumar Thiagarajan 34208dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 34218dafb70eSVasanthakumar Thiagarajan 3422e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 34238dafb70eSVasanthakumar Thiagarajan 3424c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 34258dafb70eSVasanthakumar Thiagarajan goto err; 34268dafb70eSVasanthakumar Thiagarajan 342727929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 34288dafb70eSVasanthakumar Thiagarajan goto err; 34298dafb70eSVasanthakumar Thiagarajan 343055055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 343114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 343259c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 34338dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 343459c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 34358dafb70eSVasanthakumar Thiagarajan 343655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 343755055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 343855055976SVasanthakumar Thiagarajan 343911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3440990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 344111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3442990bd915SVasanthakumar Thiagarajan 34438dafb70eSVasanthakumar Thiagarajan return ndev; 34448dafb70eSVasanthakumar Thiagarajan 34458dafb70eSVasanthakumar Thiagarajan err: 344627929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 344727929723SVasanthakumar Thiagarajan free_netdev(ndev); 3448bdcd8170SKalle Valo return NULL; 3449bdcd8170SKalle Valo } 3450bdcd8170SKalle Valo 345146d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 345246d33a21SKalle Valo { 345346d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3454d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 345546d33a21SKalle Valo int ret; 345646d33a21SKalle Valo 345746d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 345846d33a21SKalle Valo 345946d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 346046d33a21SKalle Valo 346146d33a21SKalle Valo /* set device pointer for wiphy */ 346246d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 346346d33a21SKalle Valo 346446d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 346546d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 346646d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 346746d33a21SKalle Valo if (ar->p2p) { 346846d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 346946d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 347046d33a21SKalle Valo } 347146d33a21SKalle Valo 347246d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 34738ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 347446d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3475d92917e4SThomas Pedersen switch (ar->hw.cap) { 3476d92917e4SThomas Pedersen case WMI_11AN_CAP: 3477d92917e4SThomas Pedersen ht = true; 3478d92917e4SThomas Pedersen case WMI_11A_CAP: 3479d92917e4SThomas Pedersen band_5gig = true; 3480d92917e4SThomas Pedersen break; 3481d92917e4SThomas Pedersen case WMI_11GN_CAP: 3482d92917e4SThomas Pedersen ht = true; 3483d92917e4SThomas Pedersen case WMI_11G_CAP: 3484d92917e4SThomas Pedersen band_2gig = true; 3485d92917e4SThomas Pedersen break; 3486d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3487d92917e4SThomas Pedersen ht = true; 3488d92917e4SThomas Pedersen case WMI_11AG_CAP: 3489d92917e4SThomas Pedersen band_2gig = true; 3490d92917e4SThomas Pedersen band_5gig = true; 3491d92917e4SThomas Pedersen break; 3492d92917e4SThomas Pedersen default: 3493d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3494d92917e4SThomas Pedersen return -EINVAL; 3495d92917e4SThomas Pedersen } 3496d92917e4SThomas Pedersen 34977fd1ce7eSVasanthakumar Thiagarajan /* 34987fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 34997fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 35007fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 35017fd1ce7eSVasanthakumar Thiagarajan */ 35027fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 35037fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 35047fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3505d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3506d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3507d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3508d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3509d92917e4SThomas Pedersen } 3510d92917e4SThomas Pedersen if (band_2gig) 351146d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3512d92917e4SThomas Pedersen if (band_5gig) 351346d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3514d92917e4SThomas Pedersen 351546d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 351646d33a21SKalle Valo 351746d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 351846d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 351946d33a21SKalle Valo 352046d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 352146d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 352246d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 352346d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 352446d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 352546d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 352646d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 352746d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 352846d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 352946d33a21SKalle Valo 35308ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 353146d33a21SKalle Valo 3532f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3533f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3534f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3535f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3536f2afdac7SVasanthakumar Thiagarajan 3537f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3538f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3539f2afdac7SVasanthakumar Thiagarajan 354003bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 354103bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 354203bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 354303bdeb0dSVasanthakumar Thiagarajan 3544f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3545f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3546f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3547a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3548f2afdac7SVasanthakumar Thiagarajan 354946d33a21SKalle Valo ret = wiphy_register(wiphy); 355046d33a21SKalle Valo if (ret < 0) { 355146d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 355246d33a21SKalle Valo return ret; 355346d33a21SKalle Valo } 355446d33a21SKalle Valo 3555e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3556e5348a1eSVasanthakumar Thiagarajan 355746d33a21SKalle Valo return 0; 355846d33a21SKalle Valo } 355946d33a21SKalle Valo 356046d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3561bdcd8170SKalle Valo { 3562be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3563e5348a1eSVasanthakumar Thiagarajan 3564e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 356545eaa78fSKalle Valo } 356646d33a21SKalle Valo 356745eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 356845eaa78fSKalle Valo { 356945eaa78fSKalle Valo struct ath6kl *ar; 357045eaa78fSKalle Valo struct wiphy *wiphy; 357145eaa78fSKalle Valo 357245eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 357345eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 357445eaa78fSKalle Valo 357545eaa78fSKalle Valo if (!wiphy) { 357645eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 357745eaa78fSKalle Valo return NULL; 357845eaa78fSKalle Valo } 357945eaa78fSKalle Valo 358045eaa78fSKalle Valo ar = wiphy_priv(wiphy); 358145eaa78fSKalle Valo ar->wiphy = wiphy; 358245eaa78fSKalle Valo 358345eaa78fSKalle Valo return ar; 358445eaa78fSKalle Valo } 358545eaa78fSKalle Valo 358645eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 358745eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 358845eaa78fSKalle Valo { 35891d2a4456SVasanthakumar Thiagarajan int i; 35901d2a4456SVasanthakumar Thiagarajan 35911d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 35921d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 35931d2a4456SVasanthakumar Thiagarajan 3594be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3595bdcd8170SKalle Valo } 359645eaa78fSKalle Valo 3597