1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19516304b0SJoe Perches 206eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 21c08631c6SRaja Mani #include <linux/inetdevice.h> 22d6a434d6SKalle Valo #include <linux/export.h> 236eb07cafSPaul Gortmaker 24bdcd8170SKalle Valo #include "core.h" 25bdcd8170SKalle Valo #include "cfg80211.h" 26bdcd8170SKalle Valo #include "debug.h" 27abcb344bSKalle Valo #include "hif-ops.h" 28003353b0SKalle Valo #include "testmode.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 55f599359cSBala Shanmugam 56dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid { 57dd45b759SNaveen Singh struct cfg80211_ssid ssid; 58dd45b759SNaveen Singh u8 flag; 59dd45b759SNaveen Singh }; 60dd45b759SNaveen Singh 61bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 62bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 63bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 64bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 65bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 66bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 67bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 68bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 69bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 70bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 71bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 72bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 73bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 74bdcd8170SKalle Valo }; 75bdcd8170SKalle Valo 76bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 77bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 78bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 79bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 80bdcd8170SKalle Valo 81bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 82bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 83faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 84faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 85faaf1929SVasanthakumar Thiagarajan 86bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 87bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 88bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 89bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 90bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 91bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 92bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 93bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 94bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 95bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 96bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 97bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 98bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 99bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 100bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 101bdcd8170SKalle Valo }; 102bdcd8170SKalle Valo 103bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 104bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 105bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 106bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 107bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 108bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 109bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 110bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 111bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 112bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 113bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 114bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 115bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 116bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 117bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 118bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 119bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 120bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 121bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 122bdcd8170SKalle Valo CHAN5G(216, 0), 123bdcd8170SKalle Valo }; 124bdcd8170SKalle Valo 125bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 126bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 127bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 128bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 129bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 131faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 132bdcd8170SKalle Valo }; 133bdcd8170SKalle Valo 134bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 135bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 136bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 137bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 138bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 139bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 140faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 141bdcd8170SKalle Valo }; 142bdcd8170SKalle Valo 143837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 144837cb97eSJouni Malinen 14510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14710509f90SKalle Valo { 14810509f90SKalle Valo struct ath6kl *ar = vif->ar; 14910509f90SKalle Valo 150b1f47e3aSThomas Pedersen if (!test_and_clear_bit(SCHED_SCANNING, &vif->flags)) 15110509f90SKalle Valo return false; 15210509f90SKalle Valo 15310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 15410509f90SKalle Valo 15558109df6SVasanthakumar Thiagarajan if (ar->state == ATH6KL_STATE_RECOVERY) 15658109df6SVasanthakumar Thiagarajan return true; 15710509f90SKalle Valo 158b1f47e3aSThomas Pedersen ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, false); 15910509f90SKalle Valo 16010509f90SKalle Valo return true; 16110509f90SKalle Valo } 16210509f90SKalle Valo 16310509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 16410509f90SKalle Valo { 16510509f90SKalle Valo struct ath6kl *ar = vif->ar; 16610509f90SKalle Valo bool stopped; 16710509f90SKalle Valo 16810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16910509f90SKalle Valo 17010509f90SKalle Valo if (!stopped) 17110509f90SKalle Valo return; 17210509f90SKalle Valo 17310509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 17410509f90SKalle Valo } 17510509f90SKalle Valo 176240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 177bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 178bdcd8170SKalle Valo { 179bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 180bdcd8170SKalle Valo 181bdcd8170SKalle Valo if (!wpa_version) { 1823450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 183bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1843450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 185bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1863450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 187bdcd8170SKalle Valo } else { 188bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 189bdcd8170SKalle Valo return -ENOTSUPP; 190bdcd8170SKalle Valo } 191bdcd8170SKalle Valo 192bdcd8170SKalle Valo return 0; 193bdcd8170SKalle Valo } 194bdcd8170SKalle Valo 195240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 196bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 197bdcd8170SKalle Valo { 198bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 199bdcd8170SKalle Valo 200bdcd8170SKalle Valo switch (auth_type) { 201bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 2023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 203bdcd8170SKalle Valo break; 204bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2053450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 206bdcd8170SKalle Valo break; 207bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2083450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 209bdcd8170SKalle Valo break; 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2123450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 213bdcd8170SKalle Valo break; 214bdcd8170SKalle Valo 215bdcd8170SKalle Valo default: 2163c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 217bdcd8170SKalle Valo return -ENOTSUPP; 218bdcd8170SKalle Valo } 219bdcd8170SKalle Valo 220bdcd8170SKalle Valo return 0; 221bdcd8170SKalle Valo } 222bdcd8170SKalle Valo 223240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 224bdcd8170SKalle Valo { 2253450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2263450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2273450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 228bdcd8170SKalle Valo 229bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 230bdcd8170SKalle Valo __func__, cipher, ucast); 231bdcd8170SKalle Valo 232bdcd8170SKalle Valo switch (cipher) { 233bdcd8170SKalle Valo case 0: 234bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 235bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 0; 237bdcd8170SKalle Valo break; 238bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 239bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 240bdcd8170SKalle Valo *ar_cipher_len = 5; 241bdcd8170SKalle Valo break; 242bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 243bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 244bdcd8170SKalle Valo *ar_cipher_len = 13; 245bdcd8170SKalle Valo break; 246bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 247bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 248bdcd8170SKalle Valo *ar_cipher_len = 0; 249bdcd8170SKalle Valo break; 250bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 251bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 252bdcd8170SKalle Valo *ar_cipher_len = 0; 253bdcd8170SKalle Valo break; 2545e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2555e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2565e07021eSDai Shuibing *ar_cipher_len = 0; 2575e07021eSDai Shuibing break; 258bdcd8170SKalle Valo default: 259bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 260bdcd8170SKalle Valo return -ENOTSUPP; 261bdcd8170SKalle Valo } 262bdcd8170SKalle Valo 263bdcd8170SKalle Valo return 0; 264bdcd8170SKalle Valo } 265bdcd8170SKalle Valo 266240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 267bdcd8170SKalle Valo { 268bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 269bdcd8170SKalle Valo 270bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2713450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2723450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2733450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 275837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2763450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2773450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2783450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2793450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 280bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2813450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo } 284bdcd8170SKalle Valo 285990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 286bdcd8170SKalle Valo { 287990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28859c98449SVasanthakumar Thiagarajan 289bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 290bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 291bdcd8170SKalle Valo return false; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 29459c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 295bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 296bdcd8170SKalle Valo return false; 297bdcd8170SKalle Valo } 298bdcd8170SKalle Valo 299bdcd8170SKalle Valo return true; 300bdcd8170SKalle Valo } 301bdcd8170SKalle Valo 3026981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 3036981ffdcSKevin Fang { 30404b2312aSArend van Spriel return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 3056981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3066981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3076981ffdcSKevin Fang } 3086981ffdcSKevin Fang 3096981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3106981ffdcSKevin Fang { 3116981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3126981ffdcSKevin Fang } 3136981ffdcSKevin Fang 31463541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31563541212SAarthi Thiruvengadam { 31663541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31763541212SAarthi Thiruvengadam pos[1] >= 4 && 31863541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31963541212SAarthi Thiruvengadam pos[5] == 0x04); 32063541212SAarthi Thiruvengadam } 32163541212SAarthi Thiruvengadam 322334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3236981ffdcSKevin Fang size_t ies_len) 3246981ffdcSKevin Fang { 325334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3266981ffdcSKevin Fang const u8 *pos; 3276981ffdcSKevin Fang u8 *buf = NULL; 3286981ffdcSKevin Fang size_t len = 0; 3296981ffdcSKevin Fang int ret; 3306981ffdcSKevin Fang 3316981ffdcSKevin Fang /* 33263541212SAarthi Thiruvengadam * Clear previously set flag 33363541212SAarthi Thiruvengadam */ 33463541212SAarthi Thiruvengadam 33563541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33663541212SAarthi Thiruvengadam 33763541212SAarthi Thiruvengadam /* 3386981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3396981ffdcSKevin Fang */ 3406981ffdcSKevin Fang 3416981ffdcSKevin Fang if (ies && ies_len) { 3426981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3436981ffdcSKevin Fang if (buf == NULL) 3446981ffdcSKevin Fang return -ENOMEM; 3456981ffdcSKevin Fang pos = ies; 3466981ffdcSKevin Fang 3476981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3486981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3496981ffdcSKevin Fang break; 3506981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3516981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3526981ffdcSKevin Fang len += 2 + pos[1]; 3536981ffdcSKevin Fang } 35463541212SAarthi Thiruvengadam 35563541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35663541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35763541212SAarthi Thiruvengadam 3586981ffdcSKevin Fang pos += 2 + pos[1]; 3596981ffdcSKevin Fang } 3606981ffdcSKevin Fang } 3616981ffdcSKevin Fang 362334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 363334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3646981ffdcSKevin Fang kfree(buf); 3656981ffdcSKevin Fang return ret; 3666981ffdcSKevin Fang } 3676981ffdcSKevin Fang 36855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36955055976SVasanthakumar Thiagarajan { 37055055976SVasanthakumar Thiagarajan switch (type) { 37155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 37238142644SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 37355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37655055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 38055055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 38155055976SVasanthakumar Thiagarajan break; 38255055976SVasanthakumar Thiagarajan default: 38355055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38455055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38555055976SVasanthakumar Thiagarajan } 38655055976SVasanthakumar Thiagarajan 38755055976SVasanthakumar Thiagarajan return 0; 38855055976SVasanthakumar Thiagarajan } 38955055976SVasanthakumar Thiagarajan 39055055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 39155055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 39255055976SVasanthakumar Thiagarajan { 39355055976SVasanthakumar Thiagarajan int i; 39455055976SVasanthakumar Thiagarajan 39555055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39655055976SVasanthakumar Thiagarajan return false; 39755055976SVasanthakumar Thiagarajan 39855055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39955055976SVasanthakumar Thiagarajan ar->num_vif)) 40055055976SVasanthakumar Thiagarajan return false; 40155055976SVasanthakumar Thiagarajan 40255055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 40355055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40471f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 4050db96de6SMohammed Shafi Shajakhan if ((ar->avail_idx_map) & BIT(i)) { 40655055976SVasanthakumar Thiagarajan *if_idx = i; 40755055976SVasanthakumar Thiagarajan return true; 40855055976SVasanthakumar Thiagarajan } 40955055976SVasanthakumar Thiagarajan } 41055055976SVasanthakumar Thiagarajan } 41155055976SVasanthakumar Thiagarajan 4123226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4133226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41471f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4150db96de6SMohammed Shafi Shajakhan if ((ar->avail_idx_map) & BIT(i)) { 4163226f68aSVasanthakumar Thiagarajan *if_idx = i; 4173226f68aSVasanthakumar Thiagarajan return true; 4183226f68aSVasanthakumar Thiagarajan } 4193226f68aSVasanthakumar Thiagarajan } 4203226f68aSVasanthakumar Thiagarajan } 4213226f68aSVasanthakumar Thiagarajan 42255055976SVasanthakumar Thiagarajan return false; 42355055976SVasanthakumar Thiagarajan } 42455055976SVasanthakumar Thiagarajan 4258c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4268c9bb054SKalle Valo { 4278c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4288c9bb054SKalle Valo } 4298c9bb054SKalle Valo 430355b3a98SMohammed Shafi Shajakhan static void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, 431355b3a98SMohammed Shafi Shajakhan bool enable) 432355b3a98SMohammed Shafi Shajakhan { 433355b3a98SMohammed Shafi Shajakhan int err; 434355b3a98SMohammed Shafi Shajakhan 435355b3a98SMohammed Shafi Shajakhan if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag))) 436355b3a98SMohammed Shafi Shajakhan return; 437355b3a98SMohammed Shafi Shajakhan 438355b3a98SMohammed Shafi Shajakhan if (vif->nw_type != INFRA_NETWORK) 439355b3a98SMohammed Shafi Shajakhan return; 440355b3a98SMohammed Shafi Shajakhan 441355b3a98SMohammed Shafi Shajakhan if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE, 442355b3a98SMohammed Shafi Shajakhan vif->ar->fw_capabilities)) 443355b3a98SMohammed Shafi Shajakhan return; 444355b3a98SMohammed Shafi Shajakhan 445355b3a98SMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n", 446355b3a98SMohammed Shafi Shajakhan enable ? "enable" : "disable"); 447355b3a98SMohammed Shafi Shajakhan 448355b3a98SMohammed Shafi Shajakhan err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi, 449355b3a98SMohammed Shafi Shajakhan vif->fw_vif_idx, enable); 450355b3a98SMohammed Shafi Shajakhan if (err) 451355b3a98SMohammed Shafi Shajakhan ath6kl_err("failed to %s enhanced bmiss detection: %d\n", 452355b3a98SMohammed Shafi Shajakhan enable ? "enable" : "disable", err); 453355b3a98SMohammed Shafi Shajakhan } 4548c9bb054SKalle Valo 455bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 456bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 457bdcd8170SKalle Valo { 458bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 45959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 460bdcd8170SKalle Valo int status; 4613ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 462ce0dc0cfSRaja Mani u16 interval; 463bdcd8170SKalle Valo 46410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 46510509f90SKalle Valo 46614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 467bdcd8170SKalle Valo 468990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 469bdcd8170SKalle Valo return -EIO; 470bdcd8170SKalle Valo 471bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 472bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 473bdcd8170SKalle Valo return -EBUSY; 474bdcd8170SKalle Valo } 475bdcd8170SKalle Valo 476bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 477bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 478bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 479bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 480bdcd8170SKalle Valo return -EINVAL; 481bdcd8170SKalle Valo } 482bdcd8170SKalle Valo 483bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 484bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 485bdcd8170SKalle Valo return -ERESTARTSYS; 486bdcd8170SKalle Valo } 487bdcd8170SKalle Valo 488bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 489bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 490bdcd8170SKalle Valo up(&ar->sem); 491bdcd8170SKalle Valo return -EBUSY; 492bdcd8170SKalle Valo } 493bdcd8170SKalle Valo 494bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 495bdcd8170SKalle Valo /* 496bdcd8170SKalle Valo * sleep until the command queue drains 497bdcd8170SKalle Valo */ 498bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4998c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 500bdcd8170SKalle Valo WMI_TIMEOUT); 501bdcd8170SKalle Valo if (signal_pending(current)) { 502bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 503bdcd8170SKalle Valo up(&ar->sem); 504bdcd8170SKalle Valo return -EINTR; 505bdcd8170SKalle Valo } 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 508334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 509743b4518SDan Carpenter if (status) { 510743b4518SDan Carpenter up(&ar->sem); 5116981ffdcSKevin Fang return status; 512743b4518SDan Carpenter } 5136e786cb1SJouni Malinen 5146e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 515542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 5166981ffdcSKevin Fang 51759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 5183450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 5193450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 520cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 521334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 522334234b5SVasanthakumar Thiagarajan vif->req_bssid, 523f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 524bdcd8170SKalle Valo 525bdcd8170SKalle Valo up(&ar->sem); 526bdcd8170SKalle Valo if (status) { 527bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 528bdcd8170SKalle Valo return -EIO; 529bdcd8170SKalle Valo } 530bdcd8170SKalle Valo return 0; 5313450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5323450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 533240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 534bdcd8170SKalle Valo } 535bdcd8170SKalle Valo 5363450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5373450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5383450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 539bdcd8170SKalle Valo 540bdcd8170SKalle Valo if (sme->channel) 541f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 542bdcd8170SKalle Valo 5438c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 544bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5458c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 546bdcd8170SKalle Valo 547240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 548bdcd8170SKalle Valo 549240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 550bdcd8170SKalle Valo if (status) { 551bdcd8170SKalle Valo up(&ar->sem); 552bdcd8170SKalle Valo return status; 553bdcd8170SKalle Valo } 554bdcd8170SKalle Valo 555bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 556240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 557bdcd8170SKalle Valo else 558240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 559bdcd8170SKalle Valo 560240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 563240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 564bdcd8170SKalle Valo 565bdcd8170SKalle Valo if ((sme->key_len) && 5663450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5673450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 568bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 569bdcd8170SKalle Valo 570792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 571bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 572bdcd8170SKalle Valo sme->key_idx); 573bdcd8170SKalle Valo up(&ar->sem); 574bdcd8170SKalle Valo return -ENOENT; 575bdcd8170SKalle Valo } 576bdcd8170SKalle Valo 5776f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 578bdcd8170SKalle Valo key->key_len = sme->key_len; 579bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5803450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5813450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 582bdcd8170SKalle Valo 583334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5843450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 585bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 586bdcd8170SKalle Valo key->key_len, 587f4bb9a6fSJouni Malinen NULL, 0, 588bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 589bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 590bdcd8170SKalle Valo } 591bdcd8170SKalle Valo 592bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 59359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 594240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 595240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 596bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 597bdcd8170SKalle Valo up(&ar->sem); 598bdcd8170SKalle Valo return -EIO; 599bdcd8170SKalle Valo } 600bdcd8170SKalle Valo } 601bdcd8170SKalle Valo 602f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 603bdcd8170SKalle Valo 604c422d52dSThomas Pedersen /* enable enhanced bmiss detection if applicable */ 605c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, true); 606c422d52dSThomas Pedersen 6073ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 6083ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 6093ca9d1fcSAarthi Thiruvengadam 610bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 611bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 612bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 613bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 614bdcd8170SKalle Valo __func__, 6153450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 6163450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 617f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 618bdcd8170SKalle Valo 619cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 620ce0dc0cfSRaja Mani 621ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 622b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 623b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 624ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 625ce0dc0cfSRaja Mani interval, 626ce0dc0cfSRaja Mani 0); 627ce0dc0cfSRaja Mani if (status) { 628ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 629ce0dc0cfSRaja Mani up(&ar->sem); 630ce0dc0cfSRaja Mani return status; 631ce0dc0cfSRaja Mani } 632ce0dc0cfSRaja Mani } 633ce0dc0cfSRaja Mani 634334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6353450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6363450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6373450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6383450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6393450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 640f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6413ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 642bdcd8170SKalle Valo 6436f7c1adbSMohammed Shafi Shajakhan if (sme->bg_scan_period == 0) { 644f599359cSBala Shanmugam /* disable background scan if period is 0 */ 645f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 6466f7c1adbSMohammed Shafi Shajakhan } else if (sme->bg_scan_period == -1) { 647f599359cSBala Shanmugam /* configure default value if not specified */ 648f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 6496f7c1adbSMohammed Shafi Shajakhan } 650f599359cSBala Shanmugam 651f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 652f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 653f599359cSBala Shanmugam 654bdcd8170SKalle Valo up(&ar->sem); 655bdcd8170SKalle Valo 656bdcd8170SKalle Valo if (status == -EINVAL) { 6573450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6583450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 659bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 660bdcd8170SKalle Valo return -ENOENT; 661bdcd8170SKalle Valo } else if (status) { 662bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 663bdcd8170SKalle Valo return -EIO; 664bdcd8170SKalle Valo } 665bdcd8170SKalle Valo 666bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 667ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 668ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 669de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 670bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 671bdcd8170SKalle Valo } 672bdcd8170SKalle Valo 673bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 67459c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 675bdcd8170SKalle Valo 676bdcd8170SKalle Valo return 0; 677bdcd8170SKalle Valo } 678bdcd8170SKalle Valo 6795e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6805e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6814eab6f4fSRaja Mani enum network_type nw_type, 6824eab6f4fSRaja Mani const u8 *bssid, 68301cac476SJouni Malinen struct ieee80211_channel *chan, 6845e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6855e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 68601cac476SJouni Malinen { 687240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 68801cac476SJouni Malinen struct cfg80211_bss *bss; 6894eab6f4fSRaja Mani u16 cap_mask, cap_val; 69001cac476SJouni Malinen u8 *ie; 69101cac476SJouni Malinen 6924eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6934eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6944eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6954eab6f4fSRaja Mani } else { 6964eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6974eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6984eab6f4fSRaja Mani } 6994eab6f4fSRaja Mani 700be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 7014eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 7024eab6f4fSRaja Mani cap_mask, cap_val); 70301cac476SJouni Malinen if (bss == NULL) { 70401cac476SJouni Malinen /* 70501cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 70601cac476SJouni Malinen * generate a partial entry until the first BSS info 70701cac476SJouni Malinen * event becomes available. 70801cac476SJouni Malinen * 70901cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 71001cac476SJouni Malinen * IEs from the target. 71101cac476SJouni Malinen */ 7123450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 71301cac476SJouni Malinen if (ie == NULL) 7145e13fd35SVasanthakumar Thiagarajan return NULL; 71501cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 7163450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 7173450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 7183450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 719be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 7205bc8c1f2SJohannes Berg CFG80211_BSS_FTYPE_UNKNOWN, 7214eab6f4fSRaja Mani bssid, 0, cap_val, 100, 7223450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 72301cac476SJouni Malinen 0, GFP_KERNEL); 72401cac476SJouni Malinen if (bss) 725cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 726cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 72701cac476SJouni Malinen kfree(ie); 728a5d8f9dfSKalle Valo } else { 7295e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 730a5d8f9dfSKalle Valo } 73101cac476SJouni Malinen 7325e13fd35SVasanthakumar Thiagarajan return bss; 73301cac476SJouni Malinen } 73401cac476SJouni Malinen 735240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 736bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 737bdcd8170SKalle Valo u16 beacon_intvl, 738bdcd8170SKalle Valo enum network_type nw_type, 739bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 740bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 741bdcd8170SKalle Valo { 74201cac476SJouni Malinen struct ieee80211_channel *chan; 743240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7445e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 745bdcd8170SKalle Valo 746bdcd8170SKalle Valo /* capinfo + listen interval */ 747bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 748bdcd8170SKalle Valo 749bdcd8170SKalle Valo /* capinfo + status code + associd */ 750bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 751bdcd8170SKalle Valo 752bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 753bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 754bdcd8170SKalle Valo assoc_resp_ie_offset; 755bdcd8170SKalle Valo 756bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 757bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 758bdcd8170SKalle Valo 75932c10874SJouni Malinen /* 76032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 76132c10874SJouni Malinen * a Beacon frame from the AP is seen. 76232c10874SJouni Malinen */ 763cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 76459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 76532c10874SJouni Malinen 766bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 767551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 768bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 769bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 770bdcd8170SKalle Valo return; 771bdcd8170SKalle Valo } 772bdcd8170SKalle Valo } 773bdcd8170SKalle Valo 774bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 775551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 776551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 777bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 778bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 779bdcd8170SKalle Valo return; 780bdcd8170SKalle Valo } 781bdcd8170SKalle Valo } 782bdcd8170SKalle Valo 783be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 784bdcd8170SKalle Valo 7855e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7865e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7875e13fd35SVasanthakumar Thiagarajan if (!bss) { 7884eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 789bdcd8170SKalle Valo return; 790bdcd8170SKalle Valo } 791bdcd8170SKalle Valo 7924eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7934eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7944eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 795fe94f3a4SAntonio Quartulli cfg80211_ibss_joined(vif->ndev, bssid, chan, GFP_KERNEL); 7965b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 79701cac476SJouni Malinen return; 79801cac476SJouni Malinen } 79901cac476SJouni Malinen 80014ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 801bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 80214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 803240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 804bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 805bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 806bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 8075b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 80814ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 809bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 8105e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 811bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 812bdcd8170SKalle Valo } 813bdcd8170SKalle Valo } 814bdcd8170SKalle Valo 815bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 816bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 817bdcd8170SKalle Valo { 818d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 8193450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 820bdcd8170SKalle Valo 821bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 822bdcd8170SKalle Valo reason_code); 823bdcd8170SKalle Valo 82410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 82510509f90SKalle Valo 826990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 827bdcd8170SKalle Valo return -EIO; 828bdcd8170SKalle Valo 829bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 830bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 831bdcd8170SKalle Valo return -EBUSY; 832bdcd8170SKalle Valo } 833bdcd8170SKalle Valo 834bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 835bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 836bdcd8170SKalle Valo return -ERESTARTSYS; 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 839cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 840240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8413450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8423450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 843bdcd8170SKalle Valo 844bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8458c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 846bdcd8170SKalle Valo 847bdcd8170SKalle Valo up(&ar->sem); 848bdcd8170SKalle Valo 84914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 850170826ddSVasanthakumar Thiagarajan 851bdcd8170SKalle Valo return 0; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo 854240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 855bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 856bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 857bdcd8170SKalle Valo { 858240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 85959c98449SVasanthakumar Thiagarajan 86014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 86114ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 86214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 863bdcd8170SKalle Valo } 864bdcd8170SKalle Valo 865f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 866fe94f3a4SAntonio Quartulli if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) 867bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 868bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 869bdcd8170SKalle Valo return; 870bdcd8170SKalle Valo } 871bdcd8170SKalle Valo 872f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 873551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 874551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 875bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 876bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 877bdcd8170SKalle Valo return; 878bdcd8170SKalle Valo } 879bdcd8170SKalle Valo } 880bdcd8170SKalle Valo 88159c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 882bdcd8170SKalle Valo 88314ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 884240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 885bdcd8170SKalle Valo bssid, NULL, 0, 886bdcd8170SKalle Valo NULL, 0, 887bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 888bdcd8170SKalle Valo GFP_KERNEL); 88914ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 89033a6664aSThomas Pedersen cfg80211_disconnected(vif->ndev, proto_reason, 891bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 892bdcd8170SKalle Valo } 893bdcd8170SKalle Valo 89414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 89533a6664aSThomas Pedersen 89633a6664aSThomas Pedersen /* 89733a6664aSThomas Pedersen * Send a disconnect command to target when a disconnect event is 89833a6664aSThomas Pedersen * received with reason code other than 3 (DISCONNECT_CMD - disconnect 89933a6664aSThomas Pedersen * request from host) to make the firmware stop trying to connect even 90033a6664aSThomas Pedersen * after giving disconnect event. There will be one more disconnect 90133a6664aSThomas Pedersen * event for this disconnect command with reason code DISCONNECT_CMD 90233a6664aSThomas Pedersen * which won't be notified to cfg80211. 90333a6664aSThomas Pedersen */ 90433a6664aSThomas Pedersen if (reason != DISCONNECT_CMD) 90533a6664aSThomas Pedersen ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 906bdcd8170SKalle Valo } 907bdcd8170SKalle Valo 9083b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 9093b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 910dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 911dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 912dd45b759SNaveen Singh int n_match_ssid) 9133b8ffc6aSJouni Malinen { 914dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 915dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 9163b8ffc6aSJouni Malinen 917dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 918dd45b759SNaveen Singh 919dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 920dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 9213b8ffc6aSJouni Malinen return -EINVAL; 9223b8ffc6aSJouni Malinen 9233b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 924dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 925dd45b759SNaveen Singh ssids[i].ssid, 926dd45b759SNaveen Singh ssids[i].ssid_len); 927dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 928dd45b759SNaveen Singh 929dd45b759SNaveen Singh if (ssids[i].ssid_len) 930dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 931dd45b759SNaveen Singh else 932dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 933dd45b759SNaveen Singh 934dd45b759SNaveen Singh if (n_match_ssid == 0) 935dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 936dd45b759SNaveen Singh } 937dd45b759SNaveen Singh 938dd45b759SNaveen Singh index_to_add = i; 939dd45b759SNaveen Singh 940dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 941dd45b759SNaveen Singh ssid_found = false; 942dd45b759SNaveen Singh 943dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 944dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 945dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 946dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 947dd45b759SNaveen Singh match_set[i].ssid.ssid, 948dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 949dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 950dd45b759SNaveen Singh ssid_found = true; 951dd45b759SNaveen Singh break; 952dd45b759SNaveen Singh } 953dd45b759SNaveen Singh } 954dd45b759SNaveen Singh 955dd45b759SNaveen Singh if (ssid_found) 956dd45b759SNaveen Singh continue; 957dd45b759SNaveen Singh 958dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 959dd45b759SNaveen Singh continue; 960dd45b759SNaveen Singh 961dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 962dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 963dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 964dd45b759SNaveen Singh match_set[i].ssid.ssid, 965dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 966dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 967dd45b759SNaveen Singh index_to_add++; 968dd45b759SNaveen Singh } 969dd45b759SNaveen Singh 970dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9713b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 972dd45b759SNaveen Singh ssid_list[i].flag, 973dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 974dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 9753b8ffc6aSJouni Malinen } 9763b8ffc6aSJouni Malinen 9773b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 978dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9793b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9803b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9813b8ffc6aSJouni Malinen } 9823b8ffc6aSJouni Malinen 9833b8ffc6aSJouni Malinen return 0; 9843b8ffc6aSJouni Malinen } 9853b8ffc6aSJouni Malinen 986fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy, 987bdcd8170SKalle Valo struct cfg80211_scan_request *request) 988bdcd8170SKalle Valo { 989fd014284SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev); 990fd014284SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 9911276c9efSEdward Lu s8 n_channels = 0; 9921276c9efSEdward Lu u16 *channels = NULL; 993bdcd8170SKalle Valo int ret = 0; 994f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 995bdcd8170SKalle Valo 996990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 997bdcd8170SKalle Valo return -EIO; 998bdcd8170SKalle Valo 99910509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 100010509f90SKalle Valo 1001bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 100259c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 1003954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 1004954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 10051b1e6ee3SJouni Malinen if (ret) { 1006bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 10071b1e6ee3SJouni Malinen return ret; 1008bdcd8170SKalle Valo } 1009bdcd8170SKalle Valo } 1010bdcd8170SKalle Valo 10113b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 1012dd45b759SNaveen Singh request->n_ssids, NULL, 0); 10133b8ffc6aSJouni Malinen if (ret < 0) 10143b8ffc6aSJouni Malinen return ret; 1015bdcd8170SKalle Valo 1016080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 1017334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1018334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 1019b84da8c7SJouni Malinen request->ie, request->ie_len); 1020b84da8c7SJouni Malinen if (ret) { 1021f1ff32e8SJoe Perches ath6kl_err("failed to set Probe Request appie for scan\n"); 1022b84da8c7SJouni Malinen return ret; 1023b84da8c7SJouni Malinen } 1024b84da8c7SJouni Malinen 102511869befSJouni Malinen /* 102611869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 102711869befSJouni Malinen * channels. If the list is longer than the target supports, do not 102811869befSJouni Malinen * configure the list and instead, scan all available channels. 102911869befSJouni Malinen */ 103011869befSJouni Malinen if (request->n_channels > 0 && 103111869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10321276c9efSEdward Lu u8 i; 10331276c9efSEdward Lu 103411869befSJouni Malinen n_channels = request->n_channels; 10351276c9efSEdward Lu 10361276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 10371276c9efSEdward Lu if (channels == NULL) { 1038cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10391276c9efSEdward Lu n_channels = 0; 10401276c9efSEdward Lu } 10411276c9efSEdward Lu 10421276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10431276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10441276c9efSEdward Lu } 10451276c9efSEdward Lu 104659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1047f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1048f1f92179SVasanthakumar Thiagarajan 10495b35dff0SRaja Mani vif->scan_req = request; 10505b35dff0SRaja Mani 10513ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10523ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 105313423c31SVasanthakumar Thiagarajan false, 0, 105413423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 105513423c31SVasanthakumar Thiagarajan n_channels, channels, 105613423c31SVasanthakumar Thiagarajan request->no_cck, 10573ca9d1fcSAarthi Thiruvengadam request->rates); 10585b35dff0SRaja Mani if (ret) { 105911f0bfcfSKalle Valo ath6kl_err("failed to start scan: %d\n", ret); 10605b35dff0SRaja Mani vif->scan_req = NULL; 10615b35dff0SRaja Mani } 1062bdcd8170SKalle Valo 10631276c9efSEdward Lu kfree(channels); 10641276c9efSEdward Lu 1065bdcd8170SKalle Valo return ret; 1066bdcd8170SKalle Valo } 1067bdcd8170SKalle Valo 10681c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1069bdcd8170SKalle Valo { 1070240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10716fd1eaceSKalle Valo int i; 1072bdcd8170SKalle Valo 10731c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10741c17d313SKalle Valo aborted ? " aborted" : ""); 1075bdcd8170SKalle Valo 107614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10776fd1eaceSKalle Valo return; 10786fd1eaceSKalle Valo 10791c17d313SKalle Valo if (aborted) 10806fd1eaceSKalle Valo goto out; 1081bdcd8170SKalle Valo 108214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 108314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1084334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1085334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1086bdcd8170SKalle Valo 0, NULL); 1087bdcd8170SKalle Valo } 1088bdcd8170SKalle Valo } 10896fd1eaceSKalle Valo 10906fd1eaceSKalle Valo out: 1091cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 109214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1093bdcd8170SKalle Valo } 1094bdcd8170SKalle Valo 1095c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1096c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1097c4f7863eSThomas Pedersen { 1098683b6d3bSJohannes Berg struct cfg80211_chan_def chandef; 1099c4f7863eSThomas Pedersen 1100c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1101c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1102c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1103c4f7863eSThomas Pedersen 11043d9d1d66SJohannes Berg cfg80211_chandef_create(&chandef, 11053d9d1d66SJohannes Berg ieee80211_get_channel(vif->ar->wiphy, freq), 11063d9d1d66SJohannes Berg (mode == WMI_11G_HT20) ? 11073d9d1d66SJohannes Berg NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT); 1108c4f7863eSThomas Pedersen 1109e487eaebSSimon Wunderlich mutex_lock(&vif->wdev.mtx); 1110683b6d3bSJohannes Berg cfg80211_ch_switch_notify(vif->ndev, &chandef); 1111e487eaebSSimon Wunderlich mutex_unlock(&vif->wdev.mtx); 1112c4f7863eSThomas Pedersen } 1113c4f7863eSThomas Pedersen 1114bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1115bdcd8170SKalle Valo u8 key_index, bool pairwise, 1116bdcd8170SKalle Valo const u8 *mac_addr, 1117bdcd8170SKalle Valo struct key_params *params) 1118bdcd8170SKalle Valo { 1119d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 112059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1121bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 11224a8ce2fdSSujith Manoharan int seq_len; 1123bdcd8170SKalle Valo u8 key_usage; 1124bdcd8170SKalle Valo u8 key_type; 1125bdcd8170SKalle Valo 1126990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1127bdcd8170SKalle Valo return -EIO; 1128bdcd8170SKalle Valo 1129837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1130837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1131837cb97eSJouni Malinen return -EINVAL; 1132240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1133240d2799SVasanthakumar Thiagarajan params->key); 1134837cb97eSJouni Malinen } 1135837cb97eSJouni Malinen 1136792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1137bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1138bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1139bdcd8170SKalle Valo key_index); 1140bdcd8170SKalle Valo return -ENOENT; 1141bdcd8170SKalle Valo } 1142bdcd8170SKalle Valo 11436f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1144bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1145bdcd8170SKalle Valo 1146bdcd8170SKalle Valo if (pairwise) 1147bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1148bdcd8170SKalle Valo else 1149bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1150bdcd8170SKalle Valo 11514a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11525e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11535e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11545e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11555e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11565e07021eSDai Shuibing } 1157bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11585e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1159bdcd8170SKalle Valo return -EINVAL; 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo key->key_len = params->key_len; 1162bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11635e07021eSDai Shuibing key->seq_len = seq_len; 1164bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1165bdcd8170SKalle Valo key->cipher = params->cipher; 1166bdcd8170SKalle Valo 1167bdcd8170SKalle Valo switch (key->cipher) { 1168bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1169bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1170bdcd8170SKalle Valo key_type = WEP_CRYPT; 1171bdcd8170SKalle Valo break; 1172bdcd8170SKalle Valo 1173bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1174bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1175bdcd8170SKalle Valo break; 1176bdcd8170SKalle Valo 1177bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1178bdcd8170SKalle Valo key_type = AES_CRYPT; 1179bdcd8170SKalle Valo break; 11805e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11815e07021eSDai Shuibing key_type = WAPI_CRYPT; 11825e07021eSDai Shuibing break; 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo default: 1185bdcd8170SKalle Valo return -ENOTSUPP; 1186bdcd8170SKalle Valo } 1187bdcd8170SKalle Valo 1188ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1189ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1190ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1191de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1192bdcd8170SKalle Valo 1193bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1194bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1195bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1196bdcd8170SKalle Valo key_usage, key->seq_len); 1197bdcd8170SKalle Valo 1198f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11994703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1200cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 12019a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 12029a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 12039a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 12049a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 12059a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 120659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1207cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1208cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 12099a5b1318SJouni Malinen /* 12109a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 12119a5b1318SJouni Malinen * the connected event is received from the target. 12129a5b1318SJouni Malinen */ 12139a5b1318SJouni Malinen return 0; 12149a5b1318SJouni Malinen } 12159a5b1318SJouni Malinen } 12169a5b1318SJouni Malinen 1217f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 121859c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1219151411e8SJouni Malinen /* 1220151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1221151411e8SJouni Malinen * the AP mode has properly started 1222151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1223151411e8SJouni Malinen */ 1224cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1225cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 12266f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 12276f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 12286f2a73f9SVasanthakumar Thiagarajan key->key_len); 1229151411e8SJouni Malinen return 0; 1230151411e8SJouni Malinen } 1231151411e8SJouni Malinen 12327cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1233bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1234f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1235f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1236bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1237bdcd8170SKalle Valo } 1238bdcd8170SKalle Valo 1239bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1240bdcd8170SKalle Valo u8 key_index, bool pairwise, 1241bdcd8170SKalle Valo const u8 *mac_addr) 1242bdcd8170SKalle Valo { 1243d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12446f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1245bdcd8170SKalle Valo 1246bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1247bdcd8170SKalle Valo 1248990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1249bdcd8170SKalle Valo return -EIO; 1250bdcd8170SKalle Valo 1251792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1252bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1253bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1254bdcd8170SKalle Valo key_index); 1255bdcd8170SKalle Valo return -ENOENT; 1256bdcd8170SKalle Valo } 1257bdcd8170SKalle Valo 12586f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1259bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1260bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1261bdcd8170SKalle Valo return 0; 1262bdcd8170SKalle Valo } 1263bdcd8170SKalle Valo 12646f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1265bdcd8170SKalle Valo 1266334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1267bdcd8170SKalle Valo } 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1270bdcd8170SKalle Valo u8 key_index, bool pairwise, 1271bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1272bdcd8170SKalle Valo void (*callback) (void *cookie, 1273bdcd8170SKalle Valo struct key_params *)) 1274bdcd8170SKalle Valo { 12756f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1276bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1277bdcd8170SKalle Valo struct key_params params; 1278bdcd8170SKalle Valo 1279bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1280bdcd8170SKalle Valo 1281990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1282bdcd8170SKalle Valo return -EIO; 1283bdcd8170SKalle Valo 1284792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1285bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1286bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1287bdcd8170SKalle Valo key_index); 1288bdcd8170SKalle Valo return -ENOENT; 1289bdcd8170SKalle Valo } 1290bdcd8170SKalle Valo 12916f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1292bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1293bdcd8170SKalle Valo params.cipher = key->cipher; 1294bdcd8170SKalle Valo params.key_len = key->key_len; 1295bdcd8170SKalle Valo params.seq_len = key->seq_len; 1296bdcd8170SKalle Valo params.seq = key->seq; 1297bdcd8170SKalle Valo params.key = key->key; 1298bdcd8170SKalle Valo 1299bdcd8170SKalle Valo callback(cookie, ¶ms); 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1302bdcd8170SKalle Valo } 1303bdcd8170SKalle Valo 1304bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1305bdcd8170SKalle Valo struct net_device *ndev, 1306bdcd8170SKalle Valo u8 key_index, bool unicast, 1307bdcd8170SKalle Valo bool multicast) 1308bdcd8170SKalle Valo { 1309d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 131059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1311bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1312bdcd8170SKalle Valo u8 key_usage; 1313229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1314bdcd8170SKalle Valo 1315bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1316bdcd8170SKalle Valo 1317990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1318bdcd8170SKalle Valo return -EIO; 1319bdcd8170SKalle Valo 1320792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1321bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1322bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1323bdcd8170SKalle Valo __func__, key_index); 1324bdcd8170SKalle Valo return -ENOENT; 1325bdcd8170SKalle Valo } 1326bdcd8170SKalle Valo 13276f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1328bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1329bdcd8170SKalle Valo __func__, key_index); 1330bdcd8170SKalle Valo return -EINVAL; 1331bdcd8170SKalle Valo } 1332bdcd8170SKalle Valo 13333450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13346f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1335bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13363450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1337bdcd8170SKalle Valo key_usage |= TX_USAGE; 1338229ed6b5SEdward Lu if (unicast) 13393450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1340229ed6b5SEdward Lu if (multicast) 13413450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1342bdcd8170SKalle Valo 1343f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13449a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13459a5b1318SJouni Malinen 1346f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1347334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1348229ed6b5SEdward Lu key_type, key_usage, 1349f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1350f4bb9a6fSJouni Malinen key->key, 1351bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1352bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1353bdcd8170SKalle Valo } 1354bdcd8170SKalle Valo 1355240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1356bdcd8170SKalle Valo bool ismcast) 1357bdcd8170SKalle Valo { 1358bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1359bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1360bdcd8170SKalle Valo 1361240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1362bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1363bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1364bdcd8170SKalle Valo GFP_KERNEL); 1365bdcd8170SKalle Valo } 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1368bdcd8170SKalle Valo { 1369bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1370990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1371bdcd8170SKalle Valo int ret; 1372bdcd8170SKalle Valo 1373bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1374bdcd8170SKalle Valo changed); 1375bdcd8170SKalle Valo 1376990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1377990bd915SVasanthakumar Thiagarajan if (!vif) 1378990bd915SVasanthakumar Thiagarajan return -EIO; 1379990bd915SVasanthakumar Thiagarajan 1380990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1381bdcd8170SKalle Valo return -EIO; 1382bdcd8170SKalle Valo 1383bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1384bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1385bdcd8170SKalle Valo if (ret != 0) { 1386bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1387bdcd8170SKalle Valo return -EIO; 1388bdcd8170SKalle Valo } 1389bdcd8170SKalle Valo } 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo return 0; 1392bdcd8170SKalle Valo } 1393bdcd8170SKalle Valo 1394bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1395c8442118SJohannes Berg struct wireless_dev *wdev, 1396bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1397b992a285SLuis R. Rodriguez int mbm) 1398bdcd8170SKalle Valo { 1399bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1400990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1401b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1402bdcd8170SKalle Valo 1403bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1404bdcd8170SKalle Valo type, dbm); 1405bdcd8170SKalle Valo 1406990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1407990bd915SVasanthakumar Thiagarajan if (!vif) 1408990bd915SVasanthakumar Thiagarajan return -EIO; 1409990bd915SVasanthakumar Thiagarajan 1410990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1411bdcd8170SKalle Valo return -EIO; 1412bdcd8170SKalle Valo 1413bdcd8170SKalle Valo switch (type) { 1414bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1415bdcd8170SKalle Valo return 0; 1416bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1417d0d670abSKalle Valo ar->tx_pwr = dbm; 1418bdcd8170SKalle Valo break; 1419bdcd8170SKalle Valo default: 1420bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1421bdcd8170SKalle Valo __func__, type); 1422bdcd8170SKalle Valo return -EOPNOTSUPP; 1423bdcd8170SKalle Valo } 1424bdcd8170SKalle Valo 1425d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1426bdcd8170SKalle Valo 1427bdcd8170SKalle Valo return 0; 1428bdcd8170SKalle Valo } 1429bdcd8170SKalle Valo 1430c8442118SJohannes Berg static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, 1431c8442118SJohannes Berg struct wireless_dev *wdev, 1432c8442118SJohannes Berg int *dbm) 1433bdcd8170SKalle Valo { 1434bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1435990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1436bdcd8170SKalle Valo 1437990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1438990bd915SVasanthakumar Thiagarajan if (!vif) 1439990bd915SVasanthakumar Thiagarajan return -EIO; 1440990bd915SVasanthakumar Thiagarajan 1441990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1442bdcd8170SKalle Valo return -EIO; 1443bdcd8170SKalle Valo 144459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1445bdcd8170SKalle Valo ar->tx_pwr = 0; 1446bdcd8170SKalle Valo 1447990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1448bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1449bdcd8170SKalle Valo return -EIO; 1450bdcd8170SKalle Valo } 1451bdcd8170SKalle Valo 1452bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1453bdcd8170SKalle Valo 5 * HZ); 1454bdcd8170SKalle Valo 1455bdcd8170SKalle Valo if (signal_pending(current)) { 1456bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1457bdcd8170SKalle Valo return -EINTR; 1458bdcd8170SKalle Valo } 1459bdcd8170SKalle Valo } 1460bdcd8170SKalle Valo 1461bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1462bdcd8170SKalle Valo return 0; 1463bdcd8170SKalle Valo } 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1466bdcd8170SKalle Valo struct net_device *dev, 1467bdcd8170SKalle Valo bool pmgmt, int timeout) 1468bdcd8170SKalle Valo { 1469bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1470bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1471334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1472bdcd8170SKalle Valo 1473bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1474bdcd8170SKalle Valo __func__, pmgmt, timeout); 1475bdcd8170SKalle Valo 1476990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1477bdcd8170SKalle Valo return -EIO; 1478bdcd8170SKalle Valo 1479bdcd8170SKalle Valo if (pmgmt) { 1480f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1481bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1482bdcd8170SKalle Valo } else { 1483f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1484bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1485bdcd8170SKalle Valo } 1486bdcd8170SKalle Valo 1487334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1488334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1489bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1490bdcd8170SKalle Valo return -EIO; 1491bdcd8170SKalle Valo } 1492bdcd8170SKalle Valo 1493bdcd8170SKalle Valo return 0; 1494bdcd8170SKalle Valo } 1495bdcd8170SKalle Valo 149684efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1497552bff0cSJohannes Berg const char *name, 149855055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 149955055976SVasanthakumar Thiagarajan u32 *flags, 150055055976SVasanthakumar Thiagarajan struct vif_params *params) 150155055976SVasanthakumar Thiagarajan { 150255055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 150384efbb84SJohannes Berg struct wireless_dev *wdev; 150455055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 150555055976SVasanthakumar Thiagarajan 150671f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 150755055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 150855055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 150955055976SVasanthakumar Thiagarajan } 151055055976SVasanthakumar Thiagarajan 151155055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 151255055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 151355055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 151455055976SVasanthakumar Thiagarajan } 151555055976SVasanthakumar Thiagarajan 151684efbb84SJohannes Berg wdev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 151784efbb84SJohannes Berg if (!wdev) 151855055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 151955055976SVasanthakumar Thiagarajan 152055055976SVasanthakumar Thiagarajan ar->num_vif++; 152155055976SVasanthakumar Thiagarajan 152284efbb84SJohannes Berg return wdev; 152355055976SVasanthakumar Thiagarajan } 152455055976SVasanthakumar Thiagarajan 152555055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 152684efbb84SJohannes Berg struct wireless_dev *wdev) 152755055976SVasanthakumar Thiagarajan { 152855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 152984efbb84SJohannes Berg struct ath6kl_vif *vif = netdev_priv(wdev->netdev); 153055055976SVasanthakumar Thiagarajan 153111f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 153255055976SVasanthakumar Thiagarajan list_del(&vif->list); 153311f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 153455055976SVasanthakumar Thiagarajan 1535355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_vif_stop(vif, test_bit(WMI_READY, &ar->flag)); 153655055976SVasanthakumar Thiagarajan 1537bc52aab3SMohammed Shafi Shajakhan rtnl_lock(); 1538c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 1539bc52aab3SMohammed Shafi Shajakhan rtnl_unlock(); 154055055976SVasanthakumar Thiagarajan 154155055976SVasanthakumar Thiagarajan return 0; 154255055976SVasanthakumar Thiagarajan } 154355055976SVasanthakumar Thiagarajan 1544bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1545bdcd8170SKalle Valo struct net_device *ndev, 1546bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1547bdcd8170SKalle Valo struct vif_params *params) 1548bdcd8170SKalle Valo { 1549f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15501e8d13b0SVasanthakumar Thiagarajan int i; 1551bdcd8170SKalle Valo 1552bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1553bdcd8170SKalle Valo 15541e8d13b0SVasanthakumar Thiagarajan /* 15551e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15561e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15571e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15581e8d13b0SVasanthakumar Thiagarajan */ 15591e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15601e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15611e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15621e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15631e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15641e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15651e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15661e8d13b0SVasanthakumar Thiagarajan else 15671e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15681e8d13b0SVasanthakumar Thiagarajan } 15691e8d13b0SVasanthakumar Thiagarajan 15701e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15711e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15721e8d13b0SVasanthakumar Thiagarajan break; 15731e8d13b0SVasanthakumar Thiagarajan } 15741e8d13b0SVasanthakumar Thiagarajan 15751e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15761e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15771e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15781e8d13b0SVasanthakumar Thiagarajan } 15791e8d13b0SVasanthakumar Thiagarajan } 15801e8d13b0SVasanthakumar Thiagarajan 1581c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1582c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1583c422d52dSThomas Pedersen 15841e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1585bdcd8170SKalle Valo switch (type) { 1586bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 15878aa659d2SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 1588f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1589bdcd8170SKalle Valo break; 1590bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1591f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1592bdcd8170SKalle Valo break; 15936e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 15946b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1595f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15966b5e5d25SJouni Malinen break; 1597bdcd8170SKalle Valo default: 1598bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1599bdcd8170SKalle Valo return -EOPNOTSUPP; 1600bdcd8170SKalle Valo } 1601bdcd8170SKalle Valo 1602551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1603bdcd8170SKalle Valo 1604bdcd8170SKalle Valo return 0; 1605bdcd8170SKalle Valo } 1606bdcd8170SKalle Valo 1607bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1608bdcd8170SKalle Valo struct net_device *dev, 1609bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1610bdcd8170SKalle Valo { 1611bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 161259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1613bdcd8170SKalle Valo int status; 1614bdcd8170SKalle Valo 1615990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1616bdcd8170SKalle Valo return -EIO; 1617bdcd8170SKalle Valo 16183450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 16193450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1620bdcd8170SKalle Valo 1621683b6d3bSJohannes Berg if (ibss_param->chandef.chan) 1622683b6d3bSJohannes Berg vif->ch_hint = ibss_param->chandef.chan->center_freq; 1623bdcd8170SKalle Valo 1624bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1625bdcd8170SKalle Valo /* 1626bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1627bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1628bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1629bdcd8170SKalle Valo * updated. 1630bdcd8170SKalle Valo */ 1631bdcd8170SKalle Valo return -EOPNOTSUPP; 1632bdcd8170SKalle Valo } 1633bdcd8170SKalle Valo 16348c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1635bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16368c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16378c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1638bdcd8170SKalle Valo 1639240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1640bdcd8170SKalle Valo 1641240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1642bdcd8170SKalle Valo if (status) 1643bdcd8170SKalle Valo return status; 1644bdcd8170SKalle Valo 1645bdcd8170SKalle Valo if (ibss_param->privacy) { 1646240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1647240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1648bdcd8170SKalle Valo } else { 1649240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1650240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1651bdcd8170SKalle Valo } 1652bdcd8170SKalle Valo 1653f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1654bdcd8170SKalle Valo 1655bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1656bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1657bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1658bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1659bdcd8170SKalle Valo __func__, 16603450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16613450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1662f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1663bdcd8170SKalle Valo 1664334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16653450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16663450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16673450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16683450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16693450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1670f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16713ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 167259c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1673bdcd8170SKalle Valo 1674bdcd8170SKalle Valo return 0; 1675bdcd8170SKalle Valo } 1676bdcd8170SKalle Valo 1677bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1678bdcd8170SKalle Valo struct net_device *dev) 1679bdcd8170SKalle Valo { 16803450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1681bdcd8170SKalle Valo 1682990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1683bdcd8170SKalle Valo return -EIO; 1684bdcd8170SKalle Valo 1685240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16863450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16873450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo return 0; 1690bdcd8170SKalle Valo } 1691bdcd8170SKalle Valo 1692bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1693bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1694bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1695bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1696bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1697837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16985e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1699bdcd8170SKalle Valo }; 1700bdcd8170SKalle Valo 1701bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1702bdcd8170SKalle Valo { 1703bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1704bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1705bdcd8170SKalle Valo 36000, 48000, 54000 1706bdcd8170SKalle Valo }; 1707bdcd8170SKalle Valo u8 i; 1708bdcd8170SKalle Valo 1709bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1710bdcd8170SKalle Valo if (rate == legacy[i]) 1711bdcd8170SKalle Valo return true; 1712bdcd8170SKalle Valo 1713bdcd8170SKalle Valo return false; 1714bdcd8170SKalle Valo } 1715bdcd8170SKalle Valo 1716bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1717bdcd8170SKalle Valo { 1718bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1719bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1720bdcd8170SKalle Valo }; 1721bdcd8170SKalle Valo u8 i; 1722bdcd8170SKalle Valo 1723bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1724bdcd8170SKalle Valo if (rate == ht20[i]) { 1725bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1726bdcd8170SKalle Valo /* last rate uses sgi */ 1727bdcd8170SKalle Valo *sgi = true; 1728bdcd8170SKalle Valo else 1729bdcd8170SKalle Valo *sgi = false; 1730bdcd8170SKalle Valo 1731bdcd8170SKalle Valo *mcs = i; 1732bdcd8170SKalle Valo return true; 1733bdcd8170SKalle Valo } 1734bdcd8170SKalle Valo } 1735bdcd8170SKalle Valo return false; 1736bdcd8170SKalle Valo } 1737bdcd8170SKalle Valo 1738bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1739bdcd8170SKalle Valo { 1740bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1741bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1742bdcd8170SKalle Valo 150000 1743bdcd8170SKalle Valo }; 1744bdcd8170SKalle Valo u8 i; 1745bdcd8170SKalle Valo 1746bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1747bdcd8170SKalle Valo if (rate == ht40[i]) { 1748bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1749bdcd8170SKalle Valo /* last rate uses sgi */ 1750bdcd8170SKalle Valo *sgi = true; 1751bdcd8170SKalle Valo else 1752bdcd8170SKalle Valo *sgi = false; 1753bdcd8170SKalle Valo 1754bdcd8170SKalle Valo *mcs = i; 1755bdcd8170SKalle Valo return true; 1756bdcd8170SKalle Valo } 1757bdcd8170SKalle Valo } 1758bdcd8170SKalle Valo 1759bdcd8170SKalle Valo return false; 1760bdcd8170SKalle Valo } 1761bdcd8170SKalle Valo 1762bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 17633b3a0162SJohannes Berg const u8 *mac, struct station_info *sinfo) 1764bdcd8170SKalle Valo { 1765bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 176659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1767bdcd8170SKalle Valo long left; 1768bdcd8170SKalle Valo bool sgi; 1769bdcd8170SKalle Valo s32 rate; 1770bdcd8170SKalle Valo int ret; 1771bdcd8170SKalle Valo u8 mcs; 1772bdcd8170SKalle Valo 17738c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1774bdcd8170SKalle Valo return -ENOENT; 1775bdcd8170SKalle Valo 1776bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1777bdcd8170SKalle Valo return -EBUSY; 1778bdcd8170SKalle Valo 1779b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1780bdcd8170SKalle Valo 1781334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1782bdcd8170SKalle Valo 1783bdcd8170SKalle Valo if (ret != 0) { 1784bdcd8170SKalle Valo up(&ar->sem); 1785bdcd8170SKalle Valo return -EIO; 1786bdcd8170SKalle Valo } 1787bdcd8170SKalle Valo 1788bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1789bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1790b95907a7SVasanthakumar Thiagarajan &vif->flags), 1791bdcd8170SKalle Valo WMI_TIMEOUT); 1792bdcd8170SKalle Valo 1793bdcd8170SKalle Valo up(&ar->sem); 1794bdcd8170SKalle Valo 1795bdcd8170SKalle Valo if (left == 0) 1796bdcd8170SKalle Valo return -ETIMEDOUT; 1797bdcd8170SKalle Valo else if (left < 0) 1798bdcd8170SKalle Valo return left; 1799bdcd8170SKalle Valo 1800b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1801b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1802319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64); 1803b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1804319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS); 1805bdcd8170SKalle Valo } 1806bdcd8170SKalle Valo 1807b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1808b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1809319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64); 1810b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1811319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS); 1812bdcd8170SKalle Valo } 1813bdcd8170SKalle Valo 1814b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1815319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL); 1816bdcd8170SKalle Valo 1817b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1818bdcd8170SKalle Valo 1819bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1820bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1821bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1822bdcd8170SKalle Valo if (sgi) { 1823bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1824bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1825bdcd8170SKalle Valo } else { 1826bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1827bdcd8170SKalle Valo } 1828bdcd8170SKalle Valo 1829bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1830b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_20; 1831bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1832bdcd8170SKalle Valo if (sgi) { 1833bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1834bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1835bdcd8170SKalle Valo } else { 1836bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1837bdcd8170SKalle Valo } 1838bdcd8170SKalle Valo 1839b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_40; 1840bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1841bdcd8170SKalle Valo } else { 18429a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18439a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18449a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1845bdcd8170SKalle Valo return 0; 1846bdcd8170SKalle Valo } 1847bdcd8170SKalle Valo 1848319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE); 1849bdcd8170SKalle Valo 185059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 185159c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1852f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 1853319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_BSS_PARAM); 185432c10874SJouni Malinen sinfo->bss_param.flags = 0; 1855cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1856cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 185732c10874SJouni Malinen } 185832c10874SJouni Malinen 1859bdcd8170SKalle Valo return 0; 1860bdcd8170SKalle Valo } 1861bdcd8170SKalle Valo 1862bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1863bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1864bdcd8170SKalle Valo { 1865bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1866334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1867334234b5SVasanthakumar Thiagarajan 1868334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1869bdcd8170SKalle Valo pmksa->pmkid, true); 1870bdcd8170SKalle Valo } 1871bdcd8170SKalle Valo 1872bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1873bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1874bdcd8170SKalle Valo { 1875bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1876334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1877334234b5SVasanthakumar Thiagarajan 1878334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1879bdcd8170SKalle Valo pmksa->pmkid, false); 1880bdcd8170SKalle Valo } 1881bdcd8170SKalle Valo 1882bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1883bdcd8170SKalle Valo { 1884bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 188559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 188659c98449SVasanthakumar Thiagarajan 188759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1888334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1889334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1890bdcd8170SKalle Valo return 0; 1891bdcd8170SKalle Valo } 1892bdcd8170SKalle Valo 1893d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1894d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18956cb3c714SRaja Mani { 1896d91e8eeeSRaja Mani int ret, pos; 18972c07cf44SThomas Pedersen u8 mask[WOW_PATTERN_SIZE]; 18986cb3c714SRaja Mani u16 i; 18996cb3c714SRaja Mani 1900d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 19016cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 19026cb3c714SRaja Mani /* 19036cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 19046cb3c714SRaja Mani * driver specific mask value and send it to the chip along 19056cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 19066cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 19076cb3c714SRaja Mani * then equivalent driver specific mask value is 19086cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 19096cb3c714SRaja Mani */ 19106cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 19116cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 19126cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 19136cb3c714SRaja Mani mask[pos] = 0xFF; 19146cb3c714SRaja Mani } 19156cb3c714SRaja Mani /* 19166cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 19176cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 19186cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 19196cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 19206cb3c714SRaja Mani */ 19216cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 19226cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 19236cb3c714SRaja Mani wow->patterns[i].pattern_len, 19246cb3c714SRaja Mani 0 /* pattern offset */, 19256cb3c714SRaja Mani wow->patterns[i].pattern, mask); 19266cb3c714SRaja Mani if (ret) 19276cb3c714SRaja Mani return ret; 19286cb3c714SRaja Mani } 19296cb3c714SRaja Mani 1930d91e8eeeSRaja Mani if (wow->disconnect) 1931d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1932d91e8eeeSRaja Mani 1933d91e8eeeSRaja Mani if (wow->magic_pkt) 1934d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1935d91e8eeeSRaja Mani 1936d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1937d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1938d91e8eeeSRaja Mani 1939d91e8eeeSRaja Mani if (wow->eap_identity_req) 1940d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1941d91e8eeeSRaja Mani 1942d91e8eeeSRaja Mani if (wow->four_way_handshake) 1943d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1944d91e8eeeSRaja Mani 1945d91e8eeeSRaja Mani return 0; 1946d91e8eeeSRaja Mani } 1947d91e8eeeSRaja Mani 1948d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1949d91e8eeeSRaja Mani { 1950d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1951d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1952d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1953d91e8eeeSRaja Mani 0x00, 0x08 }; 1954d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1955d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1956d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1957d91e8eeeSRaja Mani 0x00, 0x7f }; 1958d91e8eeeSRaja Mani u8 unicst_offset = 0; 1959d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1960d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1961d91e8eeeSRaja Mani u8 arp_offset = 20; 1962d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1963d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1964d91e8eeeSRaja Mani u8 discvr_offset = 38; 1965d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1966d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1967d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1968d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1969d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1970d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1971d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1972d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1973d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1974d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1975d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1976d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1977d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1978d91e8eeeSRaja Mani int ret; 1979d91e8eeeSRaja Mani 1980d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1981d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1982d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1983d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1984d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1985d91e8eeeSRaja Mani if (ret) { 1986d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1987d91e8eeeSRaja Mani return ret; 1988d91e8eeeSRaja Mani } 1989d91e8eeeSRaja Mani 1990d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1991d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1992d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1993d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1994d91e8eeeSRaja Mani arp_pattern, arp_mask); 1995d91e8eeeSRaja Mani if (ret) { 1996d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1997d91e8eeeSRaja Mani return ret; 1998d91e8eeeSRaja Mani } 1999d91e8eeeSRaja Mani 2000d91e8eeeSRaja Mani /* 2001d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2002d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2003d91e8eeeSRaja Mani */ 2004d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2005d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2006d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2007d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2008d91e8eeeSRaja Mani if (ret) { 2009d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2010d91e8eeeSRaja Mani return ret; 2011d91e8eeeSRaja Mani } 2012d91e8eeeSRaja Mani 2013d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 2014d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2015d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2016d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 2017d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 2018d91e8eeeSRaja Mani if (ret) { 2019d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 2020d91e8eeeSRaja Mani return ret; 2021d91e8eeeSRaja Mani } 2022d91e8eeeSRaja Mani 2023d91e8eeeSRaja Mani return 0; 2024d91e8eeeSRaja Mani } 2025d91e8eeeSRaja Mani 2026d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2027d91e8eeeSRaja Mani { 2028d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2029d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2030d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2031d91e8eeeSRaja Mani u8 discvr_offset = 38; 2032d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2033d91e8eeeSRaja Mani int ret; 2034d91e8eeeSRaja Mani 2035d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 203693803b33SJoe Perches eth_broadcast_addr(mac_mask); 2037d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2038d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2039d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2040d91e8eeeSRaja Mani mac_mask); 2041d91e8eeeSRaja Mani if (ret) { 2042d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2043d91e8eeeSRaja Mani return ret; 2044d91e8eeeSRaja Mani } 2045d91e8eeeSRaja Mani 2046d91e8eeeSRaja Mani /* 2047d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2048d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2049d91e8eeeSRaja Mani */ 2050d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2051d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2052d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2053d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2054d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2055d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2056d91e8eeeSRaja Mani if (ret) { 2057cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2058d91e8eeeSRaja Mani return ret; 2059d91e8eeeSRaja Mani } 2060d91e8eeeSRaja Mani } 2061d91e8eeeSRaja Mani 2062d91e8eeeSRaja Mani return 0; 2063d91e8eeeSRaja Mani } 2064d91e8eeeSRaja Mani 2065055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2066055bde49SRaja Mani { 2067055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2068055bde49SRaja Mani } 2069055bde49SRaja Mani 2070055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2071055bde49SRaja Mani { 2072055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2073055bde49SRaja Mani } 2074055bde49SRaja Mani 2075055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2076055bde49SRaja Mani { 2077055bde49SRaja Mani int ret, left; 2078055bde49SRaja Mani 2079055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2080055bde49SRaja Mani 2081055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2082055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2083055bde49SRaja Mani if (ret) 2084055bde49SRaja Mani return ret; 2085055bde49SRaja Mani 2086055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2087055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2088055bde49SRaja Mani WMI_TIMEOUT); 2089055bde49SRaja Mani if (left == 0) { 2090055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2091055bde49SRaja Mani ret = -ETIMEDOUT; 2092055bde49SRaja Mani } else if (left < 0) { 2093055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2094055bde49SRaja Mani left); 2095055bde49SRaja Mani ret = left; 2096055bde49SRaja Mani } 2097055bde49SRaja Mani 2098055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2099055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2100055bde49SRaja Mani is_ctrl_ep_empty(ar), 2101055bde49SRaja Mani WMI_TIMEOUT); 2102055bde49SRaja Mani if (left == 0) { 2103055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2104055bde49SRaja Mani ret = -ETIMEDOUT; 2105055bde49SRaja Mani } else if (left < 0) { 2106055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2107055bde49SRaja Mani ret = left; 2108055bde49SRaja Mani } 2109055bde49SRaja Mani } 2110055bde49SRaja Mani 2111055bde49SRaja Mani return ret; 2112055bde49SRaja Mani } 2113055bde49SRaja Mani 2114fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif, 2115fd4377b6SThomas Pedersen struct cfg80211_wowlan *wow, u32 *filter) 2116d91e8eeeSRaja Mani { 2117fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 2118d91e8eeeSRaja Mani struct in_device *in_dev; 2119d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2120055bde49SRaja Mani int ret; 2121ce0dc0cfSRaja Mani u16 i, bmiss_time; 2122d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2123fd4377b6SThomas Pedersen u8 index = 0; 2124d91e8eeeSRaja Mani 21256821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 21266821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21276821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21286251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21296251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21306251d801SNaveen Gangadharan if (ret) 21316251d801SNaveen Gangadharan return ret; 21326251d801SNaveen Gangadharan } 21336251d801SNaveen Gangadharan 2134d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2135d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2136d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2137d91e8eeeSRaja Mani WOW_LIST_ID, i); 2138d91e8eeeSRaja Mani 2139d91e8eeeSRaja Mani /* 2140d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2141d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2142d91e8eeeSRaja Mani * the user. 2143d91e8eeeSRaja Mani */ 2144d91e8eeeSRaja Mani if (wow) 2145fd4377b6SThomas Pedersen ret = ath6kl_wow_usr(ar, vif, wow, filter); 2146d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2147d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2148d91e8eeeSRaja Mani else 2149d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2150d91e8eeeSRaja Mani 2151d91e8eeeSRaja Mani if (ret) 2152d91e8eeeSRaja Mani return ret; 2153d91e8eeeSRaja Mani 2154390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2155390a8c8fSRaja Mani 2156ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2157ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2158ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2159ce0dc0cfSRaja Mani 0); 2160ce0dc0cfSRaja Mani if (ret) 2161ce0dc0cfSRaja Mani return ret; 2162ce0dc0cfSRaja Mani 2163ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2164ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2165ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2166ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2167ce0dc0cfSRaja Mani 2168ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2169ce0dc0cfSRaja Mani bmiss_time, 0); 2170ce0dc0cfSRaja Mani if (ret) 2171ce0dc0cfSRaja Mani return ret; 2172ce0dc0cfSRaja Mani 2173ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2174ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2175ce0dc0cfSRaja Mani 0, 0, 0, 0); 2176ce0dc0cfSRaja Mani if (ret) 2177ce0dc0cfSRaja Mani return ret; 2178ce0dc0cfSRaja Mani } 2179ce0dc0cfSRaja Mani 2180c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2181c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2182c08631c6SRaja Mani if (!in_dev) 2183fd4377b6SThomas Pedersen return 0; 2184c08631c6SRaja Mani 2185c08631c6SRaja Mani ifa = in_dev->ifa_list; 2186c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2187c08631c6SRaja Mani 2188c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2189c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2190c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2191c08631c6SRaja Mani ifa = ifa->ifa_next; 2192c08631c6SRaja Mani index++; 2193c08631c6SRaja Mani } 2194c08631c6SRaja Mani 2195c08631c6SRaja Mani if (ifa) { 2196c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2197c08631c6SRaja Mani return -EINVAL; 2198c08631c6SRaja Mani } 2199c08631c6SRaja Mani 2200c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2201c08631c6SRaja Mani if (ret) { 2202c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2203c08631c6SRaja Mani return ret; 2204c08631c6SRaja Mani } 2205c08631c6SRaja Mani 2206fd4377b6SThomas Pedersen return ret; 2207fd4377b6SThomas Pedersen } 2208fd4377b6SThomas Pedersen 2209fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2210fd4377b6SThomas Pedersen { 2211fd4377b6SThomas Pedersen struct ath6kl_vif *first_vif, *vif; 2212fd4377b6SThomas Pedersen int ret = 0; 2213fd4377b6SThomas Pedersen u32 filter = 0; 2214fd4377b6SThomas Pedersen bool connected = false; 2215fd4377b6SThomas Pedersen 2216fd4377b6SThomas Pedersen /* enter / leave wow suspend on first vif always */ 2217fd4377b6SThomas Pedersen first_vif = ath6kl_vif_first(ar); 2218fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!first_vif)) || 2219fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(first_vif)) 2220fd4377b6SThomas Pedersen return -EIO; 2221fd4377b6SThomas Pedersen 2222fd4377b6SThomas Pedersen if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2223fd4377b6SThomas Pedersen return -EINVAL; 2224fd4377b6SThomas Pedersen 2225fd4377b6SThomas Pedersen /* install filters for each connected vif */ 2226fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2227fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2228fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2229fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2230fd4377b6SThomas Pedersen continue; 2231fd4377b6SThomas Pedersen connected = true; 2232fd4377b6SThomas Pedersen 2233fd4377b6SThomas Pedersen ret = ath6kl_wow_suspend_vif(vif, wow, &filter); 2234fd4377b6SThomas Pedersen if (ret) 2235fd4377b6SThomas Pedersen break; 2236fd4377b6SThomas Pedersen } 2237fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2238fd4377b6SThomas Pedersen 2239fd4377b6SThomas Pedersen if (!connected) 2240fd4377b6SThomas Pedersen return -ENOTCONN; 2241fd4377b6SThomas Pedersen else if (ret) 2242fd4377b6SThomas Pedersen return ret; 2243fd4377b6SThomas Pedersen 2244fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_SUSPENDING; 2245fd4377b6SThomas Pedersen 2246fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx, 22476cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22486cb3c714SRaja Mani filter, 22496cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22506cb3c714SRaja Mani if (ret) 22516cb3c714SRaja Mani return ret; 22526cb3c714SRaja Mani 2253fd4377b6SThomas Pedersen return ath6kl_cfg80211_host_sleep(ar, first_vif); 22546cb3c714SRaja Mani } 22556cb3c714SRaja Mani 2256fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif) 22576cb3c714SRaja Mani { 2258fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 22596cb3c714SRaja Mani int ret; 22606cb3c714SRaja Mani 2261ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2262ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2263ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2264ce0dc0cfSRaja Mani if (ret) 2265ce0dc0cfSRaja Mani return ret; 2266ce0dc0cfSRaja Mani 2267ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2268ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2269ce0dc0cfSRaja Mani if (ret) 2270ce0dc0cfSRaja Mani return ret; 2271ce0dc0cfSRaja Mani 2272ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2273ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2274ce0dc0cfSRaja Mani if (ret) 2275ce0dc0cfSRaja Mani return ret; 2276ce0dc0cfSRaja Mani } 2277ce0dc0cfSRaja Mani 22786821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22796821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22806821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22816251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22826251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22836251d801SNaveen Gangadharan if (ret) 22846251d801SNaveen Gangadharan return ret; 22856251d801SNaveen Gangadharan } 22866251d801SNaveen Gangadharan 2287390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2288390a8c8fSRaja Mani 2289390a8c8fSRaja Mani return 0; 2290390a8c8fSRaja Mani } 2291390a8c8fSRaja Mani 2292fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar) 2293fd4377b6SThomas Pedersen { 2294fd4377b6SThomas Pedersen struct ath6kl_vif *vif; 2295fd4377b6SThomas Pedersen int ret; 2296fd4377b6SThomas Pedersen 2297fd4377b6SThomas Pedersen vif = ath6kl_vif_first(ar); 2298fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!vif)) || 2299fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2300fd4377b6SThomas Pedersen return -EIO; 2301fd4377b6SThomas Pedersen 2302fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_RESUMING; 2303fd4377b6SThomas Pedersen 2304fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2305fd4377b6SThomas Pedersen ATH6KL_HOST_MODE_AWAKE); 2306fd4377b6SThomas Pedersen if (ret) { 2307fd4377b6SThomas Pedersen ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2308fd4377b6SThomas Pedersen ret); 2309fd4377b6SThomas Pedersen goto cleanup; 2310fd4377b6SThomas Pedersen } 2311fd4377b6SThomas Pedersen 2312fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2313fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2314fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2315fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2316fd4377b6SThomas Pedersen continue; 2317fd4377b6SThomas Pedersen ret = ath6kl_wow_resume_vif(vif); 2318fd4377b6SThomas Pedersen if (ret) 2319fd4377b6SThomas Pedersen break; 2320fd4377b6SThomas Pedersen } 2321fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2322fd4377b6SThomas Pedersen 2323fd4377b6SThomas Pedersen if (ret) 2324fd4377b6SThomas Pedersen goto cleanup; 2325fd4377b6SThomas Pedersen 2326fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_ON; 2327fd4377b6SThomas Pedersen return 0; 2328fd4377b6SThomas Pedersen 2329fd4377b6SThomas Pedersen cleanup: 2330fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_WOW; 2331fd4377b6SThomas Pedersen return ret; 2332fd4377b6SThomas Pedersen } 2333fd4377b6SThomas Pedersen 233440abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 233540abc2deSRaja Mani { 233640abc2deSRaja Mani struct ath6kl_vif *vif; 233740abc2deSRaja Mani int ret; 233840abc2deSRaja Mani 233940abc2deSRaja Mani vif = ath6kl_vif_first(ar); 234040abc2deSRaja Mani if (!vif) 234140abc2deSRaja Mani return -EIO; 234240abc2deSRaja Mani 234348f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 234448f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 234540abc2deSRaja Mani return -EIO; 234648f27587SMing Jiang } 234740abc2deSRaja Mani 234840abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 234940abc2deSRaja Mani 235040abc2deSRaja Mani /* Save the current power mode before enabling power save */ 235140abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 235240abc2deSRaja Mani 235340abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 235440abc2deSRaja Mani if (ret) 235540abc2deSRaja Mani return ret; 235640abc2deSRaja Mani 235740abc2deSRaja Mani /* Disable WOW mode */ 235840abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 235940abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 236040abc2deSRaja Mani 0, 0); 236140abc2deSRaja Mani if (ret) 236240abc2deSRaja Mani return ret; 236340abc2deSRaja Mani 236440abc2deSRaja Mani /* Flush all non control pkts in TX path */ 236540abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 236640abc2deSRaja Mani 236740abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 236840abc2deSRaja Mani if (ret) 236940abc2deSRaja Mani return ret; 237040abc2deSRaja Mani 237140abc2deSRaja Mani return 0; 237240abc2deSRaja Mani } 237340abc2deSRaja Mani 237440abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 237540abc2deSRaja Mani { 237640abc2deSRaja Mani struct ath6kl_vif *vif; 237740abc2deSRaja Mani int ret; 237840abc2deSRaja Mani 237940abc2deSRaja Mani vif = ath6kl_vif_first(ar); 238040abc2deSRaja Mani 238140abc2deSRaja Mani if (!vif) 238240abc2deSRaja Mani return -EIO; 238340abc2deSRaja Mani 238440abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 238540abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 238640abc2deSRaja Mani ar->wmi->saved_pwr_mode); 238740abc2deSRaja Mani if (ret) 238840abc2deSRaja Mani return ret; 238940abc2deSRaja Mani } 239040abc2deSRaja Mani 239140abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 239240abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 239340abc2deSRaja Mani if (ret) 239440abc2deSRaja Mani return ret; 239540abc2deSRaja Mani 239640abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 239740abc2deSRaja Mani 239840abc2deSRaja Mani /* Reset scan parameter to default values */ 239940abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 240040abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 240140abc2deSRaja Mani if (ret) 240240abc2deSRaja Mani return ret; 240340abc2deSRaja Mani 240440abc2deSRaja Mani return 0; 240540abc2deSRaja Mani } 240640abc2deSRaja Mani 240752d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 24080f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 24090f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 241052d81a68SKalle Valo { 24113d79499cSVivek Natarajan struct ath6kl_vif *vif; 2412390a8c8fSRaja Mani enum ath6kl_state prev_state; 241352d81a68SKalle Valo int ret; 241452d81a68SKalle Valo 241552d81a68SKalle Valo switch (mode) { 2416d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2417d7c44e0bSRaja Mani 2418d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2419d7c44e0bSRaja Mani 2420d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2421d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2422d7c44e0bSRaja Mani 2423390a8c8fSRaja Mani prev_state = ar->state; 2424390a8c8fSRaja Mani 2425d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2426390a8c8fSRaja Mani if (ret) { 2427390a8c8fSRaja Mani ar->state = prev_state; 2428d7c44e0bSRaja Mani return ret; 2429390a8c8fSRaja Mani } 24301e9a905dSRaja Mani 2431d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2432d7c44e0bSRaja Mani break; 2433d7c44e0bSRaja Mani 243452d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2435524441e3SRaja Mani 243640abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2437524441e3SRaja Mani 243840abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 243952d81a68SKalle Valo if (ret) { 244040abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 244140abc2deSRaja Mani return ret; 244252d81a68SKalle Valo } 244352d81a68SKalle Valo 244476a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 244576a9fbe2SKalle Valo 244652d81a68SKalle Valo break; 2447b4b2a0b1SKalle Valo 2448b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2449524441e3SRaja Mani 24507125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2451524441e3SRaja Mani 2452b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2453b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2454b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2455b4b2a0b1SKalle Valo break; 2456b4b2a0b1SKalle Valo } 2457b4b2a0b1SKalle Valo 2458b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2459b4b2a0b1SKalle Valo 2460b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2461b4b2a0b1SKalle Valo if (ret) { 2462b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2463b4b2a0b1SKalle Valo ret); 2464b4b2a0b1SKalle Valo } 2465b4b2a0b1SKalle Valo 2466b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2467b4b2a0b1SKalle Valo 2468b4b2a0b1SKalle Valo break; 2469b4b2a0b1SKalle Valo 2470b4b2a0b1SKalle Valo default: 2471b4b2a0b1SKalle Valo break; 247252d81a68SKalle Valo } 247352d81a68SKalle Valo 24743d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24753d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24763d79499cSVivek Natarajan 247752d81a68SKalle Valo return 0; 247852d81a68SKalle Valo } 2479d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 248052d81a68SKalle Valo 248152d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 248252d81a68SKalle Valo { 248376a9fbe2SKalle Valo int ret; 248476a9fbe2SKalle Valo 248576a9fbe2SKalle Valo switch (ar->state) { 2486d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2487d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2488d7c44e0bSRaja Mani 2489d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2490d7c44e0bSRaja Mani if (ret) { 2491d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2492d7c44e0bSRaja Mani return ret; 2493d7c44e0bSRaja Mani } 2494d7c44e0bSRaja Mani 2495d7c44e0bSRaja Mani break; 2496d7c44e0bSRaja Mani 249776a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 249840abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 249940abc2deSRaja Mani 250040abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 250176a9fbe2SKalle Valo if (ret) { 250240abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 250340abc2deSRaja Mani return ret; 250476a9fbe2SKalle Valo } 250576a9fbe2SKalle Valo break; 250676a9fbe2SKalle Valo 2507b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2508b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2509b4b2a0b1SKalle Valo 2510b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2511b4b2a0b1SKalle Valo if (ret) { 2512b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2513b4b2a0b1SKalle Valo return ret; 2514b4b2a0b1SKalle Valo } 2515d7c44e0bSRaja Mani break; 2516b4b2a0b1SKalle Valo 251776a9fbe2SKalle Valo default: 251876a9fbe2SKalle Valo break; 251952d81a68SKalle Valo } 252052d81a68SKalle Valo 252152d81a68SKalle Valo return 0; 252252d81a68SKalle Valo } 2523d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 252452d81a68SKalle Valo 2525abcb344bSKalle Valo #ifdef CONFIG_PM 252652d81a68SKalle Valo 252752d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 252852d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2529abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2530abcb344bSKalle Valo { 2531abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2532abcb344bSKalle Valo 253384caf800SVasanthakumar Thiagarajan ath6kl_recovery_suspend(ar); 253484caf800SVasanthakumar Thiagarajan 25350f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2536abcb344bSKalle Valo } 2537aa6cffc1SChilam Ng 253852d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2539aa6cffc1SChilam Ng { 2540aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 254184caf800SVasanthakumar Thiagarajan int err; 2542aa6cffc1SChilam Ng 254384caf800SVasanthakumar Thiagarajan err = ath6kl_hif_resume(ar); 254484caf800SVasanthakumar Thiagarajan if (err) 254584caf800SVasanthakumar Thiagarajan return err; 254684caf800SVasanthakumar Thiagarajan 254792332993SVasanthakumar Thiagarajan ath6kl_recovery_resume(ar); 254884caf800SVasanthakumar Thiagarajan 254984caf800SVasanthakumar Thiagarajan return 0; 2550aa6cffc1SChilam Ng } 2551a918fb3cSRaja Mani 2552a918fb3cSRaja Mani /* 2553a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2554a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2555a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2556a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2557a918fb3cSRaja Mani * 2558a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2559a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2560a918fb3cSRaja Mani * 2561a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2562a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2563a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2564a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2565a918fb3cSRaja Mani * 2566a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2567a918fb3cSRaja Mani */ 2568a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2569a918fb3cSRaja Mani { 2570390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2571390a8c8fSRaja Mani return; 2572390a8c8fSRaja Mani 2573a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2574a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2575a918fb3cSRaja Mani } 2576a918fb3cSRaja Mani 2577a918fb3cSRaja Mani #else 2578a918fb3cSRaja Mani 2579a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2580a918fb3cSRaja Mani { 2581a918fb3cSRaja Mani } 2582abcb344bSKalle Valo #endif 2583abcb344bSKalle Valo 2584df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2585df90b369SVasanthakumar Thiagarajan bool ht_enable) 25866a7c9badSJouni Malinen { 258767b3f129SKiran Reddy struct ath6kl_htcap *htcap = &vif->htcap[band]; 2588e68f6750SSujith Manoharan 2589df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 25906a7c9badSJouni Malinen return 0; 2591df90b369SVasanthakumar Thiagarajan 2592df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2593df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2594df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2595df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2596df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2597df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2598df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2599df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2600df90b369SVasanthakumar Thiagarajan 2601df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2602df90b369SVasanthakumar Thiagarajan band, htcap); 26036a7c9badSJouni Malinen } 26046a7c9badSJouni Malinen 260537a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 260637a2f950SThomas Pedersen { 260737a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 260837a2f950SThomas Pedersen int band, ret = 0; 260937a2f950SThomas Pedersen 261037a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 261137a2f950SThomas Pedersen if (!wiphy->bands[band]) 261237a2f950SThomas Pedersen continue; 261337a2f950SThomas Pedersen 261437a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 261537a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 261637a2f950SThomas Pedersen if (ret) 261737a2f950SThomas Pedersen return ret; 261837a2f950SThomas Pedersen } 261937a2f950SThomas Pedersen 262037a2f950SThomas Pedersen return ret; 262137a2f950SThomas Pedersen } 262237a2f950SThomas Pedersen 26238bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 26248bdfbf40SJouni Malinen { 26258bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 26268bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 26278bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 26288bdfbf40SJouni Malinen } 26298bdfbf40SJouni Malinen 2630334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2631334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 26328bdfbf40SJouni Malinen { 2633334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26348bdfbf40SJouni Malinen const u8 *pos; 26358bdfbf40SJouni Malinen u8 *buf = NULL; 26368bdfbf40SJouni Malinen size_t len = 0; 26378bdfbf40SJouni Malinen int ret; 26388bdfbf40SJouni Malinen 26398bdfbf40SJouni Malinen /* 26408bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26418bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26428bdfbf40SJouni Malinen */ 26438bdfbf40SJouni Malinen 26448bdfbf40SJouni Malinen if (ies && ies_len) { 26458bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26468bdfbf40SJouni Malinen if (buf == NULL) 26478bdfbf40SJouni Malinen return -ENOMEM; 26488bdfbf40SJouni Malinen pos = ies; 26498bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26508bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26518bdfbf40SJouni Malinen break; 26528bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26538bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26548bdfbf40SJouni Malinen len += 2 + pos[1]; 26558bdfbf40SJouni Malinen } 26568bdfbf40SJouni Malinen pos += 2 + pos[1]; 26578bdfbf40SJouni Malinen } 26588bdfbf40SJouni Malinen } 26598bdfbf40SJouni Malinen 2660334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2661334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26628bdfbf40SJouni Malinen kfree(buf); 26638bdfbf40SJouni Malinen return ret; 26648bdfbf40SJouni Malinen } 26658bdfbf40SJouni Malinen 26668860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26678860020eSJohannes Berg struct cfg80211_beacon_data *info) 26688860020eSJohannes Berg { 26698860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26708860020eSJohannes Berg int res; 26718860020eSJohannes Berg 267217a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26738860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26748860020eSJohannes Berg WMI_FRAME_BEACON, 26758860020eSJohannes Berg info->beacon_ies, 26768860020eSJohannes Berg info->beacon_ies_len); 26778860020eSJohannes Berg if (res) 26788860020eSJohannes Berg return res; 26798860020eSJohannes Berg 268017a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26818860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26828860020eSJohannes Berg info->proberesp_ies_len); 26838860020eSJohannes Berg if (res) 26848860020eSJohannes Berg return res; 26858860020eSJohannes Berg 268617a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26878860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26888860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 26898860020eSJohannes Berg info->assocresp_ies, 26908860020eSJohannes Berg info->assocresp_ies_len); 26918860020eSJohannes Berg if (res) 26928860020eSJohannes Berg return res; 26938860020eSJohannes Berg 26948860020eSJohannes Berg return 0; 26958860020eSJohannes Berg } 26968860020eSJohannes Berg 2697d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2698d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2699d97c121bSVasanthakumar Thiagarajan { 2700d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2701d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2702d97c121bSVasanthakumar Thiagarajan u16 cnt; 2703d97c121bSVasanthakumar Thiagarajan 2704d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2705d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2706d97c121bSVasanthakumar Thiagarajan 2707d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2708d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2709d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2710d97c121bSVasanthakumar Thiagarajan 2711d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2712d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2713d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2714d97c121bSVasanthakumar Thiagarajan 27159e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27169e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2717d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27189e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27199e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27209e8b16dbSVasanthakumar Thiagarajan 27219e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27229e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27239e8b16dbSVasanthakumar Thiagarajan return 0; 27249e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27259e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2726d97c121bSVasanthakumar Thiagarajan 2727d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2728d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27299e8b16dbSVasanthakumar Thiagarajan return 0; 2730798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2731d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2732d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2733d97c121bSVasanthakumar Thiagarajan 2734d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2735d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27369e8b16dbSVasanthakumar Thiagarajan return 0; 2737798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2738d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2739d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2740d97c121bSVasanthakumar Thiagarajan 2741d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27429e8b16dbSVasanthakumar Thiagarajan return 0; 2743d97c121bSVasanthakumar Thiagarajan 2744d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2745d97c121bSVasanthakumar Thiagarajan 2746d97c121bSVasanthakumar Thiagarajan return 0; 2747d97c121bSVasanthakumar Thiagarajan } 2748d97c121bSVasanthakumar Thiagarajan 27498860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27508860020eSJohannes Berg struct cfg80211_ap_settings *info) 27516a7c9badSJouni Malinen { 27526a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27533450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27546a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 275567cd22e4SThomas Pedersen bool hidden = false; 27566a7c9badSJouni Malinen u8 *ies; 27576a7c9badSJouni Malinen int ies_len; 27586a7c9badSJouni Malinen struct wmi_connect_cmd p; 27596a7c9badSJouni Malinen int res; 2760be5abaafSVasanthakumar Thiagarajan int i, ret; 2761d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27627ac25eacSMohammed Shafi Shajakhan int inactivity_timeout = 0; 27636a7c9badSJouni Malinen 27648860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27656a7c9badSJouni Malinen 2766990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27676a7c9badSJouni Malinen return -EIO; 27686a7c9badSJouni Malinen 2769f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27706a7c9badSJouni Malinen return -EOPNOTSUPP; 27716a7c9badSJouni Malinen 27728860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27736a7c9badSJouni Malinen 27749a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27759a5b1318SJouni Malinen 2776eb922e4bSMohammed Shafi Shajakhan ret = ath6kl_wmi_ap_set_beacon_intvl_cmd(ar->wmi, vif->fw_vif_idx, 2777eb922e4bSMohammed Shafi Shajakhan info->beacon_interval); 2778eb922e4bSMohammed Shafi Shajakhan 2779eb922e4bSMohammed Shafi Shajakhan if (ret) 2780eb922e4bSMohammed Shafi Shajakhan ath6kl_warn("Failed to set beacon interval: %d\n", ret); 27816a7c9badSJouni Malinen 2782d154f32eSEtay Luz ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx, 2783d154f32eSEtay Luz info->dtim_period); 2784d154f32eSEtay Luz 2785d154f32eSEtay Luz /* ignore error, just print a warning and continue normally */ 2786d154f32eSEtay Luz if (ret) 2787d154f32eSEtay Luz ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret); 2788d154f32eSEtay Luz 27898860020eSJohannes Berg if (info->beacon.head == NULL) 27906a7c9badSJouni Malinen return -EINVAL; 27918860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 27926a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 27938860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 27946a7c9badSJouni Malinen return -EINVAL; 27958860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 27966a7c9badSJouni Malinen 27976a7c9badSJouni Malinen if (info->ssid == NULL) 27986a7c9badSJouni Malinen return -EINVAL; 27993450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 28003450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 28016a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 280267cd22e4SThomas Pedersen hidden = true; 280367cd22e4SThomas Pedersen 280467cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 280567cd22e4SThomas Pedersen if (res) 280667cd22e4SThomas Pedersen return res; 28076a7c9badSJouni Malinen 2808be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2809be5abaafSVasanthakumar Thiagarajan if (ret) 2810be5abaafSVasanthakumar Thiagarajan return ret; 28116a7c9badSJouni Malinen 28126a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28136a7c9badSJouni Malinen 28146a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28156a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28166a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28176a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28186a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28196a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28206a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28216a7c9badSJouni Malinen break; 28226a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28236a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28246a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28256a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28266a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28276a7c9badSJouni Malinen break; 28286a7c9badSJouni Malinen } 28296a7c9badSJouni Malinen } 28306a7c9badSJouni Malinen if (p.auth_mode == 0) 28316a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28323450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28336a7c9badSJouni Malinen 28346a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28356a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28376a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28386a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28396a7c9badSJouni Malinen break; 28406a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28416a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28426a7c9badSJouni Malinen break; 28436a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28446a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28456a7c9badSJouni Malinen break; 2846b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2847b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2848b8214df1SDai Shuibing break; 28496a7c9badSJouni Malinen } 28506a7c9badSJouni Malinen } 2851229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28526a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2853240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2854a5d8f9dfSKalle Valo } else if (info->crypto.n_ciphers_pairwise == 1) { 2855240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 2856a5d8f9dfSKalle Valo } 28576a7c9badSJouni Malinen 28586a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28596a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28606a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28616a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28626a7c9badSJouni Malinen break; 28636a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28646a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28656a7c9badSJouni Malinen break; 28666a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28676a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28686a7c9badSJouni Malinen break; 2869b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2870b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2871b8214df1SDai Shuibing break; 28726a7c9badSJouni Malinen default: 28736a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28746a7c9badSJouni Malinen break; 28756a7c9badSJouni Malinen } 2876240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28776a7c9badSJouni Malinen 28786a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2879f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28806a7c9badSJouni Malinen 28813450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28823450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28833450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2884683b6d3bSJohannes Berg p.ch = cpu_to_le16(info->chandef.chan->center_freq); 28856a7c9badSJouni Malinen 2886c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2887c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2888c1762a3fSThirumalai Pachamuthu if (res < 0) 2889c1762a3fSThirumalai Pachamuthu return res; 2890c1762a3fSThirumalai Pachamuthu 28913ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 28923ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 28933ca9d1fcSAarthi Thiruvengadam } else { 28943ca9d1fcSAarthi Thiruvengadam /* 28953ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 28963ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 28973ca9d1fcSAarthi Thiruvengadam */ 28983ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 28993ca9d1fcSAarthi Thiruvengadam } 29003ca9d1fcSAarthi Thiruvengadam 290103bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 29027ac25eacSMohammed Shafi Shajakhan inactivity_timeout = info->inactivity_timeout; 29037ac25eacSMohammed Shafi Shajakhan 2904eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_AP_INACTIVITY_MINS, 2905eba95bceSKalle Valo ar->fw_capabilities)) 29067ac25eacSMohammed Shafi Shajakhan inactivity_timeout = DIV_ROUND_UP(inactivity_timeout, 29077ac25eacSMohammed Shafi Shajakhan 60); 29087ac25eacSMohammed Shafi Shajakhan 290903bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 29107ac25eacSMohammed Shafi Shajakhan inactivity_timeout); 291103bdeb0dSVasanthakumar Thiagarajan if (res < 0) 291203bdeb0dSVasanthakumar Thiagarajan return res; 291303bdeb0dSVasanthakumar Thiagarajan } 291403bdeb0dSVasanthakumar Thiagarajan 2915683b6d3bSJohannes Berg if (ath6kl_set_htcap(vif, info->chandef.chan->band, 2916683b6d3bSJohannes Berg cfg80211_get_chandef_type(&info->chandef) 2917683b6d3bSJohannes Berg != NL80211_CHAN_NO_HT)) 2918df90b369SVasanthakumar Thiagarajan return -EIO; 2919df90b369SVasanthakumar Thiagarajan 2920d97c121bSVasanthakumar Thiagarajan /* 2921d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2922d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2923d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2924d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2925d97c121bSVasanthakumar Thiagarajan */ 2926d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2927d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2928d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2929d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2930d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2931d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2932d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2933f21243a8SThomas Pedersen vif->rsn_capab = rsn_capab; 2934d97c121bSVasanthakumar Thiagarajan if (res < 0) 2935d97c121bSVasanthakumar Thiagarajan return res; 2936d97c121bSVasanthakumar Thiagarajan } 2937d97c121bSVasanthakumar Thiagarajan 2938c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2939334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29409a5b1318SJouni Malinen if (res < 0) 29419a5b1318SJouni Malinen return res; 29429a5b1318SJouni Malinen 29439a5b1318SJouni Malinen return 0; 29446a7c9badSJouni Malinen } 29456a7c9badSJouni Malinen 29468860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29478860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29486a7c9badSJouni Malinen { 29498860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29508860020eSJohannes Berg 29518860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29528860020eSJohannes Berg return -EIO; 29538860020eSJohannes Berg 29548860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29558860020eSJohannes Berg return -EOPNOTSUPP; 29568860020eSJohannes Berg 29578860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29586a7c9badSJouni Malinen } 29596a7c9badSJouni Malinen 29608860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29616a7c9badSJouni Malinen { 29626a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 296359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29646a7c9badSJouni Malinen 2965f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29666a7c9badSJouni Malinen return -EOPNOTSUPP; 296759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29686a7c9badSJouni Malinen return -ENOTCONN; 29696a7c9badSJouni Malinen 2970334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 297159c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 29726a7c9badSJouni Malinen 2973df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 297437a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29756a7c9badSJouni Malinen } 29766a7c9badSJouni Malinen 297733e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 297833e5308dSJouni Malinen 297933e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 298089c771e5SJouni Malinen struct station_del_parameters *params) 298133e5308dSJouni Malinen { 298233e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 298333e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 298489c771e5SJouni Malinen const u8 *addr = params->mac ? params->mac : bcast_addr; 298533e5308dSJouni Malinen 298633e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 298733e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 298833e5308dSJouni Malinen } 298933e5308dSJouni Malinen 299023875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 29913b3a0162SJohannes Berg const u8 *mac, 29923b3a0162SJohannes Berg struct station_parameters *params) 299323875136SJouni Malinen { 299423875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2995f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 299677ee7c89SJohannes Berg int err; 299723875136SJouni Malinen 2998f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 299923875136SJouni Malinen return -EOPNOTSUPP; 300023875136SJouni Malinen 300177ee7c89SJohannes Berg err = cfg80211_check_station_change(wiphy, params, 300277ee7c89SJohannes Berg CFG80211_STA_AP_MLME_CLIENT); 300377ee7c89SJohannes Berg if (err) 300477ee7c89SJohannes Berg return err; 300523875136SJouni Malinen 300623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 3007334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3008334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 3009334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3010334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 301123875136SJouni Malinen } 301223875136SJouni Malinen 301363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 301471bbc994SJohannes Berg struct wireless_dev *wdev, 301563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 301663fa1e0cSJouni Malinen unsigned int duration, 301763fa1e0cSJouni Malinen u64 *cookie) 301863fa1e0cSJouni Malinen { 301971bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 302071bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 30211052261eSJouni Malinen u32 id; 302263fa1e0cSJouni Malinen 302363fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 302463fa1e0cSJouni Malinen * return -EBUSY */ 30251052261eSJouni Malinen id = ++vif->last_roc_id; 30261052261eSJouni Malinen if (id == 0) { 30271052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30281052261eSJouni Malinen id = ++vif->last_roc_id; 30291052261eSJouni Malinen } 30301052261eSJouni Malinen *cookie = id; 303163fa1e0cSJouni Malinen 3032334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3033334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 303463fa1e0cSJouni Malinen } 303563fa1e0cSJouni Malinen 303663fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 303771bbc994SJohannes Berg struct wireless_dev *wdev, 303863fa1e0cSJouni Malinen u64 cookie) 303963fa1e0cSJouni Malinen { 304071bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 304171bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 304263fa1e0cSJouni Malinen 30431052261eSJouni Malinen if (cookie != vif->last_roc_id) 304463fa1e0cSJouni Malinen return -ENOENT; 30451052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 304663fa1e0cSJouni Malinen 3047334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 304863fa1e0cSJouni Malinen } 304963fa1e0cSJouni Malinen 3050334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3051334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3052334234b5SVasanthakumar Thiagarajan unsigned int freq) 30538bdfbf40SJouni Malinen { 3054334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30558bdfbf40SJouni Malinen const u8 *pos; 30568bdfbf40SJouni Malinen u8 *p2p; 30578bdfbf40SJouni Malinen int p2p_len; 30588bdfbf40SJouni Malinen int ret; 30598bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30608bdfbf40SJouni Malinen 30618bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30628bdfbf40SJouni Malinen 30638bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30648bdfbf40SJouni Malinen 30658bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30668bdfbf40SJouni Malinen if (p2p == NULL) 30678bdfbf40SJouni Malinen return -ENOMEM; 30688bdfbf40SJouni Malinen p2p_len = 0; 30698bdfbf40SJouni Malinen 30708bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30718bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30728bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30738bdfbf40SJouni Malinen break; 30748bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30758bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30768bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30778bdfbf40SJouni Malinen } 30788bdfbf40SJouni Malinen pos += 2 + pos[1]; 30798bdfbf40SJouni Malinen } 30808bdfbf40SJouni Malinen 3081334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3082334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30838bdfbf40SJouni Malinen kfree(p2p); 30848bdfbf40SJouni Malinen return ret; 30858bdfbf40SJouni Malinen } 30868bdfbf40SJouni Malinen 3087d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3088d0ff7383SNaveen Gangadharan u32 id, 3089d0ff7383SNaveen Gangadharan u32 freq, 3090d0ff7383SNaveen Gangadharan u32 wait, 3091d0ff7383SNaveen Gangadharan const u8 *buf, 3092d0ff7383SNaveen Gangadharan size_t len, 3093d0ff7383SNaveen Gangadharan bool *more_data, 3094d0ff7383SNaveen Gangadharan bool no_cck) 3095d0ff7383SNaveen Gangadharan { 3096d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3097d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3098d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3099d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3100d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3101d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3102d0ff7383SNaveen Gangadharan 3103d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3104d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3105d0ff7383SNaveen Gangadharan return false; 3106d0ff7383SNaveen Gangadharan 3107d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3108d0ff7383SNaveen Gangadharan if (!conn) 3109d0ff7383SNaveen Gangadharan return false; 3110d0ff7383SNaveen Gangadharan 3111d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3112d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3113d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3114d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3115d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3116d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3117d0ff7383SNaveen Gangadharan return false; 3118d0ff7383SNaveen Gangadharan 3119d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3120d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3121d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3122d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3123d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3124d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3125d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3126d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3127d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3128d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3129d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3130d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3131d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3132d0ff7383SNaveen Gangadharan 3133d0ff7383SNaveen Gangadharan /* 3134d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3135d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3136d0ff7383SNaveen Gangadharan * STA. 3137d0ff7383SNaveen Gangadharan */ 3138d0ff7383SNaveen Gangadharan if (is_psq_empty) 3139d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3140d0ff7383SNaveen Gangadharan conn->aid, 1); 3141d0ff7383SNaveen Gangadharan return true; 3142d0ff7383SNaveen Gangadharan } 3143d0ff7383SNaveen Gangadharan 3144d0ff7383SNaveen Gangadharan /* 3145d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3146d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3147d0ff7383SNaveen Gangadharan */ 3148d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3149d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3150d0ff7383SNaveen Gangadharan *more_data = true; 3151d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3152d0ff7383SNaveen Gangadharan } 3153d0ff7383SNaveen Gangadharan 3154d0ff7383SNaveen Gangadharan return false; 3155d0ff7383SNaveen Gangadharan } 3156d0ff7383SNaveen Gangadharan 3157c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3158c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3159c86e4f44SAarthi Thiruvengadam { 3160c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3161c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3162c86e4f44SAarthi Thiruvengadam 3163c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3164c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3165c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3166c86e4f44SAarthi Thiruvengadam return true; 3167c86e4f44SAarthi Thiruvengadam } 3168c86e4f44SAarthi Thiruvengadam 3169c86e4f44SAarthi Thiruvengadam return false; 3170c86e4f44SAarthi Thiruvengadam } 3171c86e4f44SAarthi Thiruvengadam 317271bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 3173b176e629SAndrei Otcheretianski struct cfg80211_mgmt_tx_params *params, u64 *cookie) 31748a6c8060SJouni Malinen { 317571bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 317671bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 3177b176e629SAndrei Otcheretianski struct ieee80211_channel *chan = params->chan; 3178b176e629SAndrei Otcheretianski const u8 *buf = params->buf; 3179b176e629SAndrei Otcheretianski size_t len = params->len; 3180b176e629SAndrei Otcheretianski unsigned int wait = params->wait; 3181b176e629SAndrei Otcheretianski bool no_cck = params->no_cck; 3182bfd634d0SAntonio Quartulli u32 id, freq; 31838bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3184d0ff7383SNaveen Gangadharan bool more_data, queued; 31858bdfbf40SJouni Malinen 3186bfd634d0SAntonio Quartulli /* default to the current channel, but use the one specified as argument 3187bfd634d0SAntonio Quartulli * if any 3188bfd634d0SAntonio Quartulli */ 3189bfd634d0SAntonio Quartulli freq = vif->ch_hint; 3190bfd634d0SAntonio Quartulli if (chan) 3191bfd634d0SAntonio Quartulli freq = chan->center_freq; 3192bfd634d0SAntonio Quartulli 3193bfd634d0SAntonio Quartulli /* never send freq zero to the firmware */ 3194bfd634d0SAntonio Quartulli if (WARN_ON(freq == 0)) 3195bfd634d0SAntonio Quartulli return -EINVAL; 3196bfd634d0SAntonio Quartulli 31978bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3198c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3199c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3200c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 32018bdfbf40SJouni Malinen /* 3202c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 32038bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 32048bdfbf40SJouni Malinen */ 32058bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3206bfd634d0SAntonio Quartulli return ath6kl_send_go_probe_resp(vif, buf, len, freq); 32078bdfbf40SJouni Malinen } 32088a6c8060SJouni Malinen 3209cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32108a6c8060SJouni Malinen if (id == 0) { 32118a6c8060SJouni Malinen /* 32128a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 32138a6c8060SJouni Malinen * used for the command. 32148a6c8060SJouni Malinen */ 3215cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32168a6c8060SJouni Malinen } 32178a6c8060SJouni Malinen 32188a6c8060SJouni Malinen *cookie = id; 32193ca9d1fcSAarthi Thiruvengadam 3220d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3221d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3222bfd634d0SAntonio Quartulli queued = ath6kl_mgmt_powersave_ap(vif, id, freq, wait, buf, len, 3223bfd634d0SAntonio Quartulli &more_data, no_cck); 3224d0ff7383SNaveen Gangadharan if (queued) 3225d0ff7383SNaveen Gangadharan return 0; 3226d0ff7383SNaveen Gangadharan } 3227d0ff7383SNaveen Gangadharan 3228bfd634d0SAntonio Quartulli return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, freq, 3229bfd634d0SAntonio Quartulli wait, buf, len, no_cck); 32303ca9d1fcSAarthi Thiruvengadam } 32318a6c8060SJouni Malinen 3232ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 323371bbc994SJohannes Berg struct wireless_dev *wdev, 3234ae32c30aSJouni Malinen u16 frame_type, bool reg) 3235ae32c30aSJouni Malinen { 323671bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 3237ae32c30aSJouni Malinen 3238ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3239ae32c30aSJouni Malinen __func__, frame_type, reg); 3240ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3241ae32c30aSJouni Malinen /* 3242ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3243ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3244ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3245ae32c30aSJouni Malinen */ 3246cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3247ae32c30aSJouni Malinen } 3248ae32c30aSJouni Malinen } 3249ae32c30aSJouni Malinen 325010509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 325110509f90SKalle Valo struct net_device *dev, 325210509f90SKalle Valo struct cfg80211_sched_scan_request *request) 325310509f90SKalle Valo { 325410509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 325510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 325610509f90SKalle Valo u16 interval; 325785b20fc2SThomas Pedersen int ret, rssi_thold; 3258ea73cbceSJohannes Berg int n_match_sets = request->n_match_sets; 3259ea73cbceSJohannes Berg 3260ea73cbceSJohannes Berg /* 3261ea73cbceSJohannes Berg * If there's a matchset w/o an SSID, then assume it's just for 3262ea73cbceSJohannes Berg * the RSSI (nothing else is currently supported) and ignore it. 3263ea73cbceSJohannes Berg * The device only supports a global RSSI filter that we set below. 3264ea73cbceSJohannes Berg */ 3265ea73cbceSJohannes Berg if (n_match_sets == 1 && !request->match_sets[0].ssid.ssid_len) 3266ea73cbceSJohannes Berg n_match_sets = 0; 326710509f90SKalle Valo 326810509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 326910509f90SKalle Valo return -EIO; 327010509f90SKalle Valo 327110509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 327210509f90SKalle Valo return -EBUSY; 327310509f90SKalle Valo 3274b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3275b4d13d3bSKalle Valo 32763b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3277dd45b759SNaveen Singh request->n_ssids, 3278dd45b759SNaveen Singh request->match_sets, 3279ea73cbceSJohannes Berg n_match_sets); 32803b8ffc6aSJouni Malinen if (ret < 0) 32813b8ffc6aSJouni Malinen return ret; 328210509f90SKalle Valo 3283ea73cbceSJohannes Berg if (!n_match_sets) { 3284dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3285dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3286dd45b759SNaveen Singh if (ret < 0) 3287dd45b759SNaveen Singh return ret; 3288dd45b759SNaveen Singh } else { 3289dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3290dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3291dd45b759SNaveen Singh if (ret < 0) 3292dd45b759SNaveen Singh return ret; 3293dd45b759SNaveen Singh } 3294dd45b759SNaveen Singh 329585b20fc2SThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD, 329685b20fc2SThomas Pedersen ar->fw_capabilities)) { 3297ea73cbceSJohannes Berg if (request->min_rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF) 329885b20fc2SThomas Pedersen rssi_thold = 0; 3299ea73cbceSJohannes Berg else if (request->min_rssi_thold < -127) 330085b20fc2SThomas Pedersen rssi_thold = -127; 330185b20fc2SThomas Pedersen else 3302ea73cbceSJohannes Berg rssi_thold = request->min_rssi_thold; 330385b20fc2SThomas Pedersen 330485b20fc2SThomas Pedersen ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx, 330585b20fc2SThomas Pedersen rssi_thold); 330685b20fc2SThomas Pedersen if (ret) { 330785b20fc2SThomas Pedersen ath6kl_err("failed to set RSSI threshold for scan\n"); 330885b20fc2SThomas Pedersen return ret; 330985b20fc2SThomas Pedersen } 331085b20fc2SThomas Pedersen } 331185b20fc2SThomas Pedersen 331210509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 331310509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 331410509f90SKalle Valo 331510509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 331610509f90SKalle Valo interval, interval, 3317d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 331810509f90SKalle Valo 331910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 332010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 332110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 332210509f90SKalle Valo request->ie, request->ie_len); 332310509f90SKalle Valo if (ret) { 3324f1ff32e8SJoe Perches ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n", 332510509f90SKalle Valo ret); 332610509f90SKalle Valo return ret; 332710509f90SKalle Valo } 332810509f90SKalle Valo 3329b1f47e3aSThomas Pedersen ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true); 3330b1f47e3aSThomas Pedersen if (ret) 333110509f90SKalle Valo return ret; 333210509f90SKalle Valo 3333b1f47e3aSThomas Pedersen set_bit(SCHED_SCANNING, &vif->flags); 333410509f90SKalle Valo 3335b1f47e3aSThomas Pedersen return 0; 333610509f90SKalle Valo } 333710509f90SKalle Valo 333810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 333910509f90SKalle Valo struct net_device *dev) 334010509f90SKalle Valo { 334110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 334210509f90SKalle Valo bool stopped; 334310509f90SKalle Valo 334410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 334510509f90SKalle Valo 334610509f90SKalle Valo if (!stopped) 334710509f90SKalle Valo return -EIO; 334810509f90SKalle Valo 334910509f90SKalle Valo return 0; 335010509f90SKalle Valo } 335110509f90SKalle Valo 335206e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy, 335306e360acSBala Shanmugam struct net_device *dev, 335406e360acSBala Shanmugam const u8 *addr, 335506e360acSBala Shanmugam const struct cfg80211_bitrate_mask *mask) 335606e360acSBala Shanmugam { 335706e360acSBala Shanmugam struct ath6kl *ar = ath6kl_priv(dev); 335806e360acSBala Shanmugam struct ath6kl_vif *vif = netdev_priv(dev); 335906e360acSBala Shanmugam 336006e360acSBala Shanmugam return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx, 336106e360acSBala Shanmugam mask); 336206e360acSBala Shanmugam } 336306e360acSBala Shanmugam 3364279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy, 3365279b2862SThomas Pedersen struct net_device *dev, 3366279b2862SThomas Pedersen u32 rate, u32 pkts, u32 intvl) 3367279b2862SThomas Pedersen { 3368279b2862SThomas Pedersen struct ath6kl *ar = ath6kl_priv(dev); 3369279b2862SThomas Pedersen struct ath6kl_vif *vif = netdev_priv(dev); 3370279b2862SThomas Pedersen 3371279b2862SThomas Pedersen if (vif->nw_type != INFRA_NETWORK || 3372279b2862SThomas Pedersen !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities)) 3373279b2862SThomas Pedersen return -EOPNOTSUPP; 3374279b2862SThomas Pedersen 3375279b2862SThomas Pedersen if (vif->sme_state != SME_CONNECTED) 3376279b2862SThomas Pedersen return -ENOTCONN; 3377279b2862SThomas Pedersen 3378279b2862SThomas Pedersen /* save this since the firmware won't report the interval */ 3379279b2862SThomas Pedersen vif->txe_intvl = intvl; 3380279b2862SThomas Pedersen 3381279b2862SThomas Pedersen return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx, 3382279b2862SThomas Pedersen rate, pkts, intvl); 3383279b2862SThomas Pedersen } 3384279b2862SThomas Pedersen 3385f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3386f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3387f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3388f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3389f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3390f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3391f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3392f80574aeSJouni Malinen }, 3393ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3394ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3395ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3396ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3397ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3398ba1f6fe3SJouni Malinen }, 3399f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3400f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3401f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3402f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3403f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3404f80574aeSJouni Malinen }, 3405f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3406f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3407f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3408f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3409f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3410f80574aeSJouni Malinen }, 3411f80574aeSJouni Malinen }; 3412f80574aeSJouni Malinen 3413bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 341455055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 341555055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3416bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3417bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3418bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3419bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3420bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3421bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3422bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3423bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3424bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3425bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3426bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3427bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3428bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3429bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3430bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3431bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3432bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3433bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3434003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3435abcb344bSKalle Valo #ifdef CONFIG_PM 343652d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 343752d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3438abcb344bSKalle Valo #endif 34398860020eSJohannes Berg .start_ap = ath6kl_start_ap, 34408860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 34418860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 344233e5308dSJouni Malinen .del_station = ath6kl_del_station, 344323875136SJouni Malinen .change_station = ath6kl_change_station, 344463fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 344563fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 34468a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3447ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 344810509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 344910509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 345006e360acSBala Shanmugam .set_bitrate_mask = ath6kl_cfg80211_set_bitrate, 3451279b2862SThomas Pedersen .set_cqm_txe_config = ath6kl_cfg80211_set_txe_config, 3452bdcd8170SKalle Valo }; 3453bdcd8170SKalle Valo 34547125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3455ec4b7f60SKalle Valo { 345610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 345710509f90SKalle Valo 3458ec4b7f60SKalle Valo switch (vif->sme_state) { 3459c97a31b0SKalle Valo case SME_DISCONNECTED: 3460c97a31b0SKalle Valo break; 3461ec4b7f60SKalle Valo case SME_CONNECTING: 3462ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3463ec4b7f60SKalle Valo NULL, 0, 3464ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3465ec4b7f60SKalle Valo GFP_KERNEL); 3466ec4b7f60SKalle Valo break; 3467ec4b7f60SKalle Valo case SME_CONNECTED: 3468ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3469ec4b7f60SKalle Valo break; 3470ec4b7f60SKalle Valo } 3471ec4b7f60SKalle Valo 347258109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 347358109df6SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) || 347458109df6SVasanthakumar Thiagarajan test_bit(CONNECT_PEND, &vif->flags))) 34757125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3476ec4b7f60SKalle Valo 3477ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34781f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 34791f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3480ec4b7f60SKalle Valo 348184caf800SVasanthakumar Thiagarajan /* Stop netdev queues, needed during recovery */ 348284caf800SVasanthakumar Thiagarajan netif_stop_queue(vif->ndev); 348384caf800SVasanthakumar Thiagarajan netif_carrier_off(vif->ndev); 348484caf800SVasanthakumar Thiagarajan 3485ec4b7f60SKalle Valo /* disable scanning */ 348658109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 348758109df6SVasanthakumar Thiagarajan ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 34887125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 34897125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3490ec4b7f60SKalle Valo 3491ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3492ec4b7f60SKalle Valo } 3493ec4b7f60SKalle Valo 34947125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 34957125f01dSKalle Valo { 34967125f01dSKalle Valo struct ath6kl_vif *vif; 34977125f01dSKalle Valo 34987125f01dSKalle Valo vif = ath6kl_vif_first(ar); 349984caf800SVasanthakumar Thiagarajan if (!vif && ar->state != ATH6KL_STATE_RECOVERY) { 35007125f01dSKalle Valo /* save the current power mode before enabling power save */ 35017125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 35027125f01dSKalle Valo 35037125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3504cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 35057125f01dSKalle Valo return; 35067125f01dSKalle Valo } 35077125f01dSKalle Valo 35087125f01dSKalle Valo /* 35097125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 35107125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 35117125f01dSKalle Valo * sleeps. 35127125f01dSKalle Valo */ 35137125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 35147125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 35157125f01dSKalle Valo } 35167125f01dSKalle Valo 35170c0280bdSLuis R. Rodriguez static void ath6kl_cfg80211_reg_notify(struct wiphy *wiphy, 351884841ba2SKalle Valo struct regulatory_request *request) 351984841ba2SKalle Valo { 352084841ba2SKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 352184841ba2SKalle Valo u32 rates[IEEE80211_NUM_BANDS]; 352284841ba2SKalle Valo int ret, i; 352384841ba2SKalle Valo 352484841ba2SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 3525ff7e6867SKalle Valo "cfg reg_notify %c%c%s%s initiator %d hint_type %d\n", 352684841ba2SKalle Valo request->alpha2[0], request->alpha2[1], 352784841ba2SKalle Valo request->intersect ? " intersect" : "", 352884841ba2SKalle Valo request->processed ? " processed" : "", 3529ff7e6867SKalle Valo request->initiator, request->user_reg_hint_type); 3530ff7e6867SKalle Valo 3531ff7e6867SKalle Valo if (request->user_reg_hint_type != NL80211_USER_REG_HINT_CELL_BASE) 35320c0280bdSLuis R. Rodriguez return; 353384841ba2SKalle Valo 353484841ba2SKalle Valo ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2); 353584841ba2SKalle Valo if (ret) { 353684841ba2SKalle Valo ath6kl_err("failed to set regdomain: %d\n", ret); 35370c0280bdSLuis R. Rodriguez return; 353884841ba2SKalle Valo } 353984841ba2SKalle Valo 354084841ba2SKalle Valo /* 354184841ba2SKalle Valo * Firmware will apply the regdomain change only after a scan is 354284841ba2SKalle Valo * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been 354384841ba2SKalle Valo * changed. 354484841ba2SKalle Valo */ 354584841ba2SKalle Valo 354684841ba2SKalle Valo for (i = 0; i < IEEE80211_NUM_BANDS; i++) 354784841ba2SKalle Valo if (wiphy->bands[i]) 354884841ba2SKalle Valo rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1; 354984841ba2SKalle Valo 355084841ba2SKalle Valo 355184841ba2SKalle Valo ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false, 355284841ba2SKalle Valo false, 0, ATH6KL_FG_SCAN_INTERVAL, 355384841ba2SKalle Valo 0, NULL, false, rates); 355484841ba2SKalle Valo if (ret) { 355584841ba2SKalle Valo ath6kl_err("failed to start scan for a regdomain change: %d\n", 355684841ba2SKalle Valo ret); 35570c0280bdSLuis R. Rodriguez return; 355884841ba2SKalle Valo } 355984841ba2SKalle Valo } 356084841ba2SKalle Valo 3561c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 35628dafb70eSVasanthakumar Thiagarajan { 35637baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 35642132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 35658dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 35668dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 35678dafb70eSVasanthakumar Thiagarajan } 35688dafb70eSVasanthakumar Thiagarajan 3569de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3570108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 357110509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 357210509f90SKalle Valo (unsigned long) vif); 357310509f90SKalle Valo 3574de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3575478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 35768dafb70eSVasanthakumar Thiagarajan 357780abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 357880abaf9bSVasanthakumar Thiagarajan 35798dafb70eSVasanthakumar Thiagarajan return 0; 35808dafb70eSVasanthakumar Thiagarajan } 35818dafb70eSVasanthakumar Thiagarajan 3582355b3a98SMohammed Shafi Shajakhan void ath6kl_cfg80211_vif_stop(struct ath6kl_vif *vif, bool wmi_ready) 3583355b3a98SMohammed Shafi Shajakhan { 3584355b3a98SMohammed Shafi Shajakhan static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; 3585355b3a98SMohammed Shafi Shajakhan bool discon_issued; 3586355b3a98SMohammed Shafi Shajakhan 3587355b3a98SMohammed Shafi Shajakhan netif_stop_queue(vif->ndev); 3588355b3a98SMohammed Shafi Shajakhan 3589355b3a98SMohammed Shafi Shajakhan clear_bit(WLAN_ENABLED, &vif->flags); 3590355b3a98SMohammed Shafi Shajakhan 3591355b3a98SMohammed Shafi Shajakhan if (wmi_ready) { 3592355b3a98SMohammed Shafi Shajakhan discon_issued = test_bit(CONNECTED, &vif->flags) || 3593355b3a98SMohammed Shafi Shajakhan test_bit(CONNECT_PEND, &vif->flags); 3594355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect(vif); 3595355b3a98SMohammed Shafi Shajakhan del_timer(&vif->disconnect_timer); 3596355b3a98SMohammed Shafi Shajakhan 3597355b3a98SMohammed Shafi Shajakhan if (discon_issued) 3598355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect_event(vif, DISCONNECT_CMD, 3599355b3a98SMohammed Shafi Shajakhan (vif->nw_type & AP_NETWORK) ? 3600355b3a98SMohammed Shafi Shajakhan bcast_mac : vif->bssid, 3601355b3a98SMohammed Shafi Shajakhan 0, NULL, 0); 3602355b3a98SMohammed Shafi Shajakhan } 3603355b3a98SMohammed Shafi Shajakhan 3604355b3a98SMohammed Shafi Shajakhan if (vif->scan_req) { 3605355b3a98SMohammed Shafi Shajakhan cfg80211_scan_done(vif->scan_req, true); 3606355b3a98SMohammed Shafi Shajakhan vif->scan_req = NULL; 3607355b3a98SMohammed Shafi Shajakhan } 3608355b3a98SMohammed Shafi Shajakhan 3609355b3a98SMohammed Shafi Shajakhan /* need to clean up enhanced bmiss detection fw state */ 3610355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 3611355b3a98SMohammed Shafi Shajakhan } 3612355b3a98SMohammed Shafi Shajakhan 3613c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 36148dafb70eSVasanthakumar Thiagarajan { 361555055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 361680abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 361755055976SVasanthakumar Thiagarajan 36182132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3619108438bcSVasanthakumar Thiagarajan 362055055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 362155055976SVasanthakumar Thiagarajan 362255055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 362355055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 362455055976SVasanthakumar Thiagarajan 362580abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 362680abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 362780abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 362880abaf9bSVasanthakumar Thiagarajan } 362980abaf9bSVasanthakumar Thiagarajan 363027929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 363155055976SVasanthakumar Thiagarajan 363255055976SVasanthakumar Thiagarajan ar->num_vif--; 36338dafb70eSVasanthakumar Thiagarajan } 36348dafb70eSVasanthakumar Thiagarajan 3635552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name, 363684efbb84SJohannes Berg enum nl80211_iftype type, 363784efbb84SJohannes Berg u8 fw_vif_idx, u8 nw_type) 36388dafb70eSVasanthakumar Thiagarajan { 36398dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3640108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 36418dafb70eSVasanthakumar Thiagarajan 3642c835a677STom Gundersen ndev = alloc_netdev(sizeof(*vif), name, NET_NAME_UNKNOWN, ether_setup); 36438dafb70eSVasanthakumar Thiagarajan if (!ndev) 36448dafb70eSVasanthakumar Thiagarajan return NULL; 36458dafb70eSVasanthakumar Thiagarajan 3646108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3647108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3648108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3649108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3650108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3651108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3652108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3653108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3654334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3655d0d670abSKalle Valo vif->nw_type = nw_type; 3656d0d670abSKalle Valo vif->next_mode = nw_type; 36578f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3658ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3659eb38987eSRaja Mani vif->bg_scan_period = 0; 366067b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_2GHZ].ht_enable = true; 366167b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_5GHZ].ht_enable = true; 36628dafb70eSVasanthakumar Thiagarajan 366355055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3664c95dcb59SAarthi Thiruvengadam if (fw_vif_idx != 0) { 366555055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 366655055976SVasanthakumar Thiagarajan 0x2; 3667c95dcb59SAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR, 3668c95dcb59SAarthi Thiruvengadam ar->fw_capabilities)) 3669c95dcb59SAarthi Thiruvengadam ndev->dev_addr[4] ^= 0x80; 3670c95dcb59SAarthi Thiruvengadam } 367155055976SVasanthakumar Thiagarajan 36728dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 36738dafb70eSVasanthakumar Thiagarajan 3674e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 36758dafb70eSVasanthakumar Thiagarajan 3676c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 36778dafb70eSVasanthakumar Thiagarajan goto err; 36788dafb70eSVasanthakumar Thiagarajan 367927929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 36808dafb70eSVasanthakumar Thiagarajan goto err; 36818dafb70eSVasanthakumar Thiagarajan 368255055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 368314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 368459c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 36858dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 36868dafb70eSVasanthakumar Thiagarajan 368755055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 368855055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 368955055976SVasanthakumar Thiagarajan 369011f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3691990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 369211f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3693990bd915SVasanthakumar Thiagarajan 369484efbb84SJohannes Berg return &vif->wdev; 36958dafb70eSVasanthakumar Thiagarajan 36968dafb70eSVasanthakumar Thiagarajan err: 369727929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 369827929723SVasanthakumar Thiagarajan free_netdev(ndev); 3699bdcd8170SKalle Valo return NULL; 3700bdcd8170SKalle Valo } 3701bdcd8170SKalle Valo 3702964dc9e2SJohannes Berg #ifdef CONFIG_PM 3703964dc9e2SJohannes Berg static const struct wiphy_wowlan_support ath6kl_wowlan_support = { 3704964dc9e2SJohannes Berg .flags = WIPHY_WOWLAN_MAGIC_PKT | 3705964dc9e2SJohannes Berg WIPHY_WOWLAN_DISCONNECT | 3706964dc9e2SJohannes Berg WIPHY_WOWLAN_GTK_REKEY_FAILURE | 3707964dc9e2SJohannes Berg WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 3708964dc9e2SJohannes Berg WIPHY_WOWLAN_EAP_IDENTITY_REQ | 3709964dc9e2SJohannes Berg WIPHY_WOWLAN_4WAY_HANDSHAKE, 3710964dc9e2SJohannes Berg .n_patterns = WOW_MAX_FILTERS_PER_LIST, 3711964dc9e2SJohannes Berg .pattern_min_len = 1, 3712964dc9e2SJohannes Berg .pattern_max_len = WOW_PATTERN_SIZE, 3713964dc9e2SJohannes Berg }; 3714964dc9e2SJohannes Berg #endif 3715964dc9e2SJohannes Berg 371646d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 371746d33a21SKalle Valo { 371846d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3719d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 372046d33a21SKalle Valo int ret; 372146d33a21SKalle Valo 372246d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 372346d33a21SKalle Valo 372446d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 372546d33a21SKalle Valo 372646d33a21SKalle Valo /* set device pointer for wiphy */ 372746d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 372846d33a21SKalle Valo 372946d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 373046d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 373146d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 373246d33a21SKalle Valo if (ar->p2p) { 373346d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 373446d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 373546d33a21SKalle Valo } 373646d33a21SKalle Valo 373784841ba2SKalle Valo if (config_enabled(CONFIG_ATH6KL_REGDOMAIN) && 3738ff7e6867SKalle Valo test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) { 373984841ba2SKalle Valo wiphy->reg_notifier = ath6kl_cfg80211_reg_notify; 3740ff7e6867SKalle Valo ar->wiphy->features |= NL80211_FEATURE_CELL_BASE_REG_HINTS; 3741ff7e6867SKalle Valo } 374284841ba2SKalle Valo 374346d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 37448ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3745dd45b759SNaveen Singh 3746dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3747dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3748dd45b759SNaveen Singh ar->fw_capabilities)) 3749dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3750dd45b759SNaveen Singh 375146d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3752d92917e4SThomas Pedersen switch (ar->hw.cap) { 3753d92917e4SThomas Pedersen case WMI_11AN_CAP: 3754d92917e4SThomas Pedersen ht = true; 3755d92917e4SThomas Pedersen case WMI_11A_CAP: 3756d92917e4SThomas Pedersen band_5gig = true; 3757d92917e4SThomas Pedersen break; 3758d92917e4SThomas Pedersen case WMI_11GN_CAP: 3759d92917e4SThomas Pedersen ht = true; 3760d92917e4SThomas Pedersen case WMI_11G_CAP: 3761d92917e4SThomas Pedersen band_2gig = true; 3762d92917e4SThomas Pedersen break; 3763d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3764d92917e4SThomas Pedersen ht = true; 3765d92917e4SThomas Pedersen case WMI_11AG_CAP: 3766d92917e4SThomas Pedersen band_2gig = true; 3767d92917e4SThomas Pedersen band_5gig = true; 3768d92917e4SThomas Pedersen break; 3769d92917e4SThomas Pedersen default: 3770d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3771d92917e4SThomas Pedersen return -EINVAL; 3772d92917e4SThomas Pedersen } 3773d92917e4SThomas Pedersen 37747fd1ce7eSVasanthakumar Thiagarajan /* 37757fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 37767fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 37777fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 37787fd1ce7eSVasanthakumar Thiagarajan */ 37797fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 37807fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 37817fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3782d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3783d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3784d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3785d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3786d92917e4SThomas Pedersen } 378706e360acSBala Shanmugam 3788eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_64BIT_RATES, 3789eba95bceSKalle Valo ar->fw_capabilities)) { 379006e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 379106e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 379206e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff; 379306e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff; 379406e360acSBala Shanmugam } else { 379506e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 379606e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 379706e360acSBala Shanmugam } 379806e360acSBala Shanmugam 3799d92917e4SThomas Pedersen if (band_2gig) 380046d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3801d92917e4SThomas Pedersen if (band_5gig) 380246d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3803d92917e4SThomas Pedersen 380446d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 380546d33a21SKalle Valo 380646d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 380746d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 380846d33a21SKalle Valo 3809dfb89c56SJohannes Berg #ifdef CONFIG_PM 3810964dc9e2SJohannes Berg wiphy->wowlan = &ath6kl_wowlan_support; 3811dfb89c56SJohannes Berg #endif 381246d33a21SKalle Valo 38138ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 381446d33a21SKalle Valo 3815f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3816f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3817f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3818f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3819f2afdac7SVasanthakumar Thiagarajan 3820b1f47e3aSThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities)) 3821f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3822f2afdac7SVasanthakumar Thiagarajan 382303bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 382403bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 3825b292219fSJohannes Berg ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER; 382603bdeb0dSVasanthakumar Thiagarajan 3827f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3828f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3829f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3830a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3831f2afdac7SVasanthakumar Thiagarajan 383246d33a21SKalle Valo ret = wiphy_register(wiphy); 383346d33a21SKalle Valo if (ret < 0) { 383446d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 383546d33a21SKalle Valo return ret; 383646d33a21SKalle Valo } 383746d33a21SKalle Valo 3838e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3839e5348a1eSVasanthakumar Thiagarajan 384046d33a21SKalle Valo return 0; 384146d33a21SKalle Valo } 384246d33a21SKalle Valo 384346d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3844bdcd8170SKalle Valo { 3845be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3846e5348a1eSVasanthakumar Thiagarajan 3847e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 384845eaa78fSKalle Valo } 384946d33a21SKalle Valo 385045eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 385145eaa78fSKalle Valo { 385245eaa78fSKalle Valo struct ath6kl *ar; 385345eaa78fSKalle Valo struct wiphy *wiphy; 385445eaa78fSKalle Valo 385545eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 385645eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 385745eaa78fSKalle Valo 385845eaa78fSKalle Valo if (!wiphy) { 385945eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 386045eaa78fSKalle Valo return NULL; 386145eaa78fSKalle Valo } 386245eaa78fSKalle Valo 386345eaa78fSKalle Valo ar = wiphy_priv(wiphy); 386445eaa78fSKalle Valo ar->wiphy = wiphy; 386545eaa78fSKalle Valo 386645eaa78fSKalle Valo return ar; 386745eaa78fSKalle Valo } 386845eaa78fSKalle Valo 386945eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 387045eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 387145eaa78fSKalle Valo { 38721d2a4456SVasanthakumar Thiagarajan int i; 38731d2a4456SVasanthakumar Thiagarajan 38741d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 38751d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 38761d2a4456SVasanthakumar Thiagarajan 3877be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3878bdcd8170SKalle Valo } 387945eaa78fSKalle Valo 3880