1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19516304b0SJoe Perches 206eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 21c08631c6SRaja Mani #include <linux/inetdevice.h> 22d6a434d6SKalle Valo #include <linux/export.h> 236eb07cafSPaul Gortmaker 24bdcd8170SKalle Valo #include "core.h" 25bdcd8170SKalle Valo #include "cfg80211.h" 26bdcd8170SKalle Valo #include "debug.h" 27abcb344bSKalle Valo #include "hif-ops.h" 28003353b0SKalle Valo #include "testmode.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 55f599359cSBala Shanmugam 56bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 57bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 58bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 59bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 60bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 61bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 62bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 63bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 64bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 65bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 66bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 67bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 68bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 69bdcd8170SKalle Valo }; 70bdcd8170SKalle Valo 71bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 72bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 73bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 74bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 75bdcd8170SKalle Valo 76bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 77bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 78faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 79faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 80faaf1929SVasanthakumar Thiagarajan 81bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 82bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 83bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 84bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 85bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 86bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 87bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 88bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 89bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 90bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 91bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 92bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 93bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 94bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 95bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 96bdcd8170SKalle Valo }; 97bdcd8170SKalle Valo 98bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 99bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 100bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 101bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 102bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 103bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 104bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 105bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 106bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 107bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 108bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 109bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 110bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 111bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 112bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 113bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 114bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 115bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 116bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 117bdcd8170SKalle Valo CHAN5G(216, 0), 118bdcd8170SKalle Valo }; 119bdcd8170SKalle Valo 120bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 121bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 122bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 123bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 124bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 125faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 126faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 127bdcd8170SKalle Valo }; 128bdcd8170SKalle Valo 129bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 130bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 131bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 132bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 133bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 134bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 135faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 136bdcd8170SKalle Valo }; 137bdcd8170SKalle Valo 138837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 139837cb97eSJouni Malinen 14010509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14110509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14210509f90SKalle Valo { 14310509f90SKalle Valo struct ath6kl *ar = vif->ar; 14410509f90SKalle Valo 14510509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14610509f90SKalle Valo return false; 14710509f90SKalle Valo 14810509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14910509f90SKalle Valo 15010509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 15110509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 15210509f90SKalle Valo 15310509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 15410509f90SKalle Valo 15510509f90SKalle Valo return true; 15610509f90SKalle Valo } 15710509f90SKalle Valo 15810509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15910509f90SKalle Valo { 16010509f90SKalle Valo struct ath6kl *ar = vif->ar; 16110509f90SKalle Valo bool stopped; 16210509f90SKalle Valo 16310509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16410509f90SKalle Valo 16510509f90SKalle Valo if (!stopped) 16610509f90SKalle Valo return; 16710509f90SKalle Valo 16810509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16910509f90SKalle Valo } 17010509f90SKalle Valo 171240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 172bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 173bdcd8170SKalle Valo { 174bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 175bdcd8170SKalle Valo 176bdcd8170SKalle Valo if (!wpa_version) { 1773450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 178bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1793450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 180bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1813450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 182bdcd8170SKalle Valo } else { 183bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 184bdcd8170SKalle Valo return -ENOTSUPP; 185bdcd8170SKalle Valo } 186bdcd8170SKalle Valo 187bdcd8170SKalle Valo return 0; 188bdcd8170SKalle Valo } 189bdcd8170SKalle Valo 190240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 191bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 192bdcd8170SKalle Valo { 193bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 194bdcd8170SKalle Valo 195bdcd8170SKalle Valo switch (auth_type) { 196bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1973450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 198bdcd8170SKalle Valo break; 199bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2003450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 201bdcd8170SKalle Valo break; 202bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2033450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 204bdcd8170SKalle Valo break; 205bdcd8170SKalle Valo 206bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 208bdcd8170SKalle Valo break; 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo default: 2113c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 212bdcd8170SKalle Valo return -ENOTSUPP; 213bdcd8170SKalle Valo } 214bdcd8170SKalle Valo 215bdcd8170SKalle Valo return 0; 216bdcd8170SKalle Valo } 217bdcd8170SKalle Valo 218240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 219bdcd8170SKalle Valo { 2203450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2213450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2223450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 223bdcd8170SKalle Valo 224bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 225bdcd8170SKalle Valo __func__, cipher, ucast); 226bdcd8170SKalle Valo 227bdcd8170SKalle Valo switch (cipher) { 228bdcd8170SKalle Valo case 0: 229bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 230bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 231bdcd8170SKalle Valo *ar_cipher_len = 0; 232bdcd8170SKalle Valo break; 233bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 234bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 235bdcd8170SKalle Valo *ar_cipher_len = 5; 236bdcd8170SKalle Valo break; 237bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 238bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 239bdcd8170SKalle Valo *ar_cipher_len = 13; 240bdcd8170SKalle Valo break; 241bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 242bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 243bdcd8170SKalle Valo *ar_cipher_len = 0; 244bdcd8170SKalle Valo break; 245bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 246bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 247bdcd8170SKalle Valo *ar_cipher_len = 0; 248bdcd8170SKalle Valo break; 2495e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2505e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2515e07021eSDai Shuibing *ar_cipher_len = 0; 2525e07021eSDai Shuibing break; 253bdcd8170SKalle Valo default: 254bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 255bdcd8170SKalle Valo return -ENOTSUPP; 256bdcd8170SKalle Valo } 257bdcd8170SKalle Valo 258bdcd8170SKalle Valo return 0; 259bdcd8170SKalle Valo } 260bdcd8170SKalle Valo 261240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 262bdcd8170SKalle Valo { 263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 264bdcd8170SKalle Valo 265bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2663450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2673450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2683450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 270837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2713450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2723450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2733450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 275bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2763450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 277bdcd8170SKalle Valo } 278bdcd8170SKalle Valo } 279bdcd8170SKalle Valo 280990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 281bdcd8170SKalle Valo { 282990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28359c98449SVasanthakumar Thiagarajan 284bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 285bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 286bdcd8170SKalle Valo return false; 287bdcd8170SKalle Valo } 288bdcd8170SKalle Valo 28959c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 290bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 291bdcd8170SKalle Valo return false; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 294bdcd8170SKalle Valo return true; 295bdcd8170SKalle Valo } 296bdcd8170SKalle Valo 2976981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2986981ffdcSKevin Fang { 2996981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 3006981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3016981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3026981ffdcSKevin Fang } 3036981ffdcSKevin Fang 3046981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3056981ffdcSKevin Fang { 3066981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3076981ffdcSKevin Fang } 3086981ffdcSKevin Fang 30963541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31063541212SAarthi Thiruvengadam { 31163541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31263541212SAarthi Thiruvengadam pos[1] >= 4 && 31363541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31463541212SAarthi Thiruvengadam pos[5] == 0x04); 31563541212SAarthi Thiruvengadam } 31663541212SAarthi Thiruvengadam 317334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3186981ffdcSKevin Fang size_t ies_len) 3196981ffdcSKevin Fang { 320334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3216981ffdcSKevin Fang const u8 *pos; 3226981ffdcSKevin Fang u8 *buf = NULL; 3236981ffdcSKevin Fang size_t len = 0; 3246981ffdcSKevin Fang int ret; 3256981ffdcSKevin Fang 3266981ffdcSKevin Fang /* 32763541212SAarthi Thiruvengadam * Clear previously set flag 32863541212SAarthi Thiruvengadam */ 32963541212SAarthi Thiruvengadam 33063541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33163541212SAarthi Thiruvengadam 33263541212SAarthi Thiruvengadam /* 3336981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3346981ffdcSKevin Fang */ 3356981ffdcSKevin Fang 3366981ffdcSKevin Fang if (ies && ies_len) { 3376981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3386981ffdcSKevin Fang if (buf == NULL) 3396981ffdcSKevin Fang return -ENOMEM; 3406981ffdcSKevin Fang pos = ies; 3416981ffdcSKevin Fang 3426981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3436981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3446981ffdcSKevin Fang break; 3456981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3466981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3476981ffdcSKevin Fang len += 2 + pos[1]; 3486981ffdcSKevin Fang } 34963541212SAarthi Thiruvengadam 35063541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35163541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35263541212SAarthi Thiruvengadam 3536981ffdcSKevin Fang pos += 2 + pos[1]; 3546981ffdcSKevin Fang } 3556981ffdcSKevin Fang } 3566981ffdcSKevin Fang 357334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 358334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3596981ffdcSKevin Fang kfree(buf); 3606981ffdcSKevin Fang return ret; 3616981ffdcSKevin Fang } 3626981ffdcSKevin Fang 36355055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36455055976SVasanthakumar Thiagarajan { 36555055976SVasanthakumar Thiagarajan switch (type) { 36655055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36755055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36855055976SVasanthakumar Thiagarajan break; 36955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37055055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37155055976SVasanthakumar Thiagarajan break; 37255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37355055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37655055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37955055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 38055055976SVasanthakumar Thiagarajan break; 38155055976SVasanthakumar Thiagarajan default: 38255055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38355055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38455055976SVasanthakumar Thiagarajan } 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan return 0; 38755055976SVasanthakumar Thiagarajan } 38855055976SVasanthakumar Thiagarajan 38955055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 39055055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 39155055976SVasanthakumar Thiagarajan { 39255055976SVasanthakumar Thiagarajan int i; 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39555055976SVasanthakumar Thiagarajan return false; 39655055976SVasanthakumar Thiagarajan 39755055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39855055976SVasanthakumar Thiagarajan ar->num_vif)) 39955055976SVasanthakumar Thiagarajan return false; 40055055976SVasanthakumar Thiagarajan 40155055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 40255055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40371f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40455055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40555055976SVasanthakumar Thiagarajan *if_idx = i; 40655055976SVasanthakumar Thiagarajan return true; 40755055976SVasanthakumar Thiagarajan } 40855055976SVasanthakumar Thiagarajan } 40955055976SVasanthakumar Thiagarajan } 41055055976SVasanthakumar Thiagarajan 4113226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4123226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41371f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4143226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4153226f68aSVasanthakumar Thiagarajan *if_idx = i; 4163226f68aSVasanthakumar Thiagarajan return true; 4173226f68aSVasanthakumar Thiagarajan } 4183226f68aSVasanthakumar Thiagarajan } 4193226f68aSVasanthakumar Thiagarajan } 4203226f68aSVasanthakumar Thiagarajan 42155055976SVasanthakumar Thiagarajan return false; 42255055976SVasanthakumar Thiagarajan } 42355055976SVasanthakumar Thiagarajan 4248c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4258c9bb054SKalle Valo { 4268c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4278c9bb054SKalle Valo } 4288c9bb054SKalle Valo 4298c9bb054SKalle Valo 430bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 431bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 432bdcd8170SKalle Valo { 433bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 435bdcd8170SKalle Valo int status; 4363ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 437ce0dc0cfSRaja Mani u16 interval; 438bdcd8170SKalle Valo 43910509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 44010509f90SKalle Valo 44114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 442bdcd8170SKalle Valo 443990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 444bdcd8170SKalle Valo return -EIO; 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 447bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 448bdcd8170SKalle Valo return -EBUSY; 449bdcd8170SKalle Valo } 450bdcd8170SKalle Valo 451bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 452bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 453bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 454bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 455bdcd8170SKalle Valo return -EINVAL; 456bdcd8170SKalle Valo } 457bdcd8170SKalle Valo 458bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 459bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 460bdcd8170SKalle Valo return -ERESTARTSYS; 461bdcd8170SKalle Valo } 462bdcd8170SKalle Valo 463bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 464bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 465bdcd8170SKalle Valo up(&ar->sem); 466bdcd8170SKalle Valo return -EBUSY; 467bdcd8170SKalle Valo } 468bdcd8170SKalle Valo 469bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 470bdcd8170SKalle Valo /* 471bdcd8170SKalle Valo * sleep until the command queue drains 472bdcd8170SKalle Valo */ 473bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4748c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 475bdcd8170SKalle Valo WMI_TIMEOUT); 476bdcd8170SKalle Valo if (signal_pending(current)) { 477bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 478bdcd8170SKalle Valo up(&ar->sem); 479bdcd8170SKalle Valo return -EINTR; 480bdcd8170SKalle Valo } 481bdcd8170SKalle Valo } 482bdcd8170SKalle Valo 483334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 484743b4518SDan Carpenter if (status) { 485743b4518SDan Carpenter up(&ar->sem); 4866981ffdcSKevin Fang return status; 487743b4518SDan Carpenter } 4886e786cb1SJouni Malinen 4896e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 490542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4916981ffdcSKevin Fang 49259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4933450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4943450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 495cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 496334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 497334234b5SVasanthakumar Thiagarajan vif->req_bssid, 498f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 499bdcd8170SKalle Valo 500bdcd8170SKalle Valo up(&ar->sem); 501bdcd8170SKalle Valo if (status) { 502bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 503bdcd8170SKalle Valo return -EIO; 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo return 0; 5063450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5073450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 508240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 509bdcd8170SKalle Valo } 510bdcd8170SKalle Valo 5113450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5123450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5133450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 514bdcd8170SKalle Valo 515bdcd8170SKalle Valo if (sme->channel) 516f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 517bdcd8170SKalle Valo 5188c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 519bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5208c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 521bdcd8170SKalle Valo 522240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 523bdcd8170SKalle Valo 524240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 525bdcd8170SKalle Valo if (status) { 526bdcd8170SKalle Valo up(&ar->sem); 527bdcd8170SKalle Valo return status; 528bdcd8170SKalle Valo } 529bdcd8170SKalle Valo 530bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 531240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 532bdcd8170SKalle Valo else 533240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 534bdcd8170SKalle Valo 535240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 538240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 539bdcd8170SKalle Valo 540bdcd8170SKalle Valo if ((sme->key_len) && 5413450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5423450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 543bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 544bdcd8170SKalle Valo 545792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 546bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 547bdcd8170SKalle Valo sme->key_idx); 548bdcd8170SKalle Valo up(&ar->sem); 549bdcd8170SKalle Valo return -ENOENT; 550bdcd8170SKalle Valo } 551bdcd8170SKalle Valo 5526f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 553bdcd8170SKalle Valo key->key_len = sme->key_len; 554bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5553450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5563450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 557bdcd8170SKalle Valo 558334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5593450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 560bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 561bdcd8170SKalle Valo key->key_len, 562f4bb9a6fSJouni Malinen NULL, 0, 563bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 564bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 565bdcd8170SKalle Valo } 566bdcd8170SKalle Valo 567bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 569240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 570240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 571bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 572bdcd8170SKalle Valo up(&ar->sem); 573bdcd8170SKalle Valo return -EIO; 574bdcd8170SKalle Valo } 575bdcd8170SKalle Valo } 576bdcd8170SKalle Valo 577f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 578bdcd8170SKalle Valo 5793ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5803ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5813ca9d1fcSAarthi Thiruvengadam 582bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 583bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 584bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 585bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 586bdcd8170SKalle Valo __func__, 5873450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5883450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 589f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 590bdcd8170SKalle Valo 591cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 592ce0dc0cfSRaja Mani 593ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 594b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 595b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 596ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 597ce0dc0cfSRaja Mani interval, 598ce0dc0cfSRaja Mani 0); 599ce0dc0cfSRaja Mani if (status) { 600ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 601ce0dc0cfSRaja Mani up(&ar->sem); 602ce0dc0cfSRaja Mani return status; 603ce0dc0cfSRaja Mani } 604ce0dc0cfSRaja Mani } 605ce0dc0cfSRaja Mani 606334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6083450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6093450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6103450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6113450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 612f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6133ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 614bdcd8170SKalle Valo 615f599359cSBala Shanmugam /* disable background scan if period is 0 */ 616f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 617f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 618f599359cSBala Shanmugam 619f599359cSBala Shanmugam /* configure default value if not specified */ 620f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 621f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 622f599359cSBala Shanmugam 623f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 624f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 625f599359cSBala Shanmugam 626bdcd8170SKalle Valo up(&ar->sem); 627bdcd8170SKalle Valo 628bdcd8170SKalle Valo if (status == -EINVAL) { 6293450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6303450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 631bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 632bdcd8170SKalle Valo return -ENOENT; 633bdcd8170SKalle Valo } else if (status) { 634bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 635bdcd8170SKalle Valo return -EIO; 636bdcd8170SKalle Valo } 637bdcd8170SKalle Valo 638bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 639ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 640ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 641de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 642bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 643bdcd8170SKalle Valo } 644bdcd8170SKalle Valo 645bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 64659c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 647bdcd8170SKalle Valo 648bdcd8170SKalle Valo return 0; 649bdcd8170SKalle Valo } 650bdcd8170SKalle Valo 6515e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6525e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6534eab6f4fSRaja Mani enum network_type nw_type, 6544eab6f4fSRaja Mani const u8 *bssid, 65501cac476SJouni Malinen struct ieee80211_channel *chan, 6565e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6575e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 65801cac476SJouni Malinen { 659240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 66001cac476SJouni Malinen struct cfg80211_bss *bss; 6614eab6f4fSRaja Mani u16 cap_mask, cap_val; 66201cac476SJouni Malinen u8 *ie; 66301cac476SJouni Malinen 6644eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6654eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6664eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6674eab6f4fSRaja Mani } else { 6684eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6694eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6704eab6f4fSRaja Mani } 6714eab6f4fSRaja Mani 672be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6734eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6744eab6f4fSRaja Mani cap_mask, cap_val); 67501cac476SJouni Malinen if (bss == NULL) { 67601cac476SJouni Malinen /* 67701cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 67801cac476SJouni Malinen * generate a partial entry until the first BSS info 67901cac476SJouni Malinen * event becomes available. 68001cac476SJouni Malinen * 68101cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 68201cac476SJouni Malinen * IEs from the target. 68301cac476SJouni Malinen */ 6843450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 68501cac476SJouni Malinen if (ie == NULL) 6865e13fd35SVasanthakumar Thiagarajan return NULL; 68701cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6883450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6893450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6903450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 691be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6924eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6933450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 69401cac476SJouni Malinen 0, GFP_KERNEL); 69501cac476SJouni Malinen if (bss) 696cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 697cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 69801cac476SJouni Malinen kfree(ie); 69901cac476SJouni Malinen } else 7005e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 70101cac476SJouni Malinen 7025e13fd35SVasanthakumar Thiagarajan return bss; 70301cac476SJouni Malinen } 70401cac476SJouni Malinen 705240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 706bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 707bdcd8170SKalle Valo u16 beacon_intvl, 708bdcd8170SKalle Valo enum network_type nw_type, 709bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 710bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 711bdcd8170SKalle Valo { 71201cac476SJouni Malinen struct ieee80211_channel *chan; 713240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7145e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo /* capinfo + listen interval */ 717bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo /* capinfo + status code + associd */ 720bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 723bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 724bdcd8170SKalle Valo assoc_resp_ie_offset; 725bdcd8170SKalle Valo 726bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 727bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 728bdcd8170SKalle Valo 72932c10874SJouni Malinen /* 73032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 73132c10874SJouni Malinen * a Beacon frame from the AP is seen. 73232c10874SJouni Malinen */ 733cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 73459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 73532c10874SJouni Malinen 736bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 737551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 738bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 739bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 740bdcd8170SKalle Valo return; 741bdcd8170SKalle Valo } 742bdcd8170SKalle Valo } 743bdcd8170SKalle Valo 744bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 745551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 746551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 747bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 748bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 749bdcd8170SKalle Valo return; 750bdcd8170SKalle Valo } 751bdcd8170SKalle Valo } 752bdcd8170SKalle Valo 753be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 754bdcd8170SKalle Valo 7555e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7565e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7575e13fd35SVasanthakumar Thiagarajan if (!bss) { 7584eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 759bdcd8170SKalle Valo return; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 7624eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7634eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7644eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7654eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7665e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76701cac476SJouni Malinen return; 76801cac476SJouni Malinen } 76901cac476SJouni Malinen 77014ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 771bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 77214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 773240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 774bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 775bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 776bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7775e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77814ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 779bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7805e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 781bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo } 784bdcd8170SKalle Valo 785bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 786bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 787bdcd8170SKalle Valo { 788d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7893450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 790bdcd8170SKalle Valo 791bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 792bdcd8170SKalle Valo reason_code); 793bdcd8170SKalle Valo 79410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 79510509f90SKalle Valo 796990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 797bdcd8170SKalle Valo return -EIO; 798bdcd8170SKalle Valo 799bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 800bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 801bdcd8170SKalle Valo return -EBUSY; 802bdcd8170SKalle Valo } 803bdcd8170SKalle Valo 804bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 805bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 806bdcd8170SKalle Valo return -ERESTARTSYS; 807bdcd8170SKalle Valo } 808bdcd8170SKalle Valo 809cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 810240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8113450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8123450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 813bdcd8170SKalle Valo 814bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 816bdcd8170SKalle Valo 817bdcd8170SKalle Valo up(&ar->sem); 818bdcd8170SKalle Valo 81914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 820170826ddSVasanthakumar Thiagarajan 821bdcd8170SKalle Valo return 0; 822bdcd8170SKalle Valo } 823bdcd8170SKalle Valo 824240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 825bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 826bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 827bdcd8170SKalle Valo { 828240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 82959c98449SVasanthakumar Thiagarajan 83014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 83114ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 83214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 833bdcd8170SKalle Valo } 834bdcd8170SKalle Valo 835f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 836551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 837bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 838bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 839bdcd8170SKalle Valo return; 840bdcd8170SKalle Valo } 841bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 842240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 843bdcd8170SKalle Valo return; 844bdcd8170SKalle Valo } 845bdcd8170SKalle Valo 846f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 847551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 848551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 849bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 850bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 851bdcd8170SKalle Valo return; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo } 854bdcd8170SKalle Valo 8551de547d6SVasanthakumar Thiagarajan /* 8561de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8571de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8581de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8591de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8601de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8611de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8621de547d6SVasanthakumar Thiagarajan */ 863bdcd8170SKalle Valo 8641de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 865334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 866bdcd8170SKalle Valo return; 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo 86959c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 870bdcd8170SKalle Valo 87114ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 872240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 873bdcd8170SKalle Valo bssid, NULL, 0, 874bdcd8170SKalle Valo NULL, 0, 875bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 876bdcd8170SKalle Valo GFP_KERNEL); 87714ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 878240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 879bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 88214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 883bdcd8170SKalle Valo } 884bdcd8170SKalle Valo 8853b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 8863b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 8873b8ffc6aSJouni Malinen struct cfg80211_ssid *ssids, int n_ssids) 8883b8ffc6aSJouni Malinen { 8893b8ffc6aSJouni Malinen u8 i; 8903b8ffc6aSJouni Malinen 8913b8ffc6aSJouni Malinen if (n_ssids > MAX_PROBED_SSID_INDEX) 8923b8ffc6aSJouni Malinen return -EINVAL; 8933b8ffc6aSJouni Malinen 8943b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 8953b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 8963b8ffc6aSJouni Malinen ssids[i].ssid_len ? 8973b8ffc6aSJouni Malinen SPECIFIC_SSID_FLAG : ANY_SSID_FLAG, 8983b8ffc6aSJouni Malinen ssids[i].ssid_len, 8993b8ffc6aSJouni Malinen ssids[i].ssid); 9003b8ffc6aSJouni Malinen } 9013b8ffc6aSJouni Malinen 9023b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 9033b8ffc6aSJouni Malinen for (i = n_ssids; i < MAX_PROBED_SSID_INDEX; i++) { 9043b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9053b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9063b8ffc6aSJouni Malinen } 9073b8ffc6aSJouni Malinen 9083b8ffc6aSJouni Malinen return 0; 9093b8ffc6aSJouni Malinen } 9103b8ffc6aSJouni Malinen 911bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 912bdcd8170SKalle Valo struct cfg80211_scan_request *request) 913bdcd8170SKalle Valo { 914d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 91559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 9161276c9efSEdward Lu s8 n_channels = 0; 9171276c9efSEdward Lu u16 *channels = NULL; 918bdcd8170SKalle Valo int ret = 0; 919f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 920bdcd8170SKalle Valo 921990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 922bdcd8170SKalle Valo return -EIO; 923bdcd8170SKalle Valo 92410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 92510509f90SKalle Valo 926bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 92759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 9281b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 929240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 93059c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 9311b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 9321b1e6ee3SJouni Malinen if (ret) { 933bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9341b1e6ee3SJouni Malinen return ret; 935bdcd8170SKalle Valo } 936bdcd8170SKalle Valo } 937bdcd8170SKalle Valo 9383b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 9393b8ffc6aSJouni Malinen request->n_ssids); 9403b8ffc6aSJouni Malinen if (ret < 0) 9413b8ffc6aSJouni Malinen return ret; 942bdcd8170SKalle Valo 943080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 944334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 945334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 946b84da8c7SJouni Malinen request->ie, request->ie_len); 947b84da8c7SJouni Malinen if (ret) { 948cdeb8602SKalle Valo ath6kl_err("failed to set Probe Request appie for scan"); 949b84da8c7SJouni Malinen return ret; 950b84da8c7SJouni Malinen } 951b84da8c7SJouni Malinen 95211869befSJouni Malinen /* 95311869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 95411869befSJouni Malinen * channels. If the list is longer than the target supports, do not 95511869befSJouni Malinen * configure the list and instead, scan all available channels. 95611869befSJouni Malinen */ 95711869befSJouni Malinen if (request->n_channels > 0 && 95811869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9591276c9efSEdward Lu u8 i; 9601276c9efSEdward Lu 96111869befSJouni Malinen n_channels = request->n_channels; 9621276c9efSEdward Lu 9631276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9641276c9efSEdward Lu if (channels == NULL) { 965cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 9661276c9efSEdward Lu n_channels = 0; 9671276c9efSEdward Lu } 9681276c9efSEdward Lu 9691276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9701276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9711276c9efSEdward Lu } 9721276c9efSEdward Lu 97359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 974f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 975f1f92179SVasanthakumar Thiagarajan 9765b35dff0SRaja Mani vif->scan_req = request; 9775b35dff0SRaja Mani 9783ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9793ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9803ca9d1fcSAarthi Thiruvengadam /* 9813ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9823ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9833ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9843ca9d1fcSAarthi Thiruvengadam * probe requests 9853ca9d1fcSAarthi Thiruvengadam */ 9863ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9873ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 98813423c31SVasanthakumar Thiagarajan false, 0, 98913423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 99013423c31SVasanthakumar Thiagarajan n_channels, channels, 99113423c31SVasanthakumar Thiagarajan request->no_cck, 9923ca9d1fcSAarthi Thiruvengadam request->rates); 9933ca9d1fcSAarthi Thiruvengadam } else { 9943ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9953ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 99613423c31SVasanthakumar Thiagarajan false, 0, 99713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 99813423c31SVasanthakumar Thiagarajan n_channels, channels); 9993ca9d1fcSAarthi Thiruvengadam } 10005b35dff0SRaja Mani if (ret) { 1001bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 10025b35dff0SRaja Mani vif->scan_req = NULL; 10035b35dff0SRaja Mani } 1004bdcd8170SKalle Valo 10051276c9efSEdward Lu kfree(channels); 10061276c9efSEdward Lu 1007bdcd8170SKalle Valo return ret; 1008bdcd8170SKalle Valo } 1009bdcd8170SKalle Valo 10101c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1011bdcd8170SKalle Valo { 1012240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10136fd1eaceSKalle Valo int i; 1014bdcd8170SKalle Valo 10151c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10161c17d313SKalle Valo aborted ? " aborted" : ""); 1017bdcd8170SKalle Valo 101814ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10196fd1eaceSKalle Valo return; 10206fd1eaceSKalle Valo 10211c17d313SKalle Valo if (aborted) 10226fd1eaceSKalle Valo goto out; 1023bdcd8170SKalle Valo 102414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 102514ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1026334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1027334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1028bdcd8170SKalle Valo 0, NULL); 1029bdcd8170SKalle Valo } 1030bdcd8170SKalle Valo } 10316fd1eaceSKalle Valo 10326fd1eaceSKalle Valo out: 1033cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 103414ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1035bdcd8170SKalle Valo } 1036bdcd8170SKalle Valo 1037c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1038c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1039c4f7863eSThomas Pedersen { 1040c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1041c4f7863eSThomas Pedersen 1042c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1043c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1044c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1045c4f7863eSThomas Pedersen 1046c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1047c4f7863eSThomas Pedersen 1048c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1049c4f7863eSThomas Pedersen } 1050c4f7863eSThomas Pedersen 1051bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1052bdcd8170SKalle Valo u8 key_index, bool pairwise, 1053bdcd8170SKalle Valo const u8 *mac_addr, 1054bdcd8170SKalle Valo struct key_params *params) 1055bdcd8170SKalle Valo { 1056d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 105759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1058bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10594a8ce2fdSSujith Manoharan int seq_len; 1060bdcd8170SKalle Valo u8 key_usage; 1061bdcd8170SKalle Valo u8 key_type; 1062bdcd8170SKalle Valo 1063990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1064bdcd8170SKalle Valo return -EIO; 1065bdcd8170SKalle Valo 1066837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1067837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1068837cb97eSJouni Malinen return -EINVAL; 1069240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1070240d2799SVasanthakumar Thiagarajan params->key); 1071837cb97eSJouni Malinen } 1072837cb97eSJouni Malinen 1073792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1074bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1075bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1076bdcd8170SKalle Valo key_index); 1077bdcd8170SKalle Valo return -ENOENT; 1078bdcd8170SKalle Valo } 1079bdcd8170SKalle Valo 10806f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1081bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1082bdcd8170SKalle Valo 1083bdcd8170SKalle Valo if (pairwise) 1084bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1085bdcd8170SKalle Valo else 1086bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1087bdcd8170SKalle Valo 10884a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10895e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10905e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10915e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10925e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10935e07021eSDai Shuibing } 1094bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10955e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1096bdcd8170SKalle Valo return -EINVAL; 1097bdcd8170SKalle Valo 1098bdcd8170SKalle Valo key->key_len = params->key_len; 1099bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11005e07021eSDai Shuibing key->seq_len = seq_len; 1101bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1102bdcd8170SKalle Valo key->cipher = params->cipher; 1103bdcd8170SKalle Valo 1104bdcd8170SKalle Valo switch (key->cipher) { 1105bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1106bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1107bdcd8170SKalle Valo key_type = WEP_CRYPT; 1108bdcd8170SKalle Valo break; 1109bdcd8170SKalle Valo 1110bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1111bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1112bdcd8170SKalle Valo break; 1113bdcd8170SKalle Valo 1114bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1115bdcd8170SKalle Valo key_type = AES_CRYPT; 1116bdcd8170SKalle Valo break; 11175e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11185e07021eSDai Shuibing key_type = WAPI_CRYPT; 11195e07021eSDai Shuibing break; 1120bdcd8170SKalle Valo 1121bdcd8170SKalle Valo default: 1122bdcd8170SKalle Valo return -ENOTSUPP; 1123bdcd8170SKalle Valo } 1124bdcd8170SKalle Valo 1125ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1126ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1127ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1128de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1129bdcd8170SKalle Valo 1130bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1131bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1132bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1133bdcd8170SKalle Valo key_usage, key->seq_len); 1134bdcd8170SKalle Valo 1135f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11364703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1137cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11389a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11399a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11409a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11419a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11429a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 114359c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1144cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1145cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 11469a5b1318SJouni Malinen /* 11479a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11489a5b1318SJouni Malinen * the connected event is received from the target. 11499a5b1318SJouni Malinen */ 11509a5b1318SJouni Malinen return 0; 11519a5b1318SJouni Malinen } 11529a5b1318SJouni Malinen } 11539a5b1318SJouni Malinen 1154f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 115559c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1156151411e8SJouni Malinen /* 1157151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1158151411e8SJouni Malinen * the AP mode has properly started 1159151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1160151411e8SJouni Malinen */ 1161cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1162cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 11636f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11646f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11656f2a73f9SVasanthakumar Thiagarajan key->key_len); 1166151411e8SJouni Malinen return 0; 1167151411e8SJouni Malinen } 1168151411e8SJouni Malinen 11697cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1170bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1171f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1172f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1173bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1174bdcd8170SKalle Valo } 1175bdcd8170SKalle Valo 1176bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1177bdcd8170SKalle Valo u8 key_index, bool pairwise, 1178bdcd8170SKalle Valo const u8 *mac_addr) 1179bdcd8170SKalle Valo { 1180d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11816f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1182bdcd8170SKalle Valo 1183bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1184bdcd8170SKalle Valo 1185990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1186bdcd8170SKalle Valo return -EIO; 1187bdcd8170SKalle Valo 1188792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1189bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1190bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1191bdcd8170SKalle Valo key_index); 1192bdcd8170SKalle Valo return -ENOENT; 1193bdcd8170SKalle Valo } 1194bdcd8170SKalle Valo 11956f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1196bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1197bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1198bdcd8170SKalle Valo return 0; 1199bdcd8170SKalle Valo } 1200bdcd8170SKalle Valo 12016f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1202bdcd8170SKalle Valo 1203334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1204bdcd8170SKalle Valo } 1205bdcd8170SKalle Valo 1206bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1207bdcd8170SKalle Valo u8 key_index, bool pairwise, 1208bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1209bdcd8170SKalle Valo void (*callback) (void *cookie, 1210bdcd8170SKalle Valo struct key_params *)) 1211bdcd8170SKalle Valo { 12126f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1213bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1214bdcd8170SKalle Valo struct key_params params; 1215bdcd8170SKalle Valo 1216bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1217bdcd8170SKalle Valo 1218990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1219bdcd8170SKalle Valo return -EIO; 1220bdcd8170SKalle Valo 1221792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1222bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1223bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1224bdcd8170SKalle Valo key_index); 1225bdcd8170SKalle Valo return -ENOENT; 1226bdcd8170SKalle Valo } 1227bdcd8170SKalle Valo 12286f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1229bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1230bdcd8170SKalle Valo params.cipher = key->cipher; 1231bdcd8170SKalle Valo params.key_len = key->key_len; 1232bdcd8170SKalle Valo params.seq_len = key->seq_len; 1233bdcd8170SKalle Valo params.seq = key->seq; 1234bdcd8170SKalle Valo params.key = key->key; 1235bdcd8170SKalle Valo 1236bdcd8170SKalle Valo callback(cookie, ¶ms); 1237bdcd8170SKalle Valo 1238bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1239bdcd8170SKalle Valo } 1240bdcd8170SKalle Valo 1241bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1242bdcd8170SKalle Valo struct net_device *ndev, 1243bdcd8170SKalle Valo u8 key_index, bool unicast, 1244bdcd8170SKalle Valo bool multicast) 1245bdcd8170SKalle Valo { 1246d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 124759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1248bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1249bdcd8170SKalle Valo u8 key_usage; 1250229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1251bdcd8170SKalle Valo 1252bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1253bdcd8170SKalle Valo 1254990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1255bdcd8170SKalle Valo return -EIO; 1256bdcd8170SKalle Valo 1257792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1258bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1259bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1260bdcd8170SKalle Valo __func__, key_index); 1261bdcd8170SKalle Valo return -ENOENT; 1262bdcd8170SKalle Valo } 1263bdcd8170SKalle Valo 12646f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1265bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1266bdcd8170SKalle Valo __func__, key_index); 1267bdcd8170SKalle Valo return -EINVAL; 1268bdcd8170SKalle Valo } 1269bdcd8170SKalle Valo 12703450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12716f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1272bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12733450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1274bdcd8170SKalle Valo key_usage |= TX_USAGE; 1275229ed6b5SEdward Lu if (unicast) 12763450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1277229ed6b5SEdward Lu if (multicast) 12783450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1279bdcd8170SKalle Valo 1280f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12819a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12829a5b1318SJouni Malinen 1283f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1284334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1285229ed6b5SEdward Lu key_type, key_usage, 1286f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1287f4bb9a6fSJouni Malinen key->key, 1288bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1289bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1290bdcd8170SKalle Valo } 1291bdcd8170SKalle Valo 1292240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1293bdcd8170SKalle Valo bool ismcast) 1294bdcd8170SKalle Valo { 1295bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1296bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1297bdcd8170SKalle Valo 1298240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1299bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1300bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1301bdcd8170SKalle Valo GFP_KERNEL); 1302bdcd8170SKalle Valo } 1303bdcd8170SKalle Valo 1304bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1305bdcd8170SKalle Valo { 1306bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1307990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1308bdcd8170SKalle Valo int ret; 1309bdcd8170SKalle Valo 1310bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1311bdcd8170SKalle Valo changed); 1312bdcd8170SKalle Valo 1313990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1314990bd915SVasanthakumar Thiagarajan if (!vif) 1315990bd915SVasanthakumar Thiagarajan return -EIO; 1316990bd915SVasanthakumar Thiagarajan 1317990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1318bdcd8170SKalle Valo return -EIO; 1319bdcd8170SKalle Valo 1320bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1321bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1322bdcd8170SKalle Valo if (ret != 0) { 1323bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1324bdcd8170SKalle Valo return -EIO; 1325bdcd8170SKalle Valo } 1326bdcd8170SKalle Valo } 1327bdcd8170SKalle Valo 1328bdcd8170SKalle Valo return 0; 1329bdcd8170SKalle Valo } 1330bdcd8170SKalle Valo 1331bdcd8170SKalle Valo /* 1332bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1333bdcd8170SKalle Valo * data type from 2.6.36 onwards 1334bdcd8170SKalle Valo */ 1335bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1336bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1337b992a285SLuis R. Rodriguez int mbm) 1338bdcd8170SKalle Valo { 1339bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1340990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1341b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1344bdcd8170SKalle Valo type, dbm); 1345bdcd8170SKalle Valo 1346990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1347990bd915SVasanthakumar Thiagarajan if (!vif) 1348990bd915SVasanthakumar Thiagarajan return -EIO; 1349990bd915SVasanthakumar Thiagarajan 1350990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1351bdcd8170SKalle Valo return -EIO; 1352bdcd8170SKalle Valo 1353bdcd8170SKalle Valo switch (type) { 1354bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1355bdcd8170SKalle Valo return 0; 1356bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1357d0d670abSKalle Valo ar->tx_pwr = dbm; 1358bdcd8170SKalle Valo break; 1359bdcd8170SKalle Valo default: 1360bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1361bdcd8170SKalle Valo __func__, type); 1362bdcd8170SKalle Valo return -EOPNOTSUPP; 1363bdcd8170SKalle Valo } 1364bdcd8170SKalle Valo 1365d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo return 0; 1368bdcd8170SKalle Valo } 1369bdcd8170SKalle Valo 1370bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1371bdcd8170SKalle Valo { 1372bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1373990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1374bdcd8170SKalle Valo 1375990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1376990bd915SVasanthakumar Thiagarajan if (!vif) 1377990bd915SVasanthakumar Thiagarajan return -EIO; 1378990bd915SVasanthakumar Thiagarajan 1379990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1380bdcd8170SKalle Valo return -EIO; 1381bdcd8170SKalle Valo 138259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1383bdcd8170SKalle Valo ar->tx_pwr = 0; 1384bdcd8170SKalle Valo 1385990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1386bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1387bdcd8170SKalle Valo return -EIO; 1388bdcd8170SKalle Valo } 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1391bdcd8170SKalle Valo 5 * HZ); 1392bdcd8170SKalle Valo 1393bdcd8170SKalle Valo if (signal_pending(current)) { 1394bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1395bdcd8170SKalle Valo return -EINTR; 1396bdcd8170SKalle Valo } 1397bdcd8170SKalle Valo } 1398bdcd8170SKalle Valo 1399bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1400bdcd8170SKalle Valo return 0; 1401bdcd8170SKalle Valo } 1402bdcd8170SKalle Valo 1403bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1404bdcd8170SKalle Valo struct net_device *dev, 1405bdcd8170SKalle Valo bool pmgmt, int timeout) 1406bdcd8170SKalle Valo { 1407bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1408bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1409334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1410bdcd8170SKalle Valo 1411bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1412bdcd8170SKalle Valo __func__, pmgmt, timeout); 1413bdcd8170SKalle Valo 1414990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1415bdcd8170SKalle Valo return -EIO; 1416bdcd8170SKalle Valo 1417bdcd8170SKalle Valo if (pmgmt) { 1418bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1419bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1420bdcd8170SKalle Valo } else { 1421bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1422bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1423bdcd8170SKalle Valo } 1424bdcd8170SKalle Valo 1425334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1426334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1427bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1428bdcd8170SKalle Valo return -EIO; 1429bdcd8170SKalle Valo } 1430bdcd8170SKalle Valo 1431bdcd8170SKalle Valo return 0; 1432bdcd8170SKalle Valo } 1433bdcd8170SKalle Valo 143455055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 143555055976SVasanthakumar Thiagarajan char *name, 143655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 143755055976SVasanthakumar Thiagarajan u32 *flags, 143855055976SVasanthakumar Thiagarajan struct vif_params *params) 143955055976SVasanthakumar Thiagarajan { 144055055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 144155055976SVasanthakumar Thiagarajan struct net_device *ndev; 144255055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 144355055976SVasanthakumar Thiagarajan 144471f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 144555055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 144655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 144755055976SVasanthakumar Thiagarajan } 144855055976SVasanthakumar Thiagarajan 144955055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 145055055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 145155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 145255055976SVasanthakumar Thiagarajan } 145355055976SVasanthakumar Thiagarajan 145455055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 145555055976SVasanthakumar Thiagarajan if (!ndev) 145655055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 145755055976SVasanthakumar Thiagarajan 145855055976SVasanthakumar Thiagarajan ar->num_vif++; 145955055976SVasanthakumar Thiagarajan 146055055976SVasanthakumar Thiagarajan return ndev; 146155055976SVasanthakumar Thiagarajan } 146255055976SVasanthakumar Thiagarajan 146355055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 146455055976SVasanthakumar Thiagarajan struct net_device *ndev) 146555055976SVasanthakumar Thiagarajan { 146655055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 146755055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 146855055976SVasanthakumar Thiagarajan 146911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 147055055976SVasanthakumar Thiagarajan list_del(&vif->list); 147111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 147255055976SVasanthakumar Thiagarajan 147355055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 147455055976SVasanthakumar Thiagarajan 1475c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 147655055976SVasanthakumar Thiagarajan 147755055976SVasanthakumar Thiagarajan return 0; 147855055976SVasanthakumar Thiagarajan } 147955055976SVasanthakumar Thiagarajan 1480bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1481bdcd8170SKalle Valo struct net_device *ndev, 1482bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1483bdcd8170SKalle Valo struct vif_params *params) 1484bdcd8170SKalle Valo { 1485f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 14861e8d13b0SVasanthakumar Thiagarajan int i; 1487bdcd8170SKalle Valo 1488bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1489bdcd8170SKalle Valo 14901e8d13b0SVasanthakumar Thiagarajan /* 14911e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 14921e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 14931e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 14941e8d13b0SVasanthakumar Thiagarajan */ 14951e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 14961e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 14971e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 14981e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 14991e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15001e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15011e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15021e8d13b0SVasanthakumar Thiagarajan else 15031e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15041e8d13b0SVasanthakumar Thiagarajan } 15051e8d13b0SVasanthakumar Thiagarajan 15061e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15071e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15081e8d13b0SVasanthakumar Thiagarajan break; 15091e8d13b0SVasanthakumar Thiagarajan } 15101e8d13b0SVasanthakumar Thiagarajan 15111e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15121e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15131e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15141e8d13b0SVasanthakumar Thiagarajan } 15151e8d13b0SVasanthakumar Thiagarajan } 15161e8d13b0SVasanthakumar Thiagarajan 15171e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1518bdcd8170SKalle Valo switch (type) { 1519bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1520f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1521bdcd8170SKalle Valo break; 1522bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1523f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1524bdcd8170SKalle Valo break; 15256e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1526f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15276e4604c8SJouni Malinen break; 15286b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1529f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15306b5e5d25SJouni Malinen break; 15316b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1532f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15336b5e5d25SJouni Malinen break; 1534bdcd8170SKalle Valo default: 1535bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1536bdcd8170SKalle Valo return -EOPNOTSUPP; 1537bdcd8170SKalle Valo } 1538bdcd8170SKalle Valo 1539551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1540bdcd8170SKalle Valo 1541bdcd8170SKalle Valo return 0; 1542bdcd8170SKalle Valo } 1543bdcd8170SKalle Valo 1544bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1545bdcd8170SKalle Valo struct net_device *dev, 1546bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1547bdcd8170SKalle Valo { 1548bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 154959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1550bdcd8170SKalle Valo int status; 1551bdcd8170SKalle Valo 1552990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1553bdcd8170SKalle Valo return -EIO; 1554bdcd8170SKalle Valo 15553450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 15563450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1557bdcd8170SKalle Valo 1558bdcd8170SKalle Valo if (ibss_param->channel) 1559f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1560bdcd8170SKalle Valo 1561bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1562bdcd8170SKalle Valo /* 1563bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1564bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1565bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1566bdcd8170SKalle Valo * updated. 1567bdcd8170SKalle Valo */ 1568bdcd8170SKalle Valo return -EOPNOTSUPP; 1569bdcd8170SKalle Valo } 1570bdcd8170SKalle Valo 15718c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1572bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 15738c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15748c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1575bdcd8170SKalle Valo 1576240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1577bdcd8170SKalle Valo 1578240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1579bdcd8170SKalle Valo if (status) 1580bdcd8170SKalle Valo return status; 1581bdcd8170SKalle Valo 1582bdcd8170SKalle Valo if (ibss_param->privacy) { 1583240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1584240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1585bdcd8170SKalle Valo } else { 1586240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1587240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1588bdcd8170SKalle Valo } 1589bdcd8170SKalle Valo 1590f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1591bdcd8170SKalle Valo 1592bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1593bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1594bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1595bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1596bdcd8170SKalle Valo __func__, 15973450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15983450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1599f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1600bdcd8170SKalle Valo 1601334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16033450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16043450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16053450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16063450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1607f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16083ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 160959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1610bdcd8170SKalle Valo 1611bdcd8170SKalle Valo return 0; 1612bdcd8170SKalle Valo } 1613bdcd8170SKalle Valo 1614bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1615bdcd8170SKalle Valo struct net_device *dev) 1616bdcd8170SKalle Valo { 16173450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1618bdcd8170SKalle Valo 1619990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1620bdcd8170SKalle Valo return -EIO; 1621bdcd8170SKalle Valo 1622240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16233450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16243450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1625bdcd8170SKalle Valo 1626bdcd8170SKalle Valo return 0; 1627bdcd8170SKalle Valo } 1628bdcd8170SKalle Valo 1629bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1630bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1631bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1632bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1633bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1634837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16355e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1636bdcd8170SKalle Valo }; 1637bdcd8170SKalle Valo 1638bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1639bdcd8170SKalle Valo { 1640bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1641bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1642bdcd8170SKalle Valo 36000, 48000, 54000 1643bdcd8170SKalle Valo }; 1644bdcd8170SKalle Valo u8 i; 1645bdcd8170SKalle Valo 1646bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1647bdcd8170SKalle Valo if (rate == legacy[i]) 1648bdcd8170SKalle Valo return true; 1649bdcd8170SKalle Valo 1650bdcd8170SKalle Valo return false; 1651bdcd8170SKalle Valo } 1652bdcd8170SKalle Valo 1653bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1654bdcd8170SKalle Valo { 1655bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1656bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1657bdcd8170SKalle Valo }; 1658bdcd8170SKalle Valo u8 i; 1659bdcd8170SKalle Valo 1660bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1661bdcd8170SKalle Valo if (rate == ht20[i]) { 1662bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1663bdcd8170SKalle Valo /* last rate uses sgi */ 1664bdcd8170SKalle Valo *sgi = true; 1665bdcd8170SKalle Valo else 1666bdcd8170SKalle Valo *sgi = false; 1667bdcd8170SKalle Valo 1668bdcd8170SKalle Valo *mcs = i; 1669bdcd8170SKalle Valo return true; 1670bdcd8170SKalle Valo } 1671bdcd8170SKalle Valo } 1672bdcd8170SKalle Valo return false; 1673bdcd8170SKalle Valo } 1674bdcd8170SKalle Valo 1675bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1676bdcd8170SKalle Valo { 1677bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1678bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1679bdcd8170SKalle Valo 150000 1680bdcd8170SKalle Valo }; 1681bdcd8170SKalle Valo u8 i; 1682bdcd8170SKalle Valo 1683bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1684bdcd8170SKalle Valo if (rate == ht40[i]) { 1685bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1686bdcd8170SKalle Valo /* last rate uses sgi */ 1687bdcd8170SKalle Valo *sgi = true; 1688bdcd8170SKalle Valo else 1689bdcd8170SKalle Valo *sgi = false; 1690bdcd8170SKalle Valo 1691bdcd8170SKalle Valo *mcs = i; 1692bdcd8170SKalle Valo return true; 1693bdcd8170SKalle Valo } 1694bdcd8170SKalle Valo } 1695bdcd8170SKalle Valo 1696bdcd8170SKalle Valo return false; 1697bdcd8170SKalle Valo } 1698bdcd8170SKalle Valo 1699bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1700bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1701bdcd8170SKalle Valo { 1702bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 170359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1704bdcd8170SKalle Valo long left; 1705bdcd8170SKalle Valo bool sgi; 1706bdcd8170SKalle Valo s32 rate; 1707bdcd8170SKalle Valo int ret; 1708bdcd8170SKalle Valo u8 mcs; 1709bdcd8170SKalle Valo 17108c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1711bdcd8170SKalle Valo return -ENOENT; 1712bdcd8170SKalle Valo 1713bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1714bdcd8170SKalle Valo return -EBUSY; 1715bdcd8170SKalle Valo 1716b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1717bdcd8170SKalle Valo 1718334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1719bdcd8170SKalle Valo 1720bdcd8170SKalle Valo if (ret != 0) { 1721bdcd8170SKalle Valo up(&ar->sem); 1722bdcd8170SKalle Valo return -EIO; 1723bdcd8170SKalle Valo } 1724bdcd8170SKalle Valo 1725bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1726bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1727b95907a7SVasanthakumar Thiagarajan &vif->flags), 1728bdcd8170SKalle Valo WMI_TIMEOUT); 1729bdcd8170SKalle Valo 1730bdcd8170SKalle Valo up(&ar->sem); 1731bdcd8170SKalle Valo 1732bdcd8170SKalle Valo if (left == 0) 1733bdcd8170SKalle Valo return -ETIMEDOUT; 1734bdcd8170SKalle Valo else if (left < 0) 1735bdcd8170SKalle Valo return left; 1736bdcd8170SKalle Valo 1737b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1738b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1739bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1740b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1741bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1742bdcd8170SKalle Valo } 1743bdcd8170SKalle Valo 1744b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1745b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1746bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1747b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1748bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1749bdcd8170SKalle Valo } 1750bdcd8170SKalle Valo 1751b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1752bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1753bdcd8170SKalle Valo 1754b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1755bdcd8170SKalle Valo 1756bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1757bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1758bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1759bdcd8170SKalle Valo if (sgi) { 1760bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1761bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1762bdcd8170SKalle Valo } else { 1763bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1764bdcd8170SKalle Valo } 1765bdcd8170SKalle Valo 1766bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1767bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1768bdcd8170SKalle Valo if (sgi) { 1769bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1770bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1771bdcd8170SKalle Valo } else { 1772bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1773bdcd8170SKalle Valo } 1774bdcd8170SKalle Valo 1775bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1776bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1777bdcd8170SKalle Valo } else { 17789a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17799a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17809a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1781bdcd8170SKalle Valo return 0; 1782bdcd8170SKalle Valo } 1783bdcd8170SKalle Valo 1784bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1785bdcd8170SKalle Valo 178659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 178759c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1788f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 178932c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 179032c10874SJouni Malinen sinfo->bss_param.flags = 0; 1791cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1792cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 179332c10874SJouni Malinen } 179432c10874SJouni Malinen 1795bdcd8170SKalle Valo return 0; 1796bdcd8170SKalle Valo } 1797bdcd8170SKalle Valo 1798bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1799bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1800bdcd8170SKalle Valo { 1801bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1802334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1803334234b5SVasanthakumar Thiagarajan 1804334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1805bdcd8170SKalle Valo pmksa->pmkid, true); 1806bdcd8170SKalle Valo } 1807bdcd8170SKalle Valo 1808bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1809bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1810bdcd8170SKalle Valo { 1811bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1812334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1813334234b5SVasanthakumar Thiagarajan 1814334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1815bdcd8170SKalle Valo pmksa->pmkid, false); 1816bdcd8170SKalle Valo } 1817bdcd8170SKalle Valo 1818bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1819bdcd8170SKalle Valo { 1820bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 182159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 182259c98449SVasanthakumar Thiagarajan 182359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1824334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1825334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1826bdcd8170SKalle Valo return 0; 1827bdcd8170SKalle Valo } 1828bdcd8170SKalle Valo 1829d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1830d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18316cb3c714SRaja Mani { 1832d91e8eeeSRaja Mani int ret, pos; 1833d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 18346cb3c714SRaja Mani u16 i; 18356cb3c714SRaja Mani 1836d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18376cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 18386cb3c714SRaja Mani 18396cb3c714SRaja Mani /* 18406cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 18416cb3c714SRaja Mani * driver specific mask value and send it to the chip along 18426cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 18436cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 18446cb3c714SRaja Mani * then equivalent driver specific mask value is 18456cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 18466cb3c714SRaja Mani */ 18476cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 18486cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 18496cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 18506cb3c714SRaja Mani mask[pos] = 0xFF; 18516cb3c714SRaja Mani } 18526cb3c714SRaja Mani /* 18536cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 18546cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 18556cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 18566cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 18576cb3c714SRaja Mani */ 18586cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 18596cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 18606cb3c714SRaja Mani wow->patterns[i].pattern_len, 18616cb3c714SRaja Mani 0 /* pattern offset */, 18626cb3c714SRaja Mani wow->patterns[i].pattern, mask); 18636cb3c714SRaja Mani if (ret) 18646cb3c714SRaja Mani return ret; 18656cb3c714SRaja Mani } 18666cb3c714SRaja Mani 1867d91e8eeeSRaja Mani if (wow->disconnect) 1868d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1869d91e8eeeSRaja Mani 1870d91e8eeeSRaja Mani if (wow->magic_pkt) 1871d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1872d91e8eeeSRaja Mani 1873d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1874d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1875d91e8eeeSRaja Mani 1876d91e8eeeSRaja Mani if (wow->eap_identity_req) 1877d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1878d91e8eeeSRaja Mani 1879d91e8eeeSRaja Mani if (wow->four_way_handshake) 1880d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1881d91e8eeeSRaja Mani 1882d91e8eeeSRaja Mani return 0; 1883d91e8eeeSRaja Mani } 1884d91e8eeeSRaja Mani 1885d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1886d91e8eeeSRaja Mani { 1887d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1888d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1889d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1890d91e8eeeSRaja Mani 0x00, 0x08 }; 1891d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1892d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1893d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1894d91e8eeeSRaja Mani 0x00, 0x7f }; 1895d91e8eeeSRaja Mani u8 unicst_offset = 0; 1896d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1897d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1898d91e8eeeSRaja Mani u8 arp_offset = 20; 1899d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1900d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1901d91e8eeeSRaja Mani u8 discvr_offset = 38; 1902d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1903d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1904d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1905d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1906d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1907d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1908d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1909d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1910d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1911d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1912d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1913d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1914d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1915d91e8eeeSRaja Mani int ret; 1916d91e8eeeSRaja Mani 1917d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1918d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1919d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1920d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1921d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1922d91e8eeeSRaja Mani if (ret) { 1923d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1924d91e8eeeSRaja Mani return ret; 1925d91e8eeeSRaja Mani } 1926d91e8eeeSRaja Mani 1927d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1928d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1929d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1930d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1931d91e8eeeSRaja Mani arp_pattern, arp_mask); 1932d91e8eeeSRaja Mani if (ret) { 1933d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1934d91e8eeeSRaja Mani return ret; 1935d91e8eeeSRaja Mani } 1936d91e8eeeSRaja Mani 1937d91e8eeeSRaja Mani /* 1938d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1939d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1940d91e8eeeSRaja Mani */ 1941d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1942d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1943d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1944d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1945d91e8eeeSRaja Mani if (ret) { 1946d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1947d91e8eeeSRaja Mani return ret; 1948d91e8eeeSRaja Mani } 1949d91e8eeeSRaja Mani 1950d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1951d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1952d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1953d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1954d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1955d91e8eeeSRaja Mani if (ret) { 1956d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1957d91e8eeeSRaja Mani return ret; 1958d91e8eeeSRaja Mani } 1959d91e8eeeSRaja Mani 1960d91e8eeeSRaja Mani return 0; 1961d91e8eeeSRaja Mani } 1962d91e8eeeSRaja Mani 1963d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1964d91e8eeeSRaja Mani { 1965d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1966d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1967d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1968d91e8eeeSRaja Mani u8 discvr_offset = 38; 1969d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1970d91e8eeeSRaja Mani int ret; 1971d91e8eeeSRaja Mani 1972d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1973d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1974d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1975d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1976d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1977d91e8eeeSRaja Mani mac_mask); 1978d91e8eeeSRaja Mani if (ret) { 1979d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1980d91e8eeeSRaja Mani return ret; 1981d91e8eeeSRaja Mani } 1982d91e8eeeSRaja Mani 1983d91e8eeeSRaja Mani /* 1984d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1985d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1986d91e8eeeSRaja Mani */ 1987d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1988d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1989d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1990d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1991d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1992d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1993d91e8eeeSRaja Mani if (ret) { 1994cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1995d91e8eeeSRaja Mani return ret; 1996d91e8eeeSRaja Mani } 1997d91e8eeeSRaja Mani } 1998d91e8eeeSRaja Mani 1999d91e8eeeSRaja Mani return 0; 2000d91e8eeeSRaja Mani } 2001d91e8eeeSRaja Mani 2002055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2003055bde49SRaja Mani { 2004055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2005055bde49SRaja Mani } 2006055bde49SRaja Mani 2007055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2008055bde49SRaja Mani { 2009055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2010055bde49SRaja Mani } 2011055bde49SRaja Mani 2012055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2013055bde49SRaja Mani { 2014055bde49SRaja Mani int ret, left; 2015055bde49SRaja Mani 2016055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2017055bde49SRaja Mani 2018055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2019055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2020055bde49SRaja Mani if (ret) 2021055bde49SRaja Mani return ret; 2022055bde49SRaja Mani 2023055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2024055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2025055bde49SRaja Mani WMI_TIMEOUT); 2026055bde49SRaja Mani if (left == 0) { 2027055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2028055bde49SRaja Mani ret = -ETIMEDOUT; 2029055bde49SRaja Mani } else if (left < 0) { 2030055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2031055bde49SRaja Mani left); 2032055bde49SRaja Mani ret = left; 2033055bde49SRaja Mani } 2034055bde49SRaja Mani 2035055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2036055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2037055bde49SRaja Mani is_ctrl_ep_empty(ar), 2038055bde49SRaja Mani WMI_TIMEOUT); 2039055bde49SRaja Mani if (left == 0) { 2040055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2041055bde49SRaja Mani ret = -ETIMEDOUT; 2042055bde49SRaja Mani } else if (left < 0) { 2043055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2044055bde49SRaja Mani ret = left; 2045055bde49SRaja Mani } 2046055bde49SRaja Mani } 2047055bde49SRaja Mani 2048055bde49SRaja Mani return ret; 2049055bde49SRaja Mani } 2050055bde49SRaja Mani 2051d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2052d91e8eeeSRaja Mani { 2053d91e8eeeSRaja Mani struct in_device *in_dev; 2054d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2055d91e8eeeSRaja Mani struct ath6kl_vif *vif; 2056055bde49SRaja Mani int ret; 2057d91e8eeeSRaja Mani u32 filter = 0; 2058ce0dc0cfSRaja Mani u16 i, bmiss_time; 2059d91e8eeeSRaja Mani u8 index = 0; 2060d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2061d91e8eeeSRaja Mani 2062d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2063d91e8eeeSRaja Mani if (!vif) 2064d91e8eeeSRaja Mani return -EIO; 2065d91e8eeeSRaja Mani 2066d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2067d91e8eeeSRaja Mani return -EIO; 2068d91e8eeeSRaja Mani 2069d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 20703c411a43SRaja Mani return -ENOTCONN; 2071d91e8eeeSRaja Mani 2072d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2073d91e8eeeSRaja Mani return -EINVAL; 2074d91e8eeeSRaja Mani 2075d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2076d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2077d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2078d91e8eeeSRaja Mani WOW_LIST_ID, i); 2079d91e8eeeSRaja Mani 2080d91e8eeeSRaja Mani /* 2081d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2082d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2083d91e8eeeSRaja Mani * the user. 2084d91e8eeeSRaja Mani */ 2085d91e8eeeSRaja Mani if (wow) 2086d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2087d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2088d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2089d91e8eeeSRaja Mani else 2090d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2091d91e8eeeSRaja Mani 2092d91e8eeeSRaja Mani if (ret) 2093d91e8eeeSRaja Mani return ret; 2094d91e8eeeSRaja Mani 2095390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2096390a8c8fSRaja Mani 2097ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2098ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2099ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2100ce0dc0cfSRaja Mani 0); 2101ce0dc0cfSRaja Mani if (ret) 2102ce0dc0cfSRaja Mani return ret; 2103ce0dc0cfSRaja Mani 2104ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2105ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2106ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2107ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2108ce0dc0cfSRaja Mani 2109ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2110ce0dc0cfSRaja Mani bmiss_time, 0); 2111ce0dc0cfSRaja Mani if (ret) 2112ce0dc0cfSRaja Mani return ret; 2113ce0dc0cfSRaja Mani 2114ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2115ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2116ce0dc0cfSRaja Mani 0, 0, 0, 0); 2117ce0dc0cfSRaja Mani if (ret) 2118ce0dc0cfSRaja Mani return ret; 2119ce0dc0cfSRaja Mani } 2120ce0dc0cfSRaja Mani 2121390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2122390a8c8fSRaja Mani 2123c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2124c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2125c08631c6SRaja Mani if (!in_dev) 2126c08631c6SRaja Mani goto skip_arp; 2127c08631c6SRaja Mani 2128c08631c6SRaja Mani ifa = in_dev->ifa_list; 2129c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2130c08631c6SRaja Mani 2131c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2132c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2133c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2134c08631c6SRaja Mani ifa = ifa->ifa_next; 2135c08631c6SRaja Mani index++; 2136c08631c6SRaja Mani } 2137c08631c6SRaja Mani 2138c08631c6SRaja Mani if (ifa) { 2139c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2140c08631c6SRaja Mani return -EINVAL; 2141c08631c6SRaja Mani } 2142c08631c6SRaja Mani 2143c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2144c08631c6SRaja Mani if (ret) { 2145c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2146c08631c6SRaja Mani return ret; 2147c08631c6SRaja Mani } 2148c08631c6SRaja Mani 2149c08631c6SRaja Mani skip_arp: 21506cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 21516cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 21526cb3c714SRaja Mani filter, 21536cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 21546cb3c714SRaja Mani if (ret) 21556cb3c714SRaja Mani return ret; 21566cb3c714SRaja Mani 2157055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 21586cb3c714SRaja Mani if (ret) 21596cb3c714SRaja Mani return ret; 21606cb3c714SRaja Mani 2161055bde49SRaja Mani return 0; 21626cb3c714SRaja Mani } 21636cb3c714SRaja Mani 21646cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 21656cb3c714SRaja Mani { 21666cb3c714SRaja Mani struct ath6kl_vif *vif; 21676cb3c714SRaja Mani int ret; 21686cb3c714SRaja Mani 21696cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 21706cb3c714SRaja Mani if (!vif) 21716cb3c714SRaja Mani return -EIO; 21726cb3c714SRaja Mani 2173390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2174390a8c8fSRaja Mani 21756cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21766cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2177390a8c8fSRaja Mani if (ret) { 2178cdeb8602SKalle Valo ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2179cdeb8602SKalle Valo ret); 2180390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21816cb3c714SRaja Mani return ret; 21826cb3c714SRaja Mani } 21836cb3c714SRaja Mani 2184ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2185ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2186ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2187ce0dc0cfSRaja Mani if (ret) 2188ce0dc0cfSRaja Mani return ret; 2189ce0dc0cfSRaja Mani 2190ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2191ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2192ce0dc0cfSRaja Mani if (ret) 2193ce0dc0cfSRaja Mani return ret; 2194ce0dc0cfSRaja Mani 2195ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2196ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2197ce0dc0cfSRaja Mani if (ret) 2198ce0dc0cfSRaja Mani return ret; 2199ce0dc0cfSRaja Mani } 2200ce0dc0cfSRaja Mani 2201390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2202390a8c8fSRaja Mani 2203390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2204390a8c8fSRaja Mani 2205390a8c8fSRaja Mani return 0; 2206390a8c8fSRaja Mani } 2207390a8c8fSRaja Mani 220840abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 220940abc2deSRaja Mani { 221040abc2deSRaja Mani struct ath6kl_vif *vif; 221140abc2deSRaja Mani int ret; 221240abc2deSRaja Mani 221340abc2deSRaja Mani vif = ath6kl_vif_first(ar); 221440abc2deSRaja Mani if (!vif) 221540abc2deSRaja Mani return -EIO; 221640abc2deSRaja Mani 221748f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 221848f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 221940abc2deSRaja Mani return -EIO; 222048f27587SMing Jiang } 222140abc2deSRaja Mani 222240abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 222340abc2deSRaja Mani 222440abc2deSRaja Mani /* Save the current power mode before enabling power save */ 222540abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 222640abc2deSRaja Mani 222740abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 222840abc2deSRaja Mani if (ret) 222940abc2deSRaja Mani return ret; 223040abc2deSRaja Mani 223140abc2deSRaja Mani /* Disable WOW mode */ 223240abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 223340abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 223440abc2deSRaja Mani 0, 0); 223540abc2deSRaja Mani if (ret) 223640abc2deSRaja Mani return ret; 223740abc2deSRaja Mani 223840abc2deSRaja Mani /* Flush all non control pkts in TX path */ 223940abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 224040abc2deSRaja Mani 224140abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 224240abc2deSRaja Mani if (ret) 224340abc2deSRaja Mani return ret; 224440abc2deSRaja Mani 224540abc2deSRaja Mani return 0; 224640abc2deSRaja Mani } 224740abc2deSRaja Mani 224840abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 224940abc2deSRaja Mani { 225040abc2deSRaja Mani struct ath6kl_vif *vif; 225140abc2deSRaja Mani int ret; 225240abc2deSRaja Mani 225340abc2deSRaja Mani vif = ath6kl_vif_first(ar); 225440abc2deSRaja Mani 225540abc2deSRaja Mani if (!vif) 225640abc2deSRaja Mani return -EIO; 225740abc2deSRaja Mani 225840abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 225940abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 226040abc2deSRaja Mani ar->wmi->saved_pwr_mode); 226140abc2deSRaja Mani if (ret) 226240abc2deSRaja Mani return ret; 226340abc2deSRaja Mani } 226440abc2deSRaja Mani 226540abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 226640abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 226740abc2deSRaja Mani if (ret) 226840abc2deSRaja Mani return ret; 226940abc2deSRaja Mani 227040abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 227140abc2deSRaja Mani 227240abc2deSRaja Mani /* Reset scan parameter to default values */ 227340abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 227440abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 227540abc2deSRaja Mani if (ret) 227640abc2deSRaja Mani return ret; 227740abc2deSRaja Mani 227840abc2deSRaja Mani return 0; 227940abc2deSRaja Mani } 228040abc2deSRaja Mani 228152d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22820f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22830f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 228452d81a68SKalle Valo { 22853d79499cSVivek Natarajan struct ath6kl_vif *vif; 2286390a8c8fSRaja Mani enum ath6kl_state prev_state; 228752d81a68SKalle Valo int ret; 228852d81a68SKalle Valo 228952d81a68SKalle Valo switch (mode) { 2290d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2291d7c44e0bSRaja Mani 2292d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2293d7c44e0bSRaja Mani 2294d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2295d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2296d7c44e0bSRaja Mani 2297390a8c8fSRaja Mani prev_state = ar->state; 2298390a8c8fSRaja Mani 2299d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2300390a8c8fSRaja Mani if (ret) { 2301390a8c8fSRaja Mani ar->state = prev_state; 2302d7c44e0bSRaja Mani return ret; 2303390a8c8fSRaja Mani } 23041e9a905dSRaja Mani 2305d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2306d7c44e0bSRaja Mani break; 2307d7c44e0bSRaja Mani 230852d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2309524441e3SRaja Mani 231040abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2311524441e3SRaja Mani 231240abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 231352d81a68SKalle Valo if (ret) { 231440abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 231540abc2deSRaja Mani return ret; 231652d81a68SKalle Valo } 231752d81a68SKalle Valo 231876a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 231976a9fbe2SKalle Valo 232052d81a68SKalle Valo break; 2321b4b2a0b1SKalle Valo 2322b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2323524441e3SRaja Mani 23247125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2325524441e3SRaja Mani 2326b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2327b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2328b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2329b4b2a0b1SKalle Valo break; 2330b4b2a0b1SKalle Valo } 2331b4b2a0b1SKalle Valo 2332b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2333b4b2a0b1SKalle Valo 2334b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2335b4b2a0b1SKalle Valo if (ret) { 2336b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2337b4b2a0b1SKalle Valo ret); 2338b4b2a0b1SKalle Valo } 2339b4b2a0b1SKalle Valo 2340b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2341b4b2a0b1SKalle Valo 2342b4b2a0b1SKalle Valo break; 2343b4b2a0b1SKalle Valo 234410509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 234510509f90SKalle Valo /* 234610509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 234710509f90SKalle Valo * wow mode and sleeping most of the time. 234810509f90SKalle Valo */ 234910509f90SKalle Valo break; 235010509f90SKalle Valo 2351b4b2a0b1SKalle Valo default: 2352b4b2a0b1SKalle Valo break; 235352d81a68SKalle Valo } 235452d81a68SKalle Valo 23553d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 23563d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 23573d79499cSVivek Natarajan 235852d81a68SKalle Valo return 0; 235952d81a68SKalle Valo } 2360d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 236152d81a68SKalle Valo 236252d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 236352d81a68SKalle Valo { 236476a9fbe2SKalle Valo int ret; 236576a9fbe2SKalle Valo 236676a9fbe2SKalle Valo switch (ar->state) { 2367d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2368d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2369d7c44e0bSRaja Mani 2370d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2371d7c44e0bSRaja Mani if (ret) { 2372d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2373d7c44e0bSRaja Mani return ret; 2374d7c44e0bSRaja Mani } 2375d7c44e0bSRaja Mani 2376d7c44e0bSRaja Mani break; 2377d7c44e0bSRaja Mani 237876a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 237940abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 238040abc2deSRaja Mani 238140abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 238276a9fbe2SKalle Valo if (ret) { 238340abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 238440abc2deSRaja Mani return ret; 238576a9fbe2SKalle Valo } 238676a9fbe2SKalle Valo break; 238776a9fbe2SKalle Valo 2388b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2389b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2390b4b2a0b1SKalle Valo 2391b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2392b4b2a0b1SKalle Valo if (ret) { 2393b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2394b4b2a0b1SKalle Valo return ret; 2395b4b2a0b1SKalle Valo } 2396d7c44e0bSRaja Mani break; 2397b4b2a0b1SKalle Valo 239810509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 239910509f90SKalle Valo break; 240010509f90SKalle Valo 240176a9fbe2SKalle Valo default: 240276a9fbe2SKalle Valo break; 240352d81a68SKalle Valo } 240452d81a68SKalle Valo 240552d81a68SKalle Valo return 0; 240652d81a68SKalle Valo } 2407d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 240852d81a68SKalle Valo 2409abcb344bSKalle Valo #ifdef CONFIG_PM 241052d81a68SKalle Valo 241152d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 241252d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2413abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2414abcb344bSKalle Valo { 2415abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2416abcb344bSKalle Valo 24170f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2418abcb344bSKalle Valo } 2419aa6cffc1SChilam Ng 242052d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2421aa6cffc1SChilam Ng { 2422aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2423aa6cffc1SChilam Ng 2424aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2425aa6cffc1SChilam Ng } 2426a918fb3cSRaja Mani 2427a918fb3cSRaja Mani /* 2428a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2429a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2430a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2431a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2432a918fb3cSRaja Mani * 2433a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2434a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2435a918fb3cSRaja Mani * 2436a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2437a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2438a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2439a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2440a918fb3cSRaja Mani * 2441a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2442a918fb3cSRaja Mani */ 2443a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2444a918fb3cSRaja Mani { 2445390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2446390a8c8fSRaja Mani return; 2447390a8c8fSRaja Mani 2448a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2449a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2450a918fb3cSRaja Mani } 2451a918fb3cSRaja Mani 2452a918fb3cSRaja Mani #else 2453a918fb3cSRaja Mani 2454a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2455a918fb3cSRaja Mani { 2456a918fb3cSRaja Mani } 2457abcb344bSKalle Valo #endif 2458abcb344bSKalle Valo 2459df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2460df90b369SVasanthakumar Thiagarajan bool ht_enable) 24616a7c9badSJouni Malinen { 2462df90b369SVasanthakumar Thiagarajan struct ath6kl_htcap *htcap = &vif->htcap; 2463e68f6750SSujith Manoharan 2464df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 24656a7c9badSJouni Malinen return 0; 2466df90b369SVasanthakumar Thiagarajan 2467df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2468df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2469df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2470df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2471df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2472df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2473df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2474df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2475df90b369SVasanthakumar Thiagarajan 2476df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2477df90b369SVasanthakumar Thiagarajan band, htcap); 24786a7c9badSJouni Malinen } 24796a7c9badSJouni Malinen 24808bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 24818bdfbf40SJouni Malinen { 24828bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 24838bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 24848bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 24858bdfbf40SJouni Malinen } 24868bdfbf40SJouni Malinen 2487334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2488334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 24898bdfbf40SJouni Malinen { 2490334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24918bdfbf40SJouni Malinen const u8 *pos; 24928bdfbf40SJouni Malinen u8 *buf = NULL; 24938bdfbf40SJouni Malinen size_t len = 0; 24948bdfbf40SJouni Malinen int ret; 24958bdfbf40SJouni Malinen 24968bdfbf40SJouni Malinen /* 24978bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 24988bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 24998bdfbf40SJouni Malinen */ 25008bdfbf40SJouni Malinen 25018bdfbf40SJouni Malinen if (ies && ies_len) { 25028bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 25038bdfbf40SJouni Malinen if (buf == NULL) 25048bdfbf40SJouni Malinen return -ENOMEM; 25058bdfbf40SJouni Malinen pos = ies; 25068bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 25078bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 25088bdfbf40SJouni Malinen break; 25098bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 25108bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 25118bdfbf40SJouni Malinen len += 2 + pos[1]; 25128bdfbf40SJouni Malinen } 25138bdfbf40SJouni Malinen pos += 2 + pos[1]; 25148bdfbf40SJouni Malinen } 25158bdfbf40SJouni Malinen } 25168bdfbf40SJouni Malinen 2517334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2518334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 25198bdfbf40SJouni Malinen kfree(buf); 25208bdfbf40SJouni Malinen return ret; 25218bdfbf40SJouni Malinen } 25228bdfbf40SJouni Malinen 25238860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 25248860020eSJohannes Berg struct cfg80211_beacon_data *info) 25258860020eSJohannes Berg { 25268860020eSJohannes Berg struct ath6kl *ar = vif->ar; 25278860020eSJohannes Berg int res; 25288860020eSJohannes Berg 252917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25308860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25318860020eSJohannes Berg WMI_FRAME_BEACON, 25328860020eSJohannes Berg info->beacon_ies, 25338860020eSJohannes Berg info->beacon_ies_len); 25348860020eSJohannes Berg if (res) 25358860020eSJohannes Berg return res; 25368860020eSJohannes Berg 253717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25388860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 25398860020eSJohannes Berg info->proberesp_ies_len); 25408860020eSJohannes Berg if (res) 25418860020eSJohannes Berg return res; 25428860020eSJohannes Berg 254317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25448860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25458860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 25468860020eSJohannes Berg info->assocresp_ies, 25478860020eSJohannes Berg info->assocresp_ies_len); 25488860020eSJohannes Berg if (res) 25498860020eSJohannes Berg return res; 25508860020eSJohannes Berg 25518860020eSJohannes Berg return 0; 25528860020eSJohannes Berg } 25538860020eSJohannes Berg 2554df90b369SVasanthakumar Thiagarajan static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2555df90b369SVasanthakumar Thiagarajan struct ieee80211_channel *chan, 2556df90b369SVasanthakumar Thiagarajan enum nl80211_channel_type channel_type) 2557df90b369SVasanthakumar Thiagarajan { 2558df90b369SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 2559df90b369SVasanthakumar Thiagarajan 2560df90b369SVasanthakumar Thiagarajan /* 2561df90b369SVasanthakumar Thiagarajan * 'dev' could be NULL if a channel change is required for the hardware 2562df90b369SVasanthakumar Thiagarajan * device itself, instead of a particular VIF. 2563df90b369SVasanthakumar Thiagarajan * 2564df90b369SVasanthakumar Thiagarajan * FIXME: To be handled properly when monitor mode is supported. 2565df90b369SVasanthakumar Thiagarajan */ 2566df90b369SVasanthakumar Thiagarajan if (!dev) 2567df90b369SVasanthakumar Thiagarajan return -EBUSY; 2568df90b369SVasanthakumar Thiagarajan 2569df90b369SVasanthakumar Thiagarajan vif = netdev_priv(dev); 2570df90b369SVasanthakumar Thiagarajan 2571df90b369SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 2572df90b369SVasanthakumar Thiagarajan return -EIO; 2573df90b369SVasanthakumar Thiagarajan 2574df90b369SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2575df90b369SVasanthakumar Thiagarajan __func__, chan->center_freq, chan->hw_value); 2576df90b369SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 2577df90b369SVasanthakumar Thiagarajan vif->next_ch_type = channel_type; 2578df90b369SVasanthakumar Thiagarajan vif->next_ch_band = chan->band; 2579df90b369SVasanthakumar Thiagarajan 2580df90b369SVasanthakumar Thiagarajan return 0; 2581df90b369SVasanthakumar Thiagarajan } 2582df90b369SVasanthakumar Thiagarajan 2583d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2584d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2585d97c121bSVasanthakumar Thiagarajan { 2586d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2587d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2588d97c121bSVasanthakumar Thiagarajan u16 cnt; 2589d97c121bSVasanthakumar Thiagarajan 2590d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2591d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2592d97c121bSVasanthakumar Thiagarajan 2593d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2594d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2595d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2596d97c121bSVasanthakumar Thiagarajan 2597d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2598d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2599d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2600d97c121bSVasanthakumar Thiagarajan 26019e8b16dbSVasanthakumar Thiagarajan /* skip version */ 26029e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2603d97c121bSVasanthakumar Thiagarajan return -EINVAL; 26049e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 26059e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 26069e8b16dbSVasanthakumar Thiagarajan 26079e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 26089e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 26099e8b16dbSVasanthakumar Thiagarajan return 0; 26109e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 26119e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2612d97c121bSVasanthakumar Thiagarajan 2613d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2614d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26159e8b16dbSVasanthakumar Thiagarajan return 0; 2616798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2617d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2618d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2619d97c121bSVasanthakumar Thiagarajan 2620d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2621d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26229e8b16dbSVasanthakumar Thiagarajan return 0; 2623798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2624d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2625d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2626d97c121bSVasanthakumar Thiagarajan 2627d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26289e8b16dbSVasanthakumar Thiagarajan return 0; 2629d97c121bSVasanthakumar Thiagarajan 2630d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2631d97c121bSVasanthakumar Thiagarajan 2632d97c121bSVasanthakumar Thiagarajan return 0; 2633d97c121bSVasanthakumar Thiagarajan } 2634d97c121bSVasanthakumar Thiagarajan 26358860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 26368860020eSJohannes Berg struct cfg80211_ap_settings *info) 26376a7c9badSJouni Malinen { 26386a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 26393450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26406a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 264167cd22e4SThomas Pedersen bool hidden = false; 26426a7c9badSJouni Malinen u8 *ies; 26436a7c9badSJouni Malinen int ies_len; 26446a7c9badSJouni Malinen struct wmi_connect_cmd p; 26456a7c9badSJouni Malinen int res; 2646be5abaafSVasanthakumar Thiagarajan int i, ret; 2647d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 26486a7c9badSJouni Malinen 26498860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 26506a7c9badSJouni Malinen 2651990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 26526a7c9badSJouni Malinen return -EIO; 26536a7c9badSJouni Malinen 2654f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 26556a7c9badSJouni Malinen return -EOPNOTSUPP; 26566a7c9badSJouni Malinen 26578860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 26586a7c9badSJouni Malinen 26599a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 26609a5b1318SJouni Malinen 26616a7c9badSJouni Malinen /* TODO: 26626a7c9badSJouni Malinen * info->interval 26636a7c9badSJouni Malinen * info->dtim_period 26646a7c9badSJouni Malinen */ 26656a7c9badSJouni Malinen 26668860020eSJohannes Berg if (info->beacon.head == NULL) 26676a7c9badSJouni Malinen return -EINVAL; 26688860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 26696a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 26708860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 26716a7c9badSJouni Malinen return -EINVAL; 26728860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 26736a7c9badSJouni Malinen 26746a7c9badSJouni Malinen if (info->ssid == NULL) 26756a7c9badSJouni Malinen return -EINVAL; 26763450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 26773450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 26786a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 267967cd22e4SThomas Pedersen hidden = true; 268067cd22e4SThomas Pedersen 268167cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 268267cd22e4SThomas Pedersen if (res) 268367cd22e4SThomas Pedersen return res; 26846a7c9badSJouni Malinen 2685be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2686be5abaafSVasanthakumar Thiagarajan if (ret) 2687be5abaafSVasanthakumar Thiagarajan return ret; 26886a7c9badSJouni Malinen 26896a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 26906a7c9badSJouni Malinen 26916a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 26926a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 26936a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 26946a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 26956a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 26966a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 26976a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 26986a7c9badSJouni Malinen break; 26996a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 27006a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27016a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 27026a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27036a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 27046a7c9badSJouni Malinen break; 27056a7c9badSJouni Malinen } 27066a7c9badSJouni Malinen } 27076a7c9badSJouni Malinen if (p.auth_mode == 0) 27086a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 27093450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 27106a7c9badSJouni Malinen 27116a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 27126a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 27136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27146a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27156a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 27166a7c9badSJouni Malinen break; 27176a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27186a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 27196a7c9badSJouni Malinen break; 27206a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27216a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 27226a7c9badSJouni Malinen break; 2723b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2724b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2725b8214df1SDai Shuibing break; 27266a7c9badSJouni Malinen } 27276a7c9badSJouni Malinen } 2728229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 27296a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2730240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2731229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2732240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 27336a7c9badSJouni Malinen 27346a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 27356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27376a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 27386a7c9badSJouni Malinen break; 27396a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27406a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 27416a7c9badSJouni Malinen break; 27426a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27436a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 27446a7c9badSJouni Malinen break; 2745b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2746b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2747b8214df1SDai Shuibing break; 27486a7c9badSJouni Malinen default: 27496a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 27506a7c9badSJouni Malinen break; 27516a7c9badSJouni Malinen } 2752240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 27536a7c9badSJouni Malinen 27546a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2755f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 27566a7c9badSJouni Malinen 27573450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 27583450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 27593450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2760cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 27616a7c9badSJouni Malinen 2762c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2763c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2764c1762a3fSThirumalai Pachamuthu if (res < 0) 2765c1762a3fSThirumalai Pachamuthu return res; 2766c1762a3fSThirumalai Pachamuthu 27673ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 27683ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 27693ca9d1fcSAarthi Thiruvengadam } else { 27703ca9d1fcSAarthi Thiruvengadam /* 27713ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 27723ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 27733ca9d1fcSAarthi Thiruvengadam */ 27743ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 27753ca9d1fcSAarthi Thiruvengadam } 27763ca9d1fcSAarthi Thiruvengadam 277703bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 277803bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 277903bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 278003bdeb0dSVasanthakumar Thiagarajan if (res < 0) 278103bdeb0dSVasanthakumar Thiagarajan return res; 278203bdeb0dSVasanthakumar Thiagarajan } 278303bdeb0dSVasanthakumar Thiagarajan 2784df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, vif->next_ch_band, 2785df90b369SVasanthakumar Thiagarajan vif->next_ch_type != NL80211_CHAN_NO_HT)) 2786df90b369SVasanthakumar Thiagarajan return -EIO; 2787df90b369SVasanthakumar Thiagarajan 2788d97c121bSVasanthakumar Thiagarajan /* 2789d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2790d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2791d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2792d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2793d97c121bSVasanthakumar Thiagarajan */ 2794d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2795d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2796d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2797d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2798d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2799d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2800d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2801d97c121bSVasanthakumar Thiagarajan if (res < 0) 2802d97c121bSVasanthakumar Thiagarajan return res; 2803d97c121bSVasanthakumar Thiagarajan } 2804d97c121bSVasanthakumar Thiagarajan 2805c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2806334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 28079a5b1318SJouni Malinen if (res < 0) 28089a5b1318SJouni Malinen return res; 28099a5b1318SJouni Malinen 28109a5b1318SJouni Malinen return 0; 28116a7c9badSJouni Malinen } 28126a7c9badSJouni Malinen 28138860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 28148860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 28156a7c9badSJouni Malinen { 28168860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 28178860020eSJohannes Berg 28188860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 28198860020eSJohannes Berg return -EIO; 28208860020eSJohannes Berg 28218860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 28228860020eSJohannes Berg return -EOPNOTSUPP; 28238860020eSJohannes Berg 28248860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 28256a7c9badSJouni Malinen } 28266a7c9badSJouni Malinen 28278860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 28286a7c9badSJouni Malinen { 28296a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 283059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28316a7c9badSJouni Malinen 2832f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 28336a7c9badSJouni Malinen return -EOPNOTSUPP; 283459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 28356a7c9badSJouni Malinen return -ENOTCONN; 28366a7c9badSJouni Malinen 2837334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 283859c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 28396a7c9badSJouni Malinen 2840df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 2841df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, IEEE80211_BAND_2GHZ, true)) 2842df90b369SVasanthakumar Thiagarajan return -EIO; 2843df90b369SVasanthakumar Thiagarajan 2844df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, IEEE80211_BAND_5GHZ, true)) 2845df90b369SVasanthakumar Thiagarajan return -EIO; 2846df90b369SVasanthakumar Thiagarajan 28476a7c9badSJouni Malinen return 0; 28486a7c9badSJouni Malinen } 28496a7c9badSJouni Malinen 285033e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 285133e5308dSJouni Malinen 285233e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 285333e5308dSJouni Malinen u8 *mac) 285433e5308dSJouni Malinen { 285533e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 285633e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 285733e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 285833e5308dSJouni Malinen 285933e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 286033e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 286133e5308dSJouni Malinen } 286233e5308dSJouni Malinen 286323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 286423875136SJouni Malinen u8 *mac, struct station_parameters *params) 286523875136SJouni Malinen { 286623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2867f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 286823875136SJouni Malinen 2869f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 287023875136SJouni Malinen return -EOPNOTSUPP; 287123875136SJouni Malinen 287223875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 287323875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 287423875136SJouni Malinen return -EOPNOTSUPP; 287523875136SJouni Malinen 287623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2877334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2878334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2879334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2880334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 288123875136SJouni Malinen } 288223875136SJouni Malinen 288363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 288463fa1e0cSJouni Malinen struct net_device *dev, 288563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 288663fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 288763fa1e0cSJouni Malinen unsigned int duration, 288863fa1e0cSJouni Malinen u64 *cookie) 288963fa1e0cSJouni Malinen { 289063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2891334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28921052261eSJouni Malinen u32 id; 289363fa1e0cSJouni Malinen 289463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 289563fa1e0cSJouni Malinen * return -EBUSY */ 28961052261eSJouni Malinen id = ++vif->last_roc_id; 28971052261eSJouni Malinen if (id == 0) { 28981052261eSJouni Malinen /* Do not use 0 as the cookie value */ 28991052261eSJouni Malinen id = ++vif->last_roc_id; 29001052261eSJouni Malinen } 29011052261eSJouni Malinen *cookie = id; 290263fa1e0cSJouni Malinen 2903334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2904334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 290563fa1e0cSJouni Malinen } 290663fa1e0cSJouni Malinen 290763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 290863fa1e0cSJouni Malinen struct net_device *dev, 290963fa1e0cSJouni Malinen u64 cookie) 291063fa1e0cSJouni Malinen { 291163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2912334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 291363fa1e0cSJouni Malinen 29141052261eSJouni Malinen if (cookie != vif->last_roc_id) 291563fa1e0cSJouni Malinen return -ENOENT; 29161052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 291763fa1e0cSJouni Malinen 2918334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 291963fa1e0cSJouni Malinen } 292063fa1e0cSJouni Malinen 2921334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2922334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2923334234b5SVasanthakumar Thiagarajan unsigned int freq) 29248bdfbf40SJouni Malinen { 2925334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 29268bdfbf40SJouni Malinen const u8 *pos; 29278bdfbf40SJouni Malinen u8 *p2p; 29288bdfbf40SJouni Malinen int p2p_len; 29298bdfbf40SJouni Malinen int ret; 29308bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 29318bdfbf40SJouni Malinen 29328bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 29338bdfbf40SJouni Malinen 29348bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 29358bdfbf40SJouni Malinen 29368bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 29378bdfbf40SJouni Malinen if (p2p == NULL) 29388bdfbf40SJouni Malinen return -ENOMEM; 29398bdfbf40SJouni Malinen p2p_len = 0; 29408bdfbf40SJouni Malinen 29418bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 29428bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 29438bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 29448bdfbf40SJouni Malinen break; 29458bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 29468bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 29478bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 29488bdfbf40SJouni Malinen } 29498bdfbf40SJouni Malinen pos += 2 + pos[1]; 29508bdfbf40SJouni Malinen } 29518bdfbf40SJouni Malinen 2952334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2953334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 29548bdfbf40SJouni Malinen kfree(p2p); 29558bdfbf40SJouni Malinen return ret; 29568bdfbf40SJouni Malinen } 29578bdfbf40SJouni Malinen 2958d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2959d0ff7383SNaveen Gangadharan u32 id, 2960d0ff7383SNaveen Gangadharan u32 freq, 2961d0ff7383SNaveen Gangadharan u32 wait, 2962d0ff7383SNaveen Gangadharan const u8 *buf, 2963d0ff7383SNaveen Gangadharan size_t len, 2964d0ff7383SNaveen Gangadharan bool *more_data, 2965d0ff7383SNaveen Gangadharan bool no_cck) 2966d0ff7383SNaveen Gangadharan { 2967d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2968d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2969d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2970d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2971d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2972d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2973d0ff7383SNaveen Gangadharan 2974d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2975d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2976d0ff7383SNaveen Gangadharan return false; 2977d0ff7383SNaveen Gangadharan 2978d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2979d0ff7383SNaveen Gangadharan if (!conn) 2980d0ff7383SNaveen Gangadharan return false; 2981d0ff7383SNaveen Gangadharan 2982d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2983d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2984d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2985d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2986d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2987d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2988d0ff7383SNaveen Gangadharan return false; 2989d0ff7383SNaveen Gangadharan 2990d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2991d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2992d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2993d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2994d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2995d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2996d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2997d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2998d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2999d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3000d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3001d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3002d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3003d0ff7383SNaveen Gangadharan 3004d0ff7383SNaveen Gangadharan /* 3005d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3006d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3007d0ff7383SNaveen Gangadharan * STA. 3008d0ff7383SNaveen Gangadharan */ 3009d0ff7383SNaveen Gangadharan if (is_psq_empty) 3010d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3011d0ff7383SNaveen Gangadharan conn->aid, 1); 3012d0ff7383SNaveen Gangadharan return true; 3013d0ff7383SNaveen Gangadharan } 3014d0ff7383SNaveen Gangadharan 3015d0ff7383SNaveen Gangadharan /* 3016d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3017d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3018d0ff7383SNaveen Gangadharan */ 3019d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3020d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3021d0ff7383SNaveen Gangadharan *more_data = true; 3022d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3023d0ff7383SNaveen Gangadharan } 3024d0ff7383SNaveen Gangadharan 3025d0ff7383SNaveen Gangadharan return false; 3026d0ff7383SNaveen Gangadharan } 3027d0ff7383SNaveen Gangadharan 3028c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3029c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3030c86e4f44SAarthi Thiruvengadam { 3031c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3032c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3033c86e4f44SAarthi Thiruvengadam 3034c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3035c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3036c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3037c86e4f44SAarthi Thiruvengadam return true; 3038c86e4f44SAarthi Thiruvengadam } 3039c86e4f44SAarthi Thiruvengadam 3040c86e4f44SAarthi Thiruvengadam return false; 3041c86e4f44SAarthi Thiruvengadam } 3042c86e4f44SAarthi Thiruvengadam 30438a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 30448a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 30458a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 30468a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3047e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3048e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 30498a6c8060SJouni Malinen { 30508a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 305159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30528a6c8060SJouni Malinen u32 id; 30538bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3054d0ff7383SNaveen Gangadharan bool more_data, queued; 30558bdfbf40SJouni Malinen 30568bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3057c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3058c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3059c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 30608bdfbf40SJouni Malinen /* 3061c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 30628bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 30638bdfbf40SJouni Malinen */ 30648bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3065334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 30668bdfbf40SJouni Malinen chan->center_freq); 30678bdfbf40SJouni Malinen } 30688a6c8060SJouni Malinen 3069cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30708a6c8060SJouni Malinen if (id == 0) { 30718a6c8060SJouni Malinen /* 30728a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 30738a6c8060SJouni Malinen * used for the command. 30748a6c8060SJouni Malinen */ 3075cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30768a6c8060SJouni Malinen } 30778a6c8060SJouni Malinen 30788a6c8060SJouni Malinen *cookie = id; 30793ca9d1fcSAarthi Thiruvengadam 3080d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3081d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3082d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3083d0ff7383SNaveen Gangadharan id, chan->center_freq, 3084d0ff7383SNaveen Gangadharan wait, buf, 3085d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3086d0ff7383SNaveen Gangadharan if (queued) 3087d0ff7383SNaveen Gangadharan return 0; 3088d0ff7383SNaveen Gangadharan } 3089d0ff7383SNaveen Gangadharan 30903ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 30913ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 30923ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 30933ca9d1fcSAarthi Thiruvengadam } 30948a6c8060SJouni Malinen 3095ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3096ae32c30aSJouni Malinen struct net_device *dev, 3097ae32c30aSJouni Malinen u16 frame_type, bool reg) 3098ae32c30aSJouni Malinen { 3099cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3100ae32c30aSJouni Malinen 3101ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3102ae32c30aSJouni Malinen __func__, frame_type, reg); 3103ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3104ae32c30aSJouni Malinen /* 3105ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3106ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3107ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3108ae32c30aSJouni Malinen */ 3109cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3110ae32c30aSJouni Malinen } 3111ae32c30aSJouni Malinen } 3112ae32c30aSJouni Malinen 311310509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 311410509f90SKalle Valo struct net_device *dev, 311510509f90SKalle Valo struct cfg80211_sched_scan_request *request) 311610509f90SKalle Valo { 311710509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 311810509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 311910509f90SKalle Valo u16 interval; 312010509f90SKalle Valo int ret; 312110509f90SKalle Valo 312210509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 312310509f90SKalle Valo return -EIO; 312410509f90SKalle Valo 312510509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 312610509f90SKalle Valo return -EBUSY; 312710509f90SKalle Valo 3128b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3129b4d13d3bSKalle Valo 31303b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 31313b8ffc6aSJouni Malinen request->n_ssids); 31323b8ffc6aSJouni Malinen if (ret < 0) 31333b8ffc6aSJouni Malinen return ret; 313410509f90SKalle Valo 313510509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 313610509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 313710509f90SKalle Valo 313810509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 313910509f90SKalle Valo interval, interval, 3140d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 314110509f90SKalle Valo 314210509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 314310509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 314410509f90SKalle Valo WOW_FILTER_SSID, 314510509f90SKalle Valo WOW_HOST_REQ_DELAY); 314610509f90SKalle Valo if (ret) { 314710509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 314810509f90SKalle Valo return ret; 314910509f90SKalle Valo } 315010509f90SKalle Valo 315110509f90SKalle Valo /* this also clears IE in fw if it's not set */ 315210509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 315310509f90SKalle Valo WMI_FRAME_PROBE_REQ, 315410509f90SKalle Valo request->ie, request->ie_len); 315510509f90SKalle Valo if (ret) { 315610509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 315710509f90SKalle Valo ret); 315810509f90SKalle Valo return ret; 315910509f90SKalle Valo } 316010509f90SKalle Valo 316110509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 316210509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 316310509f90SKalle Valo if (ret) { 316410509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 316510509f90SKalle Valo ret); 316610509f90SKalle Valo return ret; 316710509f90SKalle Valo } 316810509f90SKalle Valo 316910509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 317010509f90SKalle Valo 317110509f90SKalle Valo return ret; 317210509f90SKalle Valo } 317310509f90SKalle Valo 317410509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 317510509f90SKalle Valo struct net_device *dev) 317610509f90SKalle Valo { 317710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 317810509f90SKalle Valo bool stopped; 317910509f90SKalle Valo 318010509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 318110509f90SKalle Valo 318210509f90SKalle Valo if (!stopped) 318310509f90SKalle Valo return -EIO; 318410509f90SKalle Valo 318510509f90SKalle Valo return 0; 318610509f90SKalle Valo } 318710509f90SKalle Valo 3188f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3189f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3190f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3191f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3192f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3193f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3194f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3195f80574aeSJouni Malinen }, 3196ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3197ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3198ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3199ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3200ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3201ba1f6fe3SJouni Malinen }, 3202f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3203f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3204f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3205f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3206f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3207f80574aeSJouni Malinen }, 3208f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3209f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3210f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3211f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3212f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3213f80574aeSJouni Malinen }, 3214f80574aeSJouni Malinen }; 3215f80574aeSJouni Malinen 3216bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 321755055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 321855055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3219bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3220bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3221bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3222bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3223bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3224bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3225bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3226bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3227bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3228bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3229bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3230bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3231bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3232bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3233bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3234bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3235bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3236bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3237003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3238abcb344bSKalle Valo #ifdef CONFIG_PM 323952d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 324052d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3241abcb344bSKalle Valo #endif 32426a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 32438860020eSJohannes Berg .start_ap = ath6kl_start_ap, 32448860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 32458860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 324633e5308dSJouni Malinen .del_station = ath6kl_del_station, 324723875136SJouni Malinen .change_station = ath6kl_change_station, 324863fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 324963fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 32508a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3251ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 325210509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 325310509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3254bdcd8170SKalle Valo }; 3255bdcd8170SKalle Valo 32567125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3257ec4b7f60SKalle Valo { 325810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 325910509f90SKalle Valo 3260ec4b7f60SKalle Valo switch (vif->sme_state) { 3261c97a31b0SKalle Valo case SME_DISCONNECTED: 3262c97a31b0SKalle Valo break; 3263ec4b7f60SKalle Valo case SME_CONNECTING: 3264ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3265ec4b7f60SKalle Valo NULL, 0, 3266ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3267ec4b7f60SKalle Valo GFP_KERNEL); 3268ec4b7f60SKalle Valo break; 3269ec4b7f60SKalle Valo case SME_CONNECTED: 3270ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3271ec4b7f60SKalle Valo break; 3272ec4b7f60SKalle Valo } 3273ec4b7f60SKalle Valo 3274ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3275ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 32767125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3277ec4b7f60SKalle Valo 3278ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 32791f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 32801f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3281ec4b7f60SKalle Valo 3282ec4b7f60SKalle Valo /* disable scanning */ 32837125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 32847125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 32857125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3286ec4b7f60SKalle Valo 3287ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3288ec4b7f60SKalle Valo } 3289ec4b7f60SKalle Valo 32907125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 32917125f01dSKalle Valo { 32927125f01dSKalle Valo struct ath6kl_vif *vif; 32937125f01dSKalle Valo 32947125f01dSKalle Valo vif = ath6kl_vif_first(ar); 32957125f01dSKalle Valo if (!vif) { 32967125f01dSKalle Valo /* save the current power mode before enabling power save */ 32977125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 32987125f01dSKalle Valo 32997125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3300cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 33017125f01dSKalle Valo return; 33027125f01dSKalle Valo } 33037125f01dSKalle Valo 33047125f01dSKalle Valo /* 33057125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 33067125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 33077125f01dSKalle Valo * sleeps. 33087125f01dSKalle Valo */ 33097125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 33107125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 33117125f01dSKalle Valo } 33127125f01dSKalle Valo 3313c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 33148dafb70eSVasanthakumar Thiagarajan { 33157baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 33162132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 33178dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 33188dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 33198dafb70eSVasanthakumar Thiagarajan } 33208dafb70eSVasanthakumar Thiagarajan 3321de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3322108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 332310509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 332410509f90SKalle Valo (unsigned long) vif); 332510509f90SKalle Valo 3326de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3327478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 33288dafb70eSVasanthakumar Thiagarajan 332980abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 333080abaf9bSVasanthakumar Thiagarajan 33318dafb70eSVasanthakumar Thiagarajan return 0; 33328dafb70eSVasanthakumar Thiagarajan } 33338dafb70eSVasanthakumar Thiagarajan 3334c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 33358dafb70eSVasanthakumar Thiagarajan { 333655055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 333780abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 333855055976SVasanthakumar Thiagarajan 33392132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3340108438bcSVasanthakumar Thiagarajan 334155055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 334255055976SVasanthakumar Thiagarajan 334355055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 334455055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 334555055976SVasanthakumar Thiagarajan 334680abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 334780abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 334880abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 334980abaf9bSVasanthakumar Thiagarajan } 335080abaf9bSVasanthakumar Thiagarajan 335127929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 335255055976SVasanthakumar Thiagarajan 335355055976SVasanthakumar Thiagarajan ar->num_vif--; 33548dafb70eSVasanthakumar Thiagarajan } 33558dafb70eSVasanthakumar Thiagarajan 33568dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 335755055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 335855055976SVasanthakumar Thiagarajan u8 nw_type) 33598dafb70eSVasanthakumar Thiagarajan { 33608dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3361108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 33628dafb70eSVasanthakumar Thiagarajan 336355055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 33648dafb70eSVasanthakumar Thiagarajan if (!ndev) 33658dafb70eSVasanthakumar Thiagarajan return NULL; 33668dafb70eSVasanthakumar Thiagarajan 3367108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3368108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3369108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3370108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3371108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3372108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3373108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3374108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3375334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3376d0d670abSKalle Valo vif->nw_type = nw_type; 3377d0d670abSKalle Valo vif->next_mode = nw_type; 33788f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3379ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3380eb38987eSRaja Mani vif->bg_scan_period = 0; 3381df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 33828dafb70eSVasanthakumar Thiagarajan 338355055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 338455055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 338555055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 338655055976SVasanthakumar Thiagarajan 0x2; 338755055976SVasanthakumar Thiagarajan 33888dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 33898dafb70eSVasanthakumar Thiagarajan 3390e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 33918dafb70eSVasanthakumar Thiagarajan 3392c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 33938dafb70eSVasanthakumar Thiagarajan goto err; 33948dafb70eSVasanthakumar Thiagarajan 339527929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 33968dafb70eSVasanthakumar Thiagarajan goto err; 33978dafb70eSVasanthakumar Thiagarajan 339855055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 339914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 340059c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 34018dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 340259c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 34038dafb70eSVasanthakumar Thiagarajan 340455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 340555055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 340655055976SVasanthakumar Thiagarajan 340711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3408990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 340911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3410990bd915SVasanthakumar Thiagarajan 34118dafb70eSVasanthakumar Thiagarajan return ndev; 34128dafb70eSVasanthakumar Thiagarajan 34138dafb70eSVasanthakumar Thiagarajan err: 341427929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 341527929723SVasanthakumar Thiagarajan free_netdev(ndev); 3416bdcd8170SKalle Valo return NULL; 3417bdcd8170SKalle Valo } 3418bdcd8170SKalle Valo 341946d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 342046d33a21SKalle Valo { 342146d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 342246d33a21SKalle Valo int ret; 342346d33a21SKalle Valo 342446d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 342546d33a21SKalle Valo 342646d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 342746d33a21SKalle Valo 342846d33a21SKalle Valo /* set device pointer for wiphy */ 342946d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 343046d33a21SKalle Valo 343146d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 343246d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 343346d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 343446d33a21SKalle Valo if (ar->p2p) { 343546d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 343646d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 343746d33a21SKalle Valo } 343846d33a21SKalle Valo 343946d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 344046d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 344146d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 344246d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 344346d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 344446d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 344546d33a21SKalle Valo 344646d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 344746d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 344846d33a21SKalle Valo 344946d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 345046d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 345146d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 345246d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 345346d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 345446d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 345546d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 345646d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 345746d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 345846d33a21SKalle Valo 34593b8ffc6aSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSID_INDEX; 346046d33a21SKalle Valo 3461f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3462f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3463f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3464f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3465f2afdac7SVasanthakumar Thiagarajan 3466f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3467f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3468f2afdac7SVasanthakumar Thiagarajan 346903bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 347003bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 347103bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 347203bdeb0dSVasanthakumar Thiagarajan 3473f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3474f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3475f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3476a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3477f2afdac7SVasanthakumar Thiagarajan 347846d33a21SKalle Valo ret = wiphy_register(wiphy); 347946d33a21SKalle Valo if (ret < 0) { 348046d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 348146d33a21SKalle Valo return ret; 348246d33a21SKalle Valo } 348346d33a21SKalle Valo 3484e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3485e5348a1eSVasanthakumar Thiagarajan 348646d33a21SKalle Valo return 0; 348746d33a21SKalle Valo } 348846d33a21SKalle Valo 348946d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3490bdcd8170SKalle Valo { 3491be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3492e5348a1eSVasanthakumar Thiagarajan 3493e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 349445eaa78fSKalle Valo } 349546d33a21SKalle Valo 349645eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 349745eaa78fSKalle Valo { 349845eaa78fSKalle Valo struct ath6kl *ar; 349945eaa78fSKalle Valo struct wiphy *wiphy; 350045eaa78fSKalle Valo 350145eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 350245eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 350345eaa78fSKalle Valo 350445eaa78fSKalle Valo if (!wiphy) { 350545eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 350645eaa78fSKalle Valo return NULL; 350745eaa78fSKalle Valo } 350845eaa78fSKalle Valo 350945eaa78fSKalle Valo ar = wiphy_priv(wiphy); 351045eaa78fSKalle Valo ar->wiphy = wiphy; 351145eaa78fSKalle Valo 351245eaa78fSKalle Valo return ar; 351345eaa78fSKalle Valo } 351445eaa78fSKalle Valo 351545eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 351645eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 351745eaa78fSKalle Valo { 35181d2a4456SVasanthakumar Thiagarajan int i; 35191d2a4456SVasanthakumar Thiagarajan 35201d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 35211d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 35221d2a4456SVasanthakumar Thiagarajan 3523be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3524bdcd8170SKalle Valo } 352545eaa78fSKalle Valo 3526