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 206277ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 206377ed4e45SThomas Pedersen if (ar->num_vif > 1) 206477ed4e45SThomas Pedersen return -EIO; 206577ed4e45SThomas Pedersen 2066d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2067d91e8eeeSRaja Mani if (!vif) 2068d91e8eeeSRaja Mani return -EIO; 2069d91e8eeeSRaja Mani 2070d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2071d91e8eeeSRaja Mani return -EIO; 2072d91e8eeeSRaja Mani 2073d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 20743c411a43SRaja Mani return -ENOTCONN; 2075d91e8eeeSRaja Mani 2076d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2077d91e8eeeSRaja Mani return -EINVAL; 2078d91e8eeeSRaja Mani 2079d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2080d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2081d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2082d91e8eeeSRaja Mani WOW_LIST_ID, i); 2083d91e8eeeSRaja Mani 2084d91e8eeeSRaja Mani /* 2085d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2086d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2087d91e8eeeSRaja Mani * the user. 2088d91e8eeeSRaja Mani */ 2089d91e8eeeSRaja Mani if (wow) 2090d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2091d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2092d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2093d91e8eeeSRaja Mani else 2094d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2095d91e8eeeSRaja Mani 2096d91e8eeeSRaja Mani if (ret) 2097d91e8eeeSRaja Mani return ret; 2098d91e8eeeSRaja Mani 2099390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2100390a8c8fSRaja Mani 2101ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2102ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2103ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2104ce0dc0cfSRaja Mani 0); 2105ce0dc0cfSRaja Mani if (ret) 2106ce0dc0cfSRaja Mani return ret; 2107ce0dc0cfSRaja Mani 2108ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2109ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2110ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2111ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2112ce0dc0cfSRaja Mani 2113ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2114ce0dc0cfSRaja Mani bmiss_time, 0); 2115ce0dc0cfSRaja Mani if (ret) 2116ce0dc0cfSRaja Mani return ret; 2117ce0dc0cfSRaja Mani 2118ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2119ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2120ce0dc0cfSRaja Mani 0, 0, 0, 0); 2121ce0dc0cfSRaja Mani if (ret) 2122ce0dc0cfSRaja Mani return ret; 2123ce0dc0cfSRaja Mani } 2124ce0dc0cfSRaja Mani 2125390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2126390a8c8fSRaja Mani 2127c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2128c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2129c08631c6SRaja Mani if (!in_dev) 2130c08631c6SRaja Mani goto skip_arp; 2131c08631c6SRaja Mani 2132c08631c6SRaja Mani ifa = in_dev->ifa_list; 2133c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2134c08631c6SRaja Mani 2135c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2136c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2137c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2138c08631c6SRaja Mani ifa = ifa->ifa_next; 2139c08631c6SRaja Mani index++; 2140c08631c6SRaja Mani } 2141c08631c6SRaja Mani 2142c08631c6SRaja Mani if (ifa) { 2143c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2144c08631c6SRaja Mani return -EINVAL; 2145c08631c6SRaja Mani } 2146c08631c6SRaja Mani 2147c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2148c08631c6SRaja Mani if (ret) { 2149c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2150c08631c6SRaja Mani return ret; 2151c08631c6SRaja Mani } 2152c08631c6SRaja Mani 2153c08631c6SRaja Mani skip_arp: 21546cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 21556cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 21566cb3c714SRaja Mani filter, 21576cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 21586cb3c714SRaja Mani if (ret) 21596cb3c714SRaja Mani return ret; 21606cb3c714SRaja Mani 2161055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 21626cb3c714SRaja Mani if (ret) 21636cb3c714SRaja Mani return ret; 21646cb3c714SRaja Mani 2165055bde49SRaja Mani return 0; 21666cb3c714SRaja Mani } 21676cb3c714SRaja Mani 21686cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 21696cb3c714SRaja Mani { 21706cb3c714SRaja Mani struct ath6kl_vif *vif; 21716cb3c714SRaja Mani int ret; 21726cb3c714SRaja Mani 21736cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 21746cb3c714SRaja Mani if (!vif) 21756cb3c714SRaja Mani return -EIO; 21766cb3c714SRaja Mani 2177390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2178390a8c8fSRaja Mani 21796cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21806cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2181390a8c8fSRaja Mani if (ret) { 2182cdeb8602SKalle Valo ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2183cdeb8602SKalle Valo ret); 2184390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21856cb3c714SRaja Mani return ret; 21866cb3c714SRaja Mani } 21876cb3c714SRaja Mani 2188ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2189ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2190ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2191ce0dc0cfSRaja Mani if (ret) 2192ce0dc0cfSRaja Mani return ret; 2193ce0dc0cfSRaja Mani 2194ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2195ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2196ce0dc0cfSRaja Mani if (ret) 2197ce0dc0cfSRaja Mani return ret; 2198ce0dc0cfSRaja Mani 2199ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2200ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2201ce0dc0cfSRaja Mani if (ret) 2202ce0dc0cfSRaja Mani return ret; 2203ce0dc0cfSRaja Mani } 2204ce0dc0cfSRaja Mani 2205390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2206390a8c8fSRaja Mani 2207390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2208390a8c8fSRaja Mani 2209390a8c8fSRaja Mani return 0; 2210390a8c8fSRaja Mani } 2211390a8c8fSRaja Mani 221240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 221340abc2deSRaja Mani { 221440abc2deSRaja Mani struct ath6kl_vif *vif; 221540abc2deSRaja Mani int ret; 221640abc2deSRaja Mani 221740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 221840abc2deSRaja Mani if (!vif) 221940abc2deSRaja Mani return -EIO; 222040abc2deSRaja Mani 222148f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 222248f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 222340abc2deSRaja Mani return -EIO; 222448f27587SMing Jiang } 222540abc2deSRaja Mani 222640abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 222740abc2deSRaja Mani 222840abc2deSRaja Mani /* Save the current power mode before enabling power save */ 222940abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 223040abc2deSRaja Mani 223140abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 223240abc2deSRaja Mani if (ret) 223340abc2deSRaja Mani return ret; 223440abc2deSRaja Mani 223540abc2deSRaja Mani /* Disable WOW mode */ 223640abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 223740abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 223840abc2deSRaja Mani 0, 0); 223940abc2deSRaja Mani if (ret) 224040abc2deSRaja Mani return ret; 224140abc2deSRaja Mani 224240abc2deSRaja Mani /* Flush all non control pkts in TX path */ 224340abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 224440abc2deSRaja Mani 224540abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 224640abc2deSRaja Mani if (ret) 224740abc2deSRaja Mani return ret; 224840abc2deSRaja Mani 224940abc2deSRaja Mani return 0; 225040abc2deSRaja Mani } 225140abc2deSRaja Mani 225240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 225340abc2deSRaja Mani { 225440abc2deSRaja Mani struct ath6kl_vif *vif; 225540abc2deSRaja Mani int ret; 225640abc2deSRaja Mani 225740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 225840abc2deSRaja Mani 225940abc2deSRaja Mani if (!vif) 226040abc2deSRaja Mani return -EIO; 226140abc2deSRaja Mani 226240abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 226340abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 226440abc2deSRaja Mani ar->wmi->saved_pwr_mode); 226540abc2deSRaja Mani if (ret) 226640abc2deSRaja Mani return ret; 226740abc2deSRaja Mani } 226840abc2deSRaja Mani 226940abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 227040abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 227140abc2deSRaja Mani if (ret) 227240abc2deSRaja Mani return ret; 227340abc2deSRaja Mani 227440abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 227540abc2deSRaja Mani 227640abc2deSRaja Mani /* Reset scan parameter to default values */ 227740abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 227840abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 227940abc2deSRaja Mani if (ret) 228040abc2deSRaja Mani return ret; 228140abc2deSRaja Mani 228240abc2deSRaja Mani return 0; 228340abc2deSRaja Mani } 228440abc2deSRaja Mani 228552d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22860f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22870f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 228852d81a68SKalle Valo { 22893d79499cSVivek Natarajan struct ath6kl_vif *vif; 2290390a8c8fSRaja Mani enum ath6kl_state prev_state; 229152d81a68SKalle Valo int ret; 229252d81a68SKalle Valo 229352d81a68SKalle Valo switch (mode) { 2294d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2295d7c44e0bSRaja Mani 2296d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2297d7c44e0bSRaja Mani 2298d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2299d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2300d7c44e0bSRaja Mani 2301390a8c8fSRaja Mani prev_state = ar->state; 2302390a8c8fSRaja Mani 2303d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2304390a8c8fSRaja Mani if (ret) { 2305390a8c8fSRaja Mani ar->state = prev_state; 2306d7c44e0bSRaja Mani return ret; 2307390a8c8fSRaja Mani } 23081e9a905dSRaja Mani 2309d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2310d7c44e0bSRaja Mani break; 2311d7c44e0bSRaja Mani 231252d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2313524441e3SRaja Mani 231440abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2315524441e3SRaja Mani 231640abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 231752d81a68SKalle Valo if (ret) { 231840abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 231940abc2deSRaja Mani return ret; 232052d81a68SKalle Valo } 232152d81a68SKalle Valo 232276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 232376a9fbe2SKalle Valo 232452d81a68SKalle Valo break; 2325b4b2a0b1SKalle Valo 2326b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2327524441e3SRaja Mani 23287125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2329524441e3SRaja Mani 2330b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2331b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2332b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2333b4b2a0b1SKalle Valo break; 2334b4b2a0b1SKalle Valo } 2335b4b2a0b1SKalle Valo 2336b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2337b4b2a0b1SKalle Valo 2338b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2339b4b2a0b1SKalle Valo if (ret) { 2340b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2341b4b2a0b1SKalle Valo ret); 2342b4b2a0b1SKalle Valo } 2343b4b2a0b1SKalle Valo 2344b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2345b4b2a0b1SKalle Valo 2346b4b2a0b1SKalle Valo break; 2347b4b2a0b1SKalle Valo 234810509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 234910509f90SKalle Valo /* 235010509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 235110509f90SKalle Valo * wow mode and sleeping most of the time. 235210509f90SKalle Valo */ 235310509f90SKalle Valo break; 235410509f90SKalle Valo 2355b4b2a0b1SKalle Valo default: 2356b4b2a0b1SKalle Valo break; 235752d81a68SKalle Valo } 235852d81a68SKalle Valo 23593d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 23603d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 23613d79499cSVivek Natarajan 236252d81a68SKalle Valo return 0; 236352d81a68SKalle Valo } 2364d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 236552d81a68SKalle Valo 236652d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 236752d81a68SKalle Valo { 236876a9fbe2SKalle Valo int ret; 236976a9fbe2SKalle Valo 237076a9fbe2SKalle Valo switch (ar->state) { 2371d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2372d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2373d7c44e0bSRaja Mani 2374d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2375d7c44e0bSRaja Mani if (ret) { 2376d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2377d7c44e0bSRaja Mani return ret; 2378d7c44e0bSRaja Mani } 2379d7c44e0bSRaja Mani 2380d7c44e0bSRaja Mani break; 2381d7c44e0bSRaja Mani 238276a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 238340abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 238440abc2deSRaja Mani 238540abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 238676a9fbe2SKalle Valo if (ret) { 238740abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 238840abc2deSRaja Mani return ret; 238976a9fbe2SKalle Valo } 239076a9fbe2SKalle Valo break; 239176a9fbe2SKalle Valo 2392b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2393b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2394b4b2a0b1SKalle Valo 2395b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2396b4b2a0b1SKalle Valo if (ret) { 2397b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2398b4b2a0b1SKalle Valo return ret; 2399b4b2a0b1SKalle Valo } 2400d7c44e0bSRaja Mani break; 2401b4b2a0b1SKalle Valo 240210509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 240310509f90SKalle Valo break; 240410509f90SKalle Valo 240576a9fbe2SKalle Valo default: 240676a9fbe2SKalle Valo break; 240752d81a68SKalle Valo } 240852d81a68SKalle Valo 240952d81a68SKalle Valo return 0; 241052d81a68SKalle Valo } 2411d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 241252d81a68SKalle Valo 2413abcb344bSKalle Valo #ifdef CONFIG_PM 241452d81a68SKalle Valo 241552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 241652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2417abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2418abcb344bSKalle Valo { 2419abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2420abcb344bSKalle Valo 24210f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2422abcb344bSKalle Valo } 2423aa6cffc1SChilam Ng 242452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2425aa6cffc1SChilam Ng { 2426aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2427aa6cffc1SChilam Ng 2428aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2429aa6cffc1SChilam Ng } 2430a918fb3cSRaja Mani 2431a918fb3cSRaja Mani /* 2432a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2433a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2434a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2435a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2436a918fb3cSRaja Mani * 2437a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2438a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2439a918fb3cSRaja Mani * 2440a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2441a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2442a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2443a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2444a918fb3cSRaja Mani * 2445a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2446a918fb3cSRaja Mani */ 2447a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2448a918fb3cSRaja Mani { 2449390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2450390a8c8fSRaja Mani return; 2451390a8c8fSRaja Mani 2452a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2453a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2454a918fb3cSRaja Mani } 2455a918fb3cSRaja Mani 2456a918fb3cSRaja Mani #else 2457a918fb3cSRaja Mani 2458a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2459a918fb3cSRaja Mani { 2460a918fb3cSRaja Mani } 2461abcb344bSKalle Valo #endif 2462abcb344bSKalle Valo 2463df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2464df90b369SVasanthakumar Thiagarajan bool ht_enable) 24656a7c9badSJouni Malinen { 2466df90b369SVasanthakumar Thiagarajan struct ath6kl_htcap *htcap = &vif->htcap; 2467e68f6750SSujith Manoharan 2468df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 24696a7c9badSJouni Malinen return 0; 2470df90b369SVasanthakumar Thiagarajan 2471df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2472df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2473df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2474df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2475df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2476df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2477df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2478df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2479df90b369SVasanthakumar Thiagarajan 2480df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2481df90b369SVasanthakumar Thiagarajan band, htcap); 24826a7c9badSJouni Malinen } 24836a7c9badSJouni Malinen 248437a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 248537a2f950SThomas Pedersen { 248637a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 248737a2f950SThomas Pedersen int band, ret = 0; 248837a2f950SThomas Pedersen 248937a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 249037a2f950SThomas Pedersen if (!wiphy->bands[band]) 249137a2f950SThomas Pedersen continue; 249237a2f950SThomas Pedersen 249337a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 249437a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 249537a2f950SThomas Pedersen if (ret) 249637a2f950SThomas Pedersen return ret; 249737a2f950SThomas Pedersen } 249837a2f950SThomas Pedersen 249937a2f950SThomas Pedersen return ret; 250037a2f950SThomas Pedersen } 250137a2f950SThomas Pedersen 25028bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 25038bdfbf40SJouni Malinen { 25048bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 25058bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 25068bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 25078bdfbf40SJouni Malinen } 25088bdfbf40SJouni Malinen 2509334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2510334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 25118bdfbf40SJouni Malinen { 2512334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 25138bdfbf40SJouni Malinen const u8 *pos; 25148bdfbf40SJouni Malinen u8 *buf = NULL; 25158bdfbf40SJouni Malinen size_t len = 0; 25168bdfbf40SJouni Malinen int ret; 25178bdfbf40SJouni Malinen 25188bdfbf40SJouni Malinen /* 25198bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 25208bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 25218bdfbf40SJouni Malinen */ 25228bdfbf40SJouni Malinen 25238bdfbf40SJouni Malinen if (ies && ies_len) { 25248bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 25258bdfbf40SJouni Malinen if (buf == NULL) 25268bdfbf40SJouni Malinen return -ENOMEM; 25278bdfbf40SJouni Malinen pos = ies; 25288bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 25298bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 25308bdfbf40SJouni Malinen break; 25318bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 25328bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 25338bdfbf40SJouni Malinen len += 2 + pos[1]; 25348bdfbf40SJouni Malinen } 25358bdfbf40SJouni Malinen pos += 2 + pos[1]; 25368bdfbf40SJouni Malinen } 25378bdfbf40SJouni Malinen } 25388bdfbf40SJouni Malinen 2539334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2540334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 25418bdfbf40SJouni Malinen kfree(buf); 25428bdfbf40SJouni Malinen return ret; 25438bdfbf40SJouni Malinen } 25448bdfbf40SJouni Malinen 25458860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 25468860020eSJohannes Berg struct cfg80211_beacon_data *info) 25478860020eSJohannes Berg { 25488860020eSJohannes Berg struct ath6kl *ar = vif->ar; 25498860020eSJohannes Berg int res; 25508860020eSJohannes Berg 255117a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25528860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25538860020eSJohannes Berg WMI_FRAME_BEACON, 25548860020eSJohannes Berg info->beacon_ies, 25558860020eSJohannes Berg info->beacon_ies_len); 25568860020eSJohannes Berg if (res) 25578860020eSJohannes Berg return res; 25588860020eSJohannes Berg 255917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25608860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 25618860020eSJohannes Berg info->proberesp_ies_len); 25628860020eSJohannes Berg if (res) 25638860020eSJohannes Berg return res; 25648860020eSJohannes Berg 256517a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 25668860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 25678860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 25688860020eSJohannes Berg info->assocresp_ies, 25698860020eSJohannes Berg info->assocresp_ies_len); 25708860020eSJohannes Berg if (res) 25718860020eSJohannes Berg return res; 25728860020eSJohannes Berg 25738860020eSJohannes Berg return 0; 25748860020eSJohannes Berg } 25758860020eSJohannes Berg 2576df90b369SVasanthakumar Thiagarajan static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2577df90b369SVasanthakumar Thiagarajan struct ieee80211_channel *chan, 2578df90b369SVasanthakumar Thiagarajan enum nl80211_channel_type channel_type) 2579df90b369SVasanthakumar Thiagarajan { 2580df90b369SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 2581df90b369SVasanthakumar Thiagarajan 2582df90b369SVasanthakumar Thiagarajan /* 2583df90b369SVasanthakumar Thiagarajan * 'dev' could be NULL if a channel change is required for the hardware 2584df90b369SVasanthakumar Thiagarajan * device itself, instead of a particular VIF. 2585df90b369SVasanthakumar Thiagarajan * 2586df90b369SVasanthakumar Thiagarajan * FIXME: To be handled properly when monitor mode is supported. 2587df90b369SVasanthakumar Thiagarajan */ 2588df90b369SVasanthakumar Thiagarajan if (!dev) 2589df90b369SVasanthakumar Thiagarajan return -EBUSY; 2590df90b369SVasanthakumar Thiagarajan 2591df90b369SVasanthakumar Thiagarajan vif = netdev_priv(dev); 2592df90b369SVasanthakumar Thiagarajan 2593df90b369SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 2594df90b369SVasanthakumar Thiagarajan return -EIO; 2595df90b369SVasanthakumar Thiagarajan 2596df90b369SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2597df90b369SVasanthakumar Thiagarajan __func__, chan->center_freq, chan->hw_value); 2598df90b369SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 2599df90b369SVasanthakumar Thiagarajan vif->next_ch_type = channel_type; 2600df90b369SVasanthakumar Thiagarajan vif->next_ch_band = chan->band; 2601df90b369SVasanthakumar Thiagarajan 2602df90b369SVasanthakumar Thiagarajan return 0; 2603df90b369SVasanthakumar Thiagarajan } 2604df90b369SVasanthakumar Thiagarajan 2605d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2606d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2607d97c121bSVasanthakumar Thiagarajan { 2608d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2609d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2610d97c121bSVasanthakumar Thiagarajan u16 cnt; 2611d97c121bSVasanthakumar Thiagarajan 2612d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2613d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2614d97c121bSVasanthakumar Thiagarajan 2615d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2616d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2617d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2618d97c121bSVasanthakumar Thiagarajan 2619d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2620d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2621d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2622d97c121bSVasanthakumar Thiagarajan 26239e8b16dbSVasanthakumar Thiagarajan /* skip version */ 26249e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2625d97c121bSVasanthakumar Thiagarajan return -EINVAL; 26269e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 26279e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 26289e8b16dbSVasanthakumar Thiagarajan 26299e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 26309e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 26319e8b16dbSVasanthakumar Thiagarajan return 0; 26329e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 26339e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2634d97c121bSVasanthakumar Thiagarajan 2635d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2636d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26379e8b16dbSVasanthakumar Thiagarajan return 0; 2638798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2639d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2640d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2641d97c121bSVasanthakumar Thiagarajan 2642d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2643d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26449e8b16dbSVasanthakumar Thiagarajan return 0; 2645798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2646d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2647d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2648d97c121bSVasanthakumar Thiagarajan 2649d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 26509e8b16dbSVasanthakumar Thiagarajan return 0; 2651d97c121bSVasanthakumar Thiagarajan 2652d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2653d97c121bSVasanthakumar Thiagarajan 2654d97c121bSVasanthakumar Thiagarajan return 0; 2655d97c121bSVasanthakumar Thiagarajan } 2656d97c121bSVasanthakumar Thiagarajan 26578860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 26588860020eSJohannes Berg struct cfg80211_ap_settings *info) 26596a7c9badSJouni Malinen { 26606a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 26613450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26626a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 266367cd22e4SThomas Pedersen bool hidden = false; 26646a7c9badSJouni Malinen u8 *ies; 26656a7c9badSJouni Malinen int ies_len; 26666a7c9badSJouni Malinen struct wmi_connect_cmd p; 26676a7c9badSJouni Malinen int res; 2668be5abaafSVasanthakumar Thiagarajan int i, ret; 2669d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 26706a7c9badSJouni Malinen 26718860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 26726a7c9badSJouni Malinen 2673990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 26746a7c9badSJouni Malinen return -EIO; 26756a7c9badSJouni Malinen 2676f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 26776a7c9badSJouni Malinen return -EOPNOTSUPP; 26786a7c9badSJouni Malinen 26798860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 26806a7c9badSJouni Malinen 26819a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 26829a5b1318SJouni Malinen 26836a7c9badSJouni Malinen /* TODO: 26846a7c9badSJouni Malinen * info->interval 26856a7c9badSJouni Malinen * info->dtim_period 26866a7c9badSJouni Malinen */ 26876a7c9badSJouni Malinen 26888860020eSJohannes Berg if (info->beacon.head == NULL) 26896a7c9badSJouni Malinen return -EINVAL; 26908860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 26916a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 26928860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 26936a7c9badSJouni Malinen return -EINVAL; 26948860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 26956a7c9badSJouni Malinen 26966a7c9badSJouni Malinen if (info->ssid == NULL) 26976a7c9badSJouni Malinen return -EINVAL; 26983450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 26993450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 27006a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 270167cd22e4SThomas Pedersen hidden = true; 270267cd22e4SThomas Pedersen 270367cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 270467cd22e4SThomas Pedersen if (res) 270567cd22e4SThomas Pedersen return res; 27066a7c9badSJouni Malinen 2707be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2708be5abaafSVasanthakumar Thiagarajan if (ret) 2709be5abaafSVasanthakumar Thiagarajan return ret; 27106a7c9badSJouni Malinen 27116a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 27126a7c9badSJouni Malinen 27136a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 27146a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 27156a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 27166a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27176a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 27186a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27196a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 27206a7c9badSJouni Malinen break; 27216a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 27226a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 27236a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 27246a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 27256a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 27266a7c9badSJouni Malinen break; 27276a7c9badSJouni Malinen } 27286a7c9badSJouni Malinen } 27296a7c9badSJouni Malinen if (p.auth_mode == 0) 27306a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 27313450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 27326a7c9badSJouni Malinen 27336a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 27346a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 27356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27376a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 27386a7c9badSJouni Malinen break; 27396a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27406a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 27416a7c9badSJouni Malinen break; 27426a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27436a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 27446a7c9badSJouni Malinen break; 2745b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2746b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2747b8214df1SDai Shuibing break; 27486a7c9badSJouni Malinen } 27496a7c9badSJouni Malinen } 2750229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 27516a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2752240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2753229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2754240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 27556a7c9badSJouni Malinen 27566a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 27576a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 27586a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 27596a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 27606a7c9badSJouni Malinen break; 27616a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 27626a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 27636a7c9badSJouni Malinen break; 27646a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 27656a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 27666a7c9badSJouni Malinen break; 2767b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2768b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2769b8214df1SDai Shuibing break; 27706a7c9badSJouni Malinen default: 27716a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 27726a7c9badSJouni Malinen break; 27736a7c9badSJouni Malinen } 2774240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 27756a7c9badSJouni Malinen 27766a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2777f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 27786a7c9badSJouni Malinen 27793450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 27803450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 27813450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2782cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 27836a7c9badSJouni Malinen 2784c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2785c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2786c1762a3fSThirumalai Pachamuthu if (res < 0) 2787c1762a3fSThirumalai Pachamuthu return res; 2788c1762a3fSThirumalai Pachamuthu 27893ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 27903ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 27913ca9d1fcSAarthi Thiruvengadam } else { 27923ca9d1fcSAarthi Thiruvengadam /* 27933ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 27943ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 27953ca9d1fcSAarthi Thiruvengadam */ 27963ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 27973ca9d1fcSAarthi Thiruvengadam } 27983ca9d1fcSAarthi Thiruvengadam 279903bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 280003bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 280103bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 280203bdeb0dSVasanthakumar Thiagarajan if (res < 0) 280303bdeb0dSVasanthakumar Thiagarajan return res; 280403bdeb0dSVasanthakumar Thiagarajan } 280503bdeb0dSVasanthakumar Thiagarajan 2806df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, vif->next_ch_band, 2807df90b369SVasanthakumar Thiagarajan vif->next_ch_type != NL80211_CHAN_NO_HT)) 2808df90b369SVasanthakumar Thiagarajan return -EIO; 2809df90b369SVasanthakumar Thiagarajan 2810d97c121bSVasanthakumar Thiagarajan /* 2811d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2812d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2813d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2814d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2815d97c121bSVasanthakumar Thiagarajan */ 2816d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2817d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2818d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2819d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2820d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2821d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2822d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2823d97c121bSVasanthakumar Thiagarajan if (res < 0) 2824d97c121bSVasanthakumar Thiagarajan return res; 2825d97c121bSVasanthakumar Thiagarajan } 2826d97c121bSVasanthakumar Thiagarajan 2827c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2828334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 28299a5b1318SJouni Malinen if (res < 0) 28309a5b1318SJouni Malinen return res; 28319a5b1318SJouni Malinen 28329a5b1318SJouni Malinen return 0; 28336a7c9badSJouni Malinen } 28346a7c9badSJouni Malinen 28358860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 28368860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 28376a7c9badSJouni Malinen { 28388860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 28398860020eSJohannes Berg 28408860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 28418860020eSJohannes Berg return -EIO; 28428860020eSJohannes Berg 28438860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 28448860020eSJohannes Berg return -EOPNOTSUPP; 28458860020eSJohannes Berg 28468860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 28476a7c9badSJouni Malinen } 28486a7c9badSJouni Malinen 28498860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 28506a7c9badSJouni Malinen { 28516a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 285259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28536a7c9badSJouni Malinen 2854f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 28556a7c9badSJouni Malinen return -EOPNOTSUPP; 285659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 28576a7c9badSJouni Malinen return -ENOTCONN; 28586a7c9badSJouni Malinen 2859334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 286059c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 28616a7c9badSJouni Malinen 2862df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 286337a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 28646a7c9badSJouni Malinen } 28656a7c9badSJouni Malinen 286633e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 286733e5308dSJouni Malinen 286833e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 286933e5308dSJouni Malinen u8 *mac) 287033e5308dSJouni Malinen { 287133e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 287233e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 287333e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 287433e5308dSJouni Malinen 287533e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 287633e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 287733e5308dSJouni Malinen } 287833e5308dSJouni Malinen 287923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 288023875136SJouni Malinen u8 *mac, struct station_parameters *params) 288123875136SJouni Malinen { 288223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2883f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 288423875136SJouni Malinen 2885f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 288623875136SJouni Malinen return -EOPNOTSUPP; 288723875136SJouni Malinen 288823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 288923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 289023875136SJouni Malinen return -EOPNOTSUPP; 289123875136SJouni Malinen 289223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2893334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2894334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2895334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2896334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 289723875136SJouni Malinen } 289823875136SJouni Malinen 289963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 290063fa1e0cSJouni Malinen struct net_device *dev, 290163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 290263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 290363fa1e0cSJouni Malinen unsigned int duration, 290463fa1e0cSJouni Malinen u64 *cookie) 290563fa1e0cSJouni Malinen { 290663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2907334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29081052261eSJouni Malinen u32 id; 290963fa1e0cSJouni Malinen 291063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 291163fa1e0cSJouni Malinen * return -EBUSY */ 29121052261eSJouni Malinen id = ++vif->last_roc_id; 29131052261eSJouni Malinen if (id == 0) { 29141052261eSJouni Malinen /* Do not use 0 as the cookie value */ 29151052261eSJouni Malinen id = ++vif->last_roc_id; 29161052261eSJouni Malinen } 29171052261eSJouni Malinen *cookie = id; 291863fa1e0cSJouni Malinen 2919334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2920334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 292163fa1e0cSJouni Malinen } 292263fa1e0cSJouni Malinen 292363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 292463fa1e0cSJouni Malinen struct net_device *dev, 292563fa1e0cSJouni Malinen u64 cookie) 292663fa1e0cSJouni Malinen { 292763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2928334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 292963fa1e0cSJouni Malinen 29301052261eSJouni Malinen if (cookie != vif->last_roc_id) 293163fa1e0cSJouni Malinen return -ENOENT; 29321052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 293363fa1e0cSJouni Malinen 2934334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 293563fa1e0cSJouni Malinen } 293663fa1e0cSJouni Malinen 2937334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2938334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2939334234b5SVasanthakumar Thiagarajan unsigned int freq) 29408bdfbf40SJouni Malinen { 2941334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 29428bdfbf40SJouni Malinen const u8 *pos; 29438bdfbf40SJouni Malinen u8 *p2p; 29448bdfbf40SJouni Malinen int p2p_len; 29458bdfbf40SJouni Malinen int ret; 29468bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 29478bdfbf40SJouni Malinen 29488bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 29498bdfbf40SJouni Malinen 29508bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 29518bdfbf40SJouni Malinen 29528bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 29538bdfbf40SJouni Malinen if (p2p == NULL) 29548bdfbf40SJouni Malinen return -ENOMEM; 29558bdfbf40SJouni Malinen p2p_len = 0; 29568bdfbf40SJouni Malinen 29578bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 29588bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 29598bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 29608bdfbf40SJouni Malinen break; 29618bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 29628bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 29638bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 29648bdfbf40SJouni Malinen } 29658bdfbf40SJouni Malinen pos += 2 + pos[1]; 29668bdfbf40SJouni Malinen } 29678bdfbf40SJouni Malinen 2968334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2969334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 29708bdfbf40SJouni Malinen kfree(p2p); 29718bdfbf40SJouni Malinen return ret; 29728bdfbf40SJouni Malinen } 29738bdfbf40SJouni Malinen 2974d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2975d0ff7383SNaveen Gangadharan u32 id, 2976d0ff7383SNaveen Gangadharan u32 freq, 2977d0ff7383SNaveen Gangadharan u32 wait, 2978d0ff7383SNaveen Gangadharan const u8 *buf, 2979d0ff7383SNaveen Gangadharan size_t len, 2980d0ff7383SNaveen Gangadharan bool *more_data, 2981d0ff7383SNaveen Gangadharan bool no_cck) 2982d0ff7383SNaveen Gangadharan { 2983d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2984d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2985d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2986d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2987d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2988d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2989d0ff7383SNaveen Gangadharan 2990d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2991d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2992d0ff7383SNaveen Gangadharan return false; 2993d0ff7383SNaveen Gangadharan 2994d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2995d0ff7383SNaveen Gangadharan if (!conn) 2996d0ff7383SNaveen Gangadharan return false; 2997d0ff7383SNaveen Gangadharan 2998d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2999d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3000d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3001d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3002d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3003d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3004d0ff7383SNaveen Gangadharan return false; 3005d0ff7383SNaveen Gangadharan 3006d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3007d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3008d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3009d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3010d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3011d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3012d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3013d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3014d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3015d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3016d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3017d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3018d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3019d0ff7383SNaveen Gangadharan 3020d0ff7383SNaveen Gangadharan /* 3021d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3022d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3023d0ff7383SNaveen Gangadharan * STA. 3024d0ff7383SNaveen Gangadharan */ 3025d0ff7383SNaveen Gangadharan if (is_psq_empty) 3026d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3027d0ff7383SNaveen Gangadharan conn->aid, 1); 3028d0ff7383SNaveen Gangadharan return true; 3029d0ff7383SNaveen Gangadharan } 3030d0ff7383SNaveen Gangadharan 3031d0ff7383SNaveen Gangadharan /* 3032d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3033d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3034d0ff7383SNaveen Gangadharan */ 3035d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3036d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3037d0ff7383SNaveen Gangadharan *more_data = true; 3038d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3039d0ff7383SNaveen Gangadharan } 3040d0ff7383SNaveen Gangadharan 3041d0ff7383SNaveen Gangadharan return false; 3042d0ff7383SNaveen Gangadharan } 3043d0ff7383SNaveen Gangadharan 3044c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3045c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3046c86e4f44SAarthi Thiruvengadam { 3047c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3048c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3049c86e4f44SAarthi Thiruvengadam 3050c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3051c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3052c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3053c86e4f44SAarthi Thiruvengadam return true; 3054c86e4f44SAarthi Thiruvengadam } 3055c86e4f44SAarthi Thiruvengadam 3056c86e4f44SAarthi Thiruvengadam return false; 3057c86e4f44SAarthi Thiruvengadam } 3058c86e4f44SAarthi Thiruvengadam 30598a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 30608a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 30618a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 30628a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3063e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3064e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 30658a6c8060SJouni Malinen { 30668a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 306759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30688a6c8060SJouni Malinen u32 id; 30698bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3070d0ff7383SNaveen Gangadharan bool more_data, queued; 30718bdfbf40SJouni Malinen 30728bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3073c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3074c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3075c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 30768bdfbf40SJouni Malinen /* 3077c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 30788bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 30798bdfbf40SJouni Malinen */ 30808bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3081334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 30828bdfbf40SJouni Malinen chan->center_freq); 30838bdfbf40SJouni Malinen } 30848a6c8060SJouni Malinen 3085cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30868a6c8060SJouni Malinen if (id == 0) { 30878a6c8060SJouni Malinen /* 30888a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 30898a6c8060SJouni Malinen * used for the command. 30908a6c8060SJouni Malinen */ 3091cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 30928a6c8060SJouni Malinen } 30938a6c8060SJouni Malinen 30948a6c8060SJouni Malinen *cookie = id; 30953ca9d1fcSAarthi Thiruvengadam 3096d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3097d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3098d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3099d0ff7383SNaveen Gangadharan id, chan->center_freq, 3100d0ff7383SNaveen Gangadharan wait, buf, 3101d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3102d0ff7383SNaveen Gangadharan if (queued) 3103d0ff7383SNaveen Gangadharan return 0; 3104d0ff7383SNaveen Gangadharan } 3105d0ff7383SNaveen Gangadharan 31063ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 31073ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 31083ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 31093ca9d1fcSAarthi Thiruvengadam } 31108a6c8060SJouni Malinen 3111ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3112ae32c30aSJouni Malinen struct net_device *dev, 3113ae32c30aSJouni Malinen u16 frame_type, bool reg) 3114ae32c30aSJouni Malinen { 3115cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3116ae32c30aSJouni Malinen 3117ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3118ae32c30aSJouni Malinen __func__, frame_type, reg); 3119ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3120ae32c30aSJouni Malinen /* 3121ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3122ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3123ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3124ae32c30aSJouni Malinen */ 3125cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3126ae32c30aSJouni Malinen } 3127ae32c30aSJouni Malinen } 3128ae32c30aSJouni Malinen 312910509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 313010509f90SKalle Valo struct net_device *dev, 313110509f90SKalle Valo struct cfg80211_sched_scan_request *request) 313210509f90SKalle Valo { 313310509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 313410509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 313510509f90SKalle Valo u16 interval; 313610509f90SKalle Valo int ret; 313710509f90SKalle Valo 313810509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 313910509f90SKalle Valo return -EIO; 314010509f90SKalle Valo 314110509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 314210509f90SKalle Valo return -EBUSY; 314310509f90SKalle Valo 314477ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 314577ed4e45SThomas Pedersen if (ar->num_vif > 1) 314677ed4e45SThomas Pedersen return -EIO; 314777ed4e45SThomas Pedersen 3148b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3149b4d13d3bSKalle Valo 31503b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 31513b8ffc6aSJouni Malinen request->n_ssids); 31523b8ffc6aSJouni Malinen if (ret < 0) 31533b8ffc6aSJouni Malinen return ret; 315410509f90SKalle Valo 315510509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 315610509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 315710509f90SKalle Valo 315810509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 315910509f90SKalle Valo interval, interval, 3160d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 316110509f90SKalle Valo 316210509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 316310509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 316410509f90SKalle Valo WOW_FILTER_SSID, 316510509f90SKalle Valo WOW_HOST_REQ_DELAY); 316610509f90SKalle Valo if (ret) { 316710509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 316810509f90SKalle Valo return ret; 316910509f90SKalle Valo } 317010509f90SKalle Valo 317110509f90SKalle Valo /* this also clears IE in fw if it's not set */ 317210509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 317310509f90SKalle Valo WMI_FRAME_PROBE_REQ, 317410509f90SKalle Valo request->ie, request->ie_len); 317510509f90SKalle Valo if (ret) { 317610509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 317710509f90SKalle Valo ret); 317810509f90SKalle Valo return ret; 317910509f90SKalle Valo } 318010509f90SKalle Valo 318110509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 318210509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 318310509f90SKalle Valo if (ret) { 318410509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 318510509f90SKalle Valo ret); 318610509f90SKalle Valo return ret; 318710509f90SKalle Valo } 318810509f90SKalle Valo 318910509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 319010509f90SKalle Valo 319110509f90SKalle Valo return ret; 319210509f90SKalle Valo } 319310509f90SKalle Valo 319410509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 319510509f90SKalle Valo struct net_device *dev) 319610509f90SKalle Valo { 319710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 319810509f90SKalle Valo bool stopped; 319910509f90SKalle Valo 320010509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 320110509f90SKalle Valo 320210509f90SKalle Valo if (!stopped) 320310509f90SKalle Valo return -EIO; 320410509f90SKalle Valo 320510509f90SKalle Valo return 0; 320610509f90SKalle Valo } 320710509f90SKalle Valo 3208f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3209f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3210f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3211f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3212f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3213f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3214f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3215f80574aeSJouni Malinen }, 3216ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3217ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3218ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3219ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3220ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3221ba1f6fe3SJouni Malinen }, 3222f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3223f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3224f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3225f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3226f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3227f80574aeSJouni Malinen }, 3228f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3229f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3230f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3231f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3232f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3233f80574aeSJouni Malinen }, 3234f80574aeSJouni Malinen }; 3235f80574aeSJouni Malinen 3236bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 323755055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 323855055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3239bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3240bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3241bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3242bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3243bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3244bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3245bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3246bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3247bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3248bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3249bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3250bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3251bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3252bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3253bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3254bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3255bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3256bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3257003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3258abcb344bSKalle Valo #ifdef CONFIG_PM 325952d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 326052d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3261abcb344bSKalle Valo #endif 32626a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 32638860020eSJohannes Berg .start_ap = ath6kl_start_ap, 32648860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 32658860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 326633e5308dSJouni Malinen .del_station = ath6kl_del_station, 326723875136SJouni Malinen .change_station = ath6kl_change_station, 326863fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 326963fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 32708a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3271ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 327210509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 327310509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3274bdcd8170SKalle Valo }; 3275bdcd8170SKalle Valo 32767125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3277ec4b7f60SKalle Valo { 327810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 327910509f90SKalle Valo 3280ec4b7f60SKalle Valo switch (vif->sme_state) { 3281c97a31b0SKalle Valo case SME_DISCONNECTED: 3282c97a31b0SKalle Valo break; 3283ec4b7f60SKalle Valo case SME_CONNECTING: 3284ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3285ec4b7f60SKalle Valo NULL, 0, 3286ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3287ec4b7f60SKalle Valo GFP_KERNEL); 3288ec4b7f60SKalle Valo break; 3289ec4b7f60SKalle Valo case SME_CONNECTED: 3290ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3291ec4b7f60SKalle Valo break; 3292ec4b7f60SKalle Valo } 3293ec4b7f60SKalle Valo 3294ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3295ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 32967125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3297ec4b7f60SKalle Valo 3298ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 32991f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 33001f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3301ec4b7f60SKalle Valo 3302ec4b7f60SKalle Valo /* disable scanning */ 33037125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 33047125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 33057125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3306ec4b7f60SKalle Valo 3307ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3308ec4b7f60SKalle Valo } 3309ec4b7f60SKalle Valo 33107125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 33117125f01dSKalle Valo { 33127125f01dSKalle Valo struct ath6kl_vif *vif; 33137125f01dSKalle Valo 33147125f01dSKalle Valo vif = ath6kl_vif_first(ar); 33157125f01dSKalle Valo if (!vif) { 33167125f01dSKalle Valo /* save the current power mode before enabling power save */ 33177125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 33187125f01dSKalle Valo 33197125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3320cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 33217125f01dSKalle Valo return; 33227125f01dSKalle Valo } 33237125f01dSKalle Valo 33247125f01dSKalle Valo /* 33257125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 33267125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 33277125f01dSKalle Valo * sleeps. 33287125f01dSKalle Valo */ 33297125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 33307125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 33317125f01dSKalle Valo } 33327125f01dSKalle Valo 3333c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 33348dafb70eSVasanthakumar Thiagarajan { 33357baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 33362132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 33378dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 33388dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 33398dafb70eSVasanthakumar Thiagarajan } 33408dafb70eSVasanthakumar Thiagarajan 3341de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3342108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 334310509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 334410509f90SKalle Valo (unsigned long) vif); 334510509f90SKalle Valo 3346de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3347478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 33488dafb70eSVasanthakumar Thiagarajan 334980abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 335080abaf9bSVasanthakumar Thiagarajan 33518dafb70eSVasanthakumar Thiagarajan return 0; 33528dafb70eSVasanthakumar Thiagarajan } 33538dafb70eSVasanthakumar Thiagarajan 3354c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 33558dafb70eSVasanthakumar Thiagarajan { 335655055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 335780abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 335855055976SVasanthakumar Thiagarajan 33592132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3360108438bcSVasanthakumar Thiagarajan 336155055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 336255055976SVasanthakumar Thiagarajan 336355055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 336455055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 336555055976SVasanthakumar Thiagarajan 336680abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 336780abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 336880abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 336980abaf9bSVasanthakumar Thiagarajan } 337080abaf9bSVasanthakumar Thiagarajan 337127929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 337255055976SVasanthakumar Thiagarajan 337355055976SVasanthakumar Thiagarajan ar->num_vif--; 33748dafb70eSVasanthakumar Thiagarajan } 33758dafb70eSVasanthakumar Thiagarajan 33768dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 337755055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 337855055976SVasanthakumar Thiagarajan u8 nw_type) 33798dafb70eSVasanthakumar Thiagarajan { 33808dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3381108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 33828dafb70eSVasanthakumar Thiagarajan 338355055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 33848dafb70eSVasanthakumar Thiagarajan if (!ndev) 33858dafb70eSVasanthakumar Thiagarajan return NULL; 33868dafb70eSVasanthakumar Thiagarajan 3387108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3388108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3389108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3390108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3391108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3392108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3393108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3394108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3395334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3396d0d670abSKalle Valo vif->nw_type = nw_type; 3397d0d670abSKalle Valo vif->next_mode = nw_type; 33988f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3399ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3400eb38987eSRaja Mani vif->bg_scan_period = 0; 3401df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 34028dafb70eSVasanthakumar Thiagarajan 340355055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 340455055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 340555055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 340655055976SVasanthakumar Thiagarajan 0x2; 340755055976SVasanthakumar Thiagarajan 34088dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 34098dafb70eSVasanthakumar Thiagarajan 3410e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 34118dafb70eSVasanthakumar Thiagarajan 3412c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 34138dafb70eSVasanthakumar Thiagarajan goto err; 34148dafb70eSVasanthakumar Thiagarajan 341527929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 34168dafb70eSVasanthakumar Thiagarajan goto err; 34178dafb70eSVasanthakumar Thiagarajan 341855055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 341914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 342059c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 34218dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 342259c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 34238dafb70eSVasanthakumar Thiagarajan 342455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 342555055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 342655055976SVasanthakumar Thiagarajan 342711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3428990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 342911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3430990bd915SVasanthakumar Thiagarajan 34318dafb70eSVasanthakumar Thiagarajan return ndev; 34328dafb70eSVasanthakumar Thiagarajan 34338dafb70eSVasanthakumar Thiagarajan err: 343427929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 343527929723SVasanthakumar Thiagarajan free_netdev(ndev); 3436bdcd8170SKalle Valo return NULL; 3437bdcd8170SKalle Valo } 3438bdcd8170SKalle Valo 343946d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 344046d33a21SKalle Valo { 344146d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3442d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 344346d33a21SKalle Valo int ret; 344446d33a21SKalle Valo 344546d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 344646d33a21SKalle Valo 344746d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 344846d33a21SKalle Valo 344946d33a21SKalle Valo /* set device pointer for wiphy */ 345046d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 345146d33a21SKalle Valo 345246d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 345346d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 345446d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 345546d33a21SKalle Valo if (ar->p2p) { 345646d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 345746d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 345846d33a21SKalle Valo } 345946d33a21SKalle Valo 346046d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 346146d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 346246d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3463d92917e4SThomas Pedersen switch (ar->hw.cap) { 3464d92917e4SThomas Pedersen case WMI_11AN_CAP: 3465d92917e4SThomas Pedersen ht = true; 3466d92917e4SThomas Pedersen case WMI_11A_CAP: 3467d92917e4SThomas Pedersen band_5gig = true; 3468d92917e4SThomas Pedersen break; 3469d92917e4SThomas Pedersen case WMI_11GN_CAP: 3470d92917e4SThomas Pedersen ht = true; 3471d92917e4SThomas Pedersen case WMI_11G_CAP: 3472d92917e4SThomas Pedersen band_2gig = true; 3473d92917e4SThomas Pedersen break; 3474d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3475d92917e4SThomas Pedersen ht = true; 3476d92917e4SThomas Pedersen case WMI_11AG_CAP: 3477d92917e4SThomas Pedersen band_2gig = true; 3478d92917e4SThomas Pedersen band_5gig = true; 3479d92917e4SThomas Pedersen break; 3480d92917e4SThomas Pedersen default: 3481d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3482d92917e4SThomas Pedersen return -EINVAL; 3483d92917e4SThomas Pedersen } 3484d92917e4SThomas Pedersen 3485d92917e4SThomas Pedersen if (!ht) { 3486d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3487d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3488d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3489d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3490d92917e4SThomas Pedersen } 3491d92917e4SThomas Pedersen if (band_2gig) 349246d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3493d92917e4SThomas Pedersen if (band_5gig) 349446d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3495d92917e4SThomas Pedersen 349646d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 349746d33a21SKalle Valo 349846d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 349946d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 350046d33a21SKalle Valo 350146d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 350246d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 350346d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 350446d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 350546d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 350646d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 350746d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 350846d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 350946d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 351046d33a21SKalle Valo 35113b8ffc6aSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSID_INDEX; 351246d33a21SKalle Valo 3513f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3514f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3515f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3516f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3517f2afdac7SVasanthakumar Thiagarajan 3518f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3519f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3520f2afdac7SVasanthakumar Thiagarajan 352103bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 352203bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 352303bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 352403bdeb0dSVasanthakumar Thiagarajan 3525f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3526f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3527f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3528a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3529f2afdac7SVasanthakumar Thiagarajan 353046d33a21SKalle Valo ret = wiphy_register(wiphy); 353146d33a21SKalle Valo if (ret < 0) { 353246d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 353346d33a21SKalle Valo return ret; 353446d33a21SKalle Valo } 353546d33a21SKalle Valo 3536e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3537e5348a1eSVasanthakumar Thiagarajan 353846d33a21SKalle Valo return 0; 353946d33a21SKalle Valo } 354046d33a21SKalle Valo 354146d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3542bdcd8170SKalle Valo { 3543be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3544e5348a1eSVasanthakumar Thiagarajan 3545e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 354645eaa78fSKalle Valo } 354746d33a21SKalle Valo 354845eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 354945eaa78fSKalle Valo { 355045eaa78fSKalle Valo struct ath6kl *ar; 355145eaa78fSKalle Valo struct wiphy *wiphy; 355245eaa78fSKalle Valo 355345eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 355445eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 355545eaa78fSKalle Valo 355645eaa78fSKalle Valo if (!wiphy) { 355745eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 355845eaa78fSKalle Valo return NULL; 355945eaa78fSKalle Valo } 356045eaa78fSKalle Valo 356145eaa78fSKalle Valo ar = wiphy_priv(wiphy); 356245eaa78fSKalle Valo ar->wiphy = wiphy; 356345eaa78fSKalle Valo 356445eaa78fSKalle Valo return ar; 356545eaa78fSKalle Valo } 356645eaa78fSKalle Valo 356745eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 356845eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 356945eaa78fSKalle Valo { 35701d2a4456SVasanthakumar Thiagarajan int i; 35711d2a4456SVasanthakumar Thiagarajan 35721d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 35731d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 35741d2a4456SVasanthakumar Thiagarajan 3575be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3576bdcd8170SKalle Valo } 357745eaa78fSKalle Valo 3578