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 186eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 19c08631c6SRaja Mani #include <linux/inetdevice.h> 20d6a434d6SKalle Valo #include <linux/export.h> 216eb07cafSPaul Gortmaker 22bdcd8170SKalle Valo #include "core.h" 23bdcd8170SKalle Valo #include "cfg80211.h" 24bdcd8170SKalle Valo #include "debug.h" 25abcb344bSKalle Valo #include "hif-ops.h" 26003353b0SKalle Valo #include "testmode.h" 27bdcd8170SKalle Valo 28bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 29bdcd8170SKalle Valo .bitrate = (_rate), \ 30bdcd8170SKalle Valo .flags = (_flags), \ 31bdcd8170SKalle Valo .hw_value = (_rateid), \ 32bdcd8170SKalle Valo } 33bdcd8170SKalle Valo 34bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 35bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 36bdcd8170SKalle Valo .hw_value = (_channel), \ 37bdcd8170SKalle Valo .center_freq = (_freq), \ 38bdcd8170SKalle Valo .flags = (_flags), \ 39bdcd8170SKalle Valo .max_antenna_gain = 0, \ 40bdcd8170SKalle Valo .max_power = 30, \ 41bdcd8170SKalle Valo } 42bdcd8170SKalle Valo 43bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 44bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 45bdcd8170SKalle Valo .hw_value = (_channel), \ 46bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 47bdcd8170SKalle Valo .flags = (_flags), \ 48bdcd8170SKalle Valo .max_antenna_gain = 0, \ 49bdcd8170SKalle Valo .max_power = 30, \ 50bdcd8170SKalle Valo } 51bdcd8170SKalle Valo 52f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 53f599359cSBala Shanmugam 54bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 55bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 56bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 57bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 58bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 59bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 60bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 61bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 62bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 63bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 64bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 65bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 66bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 67bdcd8170SKalle Valo }; 68bdcd8170SKalle Valo 69bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 70bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 71bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 72bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 73bdcd8170SKalle Valo 74faaf1929SVasanthakumar Thiagarajan #define ath6kl_g_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 75faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 76faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 77faaf1929SVasanthakumar Thiagarajan 78bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 79bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 80bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 81bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 82bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 83bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 84bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 85bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 86bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 87bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 88bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 89bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 90bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 91bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 92bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 93bdcd8170SKalle Valo }; 94bdcd8170SKalle Valo 95bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 96bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 97bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 98bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 99bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 100bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 101bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 102bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 103bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 104bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 105bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 106bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 107bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 108bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 109bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 110bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 111bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 112bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 113bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 114bdcd8170SKalle Valo CHAN5G(216, 0), 115bdcd8170SKalle Valo }; 116bdcd8170SKalle Valo 117bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 118bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 119bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 120bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 121bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 122faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 123faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 124bdcd8170SKalle Valo }; 125bdcd8170SKalle Valo 126bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 127bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 128bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 129bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 130bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 131faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 132faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 133bdcd8170SKalle Valo }; 134bdcd8170SKalle Valo 135837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 136837cb97eSJouni Malinen 13710509f90SKalle Valo /* returns true if scheduled scan was stopped */ 13810509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 13910509f90SKalle Valo { 14010509f90SKalle Valo struct ath6kl *ar = vif->ar; 14110509f90SKalle Valo 14210509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14310509f90SKalle Valo return false; 14410509f90SKalle Valo 14510509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14610509f90SKalle Valo 14710509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 14810509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 14910509f90SKalle Valo 15010509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 15110509f90SKalle Valo 15210509f90SKalle Valo return true; 15310509f90SKalle Valo } 15410509f90SKalle Valo 15510509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15610509f90SKalle Valo { 15710509f90SKalle Valo struct ath6kl *ar = vif->ar; 15810509f90SKalle Valo bool stopped; 15910509f90SKalle Valo 16010509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16110509f90SKalle Valo 16210509f90SKalle Valo if (!stopped) 16310509f90SKalle Valo return; 16410509f90SKalle Valo 16510509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16610509f90SKalle Valo } 16710509f90SKalle Valo 168240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 169bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 170bdcd8170SKalle Valo { 171bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 172bdcd8170SKalle Valo 173bdcd8170SKalle Valo if (!wpa_version) { 1743450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 175bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1763450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 177bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1783450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 179bdcd8170SKalle Valo } else { 180bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 181bdcd8170SKalle Valo return -ENOTSUPP; 182bdcd8170SKalle Valo } 183bdcd8170SKalle Valo 184bdcd8170SKalle Valo return 0; 185bdcd8170SKalle Valo } 186bdcd8170SKalle Valo 187240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 188bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 189bdcd8170SKalle Valo { 190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 191bdcd8170SKalle Valo 192bdcd8170SKalle Valo switch (auth_type) { 193bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1943450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 195bdcd8170SKalle Valo break; 196bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1973450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 198bdcd8170SKalle Valo break; 199bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2003450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 201bdcd8170SKalle Valo break; 202bdcd8170SKalle Valo 203bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 205bdcd8170SKalle Valo break; 206bdcd8170SKalle Valo 207bdcd8170SKalle Valo default: 2083c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 209bdcd8170SKalle Valo return -ENOTSUPP; 210bdcd8170SKalle Valo } 211bdcd8170SKalle Valo 212bdcd8170SKalle Valo return 0; 213bdcd8170SKalle Valo } 214bdcd8170SKalle Valo 215240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 216bdcd8170SKalle Valo { 2173450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2183450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2193450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 220bdcd8170SKalle Valo 221bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 222bdcd8170SKalle Valo __func__, cipher, ucast); 223bdcd8170SKalle Valo 224bdcd8170SKalle Valo switch (cipher) { 225bdcd8170SKalle Valo case 0: 226bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 227bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 228bdcd8170SKalle Valo *ar_cipher_len = 0; 229bdcd8170SKalle Valo break; 230bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 231bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 232bdcd8170SKalle Valo *ar_cipher_len = 5; 233bdcd8170SKalle Valo break; 234bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 235bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 13; 237bdcd8170SKalle Valo break; 238bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 239bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 240bdcd8170SKalle Valo *ar_cipher_len = 0; 241bdcd8170SKalle Valo break; 242bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 243bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 244bdcd8170SKalle Valo *ar_cipher_len = 0; 245bdcd8170SKalle Valo break; 2465e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2475e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2485e07021eSDai Shuibing *ar_cipher_len = 0; 2495e07021eSDai Shuibing break; 250bdcd8170SKalle Valo default: 251bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 252bdcd8170SKalle Valo return -ENOTSUPP; 253bdcd8170SKalle Valo } 254bdcd8170SKalle Valo 255bdcd8170SKalle Valo return 0; 256bdcd8170SKalle Valo } 257bdcd8170SKalle Valo 258240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 259bdcd8170SKalle Valo { 260bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 261bdcd8170SKalle Valo 262bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2633450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2643450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2653450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2663450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 267837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2683450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2703450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2713450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 272bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2733450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 274bdcd8170SKalle Valo } 275bdcd8170SKalle Valo } 276bdcd8170SKalle Valo 277990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 278bdcd8170SKalle Valo { 279990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28059c98449SVasanthakumar Thiagarajan 281bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 282bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 283bdcd8170SKalle Valo return false; 284bdcd8170SKalle Valo } 285bdcd8170SKalle Valo 28659c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 287bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 288bdcd8170SKalle Valo return false; 289bdcd8170SKalle Valo } 290bdcd8170SKalle Valo 291bdcd8170SKalle Valo return true; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 2946981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2956981ffdcSKevin Fang { 2966981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2976981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2986981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2996981ffdcSKevin Fang } 3006981ffdcSKevin Fang 3016981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3026981ffdcSKevin Fang { 3036981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3046981ffdcSKevin Fang } 3056981ffdcSKevin Fang 30663541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 30763541212SAarthi Thiruvengadam { 30863541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 30963541212SAarthi Thiruvengadam pos[1] >= 4 && 31063541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31163541212SAarthi Thiruvengadam pos[5] == 0x04); 31263541212SAarthi Thiruvengadam } 31363541212SAarthi Thiruvengadam 314334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3156981ffdcSKevin Fang size_t ies_len) 3166981ffdcSKevin Fang { 317334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3186981ffdcSKevin Fang const u8 *pos; 3196981ffdcSKevin Fang u8 *buf = NULL; 3206981ffdcSKevin Fang size_t len = 0; 3216981ffdcSKevin Fang int ret; 3226981ffdcSKevin Fang 3236981ffdcSKevin Fang /* 32463541212SAarthi Thiruvengadam * Clear previously set flag 32563541212SAarthi Thiruvengadam */ 32663541212SAarthi Thiruvengadam 32763541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 32863541212SAarthi Thiruvengadam 32963541212SAarthi Thiruvengadam /* 3306981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3316981ffdcSKevin Fang */ 3326981ffdcSKevin Fang 3336981ffdcSKevin Fang if (ies && ies_len) { 3346981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3356981ffdcSKevin Fang if (buf == NULL) 3366981ffdcSKevin Fang return -ENOMEM; 3376981ffdcSKevin Fang pos = ies; 3386981ffdcSKevin Fang 3396981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3406981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3416981ffdcSKevin Fang break; 3426981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3436981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3446981ffdcSKevin Fang len += 2 + pos[1]; 3456981ffdcSKevin Fang } 34663541212SAarthi Thiruvengadam 34763541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 34863541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 34963541212SAarthi Thiruvengadam 3506981ffdcSKevin Fang pos += 2 + pos[1]; 3516981ffdcSKevin Fang } 3526981ffdcSKevin Fang } 3536981ffdcSKevin Fang 354334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 355334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3566981ffdcSKevin Fang kfree(buf); 3576981ffdcSKevin Fang return ret; 3586981ffdcSKevin Fang } 3596981ffdcSKevin Fang 36055055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36155055976SVasanthakumar Thiagarajan { 36255055976SVasanthakumar Thiagarajan switch (type) { 36355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36455055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36555055976SVasanthakumar Thiagarajan break; 36655055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 36755055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 36855055976SVasanthakumar Thiagarajan break; 36955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37055055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37155055976SVasanthakumar Thiagarajan break; 37255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37655055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan default: 37955055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38055055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38155055976SVasanthakumar Thiagarajan } 38255055976SVasanthakumar Thiagarajan 38355055976SVasanthakumar Thiagarajan return 0; 38455055976SVasanthakumar Thiagarajan } 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 38755055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38855055976SVasanthakumar Thiagarajan { 38955055976SVasanthakumar Thiagarajan int i; 39055055976SVasanthakumar Thiagarajan 39155055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39255055976SVasanthakumar Thiagarajan return false; 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39555055976SVasanthakumar Thiagarajan ar->num_vif)) 39655055976SVasanthakumar Thiagarajan return false; 39755055976SVasanthakumar Thiagarajan 39855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39955055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40071f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40155055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40255055976SVasanthakumar Thiagarajan *if_idx = i; 40355055976SVasanthakumar Thiagarajan return true; 40455055976SVasanthakumar Thiagarajan } 40555055976SVasanthakumar Thiagarajan } 40655055976SVasanthakumar Thiagarajan } 40755055976SVasanthakumar Thiagarajan 4083226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4093226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41071f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4113226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4123226f68aSVasanthakumar Thiagarajan *if_idx = i; 4133226f68aSVasanthakumar Thiagarajan return true; 4143226f68aSVasanthakumar Thiagarajan } 4153226f68aSVasanthakumar Thiagarajan } 4163226f68aSVasanthakumar Thiagarajan } 4173226f68aSVasanthakumar Thiagarajan 41855055976SVasanthakumar Thiagarajan return false; 41955055976SVasanthakumar Thiagarajan } 42055055976SVasanthakumar Thiagarajan 4218c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4228c9bb054SKalle Valo { 4238c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4248c9bb054SKalle Valo } 4258c9bb054SKalle Valo 4268c9bb054SKalle Valo 427bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 428bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 429bdcd8170SKalle Valo { 430bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 432bdcd8170SKalle Valo int status; 4333ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 434ce0dc0cfSRaja Mani u16 interval; 435bdcd8170SKalle Valo 43610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 43710509f90SKalle Valo 43814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 439bdcd8170SKalle Valo 440990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 441bdcd8170SKalle Valo return -EIO; 442bdcd8170SKalle Valo 443bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 444bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 445bdcd8170SKalle Valo return -EBUSY; 446bdcd8170SKalle Valo } 447bdcd8170SKalle Valo 448bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 449bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 450bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 451bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 452bdcd8170SKalle Valo return -EINVAL; 453bdcd8170SKalle Valo } 454bdcd8170SKalle Valo 455bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 456bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 457bdcd8170SKalle Valo return -ERESTARTSYS; 458bdcd8170SKalle Valo } 459bdcd8170SKalle Valo 460bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 461bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 462bdcd8170SKalle Valo up(&ar->sem); 463bdcd8170SKalle Valo return -EBUSY; 464bdcd8170SKalle Valo } 465bdcd8170SKalle Valo 466bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 467bdcd8170SKalle Valo /* 468bdcd8170SKalle Valo * sleep until the command queue drains 469bdcd8170SKalle Valo */ 470bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4718c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 472bdcd8170SKalle Valo WMI_TIMEOUT); 473bdcd8170SKalle Valo if (signal_pending(current)) { 474bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 475bdcd8170SKalle Valo up(&ar->sem); 476bdcd8170SKalle Valo return -EINTR; 477bdcd8170SKalle Valo } 478bdcd8170SKalle Valo } 479bdcd8170SKalle Valo 480334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 481743b4518SDan Carpenter if (status) { 482743b4518SDan Carpenter up(&ar->sem); 4836981ffdcSKevin Fang return status; 484743b4518SDan Carpenter } 4856e786cb1SJouni Malinen 4866e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 487542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4886981ffdcSKevin Fang 48959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4903450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4913450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 492cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 493334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 494334234b5SVasanthakumar Thiagarajan vif->req_bssid, 495f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 496bdcd8170SKalle Valo 497bdcd8170SKalle Valo up(&ar->sem); 498bdcd8170SKalle Valo if (status) { 499bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 500bdcd8170SKalle Valo return -EIO; 501bdcd8170SKalle Valo } 502bdcd8170SKalle Valo return 0; 5033450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5043450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 505240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 5083450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5093450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5103450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 511bdcd8170SKalle Valo 512bdcd8170SKalle Valo if (sme->channel) 513f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 514bdcd8170SKalle Valo 5158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 516bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5178c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 518bdcd8170SKalle Valo 519240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 520bdcd8170SKalle Valo 521240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 522bdcd8170SKalle Valo if (status) { 523bdcd8170SKalle Valo up(&ar->sem); 524bdcd8170SKalle Valo return status; 525bdcd8170SKalle Valo } 526bdcd8170SKalle Valo 527bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 528240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 529bdcd8170SKalle Valo else 530240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 531bdcd8170SKalle Valo 532240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 533bdcd8170SKalle Valo 534bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 535240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if ((sme->key_len) && 5383450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5393450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 540bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 541bdcd8170SKalle Valo 542792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 543bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 544bdcd8170SKalle Valo sme->key_idx); 545bdcd8170SKalle Valo up(&ar->sem); 546bdcd8170SKalle Valo return -ENOENT; 547bdcd8170SKalle Valo } 548bdcd8170SKalle Valo 5496f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 550bdcd8170SKalle Valo key->key_len = sme->key_len; 551bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5523450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5533450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 554bdcd8170SKalle Valo 555334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5563450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 557bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 558bdcd8170SKalle Valo key->key_len, 559f4bb9a6fSJouni Malinen NULL, 0, 560bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 561bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 562bdcd8170SKalle Valo } 563bdcd8170SKalle Valo 564bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 566240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 567240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 568bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 569bdcd8170SKalle Valo up(&ar->sem); 570bdcd8170SKalle Valo return -EIO; 571bdcd8170SKalle Valo } 572bdcd8170SKalle Valo } 573bdcd8170SKalle Valo 574f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 575bdcd8170SKalle Valo 5763ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5773ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5783ca9d1fcSAarthi Thiruvengadam 579bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 580bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 581bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 582bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 583bdcd8170SKalle Valo __func__, 5843450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5853450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 586f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 587bdcd8170SKalle Valo 588cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 589ce0dc0cfSRaja Mani 590ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 591b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 592b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 593ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 594ce0dc0cfSRaja Mani interval, 595ce0dc0cfSRaja Mani 0); 596ce0dc0cfSRaja Mani if (status) { 597ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 598ce0dc0cfSRaja Mani up(&ar->sem); 599ce0dc0cfSRaja Mani return status; 600ce0dc0cfSRaja Mani } 601ce0dc0cfSRaja Mani } 602ce0dc0cfSRaja Mani 603334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6053450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6063450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6073450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6083450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 609f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6103ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 611bdcd8170SKalle Valo 612f599359cSBala Shanmugam /* disable background scan if period is 0 */ 613f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 614f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 615f599359cSBala Shanmugam 616f599359cSBala Shanmugam /* configure default value if not specified */ 617f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 618f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 619f599359cSBala Shanmugam 620f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 621f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 622f599359cSBala Shanmugam 623bdcd8170SKalle Valo up(&ar->sem); 624bdcd8170SKalle Valo 625bdcd8170SKalle Valo if (status == -EINVAL) { 6263450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6273450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 628bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 629bdcd8170SKalle Valo return -ENOENT; 630bdcd8170SKalle Valo } else if (status) { 631bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 632bdcd8170SKalle Valo return -EIO; 633bdcd8170SKalle Valo } 634bdcd8170SKalle Valo 635bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 636ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 637ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 638de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 639bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 640bdcd8170SKalle Valo } 641bdcd8170SKalle Valo 642bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 64359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 644bdcd8170SKalle Valo 645bdcd8170SKalle Valo return 0; 646bdcd8170SKalle Valo } 647bdcd8170SKalle Valo 6485e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6495e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6504eab6f4fSRaja Mani enum network_type nw_type, 6514eab6f4fSRaja Mani const u8 *bssid, 65201cac476SJouni Malinen struct ieee80211_channel *chan, 6535e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6545e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 65501cac476SJouni Malinen { 656240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 65701cac476SJouni Malinen struct cfg80211_bss *bss; 6584eab6f4fSRaja Mani u16 cap_mask, cap_val; 65901cac476SJouni Malinen u8 *ie; 66001cac476SJouni Malinen 6614eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6624eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6634eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6644eab6f4fSRaja Mani } else { 6654eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6664eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6674eab6f4fSRaja Mani } 6684eab6f4fSRaja Mani 669be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6704eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6714eab6f4fSRaja Mani cap_mask, cap_val); 67201cac476SJouni Malinen if (bss == NULL) { 67301cac476SJouni Malinen /* 67401cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 67501cac476SJouni Malinen * generate a partial entry until the first BSS info 67601cac476SJouni Malinen * event becomes available. 67701cac476SJouni Malinen * 67801cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 67901cac476SJouni Malinen * IEs from the target. 68001cac476SJouni Malinen */ 6813450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 68201cac476SJouni Malinen if (ie == NULL) 6835e13fd35SVasanthakumar Thiagarajan return NULL; 68401cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6853450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6863450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6873450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 688be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6894eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6903450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 69101cac476SJouni Malinen 0, GFP_KERNEL); 69201cac476SJouni Malinen if (bss) 6934eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6944eab6f4fSRaja Mani "cfg80211\n", bssid); 69501cac476SJouni Malinen kfree(ie); 69601cac476SJouni Malinen } else 6975e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 69801cac476SJouni Malinen 6995e13fd35SVasanthakumar Thiagarajan return bss; 70001cac476SJouni Malinen } 70101cac476SJouni Malinen 702240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 703bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 704bdcd8170SKalle Valo u16 beacon_intvl, 705bdcd8170SKalle Valo enum network_type nw_type, 706bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 707bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 708bdcd8170SKalle Valo { 70901cac476SJouni Malinen struct ieee80211_channel *chan; 710240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7115e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 712bdcd8170SKalle Valo 713bdcd8170SKalle Valo /* capinfo + listen interval */ 714bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo /* capinfo + status code + associd */ 717bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 720bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 721bdcd8170SKalle Valo assoc_resp_ie_offset; 722bdcd8170SKalle Valo 723bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 724bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 725bdcd8170SKalle Valo 72632c10874SJouni Malinen /* 72732c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 72832c10874SJouni Malinen * a Beacon frame from the AP is seen. 72932c10874SJouni Malinen */ 730cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 73159c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 73232c10874SJouni Malinen 733bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 734551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 735bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 736bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 737bdcd8170SKalle Valo return; 738bdcd8170SKalle Valo } 739bdcd8170SKalle Valo } 740bdcd8170SKalle Valo 741bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 742551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 743551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 744bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 745bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 746bdcd8170SKalle Valo return; 747bdcd8170SKalle Valo } 748bdcd8170SKalle Valo } 749bdcd8170SKalle Valo 750be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 751bdcd8170SKalle Valo 7525e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7535e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7545e13fd35SVasanthakumar Thiagarajan if (!bss) { 7554eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 756bdcd8170SKalle Valo return; 757bdcd8170SKalle Valo } 758bdcd8170SKalle Valo 7594eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7604eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7614eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7624eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7635e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76401cac476SJouni Malinen return; 76501cac476SJouni Malinen } 76601cac476SJouni Malinen 76714ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 768bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 76914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 770240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 771bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 772bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 773bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7745e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 776bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7775e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 778bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 779bdcd8170SKalle Valo } 780bdcd8170SKalle Valo } 781bdcd8170SKalle Valo 782bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 783bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 784bdcd8170SKalle Valo { 785d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7863450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 787bdcd8170SKalle Valo 788bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 789bdcd8170SKalle Valo reason_code); 790bdcd8170SKalle Valo 79110509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 79210509f90SKalle Valo 793990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 794bdcd8170SKalle Valo return -EIO; 795bdcd8170SKalle Valo 796bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 797bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 798bdcd8170SKalle Valo return -EBUSY; 799bdcd8170SKalle Valo } 800bdcd8170SKalle Valo 801bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 802bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 803bdcd8170SKalle Valo return -ERESTARTSYS; 804bdcd8170SKalle Valo } 805bdcd8170SKalle Valo 806cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 807240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8083450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8093450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 810bdcd8170SKalle Valo 811bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8128c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 813bdcd8170SKalle Valo 814bdcd8170SKalle Valo up(&ar->sem); 815bdcd8170SKalle Valo 81614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 817170826ddSVasanthakumar Thiagarajan 818bdcd8170SKalle Valo return 0; 819bdcd8170SKalle Valo } 820bdcd8170SKalle Valo 821240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 822bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 823bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 824bdcd8170SKalle Valo { 825240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 82659c98449SVasanthakumar Thiagarajan 82714ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 82814ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 82914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 830bdcd8170SKalle Valo } 831bdcd8170SKalle Valo 832f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 833551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 834bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 835bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 836bdcd8170SKalle Valo return; 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 839240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 840bdcd8170SKalle Valo return; 841bdcd8170SKalle Valo } 842bdcd8170SKalle Valo 843f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 844551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 845551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 846bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 847bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 848bdcd8170SKalle Valo return; 849bdcd8170SKalle Valo } 850bdcd8170SKalle Valo } 851bdcd8170SKalle Valo 8521de547d6SVasanthakumar Thiagarajan /* 8531de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8541de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8551de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8561de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8571de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8581de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8591de547d6SVasanthakumar Thiagarajan */ 860bdcd8170SKalle Valo 8611de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 862334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 863bdcd8170SKalle Valo return; 864bdcd8170SKalle Valo } 865bdcd8170SKalle Valo 86659c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 867bdcd8170SKalle Valo 86814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 869240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 870bdcd8170SKalle Valo bssid, NULL, 0, 871bdcd8170SKalle Valo NULL, 0, 872bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 873bdcd8170SKalle Valo GFP_KERNEL); 87414ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 875240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 876bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 877bdcd8170SKalle Valo } 878bdcd8170SKalle Valo 87914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 882bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 883bdcd8170SKalle Valo struct cfg80211_scan_request *request) 884bdcd8170SKalle Valo { 885d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 88659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8871276c9efSEdward Lu s8 n_channels = 0; 8881276c9efSEdward Lu u16 *channels = NULL; 889bdcd8170SKalle Valo int ret = 0; 890f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 891bdcd8170SKalle Valo 892990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 893bdcd8170SKalle Valo return -EIO; 894bdcd8170SKalle Valo 89510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 89610509f90SKalle Valo 897bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 89859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8991b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 900240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 90159c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 9021b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 9031b1e6ee3SJouni Malinen if (ret) { 904bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9051b1e6ee3SJouni Malinen return ret; 906bdcd8170SKalle Valo } 907bdcd8170SKalle Valo } 908bdcd8170SKalle Valo 909bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 910bdcd8170SKalle Valo u8 i; 911bdcd8170SKalle Valo 912bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 913bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 914bdcd8170SKalle Valo 915bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 916334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 917334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 918bdcd8170SKalle Valo request->ssids[i].ssid_len, 919bdcd8170SKalle Valo request->ssids[i].ssid); 920bdcd8170SKalle Valo } 921bdcd8170SKalle Valo 922080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 923334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 924334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 925b84da8c7SJouni Malinen request->ie, request->ie_len); 926b84da8c7SJouni Malinen if (ret) { 927b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 928b84da8c7SJouni Malinen "scan"); 929b84da8c7SJouni Malinen return ret; 930b84da8c7SJouni Malinen } 931b84da8c7SJouni Malinen 93211869befSJouni Malinen /* 93311869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 93411869befSJouni Malinen * channels. If the list is longer than the target supports, do not 93511869befSJouni Malinen * configure the list and instead, scan all available channels. 93611869befSJouni Malinen */ 93711869befSJouni Malinen if (request->n_channels > 0 && 93811869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9391276c9efSEdward Lu u8 i; 9401276c9efSEdward Lu 94111869befSJouni Malinen n_channels = request->n_channels; 9421276c9efSEdward Lu 9431276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9441276c9efSEdward Lu if (channels == NULL) { 9451276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9461276c9efSEdward Lu "scan all channels"); 9471276c9efSEdward Lu n_channels = 0; 9481276c9efSEdward Lu } 9491276c9efSEdward Lu 9501276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9511276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9521276c9efSEdward Lu } 9531276c9efSEdward Lu 95459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 955f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 956f1f92179SVasanthakumar Thiagarajan 9575b35dff0SRaja Mani vif->scan_req = request; 9585b35dff0SRaja Mani 9593ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9603ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9613ca9d1fcSAarthi Thiruvengadam /* 9623ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9633ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9643ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9653ca9d1fcSAarthi Thiruvengadam * probe requests 9663ca9d1fcSAarthi Thiruvengadam */ 9673ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9683ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 96913423c31SVasanthakumar Thiagarajan false, 0, 97013423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 97113423c31SVasanthakumar Thiagarajan n_channels, channels, 97213423c31SVasanthakumar Thiagarajan request->no_cck, 9733ca9d1fcSAarthi Thiruvengadam request->rates); 9743ca9d1fcSAarthi Thiruvengadam } else { 9753ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9763ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 97713423c31SVasanthakumar Thiagarajan false, 0, 97813423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 97913423c31SVasanthakumar Thiagarajan n_channels, channels); 9803ca9d1fcSAarthi Thiruvengadam } 9815b35dff0SRaja Mani if (ret) { 982bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 9835b35dff0SRaja Mani vif->scan_req = NULL; 9845b35dff0SRaja Mani } 985bdcd8170SKalle Valo 9861276c9efSEdward Lu kfree(channels); 9871276c9efSEdward Lu 988bdcd8170SKalle Valo return ret; 989bdcd8170SKalle Valo } 990bdcd8170SKalle Valo 9911c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 992bdcd8170SKalle Valo { 993240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9946fd1eaceSKalle Valo int i; 995bdcd8170SKalle Valo 9961c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9971c17d313SKalle Valo aborted ? " aborted" : ""); 998bdcd8170SKalle Valo 99914ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10006fd1eaceSKalle Valo return; 10016fd1eaceSKalle Valo 10021c17d313SKalle Valo if (aborted) 10036fd1eaceSKalle Valo goto out; 1004bdcd8170SKalle Valo 100514ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 100614ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1007334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1008334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1009bdcd8170SKalle Valo 0, NULL); 1010bdcd8170SKalle Valo } 1011bdcd8170SKalle Valo } 10126fd1eaceSKalle Valo 10136fd1eaceSKalle Valo out: 1014cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 101514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1016bdcd8170SKalle Valo } 1017bdcd8170SKalle Valo 1018bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1019bdcd8170SKalle Valo u8 key_index, bool pairwise, 1020bdcd8170SKalle Valo const u8 *mac_addr, 1021bdcd8170SKalle Valo struct key_params *params) 1022bdcd8170SKalle Valo { 1023d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 102459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1025bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10264a8ce2fdSSujith Manoharan int seq_len; 1027bdcd8170SKalle Valo u8 key_usage; 1028bdcd8170SKalle Valo u8 key_type; 1029bdcd8170SKalle Valo 1030990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1031bdcd8170SKalle Valo return -EIO; 1032bdcd8170SKalle Valo 1033837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1034837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1035837cb97eSJouni Malinen return -EINVAL; 1036240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1037240d2799SVasanthakumar Thiagarajan params->key); 1038837cb97eSJouni Malinen } 1039837cb97eSJouni Malinen 1040792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1041bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1042bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1043bdcd8170SKalle Valo key_index); 1044bdcd8170SKalle Valo return -ENOENT; 1045bdcd8170SKalle Valo } 1046bdcd8170SKalle Valo 10476f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1048bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo if (pairwise) 1051bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1052bdcd8170SKalle Valo else 1053bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1054bdcd8170SKalle Valo 10554a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10565e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10575e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10585e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10595e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10605e07021eSDai Shuibing } 1061bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10625e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1063bdcd8170SKalle Valo return -EINVAL; 1064bdcd8170SKalle Valo 1065bdcd8170SKalle Valo key->key_len = params->key_len; 1066bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10675e07021eSDai Shuibing key->seq_len = seq_len; 1068bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1069bdcd8170SKalle Valo key->cipher = params->cipher; 1070bdcd8170SKalle Valo 1071bdcd8170SKalle Valo switch (key->cipher) { 1072bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1073bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1074bdcd8170SKalle Valo key_type = WEP_CRYPT; 1075bdcd8170SKalle Valo break; 1076bdcd8170SKalle Valo 1077bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1078bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1079bdcd8170SKalle Valo break; 1080bdcd8170SKalle Valo 1081bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1082bdcd8170SKalle Valo key_type = AES_CRYPT; 1083bdcd8170SKalle Valo break; 10845e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10855e07021eSDai Shuibing key_type = WAPI_CRYPT; 10865e07021eSDai Shuibing break; 1087bdcd8170SKalle Valo 1088bdcd8170SKalle Valo default: 1089bdcd8170SKalle Valo return -ENOTSUPP; 1090bdcd8170SKalle Valo } 1091bdcd8170SKalle Valo 1092ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1093ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1094ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1095de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1096bdcd8170SKalle Valo 1097bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1098bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1099bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1100bdcd8170SKalle Valo key_usage, key->seq_len); 1101bdcd8170SKalle Valo 1102f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11034703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1104cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11059a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11069a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11079a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11089a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11099a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 111059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 11119a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 11129a5b1318SJouni Malinen "key configuration until AP mode has been " 11139a5b1318SJouni Malinen "started\n"); 11149a5b1318SJouni Malinen /* 11159a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11169a5b1318SJouni Malinen * the connected event is received from the target. 11179a5b1318SJouni Malinen */ 11189a5b1318SJouni Malinen return 0; 11199a5b1318SJouni Malinen } 11209a5b1318SJouni Malinen } 11219a5b1318SJouni Malinen 1122f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 112359c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1124151411e8SJouni Malinen /* 1125151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1126151411e8SJouni Malinen * the AP mode has properly started 1127151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1128151411e8SJouni Malinen */ 1129151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1130151411e8SJouni Malinen "until AP mode has been started\n"); 11316f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11326f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11336f2a73f9SVasanthakumar Thiagarajan key->key_len); 1134151411e8SJouni Malinen return 0; 1135151411e8SJouni Malinen } 1136151411e8SJouni Malinen 11377cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1138bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1139f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1140f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1141bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1142bdcd8170SKalle Valo } 1143bdcd8170SKalle Valo 1144bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1145bdcd8170SKalle Valo u8 key_index, bool pairwise, 1146bdcd8170SKalle Valo const u8 *mac_addr) 1147bdcd8170SKalle Valo { 1148d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11496f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1150bdcd8170SKalle Valo 1151bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1152bdcd8170SKalle Valo 1153990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1154bdcd8170SKalle Valo return -EIO; 1155bdcd8170SKalle Valo 1156792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1157bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1158bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1159bdcd8170SKalle Valo key_index); 1160bdcd8170SKalle Valo return -ENOENT; 1161bdcd8170SKalle Valo } 1162bdcd8170SKalle Valo 11636f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1164bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1165bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1166bdcd8170SKalle Valo return 0; 1167bdcd8170SKalle Valo } 1168bdcd8170SKalle Valo 11696f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1170bdcd8170SKalle Valo 1171334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1172bdcd8170SKalle Valo } 1173bdcd8170SKalle Valo 1174bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1175bdcd8170SKalle Valo u8 key_index, bool pairwise, 1176bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1177bdcd8170SKalle Valo void (*callback) (void *cookie, 1178bdcd8170SKalle Valo struct key_params *)) 1179bdcd8170SKalle Valo { 11806f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1181bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1182bdcd8170SKalle Valo struct key_params params; 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1185bdcd8170SKalle Valo 1186990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1187bdcd8170SKalle Valo return -EIO; 1188bdcd8170SKalle Valo 1189792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1191bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1192bdcd8170SKalle Valo key_index); 1193bdcd8170SKalle Valo return -ENOENT; 1194bdcd8170SKalle Valo } 1195bdcd8170SKalle Valo 11966f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1197bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1198bdcd8170SKalle Valo params.cipher = key->cipher; 1199bdcd8170SKalle Valo params.key_len = key->key_len; 1200bdcd8170SKalle Valo params.seq_len = key->seq_len; 1201bdcd8170SKalle Valo params.seq = key->seq; 1202bdcd8170SKalle Valo params.key = key->key; 1203bdcd8170SKalle Valo 1204bdcd8170SKalle Valo callback(cookie, ¶ms); 1205bdcd8170SKalle Valo 1206bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1207bdcd8170SKalle Valo } 1208bdcd8170SKalle Valo 1209bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1210bdcd8170SKalle Valo struct net_device *ndev, 1211bdcd8170SKalle Valo u8 key_index, bool unicast, 1212bdcd8170SKalle Valo bool multicast) 1213bdcd8170SKalle Valo { 1214d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 121559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1216bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1217bdcd8170SKalle Valo u8 key_usage; 1218229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1219bdcd8170SKalle Valo 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1221bdcd8170SKalle Valo 1222990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1223bdcd8170SKalle Valo return -EIO; 1224bdcd8170SKalle Valo 1225792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1226bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1227bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1228bdcd8170SKalle Valo __func__, key_index); 1229bdcd8170SKalle Valo return -ENOENT; 1230bdcd8170SKalle Valo } 1231bdcd8170SKalle Valo 12326f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1233bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1234bdcd8170SKalle Valo __func__, key_index); 1235bdcd8170SKalle Valo return -EINVAL; 1236bdcd8170SKalle Valo } 1237bdcd8170SKalle Valo 12383450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12396f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1240bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12413450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1242bdcd8170SKalle Valo key_usage |= TX_USAGE; 1243229ed6b5SEdward Lu if (unicast) 12443450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1245229ed6b5SEdward Lu if (multicast) 12463450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1247bdcd8170SKalle Valo 1248f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12499a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12509a5b1318SJouni Malinen 1251f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1252334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1253229ed6b5SEdward Lu key_type, key_usage, 1254f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1255f4bb9a6fSJouni Malinen key->key, 1256bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1257bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1258bdcd8170SKalle Valo } 1259bdcd8170SKalle Valo 1260240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1261bdcd8170SKalle Valo bool ismcast) 1262bdcd8170SKalle Valo { 1263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1264bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1265bdcd8170SKalle Valo 1266240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1267bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1268bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1269bdcd8170SKalle Valo GFP_KERNEL); 1270bdcd8170SKalle Valo } 1271bdcd8170SKalle Valo 1272bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1273bdcd8170SKalle Valo { 1274bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1275990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1276bdcd8170SKalle Valo int ret; 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1279bdcd8170SKalle Valo changed); 1280bdcd8170SKalle Valo 1281990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1282990bd915SVasanthakumar Thiagarajan if (!vif) 1283990bd915SVasanthakumar Thiagarajan return -EIO; 1284990bd915SVasanthakumar Thiagarajan 1285990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1286bdcd8170SKalle Valo return -EIO; 1287bdcd8170SKalle Valo 1288bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1289bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1290bdcd8170SKalle Valo if (ret != 0) { 1291bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1292bdcd8170SKalle Valo return -EIO; 1293bdcd8170SKalle Valo } 1294bdcd8170SKalle Valo } 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo return 0; 1297bdcd8170SKalle Valo } 1298bdcd8170SKalle Valo 1299bdcd8170SKalle Valo /* 1300bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1301bdcd8170SKalle Valo * data type from 2.6.36 onwards 1302bdcd8170SKalle Valo */ 1303bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1304bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1305b992a285SLuis R. Rodriguez int mbm) 1306bdcd8170SKalle Valo { 1307bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1308990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1309b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1310bdcd8170SKalle Valo 1311bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1312bdcd8170SKalle Valo type, dbm); 1313bdcd8170SKalle Valo 1314990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1315990bd915SVasanthakumar Thiagarajan if (!vif) 1316990bd915SVasanthakumar Thiagarajan return -EIO; 1317990bd915SVasanthakumar Thiagarajan 1318990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1319bdcd8170SKalle Valo return -EIO; 1320bdcd8170SKalle Valo 1321bdcd8170SKalle Valo switch (type) { 1322bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1323bdcd8170SKalle Valo return 0; 1324bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1325d0d670abSKalle Valo ar->tx_pwr = dbm; 1326bdcd8170SKalle Valo break; 1327bdcd8170SKalle Valo default: 1328bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1329bdcd8170SKalle Valo __func__, type); 1330bdcd8170SKalle Valo return -EOPNOTSUPP; 1331bdcd8170SKalle Valo } 1332bdcd8170SKalle Valo 1333d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1334bdcd8170SKalle Valo 1335bdcd8170SKalle Valo return 0; 1336bdcd8170SKalle Valo } 1337bdcd8170SKalle Valo 1338bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1339bdcd8170SKalle Valo { 1340bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1341990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1342bdcd8170SKalle Valo 1343990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1344990bd915SVasanthakumar Thiagarajan if (!vif) 1345990bd915SVasanthakumar Thiagarajan return -EIO; 1346990bd915SVasanthakumar Thiagarajan 1347990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1348bdcd8170SKalle Valo return -EIO; 1349bdcd8170SKalle Valo 135059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1351bdcd8170SKalle Valo ar->tx_pwr = 0; 1352bdcd8170SKalle Valo 1353990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1354bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1355bdcd8170SKalle Valo return -EIO; 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1359bdcd8170SKalle Valo 5 * HZ); 1360bdcd8170SKalle Valo 1361bdcd8170SKalle Valo if (signal_pending(current)) { 1362bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1363bdcd8170SKalle Valo return -EINTR; 1364bdcd8170SKalle Valo } 1365bdcd8170SKalle Valo } 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1368bdcd8170SKalle Valo return 0; 1369bdcd8170SKalle Valo } 1370bdcd8170SKalle Valo 1371bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1372bdcd8170SKalle Valo struct net_device *dev, 1373bdcd8170SKalle Valo bool pmgmt, int timeout) 1374bdcd8170SKalle Valo { 1375bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1376bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1377334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1380bdcd8170SKalle Valo __func__, pmgmt, timeout); 1381bdcd8170SKalle Valo 1382990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo 1385bdcd8170SKalle Valo if (pmgmt) { 1386bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1387bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1388bdcd8170SKalle Valo } else { 1389bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1390bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1391bdcd8170SKalle Valo } 1392bdcd8170SKalle Valo 1393334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1394334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1395bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1396bdcd8170SKalle Valo return -EIO; 1397bdcd8170SKalle Valo } 1398bdcd8170SKalle Valo 1399bdcd8170SKalle Valo return 0; 1400bdcd8170SKalle Valo } 1401bdcd8170SKalle Valo 140255055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 140355055976SVasanthakumar Thiagarajan char *name, 140455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 140555055976SVasanthakumar Thiagarajan u32 *flags, 140655055976SVasanthakumar Thiagarajan struct vif_params *params) 140755055976SVasanthakumar Thiagarajan { 140855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 140955055976SVasanthakumar Thiagarajan struct net_device *ndev; 141055055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 141155055976SVasanthakumar Thiagarajan 141271f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 141355055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 141455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 141555055976SVasanthakumar Thiagarajan } 141655055976SVasanthakumar Thiagarajan 141755055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 141855055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 141955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 142055055976SVasanthakumar Thiagarajan } 142155055976SVasanthakumar Thiagarajan 142255055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 142355055976SVasanthakumar Thiagarajan if (!ndev) 142455055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 142555055976SVasanthakumar Thiagarajan 142655055976SVasanthakumar Thiagarajan ar->num_vif++; 142755055976SVasanthakumar Thiagarajan 142855055976SVasanthakumar Thiagarajan return ndev; 142955055976SVasanthakumar Thiagarajan } 143055055976SVasanthakumar Thiagarajan 143155055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 143255055976SVasanthakumar Thiagarajan struct net_device *ndev) 143355055976SVasanthakumar Thiagarajan { 143455055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 143555055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 143655055976SVasanthakumar Thiagarajan 143711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 143855055976SVasanthakumar Thiagarajan list_del(&vif->list); 143911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 144055055976SVasanthakumar Thiagarajan 144155055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 144255055976SVasanthakumar Thiagarajan 1443c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 144455055976SVasanthakumar Thiagarajan 144555055976SVasanthakumar Thiagarajan return 0; 144655055976SVasanthakumar Thiagarajan } 144755055976SVasanthakumar Thiagarajan 1448bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1449bdcd8170SKalle Valo struct net_device *ndev, 1450bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1451bdcd8170SKalle Valo struct vif_params *params) 1452bdcd8170SKalle Valo { 1453f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1454bdcd8170SKalle Valo 1455bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1456bdcd8170SKalle Valo 1457bdcd8170SKalle Valo switch (type) { 1458bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1459f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1460bdcd8170SKalle Valo break; 1461bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1462f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1463bdcd8170SKalle Valo break; 14646e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1465f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14666e4604c8SJouni Malinen break; 14676b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1468f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14696b5e5d25SJouni Malinen break; 14706b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1471f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14726b5e5d25SJouni Malinen break; 1473bdcd8170SKalle Valo default: 1474bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1475bdcd8170SKalle Valo return -EOPNOTSUPP; 1476bdcd8170SKalle Valo } 1477bdcd8170SKalle Valo 1478551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1479bdcd8170SKalle Valo 1480bdcd8170SKalle Valo return 0; 1481bdcd8170SKalle Valo } 1482bdcd8170SKalle Valo 1483bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1484bdcd8170SKalle Valo struct net_device *dev, 1485bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1486bdcd8170SKalle Valo { 1487bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 148859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1489bdcd8170SKalle Valo int status; 1490bdcd8170SKalle Valo 1491990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1492bdcd8170SKalle Valo return -EIO; 1493bdcd8170SKalle Valo 14943450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14953450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1496bdcd8170SKalle Valo 1497bdcd8170SKalle Valo if (ibss_param->channel) 1498f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1499bdcd8170SKalle Valo 1500bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1501bdcd8170SKalle Valo /* 1502bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1503bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1504bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1505bdcd8170SKalle Valo * updated. 1506bdcd8170SKalle Valo */ 1507bdcd8170SKalle Valo return -EOPNOTSUPP; 1508bdcd8170SKalle Valo } 1509bdcd8170SKalle Valo 15108c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1511bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 15128c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15138c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1514bdcd8170SKalle Valo 1515240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1516bdcd8170SKalle Valo 1517240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1518bdcd8170SKalle Valo if (status) 1519bdcd8170SKalle Valo return status; 1520bdcd8170SKalle Valo 1521bdcd8170SKalle Valo if (ibss_param->privacy) { 1522240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1523240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1524bdcd8170SKalle Valo } else { 1525240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1526240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1527bdcd8170SKalle Valo } 1528bdcd8170SKalle Valo 1529f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1530bdcd8170SKalle Valo 1531bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1532bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1533bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1534bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1535bdcd8170SKalle Valo __func__, 15363450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15373450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1538f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1539bdcd8170SKalle Valo 1540334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15413450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15423450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15433450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15443450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15453450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1546f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15473ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 154859c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo return 0; 1551bdcd8170SKalle Valo } 1552bdcd8170SKalle Valo 1553bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1554bdcd8170SKalle Valo struct net_device *dev) 1555bdcd8170SKalle Valo { 15563450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1557bdcd8170SKalle Valo 1558990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1559bdcd8170SKalle Valo return -EIO; 1560bdcd8170SKalle Valo 1561240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15623450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15633450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1564bdcd8170SKalle Valo 1565bdcd8170SKalle Valo return 0; 1566bdcd8170SKalle Valo } 1567bdcd8170SKalle Valo 1568bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1569bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1570bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1571bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1572bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1573837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15745e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1575bdcd8170SKalle Valo }; 1576bdcd8170SKalle Valo 1577bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1578bdcd8170SKalle Valo { 1579bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1580bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1581bdcd8170SKalle Valo 36000, 48000, 54000 1582bdcd8170SKalle Valo }; 1583bdcd8170SKalle Valo u8 i; 1584bdcd8170SKalle Valo 1585bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1586bdcd8170SKalle Valo if (rate == legacy[i]) 1587bdcd8170SKalle Valo return true; 1588bdcd8170SKalle Valo 1589bdcd8170SKalle Valo return false; 1590bdcd8170SKalle Valo } 1591bdcd8170SKalle Valo 1592bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1593bdcd8170SKalle Valo { 1594bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1595bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1596bdcd8170SKalle Valo }; 1597bdcd8170SKalle Valo u8 i; 1598bdcd8170SKalle Valo 1599bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1600bdcd8170SKalle Valo if (rate == ht20[i]) { 1601bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1602bdcd8170SKalle Valo /* last rate uses sgi */ 1603bdcd8170SKalle Valo *sgi = true; 1604bdcd8170SKalle Valo else 1605bdcd8170SKalle Valo *sgi = false; 1606bdcd8170SKalle Valo 1607bdcd8170SKalle Valo *mcs = i; 1608bdcd8170SKalle Valo return true; 1609bdcd8170SKalle Valo } 1610bdcd8170SKalle Valo } 1611bdcd8170SKalle Valo return false; 1612bdcd8170SKalle Valo } 1613bdcd8170SKalle Valo 1614bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1615bdcd8170SKalle Valo { 1616bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1617bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1618bdcd8170SKalle Valo 150000 1619bdcd8170SKalle Valo }; 1620bdcd8170SKalle Valo u8 i; 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1623bdcd8170SKalle Valo if (rate == ht40[i]) { 1624bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1625bdcd8170SKalle Valo /* last rate uses sgi */ 1626bdcd8170SKalle Valo *sgi = true; 1627bdcd8170SKalle Valo else 1628bdcd8170SKalle Valo *sgi = false; 1629bdcd8170SKalle Valo 1630bdcd8170SKalle Valo *mcs = i; 1631bdcd8170SKalle Valo return true; 1632bdcd8170SKalle Valo } 1633bdcd8170SKalle Valo } 1634bdcd8170SKalle Valo 1635bdcd8170SKalle Valo return false; 1636bdcd8170SKalle Valo } 1637bdcd8170SKalle Valo 1638bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1639bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1640bdcd8170SKalle Valo { 1641bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 164259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1643bdcd8170SKalle Valo long left; 1644bdcd8170SKalle Valo bool sgi; 1645bdcd8170SKalle Valo s32 rate; 1646bdcd8170SKalle Valo int ret; 1647bdcd8170SKalle Valo u8 mcs; 1648bdcd8170SKalle Valo 16498c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1650bdcd8170SKalle Valo return -ENOENT; 1651bdcd8170SKalle Valo 1652bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1653bdcd8170SKalle Valo return -EBUSY; 1654bdcd8170SKalle Valo 1655b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1656bdcd8170SKalle Valo 1657334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1658bdcd8170SKalle Valo 1659bdcd8170SKalle Valo if (ret != 0) { 1660bdcd8170SKalle Valo up(&ar->sem); 1661bdcd8170SKalle Valo return -EIO; 1662bdcd8170SKalle Valo } 1663bdcd8170SKalle Valo 1664bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1665bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1666b95907a7SVasanthakumar Thiagarajan &vif->flags), 1667bdcd8170SKalle Valo WMI_TIMEOUT); 1668bdcd8170SKalle Valo 1669bdcd8170SKalle Valo up(&ar->sem); 1670bdcd8170SKalle Valo 1671bdcd8170SKalle Valo if (left == 0) 1672bdcd8170SKalle Valo return -ETIMEDOUT; 1673bdcd8170SKalle Valo else if (left < 0) 1674bdcd8170SKalle Valo return left; 1675bdcd8170SKalle Valo 1676b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1677b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1678bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1679b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1680bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1681bdcd8170SKalle Valo } 1682bdcd8170SKalle Valo 1683b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1684b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1685bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1686b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1687bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1688bdcd8170SKalle Valo } 1689bdcd8170SKalle Valo 1690b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1691bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1692bdcd8170SKalle Valo 1693b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1694bdcd8170SKalle Valo 1695bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1696bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1697bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1698bdcd8170SKalle Valo if (sgi) { 1699bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1700bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1701bdcd8170SKalle Valo } else { 1702bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1703bdcd8170SKalle Valo } 1704bdcd8170SKalle Valo 1705bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1706bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1707bdcd8170SKalle Valo if (sgi) { 1708bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1709bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1710bdcd8170SKalle Valo } else { 1711bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1712bdcd8170SKalle Valo } 1713bdcd8170SKalle Valo 1714bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1715bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1716bdcd8170SKalle Valo } else { 17179a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17189a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17199a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1720bdcd8170SKalle Valo return 0; 1721bdcd8170SKalle Valo } 1722bdcd8170SKalle Valo 1723bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1724bdcd8170SKalle Valo 172559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 172659c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1727f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 172832c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 172932c10874SJouni Malinen sinfo->bss_param.flags = 0; 1730cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1731cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 173232c10874SJouni Malinen } 173332c10874SJouni Malinen 1734bdcd8170SKalle Valo return 0; 1735bdcd8170SKalle Valo } 1736bdcd8170SKalle Valo 1737bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1738bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1739bdcd8170SKalle Valo { 1740bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1741334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1742334234b5SVasanthakumar Thiagarajan 1743334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1744bdcd8170SKalle Valo pmksa->pmkid, true); 1745bdcd8170SKalle Valo } 1746bdcd8170SKalle Valo 1747bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1748bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1749bdcd8170SKalle Valo { 1750bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1751334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1752334234b5SVasanthakumar Thiagarajan 1753334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1754bdcd8170SKalle Valo pmksa->pmkid, false); 1755bdcd8170SKalle Valo } 1756bdcd8170SKalle Valo 1757bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1758bdcd8170SKalle Valo { 1759bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 176059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 176159c98449SVasanthakumar Thiagarajan 176259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1763334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1764334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1765bdcd8170SKalle Valo return 0; 1766bdcd8170SKalle Valo } 1767bdcd8170SKalle Valo 1768d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1769d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17706cb3c714SRaja Mani { 1771d91e8eeeSRaja Mani int ret, pos; 1772d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17736cb3c714SRaja Mani u16 i; 17746cb3c714SRaja Mani 1775d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17766cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17776cb3c714SRaja Mani 17786cb3c714SRaja Mani /* 17796cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17806cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17816cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17826cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17836cb3c714SRaja Mani * then equivalent driver specific mask value is 17846cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17856cb3c714SRaja Mani */ 17866cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17876cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17886cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17896cb3c714SRaja Mani mask[pos] = 0xFF; 17906cb3c714SRaja Mani } 17916cb3c714SRaja Mani /* 17926cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17936cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17946cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17956cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17966cb3c714SRaja Mani */ 17976cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17986cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17996cb3c714SRaja Mani wow->patterns[i].pattern_len, 18006cb3c714SRaja Mani 0 /* pattern offset */, 18016cb3c714SRaja Mani wow->patterns[i].pattern, mask); 18026cb3c714SRaja Mani if (ret) 18036cb3c714SRaja Mani return ret; 18046cb3c714SRaja Mani } 18056cb3c714SRaja Mani 1806d91e8eeeSRaja Mani if (wow->disconnect) 1807d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1808d91e8eeeSRaja Mani 1809d91e8eeeSRaja Mani if (wow->magic_pkt) 1810d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1811d91e8eeeSRaja Mani 1812d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1813d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1814d91e8eeeSRaja Mani 1815d91e8eeeSRaja Mani if (wow->eap_identity_req) 1816d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1817d91e8eeeSRaja Mani 1818d91e8eeeSRaja Mani if (wow->four_way_handshake) 1819d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1820d91e8eeeSRaja Mani 1821d91e8eeeSRaja Mani return 0; 1822d91e8eeeSRaja Mani } 1823d91e8eeeSRaja Mani 1824d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1825d91e8eeeSRaja Mani { 1826d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1827d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1828d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1829d91e8eeeSRaja Mani 0x00, 0x08 }; 1830d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1832d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1833d91e8eeeSRaja Mani 0x00, 0x7f }; 1834d91e8eeeSRaja Mani u8 unicst_offset = 0; 1835d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1836d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1837d91e8eeeSRaja Mani u8 arp_offset = 20; 1838d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1839d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1840d91e8eeeSRaja Mani u8 discvr_offset = 38; 1841d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1842d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1843d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1844d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1845d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1846d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1847d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1848d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1849d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1850d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1851d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1852d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1853d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1854d91e8eeeSRaja Mani int ret; 1855d91e8eeeSRaja Mani 1856d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1857d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1858d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1859d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1860d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1861d91e8eeeSRaja Mani if (ret) { 1862d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1863d91e8eeeSRaja Mani return ret; 1864d91e8eeeSRaja Mani } 1865d91e8eeeSRaja Mani 1866d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1867d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1868d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1869d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1870d91e8eeeSRaja Mani arp_pattern, arp_mask); 1871d91e8eeeSRaja Mani if (ret) { 1872d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1873d91e8eeeSRaja Mani return ret; 1874d91e8eeeSRaja Mani } 1875d91e8eeeSRaja Mani 1876d91e8eeeSRaja Mani /* 1877d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1878d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1879d91e8eeeSRaja Mani */ 1880d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1881d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1882d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1883d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1884d91e8eeeSRaja Mani if (ret) { 1885d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1886d91e8eeeSRaja Mani return ret; 1887d91e8eeeSRaja Mani } 1888d91e8eeeSRaja Mani 1889d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1890d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1891d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1892d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1893d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1894d91e8eeeSRaja Mani if (ret) { 1895d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1896d91e8eeeSRaja Mani return ret; 1897d91e8eeeSRaja Mani } 1898d91e8eeeSRaja Mani 1899d91e8eeeSRaja Mani return 0; 1900d91e8eeeSRaja Mani } 1901d91e8eeeSRaja Mani 1902d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1903d91e8eeeSRaja Mani { 1904d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1905d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1906d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1907d91e8eeeSRaja Mani u8 discvr_offset = 38; 1908d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1909d91e8eeeSRaja Mani int ret; 1910d91e8eeeSRaja Mani 1911d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1912d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1913d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1914d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1915d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1916d91e8eeeSRaja Mani mac_mask); 1917d91e8eeeSRaja Mani if (ret) { 1918d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1919d91e8eeeSRaja Mani return ret; 1920d91e8eeeSRaja Mani } 1921d91e8eeeSRaja Mani 1922d91e8eeeSRaja Mani /* 1923d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1924d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1925d91e8eeeSRaja Mani */ 1926d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1927d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1928d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1929d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1930d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1931d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1932d91e8eeeSRaja Mani if (ret) { 1933d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1934d91e8eeeSRaja Mani "pattern\n"); 1935d91e8eeeSRaja Mani return ret; 1936d91e8eeeSRaja Mani } 1937d91e8eeeSRaja Mani } 1938d91e8eeeSRaja Mani 1939d91e8eeeSRaja Mani return 0; 1940d91e8eeeSRaja Mani } 1941d91e8eeeSRaja Mani 1942055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 1943055bde49SRaja Mani { 1944055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1945055bde49SRaja Mani } 1946055bde49SRaja Mani 1947055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 1948055bde49SRaja Mani { 1949055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 1950055bde49SRaja Mani } 1951055bde49SRaja Mani 1952055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 1953055bde49SRaja Mani { 1954055bde49SRaja Mani int ret, left; 1955055bde49SRaja Mani 1956055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1957055bde49SRaja Mani 1958055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 1959055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 1960055bde49SRaja Mani if (ret) 1961055bde49SRaja Mani return ret; 1962055bde49SRaja Mani 1963055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1964055bde49SRaja Mani is_hsleep_mode_procsed(vif), 1965055bde49SRaja Mani WMI_TIMEOUT); 1966055bde49SRaja Mani if (left == 0) { 1967055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 1968055bde49SRaja Mani ret = -ETIMEDOUT; 1969055bde49SRaja Mani } else if (left < 0) { 1970055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 1971055bde49SRaja Mani left); 1972055bde49SRaja Mani ret = left; 1973055bde49SRaja Mani } 1974055bde49SRaja Mani 1975055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 1976055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1977055bde49SRaja Mani is_ctrl_ep_empty(ar), 1978055bde49SRaja Mani WMI_TIMEOUT); 1979055bde49SRaja Mani if (left == 0) { 1980055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 1981055bde49SRaja Mani ret = -ETIMEDOUT; 1982055bde49SRaja Mani } else if (left < 0) { 1983055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 1984055bde49SRaja Mani ret = left; 1985055bde49SRaja Mani } 1986055bde49SRaja Mani } 1987055bde49SRaja Mani 1988055bde49SRaja Mani return ret; 1989055bde49SRaja Mani } 1990055bde49SRaja Mani 1991d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1992d91e8eeeSRaja Mani { 1993d91e8eeeSRaja Mani struct in_device *in_dev; 1994d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1995d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1996055bde49SRaja Mani int ret; 1997d91e8eeeSRaja Mani u32 filter = 0; 1998ce0dc0cfSRaja Mani u16 i, bmiss_time; 1999d91e8eeeSRaja Mani u8 index = 0; 2000d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2001d91e8eeeSRaja Mani 2002d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2003d91e8eeeSRaja Mani if (!vif) 2004d91e8eeeSRaja Mani return -EIO; 2005d91e8eeeSRaja Mani 2006d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2007d91e8eeeSRaja Mani return -EIO; 2008d91e8eeeSRaja Mani 2009d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 20103c411a43SRaja Mani return -ENOTCONN; 2011d91e8eeeSRaja Mani 2012d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2013d91e8eeeSRaja Mani return -EINVAL; 2014d91e8eeeSRaja Mani 2015d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2016d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2017d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2018d91e8eeeSRaja Mani WOW_LIST_ID, i); 2019d91e8eeeSRaja Mani 2020d91e8eeeSRaja Mani /* 2021d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2022d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2023d91e8eeeSRaja Mani * the user. 2024d91e8eeeSRaja Mani */ 2025d91e8eeeSRaja Mani if (wow) 2026d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2027d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2028d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2029d91e8eeeSRaja Mani else 2030d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2031d91e8eeeSRaja Mani 2032d91e8eeeSRaja Mani if (ret) 2033d91e8eeeSRaja Mani return ret; 2034d91e8eeeSRaja Mani 2035390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2036390a8c8fSRaja Mani 2037ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2038ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2039ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2040ce0dc0cfSRaja Mani 0); 2041ce0dc0cfSRaja Mani if (ret) 2042ce0dc0cfSRaja Mani return ret; 2043ce0dc0cfSRaja Mani 2044ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2045ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2046ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2047ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2048ce0dc0cfSRaja Mani 2049ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2050ce0dc0cfSRaja Mani bmiss_time, 0); 2051ce0dc0cfSRaja Mani if (ret) 2052ce0dc0cfSRaja Mani return ret; 2053ce0dc0cfSRaja Mani 2054ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2055ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2056ce0dc0cfSRaja Mani 0, 0, 0, 0); 2057ce0dc0cfSRaja Mani if (ret) 2058ce0dc0cfSRaja Mani return ret; 2059ce0dc0cfSRaja Mani } 2060ce0dc0cfSRaja Mani 2061390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2062390a8c8fSRaja Mani 2063c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2064c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2065c08631c6SRaja Mani if (!in_dev) 2066c08631c6SRaja Mani goto skip_arp; 2067c08631c6SRaja Mani 2068c08631c6SRaja Mani ifa = in_dev->ifa_list; 2069c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2070c08631c6SRaja Mani 2071c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2072c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2073c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2074c08631c6SRaja Mani ifa = ifa->ifa_next; 2075c08631c6SRaja Mani index++; 2076c08631c6SRaja Mani } 2077c08631c6SRaja Mani 2078c08631c6SRaja Mani if (ifa) { 2079c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2080c08631c6SRaja Mani return -EINVAL; 2081c08631c6SRaja Mani } 2082c08631c6SRaja Mani 2083c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2084c08631c6SRaja Mani if (ret) { 2085c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2086c08631c6SRaja Mani return ret; 2087c08631c6SRaja Mani } 2088c08631c6SRaja Mani 2089c08631c6SRaja Mani skip_arp: 20906cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20916cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20926cb3c714SRaja Mani filter, 20936cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20946cb3c714SRaja Mani if (ret) 20956cb3c714SRaja Mani return ret; 20966cb3c714SRaja Mani 2097055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 20986cb3c714SRaja Mani if (ret) 20996cb3c714SRaja Mani return ret; 21006cb3c714SRaja Mani 2101055bde49SRaja Mani return 0; 21026cb3c714SRaja Mani } 21036cb3c714SRaja Mani 21046cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 21056cb3c714SRaja Mani { 21066cb3c714SRaja Mani struct ath6kl_vif *vif; 21076cb3c714SRaja Mani int ret; 21086cb3c714SRaja Mani 21096cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 21106cb3c714SRaja Mani if (!vif) 21116cb3c714SRaja Mani return -EIO; 21126cb3c714SRaja Mani 2113390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2114390a8c8fSRaja Mani 21156cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21166cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2117390a8c8fSRaja Mani if (ret) { 2118390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2119390a8c8fSRaja Mani "wow resume: %d\n", ret); 2120390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21216cb3c714SRaja Mani return ret; 21226cb3c714SRaja Mani } 21236cb3c714SRaja Mani 2124ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2125ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2126ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2127ce0dc0cfSRaja Mani if (ret) 2128ce0dc0cfSRaja Mani return ret; 2129ce0dc0cfSRaja Mani 2130ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2131ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2132ce0dc0cfSRaja Mani if (ret) 2133ce0dc0cfSRaja Mani return ret; 2134ce0dc0cfSRaja Mani 2135ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2136ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2137ce0dc0cfSRaja Mani if (ret) 2138ce0dc0cfSRaja Mani return ret; 2139ce0dc0cfSRaja Mani } 2140ce0dc0cfSRaja Mani 2141390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2142390a8c8fSRaja Mani 2143390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2144390a8c8fSRaja Mani 2145390a8c8fSRaja Mani return 0; 2146390a8c8fSRaja Mani } 2147390a8c8fSRaja Mani 214840abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 214940abc2deSRaja Mani { 215040abc2deSRaja Mani struct ath6kl_vif *vif; 215140abc2deSRaja Mani int ret; 215240abc2deSRaja Mani 215340abc2deSRaja Mani vif = ath6kl_vif_first(ar); 215440abc2deSRaja Mani if (!vif) 215540abc2deSRaja Mani return -EIO; 215640abc2deSRaja Mani 215740abc2deSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 215840abc2deSRaja Mani return -EIO; 215940abc2deSRaja Mani 216040abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 216140abc2deSRaja Mani 216240abc2deSRaja Mani /* Save the current power mode before enabling power save */ 216340abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 216440abc2deSRaja Mani 216540abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 216640abc2deSRaja Mani if (ret) 216740abc2deSRaja Mani return ret; 216840abc2deSRaja Mani 216940abc2deSRaja Mani /* Disable WOW mode */ 217040abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 217140abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 217240abc2deSRaja Mani 0, 0); 217340abc2deSRaja Mani if (ret) 217440abc2deSRaja Mani return ret; 217540abc2deSRaja Mani 217640abc2deSRaja Mani /* Flush all non control pkts in TX path */ 217740abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 217840abc2deSRaja Mani 217940abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 218040abc2deSRaja Mani if (ret) 218140abc2deSRaja Mani return ret; 218240abc2deSRaja Mani 218340abc2deSRaja Mani return 0; 218440abc2deSRaja Mani } 218540abc2deSRaja Mani 218640abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 218740abc2deSRaja Mani { 218840abc2deSRaja Mani struct ath6kl_vif *vif; 218940abc2deSRaja Mani int ret; 219040abc2deSRaja Mani 219140abc2deSRaja Mani vif = ath6kl_vif_first(ar); 219240abc2deSRaja Mani 219340abc2deSRaja Mani if (!vif) 219440abc2deSRaja Mani return -EIO; 219540abc2deSRaja Mani 219640abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 219740abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 219840abc2deSRaja Mani ar->wmi->saved_pwr_mode); 219940abc2deSRaja Mani if (ret) 220040abc2deSRaja Mani return ret; 220140abc2deSRaja Mani } 220240abc2deSRaja Mani 220340abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 220440abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 220540abc2deSRaja Mani if (ret) 220640abc2deSRaja Mani return ret; 220740abc2deSRaja Mani 220840abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 220940abc2deSRaja Mani 221040abc2deSRaja Mani /* Reset scan parameter to default values */ 221140abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 221240abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 221340abc2deSRaja Mani if (ret) 221440abc2deSRaja Mani return ret; 221540abc2deSRaja Mani 221640abc2deSRaja Mani return 0; 221740abc2deSRaja Mani } 221840abc2deSRaja Mani 221952d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22200f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22210f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 222252d81a68SKalle Valo { 22233d79499cSVivek Natarajan struct ath6kl_vif *vif; 2224390a8c8fSRaja Mani enum ath6kl_state prev_state; 222552d81a68SKalle Valo int ret; 222652d81a68SKalle Valo 222752d81a68SKalle Valo switch (mode) { 2228d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2229d7c44e0bSRaja Mani 2230d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2231d7c44e0bSRaja Mani 2232d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2233d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2234d7c44e0bSRaja Mani 2235390a8c8fSRaja Mani prev_state = ar->state; 2236390a8c8fSRaja Mani 2237d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2238390a8c8fSRaja Mani if (ret) { 2239390a8c8fSRaja Mani ar->state = prev_state; 2240d7c44e0bSRaja Mani return ret; 2241390a8c8fSRaja Mani } 22421e9a905dSRaja Mani 2243d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2244d7c44e0bSRaja Mani break; 2245d7c44e0bSRaja Mani 224652d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2247524441e3SRaja Mani 224840abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2249524441e3SRaja Mani 225040abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 225152d81a68SKalle Valo if (ret) { 225240abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 225340abc2deSRaja Mani return ret; 225452d81a68SKalle Valo } 225552d81a68SKalle Valo 225676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 225776a9fbe2SKalle Valo 225852d81a68SKalle Valo break; 2259b4b2a0b1SKalle Valo 2260b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2261524441e3SRaja Mani 22627125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2263524441e3SRaja Mani 2264b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2265b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2266b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2267b4b2a0b1SKalle Valo break; 2268b4b2a0b1SKalle Valo } 2269b4b2a0b1SKalle Valo 2270b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2271b4b2a0b1SKalle Valo 2272b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2273b4b2a0b1SKalle Valo if (ret) { 2274b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2275b4b2a0b1SKalle Valo ret); 2276b4b2a0b1SKalle Valo } 2277b4b2a0b1SKalle Valo 2278b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2279b4b2a0b1SKalle Valo 2280b4b2a0b1SKalle Valo break; 2281b4b2a0b1SKalle Valo 228210509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 228310509f90SKalle Valo /* 228410509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 228510509f90SKalle Valo * wow mode and sleeping most of the time. 228610509f90SKalle Valo */ 228710509f90SKalle Valo break; 228810509f90SKalle Valo 2289b4b2a0b1SKalle Valo default: 2290b4b2a0b1SKalle Valo break; 229152d81a68SKalle Valo } 229252d81a68SKalle Valo 22933d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 22943d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 22953d79499cSVivek Natarajan 229652d81a68SKalle Valo return 0; 229752d81a68SKalle Valo } 2298d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 229952d81a68SKalle Valo 230052d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 230152d81a68SKalle Valo { 230276a9fbe2SKalle Valo int ret; 230376a9fbe2SKalle Valo 230476a9fbe2SKalle Valo switch (ar->state) { 2305d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2306d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2307d7c44e0bSRaja Mani 2308d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2309d7c44e0bSRaja Mani if (ret) { 2310d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2311d7c44e0bSRaja Mani return ret; 2312d7c44e0bSRaja Mani } 2313d7c44e0bSRaja Mani 2314d7c44e0bSRaja Mani break; 2315d7c44e0bSRaja Mani 231676a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 231740abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 231840abc2deSRaja Mani 231940abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 232076a9fbe2SKalle Valo if (ret) { 232140abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 232240abc2deSRaja Mani return ret; 232376a9fbe2SKalle Valo } 232476a9fbe2SKalle Valo break; 232576a9fbe2SKalle Valo 2326b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2327b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2328b4b2a0b1SKalle Valo 2329b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2330b4b2a0b1SKalle Valo if (ret) { 2331b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2332b4b2a0b1SKalle Valo return ret; 2333b4b2a0b1SKalle Valo } 2334d7c44e0bSRaja Mani break; 2335b4b2a0b1SKalle Valo 233610509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 233710509f90SKalle Valo break; 233810509f90SKalle Valo 233976a9fbe2SKalle Valo default: 234076a9fbe2SKalle Valo break; 234152d81a68SKalle Valo } 234252d81a68SKalle Valo 234352d81a68SKalle Valo return 0; 234452d81a68SKalle Valo } 2345d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 234652d81a68SKalle Valo 2347abcb344bSKalle Valo #ifdef CONFIG_PM 234852d81a68SKalle Valo 234952d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 235052d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2351abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2352abcb344bSKalle Valo { 2353abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2354abcb344bSKalle Valo 23550f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2356abcb344bSKalle Valo } 2357aa6cffc1SChilam Ng 235852d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2359aa6cffc1SChilam Ng { 2360aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2361aa6cffc1SChilam Ng 2362aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2363aa6cffc1SChilam Ng } 2364a918fb3cSRaja Mani 2365a918fb3cSRaja Mani /* 2366a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2367a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2368a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2369a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2370a918fb3cSRaja Mani * 2371a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2372a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2373a918fb3cSRaja Mani * 2374a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2375a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2376a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2377a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2378a918fb3cSRaja Mani * 2379a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2380a918fb3cSRaja Mani */ 2381a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2382a918fb3cSRaja Mani { 2383390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2384390a8c8fSRaja Mani return; 2385390a8c8fSRaja Mani 2386a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2387a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2388a918fb3cSRaja Mani } 2389a918fb3cSRaja Mani 2390a918fb3cSRaja Mani #else 2391a918fb3cSRaja Mani 2392a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2393a918fb3cSRaja Mani { 2394a918fb3cSRaja Mani } 2395abcb344bSKalle Valo #endif 2396abcb344bSKalle Valo 23976a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 23986a7c9badSJouni Malinen struct ieee80211_channel *chan, 23996a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 24006a7c9badSJouni Malinen { 2401e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2402e68f6750SSujith Manoharan 2403e68f6750SSujith Manoharan /* 2404e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2405e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2406e68f6750SSujith Manoharan * 2407e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2408e68f6750SSujith Manoharan */ 2409e68f6750SSujith Manoharan if (!dev) 2410e68f6750SSujith Manoharan return -EBUSY; 2411e68f6750SSujith Manoharan 2412e68f6750SSujith Manoharan vif = netdev_priv(dev); 24136a7c9badSJouni Malinen 2414990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24156a7c9badSJouni Malinen return -EIO; 24166a7c9badSJouni Malinen 24176a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 24186a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2419cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 24206a7c9badSJouni Malinen 24216a7c9badSJouni Malinen return 0; 24226a7c9badSJouni Malinen } 24236a7c9badSJouni Malinen 24248bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 24258bdfbf40SJouni Malinen { 24268bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 24278bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 24288bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 24298bdfbf40SJouni Malinen } 24308bdfbf40SJouni Malinen 2431334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2432334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 24338bdfbf40SJouni Malinen { 2434334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24358bdfbf40SJouni Malinen const u8 *pos; 24368bdfbf40SJouni Malinen u8 *buf = NULL; 24378bdfbf40SJouni Malinen size_t len = 0; 24388bdfbf40SJouni Malinen int ret; 24398bdfbf40SJouni Malinen 24408bdfbf40SJouni Malinen /* 24418bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 24428bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 24438bdfbf40SJouni Malinen */ 24448bdfbf40SJouni Malinen 24458bdfbf40SJouni Malinen if (ies && ies_len) { 24468bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 24478bdfbf40SJouni Malinen if (buf == NULL) 24488bdfbf40SJouni Malinen return -ENOMEM; 24498bdfbf40SJouni Malinen pos = ies; 24508bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 24518bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 24528bdfbf40SJouni Malinen break; 24538bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 24548bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 24558bdfbf40SJouni Malinen len += 2 + pos[1]; 24568bdfbf40SJouni Malinen } 24578bdfbf40SJouni Malinen pos += 2 + pos[1]; 24588bdfbf40SJouni Malinen } 24598bdfbf40SJouni Malinen } 24608bdfbf40SJouni Malinen 2461334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2462334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 24638bdfbf40SJouni Malinen kfree(buf); 24648bdfbf40SJouni Malinen return ret; 24658bdfbf40SJouni Malinen } 24668bdfbf40SJouni Malinen 24678860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 24688860020eSJohannes Berg struct cfg80211_beacon_data *info) 24698860020eSJohannes Berg { 24708860020eSJohannes Berg struct ath6kl *ar = vif->ar; 24718860020eSJohannes Berg int res; 24728860020eSJohannes Berg 247317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24748860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24758860020eSJohannes Berg WMI_FRAME_BEACON, 24768860020eSJohannes Berg info->beacon_ies, 24778860020eSJohannes Berg info->beacon_ies_len); 24788860020eSJohannes Berg if (res) 24798860020eSJohannes Berg return res; 24808860020eSJohannes Berg 248117a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24828860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 24838860020eSJohannes Berg info->proberesp_ies_len); 24848860020eSJohannes Berg if (res) 24858860020eSJohannes Berg return res; 24868860020eSJohannes Berg 248717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24888860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24898860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 24908860020eSJohannes Berg info->assocresp_ies, 24918860020eSJohannes Berg info->assocresp_ies_len); 24928860020eSJohannes Berg if (res) 24938860020eSJohannes Berg return res; 24948860020eSJohannes Berg 24958860020eSJohannes Berg return 0; 24968860020eSJohannes Berg } 24978860020eSJohannes Berg 24988860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 24998860020eSJohannes Berg struct cfg80211_ap_settings *info) 25006a7c9badSJouni Malinen { 25016a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 25023450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25036a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 250467cd22e4SThomas Pedersen bool hidden = false; 25056a7c9badSJouni Malinen u8 *ies; 25066a7c9badSJouni Malinen int ies_len; 25076a7c9badSJouni Malinen struct wmi_connect_cmd p; 25086a7c9badSJouni Malinen int res; 2509be5abaafSVasanthakumar Thiagarajan int i, ret; 25106a7c9badSJouni Malinen 25118860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 25126a7c9badSJouni Malinen 2513990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 25146a7c9badSJouni Malinen return -EIO; 25156a7c9badSJouni Malinen 2516f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 25176a7c9badSJouni Malinen return -EOPNOTSUPP; 25186a7c9badSJouni Malinen 25198860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 25206a7c9badSJouni Malinen 25219a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 25229a5b1318SJouni Malinen 25236a7c9badSJouni Malinen /* TODO: 25246a7c9badSJouni Malinen * info->interval 25256a7c9badSJouni Malinen * info->dtim_period 25266a7c9badSJouni Malinen */ 25276a7c9badSJouni Malinen 25288860020eSJohannes Berg if (info->beacon.head == NULL) 25296a7c9badSJouni Malinen return -EINVAL; 25308860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 25316a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 25328860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 25336a7c9badSJouni Malinen return -EINVAL; 25348860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 25356a7c9badSJouni Malinen 25366a7c9badSJouni Malinen if (info->ssid == NULL) 25376a7c9badSJouni Malinen return -EINVAL; 25383450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 25393450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 25406a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 254167cd22e4SThomas Pedersen hidden = true; 254267cd22e4SThomas Pedersen 254367cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 254467cd22e4SThomas Pedersen if (res) 254567cd22e4SThomas Pedersen return res; 25466a7c9badSJouni Malinen 2547be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2548be5abaafSVasanthakumar Thiagarajan if (ret) 2549be5abaafSVasanthakumar Thiagarajan return ret; 25506a7c9badSJouni Malinen 25516a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 25526a7c9badSJouni Malinen 25536a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 25546a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 25556a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 25566a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25576a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 25586a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25596a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 25606a7c9badSJouni Malinen break; 25616a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 25626a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25636a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 25646a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25656a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 25666a7c9badSJouni Malinen break; 25676a7c9badSJouni Malinen } 25686a7c9badSJouni Malinen } 25696a7c9badSJouni Malinen if (p.auth_mode == 0) 25706a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 25713450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 25726a7c9badSJouni Malinen 25736a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 25746a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 25756a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25766a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25776a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 25786a7c9badSJouni Malinen break; 25796a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25806a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 25816a7c9badSJouni Malinen break; 25826a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25836a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 25846a7c9badSJouni Malinen break; 2585b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2586b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2587b8214df1SDai Shuibing break; 25886a7c9badSJouni Malinen } 25896a7c9badSJouni Malinen } 2590229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 25916a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2592240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2593229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2594240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 25956a7c9badSJouni Malinen 25966a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 25976a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25986a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25996a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 26006a7c9badSJouni Malinen break; 26016a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 26026a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 26036a7c9badSJouni Malinen break; 26046a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 26056a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 26066a7c9badSJouni Malinen break; 2607b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2608b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2609b8214df1SDai Shuibing break; 26106a7c9badSJouni Malinen default: 26116a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 26126a7c9badSJouni Malinen break; 26136a7c9badSJouni Malinen } 2614240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 26156a7c9badSJouni Malinen 26166a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2617f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 26186a7c9badSJouni Malinen 26193450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 26203450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 26213450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2622cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 26236a7c9badSJouni Malinen 2624c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2625c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2626c1762a3fSThirumalai Pachamuthu if (res < 0) 2627c1762a3fSThirumalai Pachamuthu return res; 2628c1762a3fSThirumalai Pachamuthu 26293ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 26303ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 26313ca9d1fcSAarthi Thiruvengadam } else { 26323ca9d1fcSAarthi Thiruvengadam /* 26333ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 26343ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 26353ca9d1fcSAarthi Thiruvengadam */ 26363ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 26373ca9d1fcSAarthi Thiruvengadam } 26383ca9d1fcSAarthi Thiruvengadam 263903bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 264003bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 264103bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 264203bdeb0dSVasanthakumar Thiagarajan if (res < 0) 264303bdeb0dSVasanthakumar Thiagarajan return res; 264403bdeb0dSVasanthakumar Thiagarajan } 264503bdeb0dSVasanthakumar Thiagarajan 2646334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 26479a5b1318SJouni Malinen if (res < 0) 26489a5b1318SJouni Malinen return res; 26499a5b1318SJouni Malinen 26509a5b1318SJouni Malinen return 0; 26516a7c9badSJouni Malinen } 26526a7c9badSJouni Malinen 26538860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 26548860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 26556a7c9badSJouni Malinen { 26568860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 26578860020eSJohannes Berg 26588860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 26598860020eSJohannes Berg return -EIO; 26608860020eSJohannes Berg 26618860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 26628860020eSJohannes Berg return -EOPNOTSUPP; 26638860020eSJohannes Berg 26648860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 26656a7c9badSJouni Malinen } 26666a7c9badSJouni Malinen 26678860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 26686a7c9badSJouni Malinen { 26696a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 267059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26716a7c9badSJouni Malinen 2672f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 26736a7c9badSJouni Malinen return -EOPNOTSUPP; 267459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 26756a7c9badSJouni Malinen return -ENOTCONN; 26766a7c9badSJouni Malinen 2677334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 267859c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 26796a7c9badSJouni Malinen 26806a7c9badSJouni Malinen return 0; 26816a7c9badSJouni Malinen } 26826a7c9badSJouni Malinen 268333e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 268433e5308dSJouni Malinen 268533e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 268633e5308dSJouni Malinen u8 *mac) 268733e5308dSJouni Malinen { 268833e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 268933e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 269033e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 269133e5308dSJouni Malinen 269233e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 269333e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 269433e5308dSJouni Malinen } 269533e5308dSJouni Malinen 269623875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 269723875136SJouni Malinen u8 *mac, struct station_parameters *params) 269823875136SJouni Malinen { 269923875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2700f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 270123875136SJouni Malinen 2702f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 270323875136SJouni Malinen return -EOPNOTSUPP; 270423875136SJouni Malinen 270523875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 270623875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 270723875136SJouni Malinen return -EOPNOTSUPP; 270823875136SJouni Malinen 270923875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2710334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2711334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2712334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2713334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 271423875136SJouni Malinen } 271523875136SJouni Malinen 271663fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 271763fa1e0cSJouni Malinen struct net_device *dev, 271863fa1e0cSJouni Malinen struct ieee80211_channel *chan, 271963fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 272063fa1e0cSJouni Malinen unsigned int duration, 272163fa1e0cSJouni Malinen u64 *cookie) 272263fa1e0cSJouni Malinen { 272363fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2724334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27251052261eSJouni Malinen u32 id; 272663fa1e0cSJouni Malinen 272763fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 272863fa1e0cSJouni Malinen * return -EBUSY */ 27291052261eSJouni Malinen id = ++vif->last_roc_id; 27301052261eSJouni Malinen if (id == 0) { 27311052261eSJouni Malinen /* Do not use 0 as the cookie value */ 27321052261eSJouni Malinen id = ++vif->last_roc_id; 27331052261eSJouni Malinen } 27341052261eSJouni Malinen *cookie = id; 273563fa1e0cSJouni Malinen 2736334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2737334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 273863fa1e0cSJouni Malinen } 273963fa1e0cSJouni Malinen 274063fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 274163fa1e0cSJouni Malinen struct net_device *dev, 274263fa1e0cSJouni Malinen u64 cookie) 274363fa1e0cSJouni Malinen { 274463fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2745334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 274663fa1e0cSJouni Malinen 27471052261eSJouni Malinen if (cookie != vif->last_roc_id) 274863fa1e0cSJouni Malinen return -ENOENT; 27491052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 275063fa1e0cSJouni Malinen 2751334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 275263fa1e0cSJouni Malinen } 275363fa1e0cSJouni Malinen 2754334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2755334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2756334234b5SVasanthakumar Thiagarajan unsigned int freq) 27578bdfbf40SJouni Malinen { 2758334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27598bdfbf40SJouni Malinen const u8 *pos; 27608bdfbf40SJouni Malinen u8 *p2p; 27618bdfbf40SJouni Malinen int p2p_len; 27628bdfbf40SJouni Malinen int ret; 27638bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 27648bdfbf40SJouni Malinen 27658bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27668bdfbf40SJouni Malinen 27678bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 27688bdfbf40SJouni Malinen 27698bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 27708bdfbf40SJouni Malinen if (p2p == NULL) 27718bdfbf40SJouni Malinen return -ENOMEM; 27728bdfbf40SJouni Malinen p2p_len = 0; 27738bdfbf40SJouni Malinen 27748bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 27758bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 27768bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 27778bdfbf40SJouni Malinen break; 27788bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 27798bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 27808bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 27818bdfbf40SJouni Malinen } 27828bdfbf40SJouni Malinen pos += 2 + pos[1]; 27838bdfbf40SJouni Malinen } 27848bdfbf40SJouni Malinen 2785334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2786334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 27878bdfbf40SJouni Malinen kfree(p2p); 27888bdfbf40SJouni Malinen return ret; 27898bdfbf40SJouni Malinen } 27908bdfbf40SJouni Malinen 2791d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2792d0ff7383SNaveen Gangadharan u32 id, 2793d0ff7383SNaveen Gangadharan u32 freq, 2794d0ff7383SNaveen Gangadharan u32 wait, 2795d0ff7383SNaveen Gangadharan const u8 *buf, 2796d0ff7383SNaveen Gangadharan size_t len, 2797d0ff7383SNaveen Gangadharan bool *more_data, 2798d0ff7383SNaveen Gangadharan bool no_cck) 2799d0ff7383SNaveen Gangadharan { 2800d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2801d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2802d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2803d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2804d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2805d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2806d0ff7383SNaveen Gangadharan 2807d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2808d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2809d0ff7383SNaveen Gangadharan return false; 2810d0ff7383SNaveen Gangadharan 2811d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2812d0ff7383SNaveen Gangadharan if (!conn) 2813d0ff7383SNaveen Gangadharan return false; 2814d0ff7383SNaveen Gangadharan 2815d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2816d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2817d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2818d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2819d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2820d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2821d0ff7383SNaveen Gangadharan return false; 2822d0ff7383SNaveen Gangadharan 2823d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2824d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2825d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2826d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2827d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2828d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2829d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2830d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2831d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2832d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2833d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2834d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2835d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2836d0ff7383SNaveen Gangadharan 2837d0ff7383SNaveen Gangadharan /* 2838d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2839d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2840d0ff7383SNaveen Gangadharan * STA. 2841d0ff7383SNaveen Gangadharan */ 2842d0ff7383SNaveen Gangadharan if (is_psq_empty) 2843d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2844d0ff7383SNaveen Gangadharan conn->aid, 1); 2845d0ff7383SNaveen Gangadharan return true; 2846d0ff7383SNaveen Gangadharan } 2847d0ff7383SNaveen Gangadharan 2848d0ff7383SNaveen Gangadharan /* 2849d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2850d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2851d0ff7383SNaveen Gangadharan */ 2852d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2853d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2854d0ff7383SNaveen Gangadharan *more_data = true; 2855d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2856d0ff7383SNaveen Gangadharan } 2857d0ff7383SNaveen Gangadharan 2858d0ff7383SNaveen Gangadharan return false; 2859d0ff7383SNaveen Gangadharan } 2860d0ff7383SNaveen Gangadharan 2861c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 2862c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 2863c86e4f44SAarthi Thiruvengadam { 2864c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 2865c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 2866c86e4f44SAarthi Thiruvengadam 2867c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 2868c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 2869c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 2870c86e4f44SAarthi Thiruvengadam return true; 2871c86e4f44SAarthi Thiruvengadam } 2872c86e4f44SAarthi Thiruvengadam 2873c86e4f44SAarthi Thiruvengadam return false; 2874c86e4f44SAarthi Thiruvengadam } 2875c86e4f44SAarthi Thiruvengadam 28768a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 28778a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 28788a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 28798a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2880e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2881e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 28828a6c8060SJouni Malinen { 28838a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 288459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28858a6c8060SJouni Malinen u32 id; 28868bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2887d0ff7383SNaveen Gangadharan bool more_data, queued; 28888bdfbf40SJouni Malinen 28898bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 2890c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 2891c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 2892c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 28938bdfbf40SJouni Malinen /* 2894c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 28958bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 28968bdfbf40SJouni Malinen */ 28978bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2898334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 28998bdfbf40SJouni Malinen chan->center_freq); 29008bdfbf40SJouni Malinen } 29018a6c8060SJouni Malinen 2902cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 29038a6c8060SJouni Malinen if (id == 0) { 29048a6c8060SJouni Malinen /* 29058a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 29068a6c8060SJouni Malinen * used for the command. 29078a6c8060SJouni Malinen */ 2908cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 29098a6c8060SJouni Malinen } 29108a6c8060SJouni Malinen 29118a6c8060SJouni Malinen *cookie = id; 29123ca9d1fcSAarthi Thiruvengadam 2913d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2914d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2915d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2916d0ff7383SNaveen Gangadharan id, chan->center_freq, 2917d0ff7383SNaveen Gangadharan wait, buf, 2918d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2919d0ff7383SNaveen Gangadharan if (queued) 2920d0ff7383SNaveen Gangadharan return 0; 2921d0ff7383SNaveen Gangadharan } 2922d0ff7383SNaveen Gangadharan 29233ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 29243ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 29253ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 29263ca9d1fcSAarthi Thiruvengadam } 29278a6c8060SJouni Malinen 2928ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2929ae32c30aSJouni Malinen struct net_device *dev, 2930ae32c30aSJouni Malinen u16 frame_type, bool reg) 2931ae32c30aSJouni Malinen { 2932cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2933ae32c30aSJouni Malinen 2934ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2935ae32c30aSJouni Malinen __func__, frame_type, reg); 2936ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2937ae32c30aSJouni Malinen /* 2938ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2939ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2940ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2941ae32c30aSJouni Malinen */ 2942cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2943ae32c30aSJouni Malinen } 2944ae32c30aSJouni Malinen } 2945ae32c30aSJouni Malinen 294610509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 294710509f90SKalle Valo struct net_device *dev, 294810509f90SKalle Valo struct cfg80211_sched_scan_request *request) 294910509f90SKalle Valo { 295010509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 295110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 295210509f90SKalle Valo u16 interval; 295310509f90SKalle Valo int ret; 295410509f90SKalle Valo u8 i; 295510509f90SKalle Valo 295610509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 295710509f90SKalle Valo return -EIO; 295810509f90SKalle Valo 295910509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 296010509f90SKalle Valo return -EBUSY; 296110509f90SKalle Valo 2962b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2963b4d13d3bSKalle Valo 296410509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 296510509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 296610509f90SKalle Valo i, DISABLE_SSID_FLAG, 296710509f90SKalle Valo 0, NULL); 296810509f90SKalle Valo } 296910509f90SKalle Valo 297010509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 297110509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 297210509f90SKalle Valo 297310509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 297410509f90SKalle Valo interval, interval, 297510509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 297610509f90SKalle Valo 297710509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 297810509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 297910509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 298010509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 298110509f90SKalle Valo request->ssids[i].ssid_len, 298210509f90SKalle Valo request->ssids[i].ssid); 298310509f90SKalle Valo } 298410509f90SKalle Valo } 298510509f90SKalle Valo 298610509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 298710509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 298810509f90SKalle Valo WOW_FILTER_SSID, 298910509f90SKalle Valo WOW_HOST_REQ_DELAY); 299010509f90SKalle Valo if (ret) { 299110509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 299210509f90SKalle Valo return ret; 299310509f90SKalle Valo } 299410509f90SKalle Valo 299510509f90SKalle Valo /* this also clears IE in fw if it's not set */ 299610509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 299710509f90SKalle Valo WMI_FRAME_PROBE_REQ, 299810509f90SKalle Valo request->ie, request->ie_len); 299910509f90SKalle Valo if (ret) { 300010509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 300110509f90SKalle Valo ret); 300210509f90SKalle Valo return ret; 300310509f90SKalle Valo } 300410509f90SKalle Valo 300510509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 300610509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 300710509f90SKalle Valo if (ret) { 300810509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 300910509f90SKalle Valo ret); 301010509f90SKalle Valo return ret; 301110509f90SKalle Valo } 301210509f90SKalle Valo 301310509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 301410509f90SKalle Valo 301510509f90SKalle Valo return ret; 301610509f90SKalle Valo } 301710509f90SKalle Valo 301810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 301910509f90SKalle Valo struct net_device *dev) 302010509f90SKalle Valo { 302110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 302210509f90SKalle Valo bool stopped; 302310509f90SKalle Valo 302410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 302510509f90SKalle Valo 302610509f90SKalle Valo if (!stopped) 302710509f90SKalle Valo return -EIO; 302810509f90SKalle Valo 302910509f90SKalle Valo return 0; 303010509f90SKalle Valo } 303110509f90SKalle Valo 3032f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3033f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3034f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3035f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3036f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3037f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3038f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3039f80574aeSJouni Malinen }, 3040ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3041ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3042ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3043ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3044ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3045ba1f6fe3SJouni Malinen }, 3046f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3047f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3048f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3049f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3050f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3051f80574aeSJouni Malinen }, 3052f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3053f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3054f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3055f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3056f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3057f80574aeSJouni Malinen }, 3058f80574aeSJouni Malinen }; 3059f80574aeSJouni Malinen 3060bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 306155055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 306255055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3063bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3064bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3065bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3066bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3067bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3068bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3069bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3070bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3071bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3072bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3073bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3074bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3075bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3076bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3077bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3078bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3079bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3080bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3081003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3082abcb344bSKalle Valo #ifdef CONFIG_PM 308352d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 308452d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3085abcb344bSKalle Valo #endif 30866a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 30878860020eSJohannes Berg .start_ap = ath6kl_start_ap, 30888860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 30898860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 309033e5308dSJouni Malinen .del_station = ath6kl_del_station, 309123875136SJouni Malinen .change_station = ath6kl_change_station, 309263fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 309363fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 30948a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3095ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 309610509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 309710509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3098bdcd8170SKalle Valo }; 3099bdcd8170SKalle Valo 31007125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3101ec4b7f60SKalle Valo { 310210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 310310509f90SKalle Valo 3104ec4b7f60SKalle Valo switch (vif->sme_state) { 3105c97a31b0SKalle Valo case SME_DISCONNECTED: 3106c97a31b0SKalle Valo break; 3107ec4b7f60SKalle Valo case SME_CONNECTING: 3108ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3109ec4b7f60SKalle Valo NULL, 0, 3110ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3111ec4b7f60SKalle Valo GFP_KERNEL); 3112ec4b7f60SKalle Valo break; 3113ec4b7f60SKalle Valo case SME_CONNECTED: 3114ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3115ec4b7f60SKalle Valo break; 3116ec4b7f60SKalle Valo } 3117ec4b7f60SKalle Valo 3118ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3119ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 31207125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3121ec4b7f60SKalle Valo 3122ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 31231f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 31241f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3125ec4b7f60SKalle Valo 3126ec4b7f60SKalle Valo /* disable scanning */ 31277125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 31287125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 31297125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3130ec4b7f60SKalle Valo 3131ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3132ec4b7f60SKalle Valo } 3133ec4b7f60SKalle Valo 31347125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 31357125f01dSKalle Valo { 31367125f01dSKalle Valo struct ath6kl_vif *vif; 31377125f01dSKalle Valo 31387125f01dSKalle Valo vif = ath6kl_vif_first(ar); 31397125f01dSKalle Valo if (!vif) { 31407125f01dSKalle Valo /* save the current power mode before enabling power save */ 31417125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 31427125f01dSKalle Valo 31437125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 31447125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 31457125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 31467125f01dSKalle Valo return; 31477125f01dSKalle Valo } 31487125f01dSKalle Valo 31497125f01dSKalle Valo /* 31507125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 31517125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 31527125f01dSKalle Valo * sleeps. 31537125f01dSKalle Valo */ 31547125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 31557125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 31567125f01dSKalle Valo } 31577125f01dSKalle Valo 3158c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 31598dafb70eSVasanthakumar Thiagarajan { 31607baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 31612132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 31628dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 31638dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 31648dafb70eSVasanthakumar Thiagarajan } 31658dafb70eSVasanthakumar Thiagarajan 3166de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3167108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 316810509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 316910509f90SKalle Valo (unsigned long) vif); 317010509f90SKalle Valo 3171de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3172478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 31738dafb70eSVasanthakumar Thiagarajan 317480abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 317580abaf9bSVasanthakumar Thiagarajan 31768dafb70eSVasanthakumar Thiagarajan return 0; 31778dafb70eSVasanthakumar Thiagarajan } 31788dafb70eSVasanthakumar Thiagarajan 3179c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 31808dafb70eSVasanthakumar Thiagarajan { 318155055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 318280abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 318355055976SVasanthakumar Thiagarajan 31842132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3185108438bcSVasanthakumar Thiagarajan 318655055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 318755055976SVasanthakumar Thiagarajan 318855055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 318955055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 319055055976SVasanthakumar Thiagarajan 319180abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 319280abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 319380abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 319480abaf9bSVasanthakumar Thiagarajan } 319580abaf9bSVasanthakumar Thiagarajan 319627929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 319755055976SVasanthakumar Thiagarajan 319855055976SVasanthakumar Thiagarajan ar->num_vif--; 31998dafb70eSVasanthakumar Thiagarajan } 32008dafb70eSVasanthakumar Thiagarajan 32018dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 320255055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 320355055976SVasanthakumar Thiagarajan u8 nw_type) 32048dafb70eSVasanthakumar Thiagarajan { 32058dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3206108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 32078dafb70eSVasanthakumar Thiagarajan 320855055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 32098dafb70eSVasanthakumar Thiagarajan if (!ndev) 32108dafb70eSVasanthakumar Thiagarajan return NULL; 32118dafb70eSVasanthakumar Thiagarajan 3212108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3213108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3214108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3215108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3216108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3217108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3218108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3219108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3220334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3221d0d670abSKalle Valo vif->nw_type = nw_type; 3222d0d670abSKalle Valo vif->next_mode = nw_type; 32238f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3224ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 32258dafb70eSVasanthakumar Thiagarajan 322655055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 322755055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 322855055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 322955055976SVasanthakumar Thiagarajan 0x2; 323055055976SVasanthakumar Thiagarajan 32318dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 32328dafb70eSVasanthakumar Thiagarajan 3233e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 32348dafb70eSVasanthakumar Thiagarajan 3235c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 32368dafb70eSVasanthakumar Thiagarajan goto err; 32378dafb70eSVasanthakumar Thiagarajan 323827929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 32398dafb70eSVasanthakumar Thiagarajan goto err; 32408dafb70eSVasanthakumar Thiagarajan 324155055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 324214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 324359c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 32448dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 324559c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 32468dafb70eSVasanthakumar Thiagarajan 324755055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 324855055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 324955055976SVasanthakumar Thiagarajan 325011f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3251990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 325211f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3253990bd915SVasanthakumar Thiagarajan 32548dafb70eSVasanthakumar Thiagarajan return ndev; 32558dafb70eSVasanthakumar Thiagarajan 32568dafb70eSVasanthakumar Thiagarajan err: 325727929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 325827929723SVasanthakumar Thiagarajan free_netdev(ndev); 3259bdcd8170SKalle Valo return NULL; 3260bdcd8170SKalle Valo } 3261bdcd8170SKalle Valo 326246d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 326346d33a21SKalle Valo { 326446d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 326546d33a21SKalle Valo int ret; 326646d33a21SKalle Valo 326746d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 326846d33a21SKalle Valo 326946d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 327046d33a21SKalle Valo 327146d33a21SKalle Valo /* set device pointer for wiphy */ 327246d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 327346d33a21SKalle Valo 327446d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 327546d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 327646d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 327746d33a21SKalle Valo if (ar->p2p) { 327846d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 327946d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 328046d33a21SKalle Valo } 328146d33a21SKalle Valo 328246d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 328346d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 328446d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 328546d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 328646d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 328746d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 328846d33a21SKalle Valo 328946d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 329046d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 329146d33a21SKalle Valo 329246d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 329346d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 329446d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 329546d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 329646d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 329746d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 329846d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 329946d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 330046d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 330146d33a21SKalle Valo 330246d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 330346d33a21SKalle Valo 3304f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3305f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3306f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3307f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3308f2afdac7SVasanthakumar Thiagarajan 3309f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3310f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3311f2afdac7SVasanthakumar Thiagarajan 331203bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 331303bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 331403bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 331503bdeb0dSVasanthakumar Thiagarajan 3316f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3317f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3318f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3319f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3320f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3321f2afdac7SVasanthakumar Thiagarajan 332246d33a21SKalle Valo ret = wiphy_register(wiphy); 332346d33a21SKalle Valo if (ret < 0) { 332446d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 332546d33a21SKalle Valo return ret; 332646d33a21SKalle Valo } 332746d33a21SKalle Valo 3328e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3329e5348a1eSVasanthakumar Thiagarajan 333046d33a21SKalle Valo return 0; 333146d33a21SKalle Valo } 333246d33a21SKalle Valo 333346d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3334bdcd8170SKalle Valo { 3335be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3336e5348a1eSVasanthakumar Thiagarajan 3337e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 333845eaa78fSKalle Valo } 333946d33a21SKalle Valo 334045eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 334145eaa78fSKalle Valo { 334245eaa78fSKalle Valo struct ath6kl *ar; 334345eaa78fSKalle Valo struct wiphy *wiphy; 334445eaa78fSKalle Valo 334545eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 334645eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 334745eaa78fSKalle Valo 334845eaa78fSKalle Valo if (!wiphy) { 334945eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 335045eaa78fSKalle Valo return NULL; 335145eaa78fSKalle Valo } 335245eaa78fSKalle Valo 335345eaa78fSKalle Valo ar = wiphy_priv(wiphy); 335445eaa78fSKalle Valo ar->wiphy = wiphy; 335545eaa78fSKalle Valo 335645eaa78fSKalle Valo return ar; 335745eaa78fSKalle Valo } 335845eaa78fSKalle Valo 335945eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 336045eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 336145eaa78fSKalle Valo { 33621d2a4456SVasanthakumar Thiagarajan int i; 33631d2a4456SVasanthakumar Thiagarajan 33641d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 33651d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 33661d2a4456SVasanthakumar Thiagarajan 3367be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3368bdcd8170SKalle Valo } 336945eaa78fSKalle Valo 3370