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) { \ 3757fbcce3SJohannes Berg .band = NL80211_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) { \ 4657fbcce3SJohannes Berg .band = NL80211_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; 6896eb18137SDedy Lansky u16 cap_val; 6906eb18137SDedy Lansky enum ieee80211_bss_type bss_type; 69101cac476SJouni Malinen u8 *ie; 69201cac476SJouni Malinen 6934eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6944eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6956eb18137SDedy Lansky bss_type = IEEE80211_BSS_TYPE_IBSS; 6964eab6f4fSRaja Mani } else { 6974eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6986eb18137SDedy Lansky bss_type = IEEE80211_BSS_TYPE_ESS; 6994eab6f4fSRaja Mani } 7004eab6f4fSRaja Mani 701be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 7024eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 7036eb18137SDedy Lansky bss_type, IEEE80211_PRIVACY_ANY); 70401cac476SJouni Malinen if (bss == NULL) { 70501cac476SJouni Malinen /* 70601cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 70701cac476SJouni Malinen * generate a partial entry until the first BSS info 70801cac476SJouni Malinen * event becomes available. 70901cac476SJouni Malinen * 71001cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 71101cac476SJouni Malinen * IEs from the target. 71201cac476SJouni Malinen */ 7133450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 71401cac476SJouni Malinen if (ie == NULL) 7155e13fd35SVasanthakumar Thiagarajan return NULL; 71601cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 7173450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 7183450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 7193450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 720be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 7215bc8c1f2SJohannes Berg CFG80211_BSS_FTYPE_UNKNOWN, 7224eab6f4fSRaja Mani bssid, 0, cap_val, 100, 7233450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 72401cac476SJouni Malinen 0, GFP_KERNEL); 72501cac476SJouni Malinen if (bss) 726cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 727cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 72801cac476SJouni Malinen kfree(ie); 729a5d8f9dfSKalle Valo } else { 7305e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 731a5d8f9dfSKalle Valo } 73201cac476SJouni Malinen 7335e13fd35SVasanthakumar Thiagarajan return bss; 73401cac476SJouni Malinen } 73501cac476SJouni Malinen 736240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 737bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 738bdcd8170SKalle Valo u16 beacon_intvl, 739bdcd8170SKalle Valo enum network_type nw_type, 740bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 741bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 742bdcd8170SKalle Valo { 74301cac476SJouni Malinen struct ieee80211_channel *chan; 744240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7455e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 746bdcd8170SKalle Valo 747bdcd8170SKalle Valo /* capinfo + listen interval */ 748bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 749bdcd8170SKalle Valo 750bdcd8170SKalle Valo /* capinfo + status code + associd */ 751bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 752bdcd8170SKalle Valo 753bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 754bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 755bdcd8170SKalle Valo assoc_resp_ie_offset; 756bdcd8170SKalle Valo 757bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 758bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 759bdcd8170SKalle Valo 76032c10874SJouni Malinen /* 76132c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 76232c10874SJouni Malinen * a Beacon frame from the AP is seen. 76332c10874SJouni Malinen */ 764cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 76559c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 76632c10874SJouni Malinen 767bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 768551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 769bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 770bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 771bdcd8170SKalle Valo return; 772bdcd8170SKalle Valo } 773bdcd8170SKalle Valo } 774bdcd8170SKalle Valo 775bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 776551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 777551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 778bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 779bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 780bdcd8170SKalle Valo return; 781bdcd8170SKalle Valo } 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo 784be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 785bdcd8170SKalle Valo 7865e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7875e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7885e13fd35SVasanthakumar Thiagarajan if (!bss) { 7894eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 790bdcd8170SKalle Valo return; 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo 7934eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7944eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7954eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 796fe94f3a4SAntonio Quartulli cfg80211_ibss_joined(vif->ndev, bssid, chan, GFP_KERNEL); 7975b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 79801cac476SJouni Malinen return; 79901cac476SJouni Malinen } 80001cac476SJouni Malinen 80114ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 802bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 80314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 804240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 805bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 806bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 807bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 8085b112d3dSJohannes Berg cfg80211_put_bss(ar->wiphy, bss); 80914ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 810bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 8115e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 812bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 813bdcd8170SKalle Valo } 814bdcd8170SKalle Valo } 815bdcd8170SKalle Valo 816bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 817bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 818bdcd8170SKalle Valo { 819d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 8203450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 821bdcd8170SKalle Valo 822bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 823bdcd8170SKalle Valo reason_code); 824bdcd8170SKalle Valo 82510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 82610509f90SKalle Valo 827990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 828bdcd8170SKalle Valo return -EIO; 829bdcd8170SKalle Valo 830bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 831bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 832bdcd8170SKalle Valo return -EBUSY; 833bdcd8170SKalle Valo } 834bdcd8170SKalle Valo 835bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 836bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 837bdcd8170SKalle Valo return -ERESTARTSYS; 838bdcd8170SKalle Valo } 839bdcd8170SKalle Valo 840cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 841240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8423450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8433450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 844bdcd8170SKalle Valo 845bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8468c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 847bdcd8170SKalle Valo 848bdcd8170SKalle Valo up(&ar->sem); 849bdcd8170SKalle Valo 850bdcd8170SKalle Valo return 0; 851bdcd8170SKalle Valo } 852bdcd8170SKalle Valo 853240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 854bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 855bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 856bdcd8170SKalle Valo { 857240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 85859c98449SVasanthakumar Thiagarajan 85914ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 8601d76250bSAvraham Stern struct cfg80211_scan_info info = { 8611d76250bSAvraham Stern .aborted = true, 8621d76250bSAvraham Stern }; 8631d76250bSAvraham Stern 8641d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 86514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 866bdcd8170SKalle Valo } 867bdcd8170SKalle Valo 868f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 869fe94f3a4SAntonio Quartulli if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) 870bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 871bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 872bdcd8170SKalle Valo return; 873bdcd8170SKalle Valo } 874bdcd8170SKalle Valo 875f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 876551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 877551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 878bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 879bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 880bdcd8170SKalle Valo return; 881bdcd8170SKalle Valo } 882bdcd8170SKalle Valo } 883bdcd8170SKalle Valo 88459c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 885bdcd8170SKalle Valo 88614ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 887240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 888bdcd8170SKalle Valo bssid, NULL, 0, 889bdcd8170SKalle Valo NULL, 0, 890bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 891bdcd8170SKalle Valo GFP_KERNEL); 89214ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 89333a6664aSThomas Pedersen cfg80211_disconnected(vif->ndev, proto_reason, 89480279fb7SJohannes Berg NULL, 0, false, GFP_KERNEL); 895bdcd8170SKalle Valo } 896bdcd8170SKalle Valo 89714ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 89833a6664aSThomas Pedersen 89933a6664aSThomas Pedersen /* 90033a6664aSThomas Pedersen * Send a disconnect command to target when a disconnect event is 90133a6664aSThomas Pedersen * received with reason code other than 3 (DISCONNECT_CMD - disconnect 90233a6664aSThomas Pedersen * request from host) to make the firmware stop trying to connect even 90333a6664aSThomas Pedersen * after giving disconnect event. There will be one more disconnect 90433a6664aSThomas Pedersen * event for this disconnect command with reason code DISCONNECT_CMD 90533a6664aSThomas Pedersen * which won't be notified to cfg80211. 90633a6664aSThomas Pedersen */ 90733a6664aSThomas Pedersen if (reason != DISCONNECT_CMD) 90833a6664aSThomas Pedersen ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 909bdcd8170SKalle Valo } 910bdcd8170SKalle Valo 9113b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 9123b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 913dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 914dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 915dd45b759SNaveen Singh int n_match_ssid) 9163b8ffc6aSJouni Malinen { 917dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 918dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 9193b8ffc6aSJouni Malinen 920dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 921dd45b759SNaveen Singh 922dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 923dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 9243b8ffc6aSJouni Malinen return -EINVAL; 9253b8ffc6aSJouni Malinen 9263b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 927dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 928dd45b759SNaveen Singh ssids[i].ssid, 929dd45b759SNaveen Singh ssids[i].ssid_len); 930dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 931dd45b759SNaveen Singh 932dd45b759SNaveen Singh if (ssids[i].ssid_len) 933dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 934dd45b759SNaveen Singh else 935dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 936dd45b759SNaveen Singh 937dd45b759SNaveen Singh if (n_match_ssid == 0) 938dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 939dd45b759SNaveen Singh } 940dd45b759SNaveen Singh 941dd45b759SNaveen Singh index_to_add = i; 942dd45b759SNaveen Singh 943dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 944dd45b759SNaveen Singh ssid_found = false; 945dd45b759SNaveen Singh 946dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 947dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 948dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 949dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 950dd45b759SNaveen Singh match_set[i].ssid.ssid, 951dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 952dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 953dd45b759SNaveen Singh ssid_found = true; 954dd45b759SNaveen Singh break; 955dd45b759SNaveen Singh } 956dd45b759SNaveen Singh } 957dd45b759SNaveen Singh 958dd45b759SNaveen Singh if (ssid_found) 959dd45b759SNaveen Singh continue; 960dd45b759SNaveen Singh 961dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 962dd45b759SNaveen Singh continue; 963dd45b759SNaveen Singh 964dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 965dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 966dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 967dd45b759SNaveen Singh match_set[i].ssid.ssid, 968dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 969dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 970dd45b759SNaveen Singh index_to_add++; 971dd45b759SNaveen Singh } 972dd45b759SNaveen Singh 973dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9743b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 975dd45b759SNaveen Singh ssid_list[i].flag, 976dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 977dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 9783b8ffc6aSJouni Malinen } 9793b8ffc6aSJouni Malinen 9803b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 981dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9823b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9833b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9843b8ffc6aSJouni Malinen } 9853b8ffc6aSJouni Malinen 9863b8ffc6aSJouni Malinen return 0; 9873b8ffc6aSJouni Malinen } 9883b8ffc6aSJouni Malinen 989fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy, 990bdcd8170SKalle Valo struct cfg80211_scan_request *request) 991bdcd8170SKalle Valo { 992fd014284SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev); 993fd014284SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 9941276c9efSEdward Lu s8 n_channels = 0; 9951276c9efSEdward Lu u16 *channels = NULL; 996bdcd8170SKalle Valo int ret = 0; 997f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 998bdcd8170SKalle Valo 999990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1000bdcd8170SKalle Valo return -EIO; 1001bdcd8170SKalle Valo 100210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 100310509f90SKalle Valo 1004bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 100559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 1006954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 1007954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 10081b1e6ee3SJouni Malinen if (ret) { 1009bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 10101b1e6ee3SJouni Malinen return ret; 1011bdcd8170SKalle Valo } 1012bdcd8170SKalle Valo } 1013bdcd8170SKalle Valo 10143b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 1015dd45b759SNaveen Singh request->n_ssids, NULL, 0); 10163b8ffc6aSJouni Malinen if (ret < 0) 10173b8ffc6aSJouni Malinen return ret; 1018bdcd8170SKalle Valo 1019080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 1020334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1021334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 1022b84da8c7SJouni Malinen request->ie, request->ie_len); 1023b84da8c7SJouni Malinen if (ret) { 1024f1ff32e8SJoe Perches ath6kl_err("failed to set Probe Request appie for scan\n"); 1025b84da8c7SJouni Malinen return ret; 1026b84da8c7SJouni Malinen } 1027b84da8c7SJouni Malinen 102811869befSJouni Malinen /* 102911869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 103011869befSJouni Malinen * channels. If the list is longer than the target supports, do not 103111869befSJouni Malinen * configure the list and instead, scan all available channels. 103211869befSJouni Malinen */ 103311869befSJouni Malinen if (request->n_channels > 0 && 103411869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10351276c9efSEdward Lu u8 i; 10361276c9efSEdward Lu 103711869befSJouni Malinen n_channels = request->n_channels; 10381276c9efSEdward Lu 10391276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 10401276c9efSEdward Lu if (channels == NULL) { 1041cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10421276c9efSEdward Lu n_channels = 0; 10431276c9efSEdward Lu } 10441276c9efSEdward Lu 10451276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10461276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10471276c9efSEdward Lu } 10481276c9efSEdward Lu 104959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1050f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1051f1f92179SVasanthakumar Thiagarajan 10525b35dff0SRaja Mani vif->scan_req = request; 10535b35dff0SRaja Mani 10543ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10553ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 105613423c31SVasanthakumar Thiagarajan false, 0, 105713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 105813423c31SVasanthakumar Thiagarajan n_channels, channels, 105913423c31SVasanthakumar Thiagarajan request->no_cck, 10603ca9d1fcSAarthi Thiruvengadam request->rates); 10615b35dff0SRaja Mani if (ret) { 106211f0bfcfSKalle Valo ath6kl_err("failed to start scan: %d\n", ret); 10635b35dff0SRaja Mani vif->scan_req = NULL; 10645b35dff0SRaja Mani } 1065bdcd8170SKalle Valo 10661276c9efSEdward Lu kfree(channels); 10671276c9efSEdward Lu 1068bdcd8170SKalle Valo return ret; 1069bdcd8170SKalle Valo } 1070bdcd8170SKalle Valo 10711c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1072bdcd8170SKalle Valo { 1073240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10741d76250bSAvraham Stern struct cfg80211_scan_info info = { 10751d76250bSAvraham Stern .aborted = aborted, 10761d76250bSAvraham Stern }; 10776fd1eaceSKalle Valo int i; 1078bdcd8170SKalle Valo 10791c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10801c17d313SKalle Valo aborted ? " aborted" : ""); 1081bdcd8170SKalle Valo 108214ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10836fd1eaceSKalle Valo return; 10846fd1eaceSKalle Valo 10851c17d313SKalle Valo if (aborted) 10866fd1eaceSKalle Valo goto out; 1087bdcd8170SKalle Valo 108814ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 108914ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1090334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1091334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1092bdcd8170SKalle Valo 0, NULL); 1093bdcd8170SKalle Valo } 1094bdcd8170SKalle Valo } 10956fd1eaceSKalle Valo 10966fd1eaceSKalle Valo out: 10971d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 109814ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1099bdcd8170SKalle Valo } 1100bdcd8170SKalle Valo 1101c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1102c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1103c4f7863eSThomas Pedersen { 1104683b6d3bSJohannes Berg struct cfg80211_chan_def chandef; 1105c4f7863eSThomas Pedersen 1106c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1107c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1108c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1109c4f7863eSThomas Pedersen 11103d9d1d66SJohannes Berg cfg80211_chandef_create(&chandef, 11113d9d1d66SJohannes Berg ieee80211_get_channel(vif->ar->wiphy, freq), 1112f3651baeSPierre Le Magourou (mode == WMI_11G_HT20 && 1113f3651baeSPierre Le Magourou ath6kl_band_2ghz.ht_cap.ht_supported) ? 11143d9d1d66SJohannes Berg NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT); 1115c4f7863eSThomas Pedersen 1116e487eaebSSimon Wunderlich mutex_lock(&vif->wdev.mtx); 1117683b6d3bSJohannes Berg cfg80211_ch_switch_notify(vif->ndev, &chandef); 1118e487eaebSSimon Wunderlich mutex_unlock(&vif->wdev.mtx); 1119c4f7863eSThomas Pedersen } 1120c4f7863eSThomas Pedersen 1121bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1122bdcd8170SKalle Valo u8 key_index, bool pairwise, 1123bdcd8170SKalle Valo const u8 *mac_addr, 1124bdcd8170SKalle Valo struct key_params *params) 1125bdcd8170SKalle Valo { 1126d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 112759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1128bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 11294a8ce2fdSSujith Manoharan int seq_len; 1130bdcd8170SKalle Valo u8 key_usage; 1131bdcd8170SKalle Valo u8 key_type; 1132bdcd8170SKalle Valo 1133990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1134bdcd8170SKalle Valo return -EIO; 1135bdcd8170SKalle Valo 1136837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1137837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1138837cb97eSJouni Malinen return -EINVAL; 1139240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1140240d2799SVasanthakumar Thiagarajan params->key); 1141837cb97eSJouni Malinen } 1142837cb97eSJouni Malinen 1143792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1145bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1146bdcd8170SKalle Valo key_index); 1147bdcd8170SKalle Valo return -ENOENT; 1148bdcd8170SKalle Valo } 1149bdcd8170SKalle Valo 11506f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1151bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1152bdcd8170SKalle Valo 1153bdcd8170SKalle Valo if (pairwise) 1154bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1155bdcd8170SKalle Valo else 1156bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1157bdcd8170SKalle Valo 11584a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11595e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11605e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11615e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11625e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11635e07021eSDai Shuibing } 1164bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11655e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1166bdcd8170SKalle Valo return -EINVAL; 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo key->key_len = params->key_len; 1169bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11705e07021eSDai Shuibing key->seq_len = seq_len; 1171bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1172bdcd8170SKalle Valo key->cipher = params->cipher; 1173bdcd8170SKalle Valo 1174bdcd8170SKalle Valo switch (key->cipher) { 1175bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1176bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1177bdcd8170SKalle Valo key_type = WEP_CRYPT; 1178bdcd8170SKalle Valo break; 1179bdcd8170SKalle Valo 1180bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1181bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1182bdcd8170SKalle Valo break; 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1185bdcd8170SKalle Valo key_type = AES_CRYPT; 1186bdcd8170SKalle Valo break; 11875e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11885e07021eSDai Shuibing key_type = WAPI_CRYPT; 11895e07021eSDai Shuibing break; 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo default: 1192bdcd8170SKalle Valo return -ENOTSUPP; 1193bdcd8170SKalle Valo } 1194bdcd8170SKalle Valo 1195ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1196ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1197ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1198de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1199bdcd8170SKalle Valo 1200bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1201bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1202bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1203bdcd8170SKalle Valo key_usage, key->seq_len); 1204bdcd8170SKalle Valo 1205f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 12064703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1207cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 12089a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 12099a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 12109a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 12119a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 12129a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 121359c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1214cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1215cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 12169a5b1318SJouni Malinen /* 12179a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 12189a5b1318SJouni Malinen * the connected event is received from the target. 12199a5b1318SJouni Malinen */ 12209a5b1318SJouni Malinen return 0; 12219a5b1318SJouni Malinen } 12229a5b1318SJouni Malinen } 12239a5b1318SJouni Malinen 1224f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 122559c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1226151411e8SJouni Malinen /* 1227151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1228151411e8SJouni Malinen * the AP mode has properly started 1229151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1230151411e8SJouni Malinen */ 1231cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1232cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 12336f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 12346f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 12356f2a73f9SVasanthakumar Thiagarajan key->key_len); 1236151411e8SJouni Malinen return 0; 1237151411e8SJouni Malinen } 1238151411e8SJouni Malinen 12397cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1240bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1241f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1242f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1243bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1244bdcd8170SKalle Valo } 1245bdcd8170SKalle Valo 1246bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1247bdcd8170SKalle Valo u8 key_index, bool pairwise, 1248bdcd8170SKalle Valo const u8 *mac_addr) 1249bdcd8170SKalle Valo { 1250d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12516f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1254bdcd8170SKalle Valo 1255990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1256bdcd8170SKalle Valo return -EIO; 1257bdcd8170SKalle Valo 1258792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1259bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1260bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1261bdcd8170SKalle Valo key_index); 1262bdcd8170SKalle Valo return -ENOENT; 1263bdcd8170SKalle Valo } 1264bdcd8170SKalle Valo 12656f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1266bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1267bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1268bdcd8170SKalle Valo return 0; 1269bdcd8170SKalle Valo } 1270bdcd8170SKalle Valo 12716f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1272bdcd8170SKalle Valo 1273334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1274bdcd8170SKalle Valo } 1275bdcd8170SKalle Valo 1276bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1277bdcd8170SKalle Valo u8 key_index, bool pairwise, 1278bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1279bdcd8170SKalle Valo void (*callback) (void *cookie, 1280bdcd8170SKalle Valo struct key_params *)) 1281bdcd8170SKalle Valo { 12826f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1283bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1284bdcd8170SKalle Valo struct key_params params; 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1287bdcd8170SKalle Valo 1288990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1289bdcd8170SKalle Valo return -EIO; 1290bdcd8170SKalle Valo 1291792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1292bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1293bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1294bdcd8170SKalle Valo key_index); 1295bdcd8170SKalle Valo return -ENOENT; 1296bdcd8170SKalle Valo } 1297bdcd8170SKalle Valo 12986f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1299bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1300bdcd8170SKalle Valo params.cipher = key->cipher; 1301bdcd8170SKalle Valo params.key_len = key->key_len; 1302bdcd8170SKalle Valo params.seq_len = key->seq_len; 1303bdcd8170SKalle Valo params.seq = key->seq; 1304bdcd8170SKalle Valo params.key = key->key; 1305bdcd8170SKalle Valo 1306bdcd8170SKalle Valo callback(cookie, ¶ms); 1307bdcd8170SKalle Valo 1308bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1309bdcd8170SKalle Valo } 1310bdcd8170SKalle Valo 1311bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1312bdcd8170SKalle Valo struct net_device *ndev, 1313bdcd8170SKalle Valo u8 key_index, bool unicast, 1314bdcd8170SKalle Valo bool multicast) 1315bdcd8170SKalle Valo { 1316d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 131759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1318bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1319bdcd8170SKalle Valo u8 key_usage; 1320229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1323bdcd8170SKalle Valo 1324990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1325bdcd8170SKalle Valo return -EIO; 1326bdcd8170SKalle Valo 1327792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1328bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1329bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1330bdcd8170SKalle Valo __func__, key_index); 1331bdcd8170SKalle Valo return -ENOENT; 1332bdcd8170SKalle Valo } 1333bdcd8170SKalle Valo 13346f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1335bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1336bdcd8170SKalle Valo __func__, key_index); 1337bdcd8170SKalle Valo return -EINVAL; 1338bdcd8170SKalle Valo } 1339bdcd8170SKalle Valo 13403450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13416f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1342bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13433450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1344bdcd8170SKalle Valo key_usage |= TX_USAGE; 1345229ed6b5SEdward Lu if (unicast) 13463450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1347229ed6b5SEdward Lu if (multicast) 13483450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1349bdcd8170SKalle Valo 1350f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13519a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13529a5b1318SJouni Malinen 1353f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1354334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1355229ed6b5SEdward Lu key_type, key_usage, 1356f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1357f4bb9a6fSJouni Malinen key->key, 1358bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1359bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1360bdcd8170SKalle Valo } 1361bdcd8170SKalle Valo 1362240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1363bdcd8170SKalle Valo bool ismcast) 1364bdcd8170SKalle Valo { 1365bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1366bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1367bdcd8170SKalle Valo 1368240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1369bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1370bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1371bdcd8170SKalle Valo GFP_KERNEL); 1372bdcd8170SKalle Valo } 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1375bdcd8170SKalle Valo { 1376bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1377990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1378bdcd8170SKalle Valo int ret; 1379bdcd8170SKalle Valo 1380bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1381bdcd8170SKalle Valo changed); 1382bdcd8170SKalle Valo 1383990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1384990bd915SVasanthakumar Thiagarajan if (!vif) 1385990bd915SVasanthakumar Thiagarajan return -EIO; 1386990bd915SVasanthakumar Thiagarajan 1387990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1388bdcd8170SKalle Valo return -EIO; 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1391bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1392bdcd8170SKalle Valo if (ret != 0) { 1393bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1394bdcd8170SKalle Valo return -EIO; 1395bdcd8170SKalle Valo } 1396bdcd8170SKalle Valo } 1397bdcd8170SKalle Valo 1398bdcd8170SKalle Valo return 0; 1399bdcd8170SKalle Valo } 1400bdcd8170SKalle Valo 1401bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1402c8442118SJohannes Berg struct wireless_dev *wdev, 1403bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1404b992a285SLuis R. Rodriguez int mbm) 1405bdcd8170SKalle Valo { 1406bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1407990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1408b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1409bdcd8170SKalle Valo 1410bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1411bdcd8170SKalle Valo type, dbm); 1412bdcd8170SKalle Valo 1413990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1414990bd915SVasanthakumar Thiagarajan if (!vif) 1415990bd915SVasanthakumar Thiagarajan return -EIO; 1416990bd915SVasanthakumar Thiagarajan 1417990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1418bdcd8170SKalle Valo return -EIO; 1419bdcd8170SKalle Valo 1420bdcd8170SKalle Valo switch (type) { 1421bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1422bdcd8170SKalle Valo return 0; 1423bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1424d0d670abSKalle Valo ar->tx_pwr = dbm; 1425bdcd8170SKalle Valo break; 1426bdcd8170SKalle Valo default: 1427bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1428bdcd8170SKalle Valo __func__, type); 1429bdcd8170SKalle Valo return -EOPNOTSUPP; 1430bdcd8170SKalle Valo } 1431bdcd8170SKalle Valo 1432d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1433bdcd8170SKalle Valo 1434bdcd8170SKalle Valo return 0; 1435bdcd8170SKalle Valo } 1436bdcd8170SKalle Valo 1437c8442118SJohannes Berg static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, 1438c8442118SJohannes Berg struct wireless_dev *wdev, 1439c8442118SJohannes Berg int *dbm) 1440bdcd8170SKalle Valo { 1441bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1442990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1443bdcd8170SKalle Valo 1444990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1445990bd915SVasanthakumar Thiagarajan if (!vif) 1446990bd915SVasanthakumar Thiagarajan return -EIO; 1447990bd915SVasanthakumar Thiagarajan 1448990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1449bdcd8170SKalle Valo return -EIO; 1450bdcd8170SKalle Valo 145159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1452bdcd8170SKalle Valo ar->tx_pwr = 0; 1453bdcd8170SKalle Valo 1454990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1455bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1456bdcd8170SKalle Valo return -EIO; 1457bdcd8170SKalle Valo } 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1460bdcd8170SKalle Valo 5 * HZ); 1461bdcd8170SKalle Valo 1462bdcd8170SKalle Valo if (signal_pending(current)) { 1463bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1464bdcd8170SKalle Valo return -EINTR; 1465bdcd8170SKalle Valo } 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1469bdcd8170SKalle Valo return 0; 1470bdcd8170SKalle Valo } 1471bdcd8170SKalle Valo 1472bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1473bdcd8170SKalle Valo struct net_device *dev, 1474bdcd8170SKalle Valo bool pmgmt, int timeout) 1475bdcd8170SKalle Valo { 1476bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1477bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1478334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1479bdcd8170SKalle Valo 1480bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1481bdcd8170SKalle Valo __func__, pmgmt, timeout); 1482bdcd8170SKalle Valo 1483990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1484bdcd8170SKalle Valo return -EIO; 1485bdcd8170SKalle Valo 1486bdcd8170SKalle Valo if (pmgmt) { 1487f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1488bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1489bdcd8170SKalle Valo } else { 1490f0ed67ecSMohammed Shafi Shajakhan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1491bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1492bdcd8170SKalle Valo } 1493bdcd8170SKalle Valo 1494334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1495334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1496bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1497bdcd8170SKalle Valo return -EIO; 1498bdcd8170SKalle Valo } 1499bdcd8170SKalle Valo 1500bdcd8170SKalle Valo return 0; 1501bdcd8170SKalle Valo } 1502bdcd8170SKalle Valo 150384efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1504552bff0cSJohannes Berg const char *name, 15056bab2e19STom Gundersen unsigned char name_assign_type, 150655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 150755055976SVasanthakumar Thiagarajan u32 *flags, 150855055976SVasanthakumar Thiagarajan struct vif_params *params) 150955055976SVasanthakumar Thiagarajan { 151055055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 151184efbb84SJohannes Berg struct wireless_dev *wdev; 151255055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 151355055976SVasanthakumar Thiagarajan 151471f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 151555055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 151655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 151755055976SVasanthakumar Thiagarajan } 151855055976SVasanthakumar Thiagarajan 151955055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 152055055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 152155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 152255055976SVasanthakumar Thiagarajan } 152355055976SVasanthakumar Thiagarajan 15246bab2e19STom Gundersen wdev = ath6kl_interface_add(ar, name, name_assign_type, type, if_idx, nw_type); 152584efbb84SJohannes Berg if (!wdev) 152655055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 152755055976SVasanthakumar Thiagarajan 152855055976SVasanthakumar Thiagarajan ar->num_vif++; 152955055976SVasanthakumar Thiagarajan 153084efbb84SJohannes Berg return wdev; 153155055976SVasanthakumar Thiagarajan } 153255055976SVasanthakumar Thiagarajan 153355055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 153484efbb84SJohannes Berg struct wireless_dev *wdev) 153555055976SVasanthakumar Thiagarajan { 153655055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 153784efbb84SJohannes Berg struct ath6kl_vif *vif = netdev_priv(wdev->netdev); 153855055976SVasanthakumar Thiagarajan 153911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 154055055976SVasanthakumar Thiagarajan list_del(&vif->list); 154111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 154255055976SVasanthakumar Thiagarajan 1543355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_vif_stop(vif, test_bit(WMI_READY, &ar->flag)); 154455055976SVasanthakumar Thiagarajan 1545bc52aab3SMohammed Shafi Shajakhan rtnl_lock(); 1546c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 1547bc52aab3SMohammed Shafi Shajakhan rtnl_unlock(); 154855055976SVasanthakumar Thiagarajan 154955055976SVasanthakumar Thiagarajan return 0; 155055055976SVasanthakumar Thiagarajan } 155155055976SVasanthakumar Thiagarajan 1552bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1553bdcd8170SKalle Valo struct net_device *ndev, 1554bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1555bdcd8170SKalle Valo struct vif_params *params) 1556bdcd8170SKalle Valo { 1557f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15581e8d13b0SVasanthakumar Thiagarajan int i; 1559bdcd8170SKalle Valo 1560bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1561bdcd8170SKalle Valo 15621e8d13b0SVasanthakumar Thiagarajan /* 15631e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15641e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15651e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15661e8d13b0SVasanthakumar Thiagarajan */ 15671e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15681e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15691e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15701e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15711e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15721e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15731e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15741e8d13b0SVasanthakumar Thiagarajan else 15751e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15761e8d13b0SVasanthakumar Thiagarajan } 15771e8d13b0SVasanthakumar Thiagarajan 15781e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15791e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15801e8d13b0SVasanthakumar Thiagarajan break; 15811e8d13b0SVasanthakumar Thiagarajan } 15821e8d13b0SVasanthakumar Thiagarajan 15831e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15841e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15851e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15861e8d13b0SVasanthakumar Thiagarajan } 15871e8d13b0SVasanthakumar Thiagarajan } 15881e8d13b0SVasanthakumar Thiagarajan 1589c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1590c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1591c422d52dSThomas Pedersen 15921e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1593bdcd8170SKalle Valo switch (type) { 1594bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 15958aa659d2SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 1596f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1597bdcd8170SKalle Valo break; 1598bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1599f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1600bdcd8170SKalle Valo break; 16016e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 16026b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1603f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 16046b5e5d25SJouni Malinen break; 1605bdcd8170SKalle Valo default: 1606bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1607bdcd8170SKalle Valo return -EOPNOTSUPP; 1608bdcd8170SKalle Valo } 1609bdcd8170SKalle Valo 1610551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1611bdcd8170SKalle Valo 1612bdcd8170SKalle Valo return 0; 1613bdcd8170SKalle Valo } 1614bdcd8170SKalle Valo 1615bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1616bdcd8170SKalle Valo struct net_device *dev, 1617bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1618bdcd8170SKalle Valo { 1619bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1621bdcd8170SKalle Valo int status; 1622bdcd8170SKalle Valo 1623990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1624bdcd8170SKalle Valo return -EIO; 1625bdcd8170SKalle Valo 16263450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 16273450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1628bdcd8170SKalle Valo 1629683b6d3bSJohannes Berg if (ibss_param->chandef.chan) 1630683b6d3bSJohannes Berg vif->ch_hint = ibss_param->chandef.chan->center_freq; 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1633bdcd8170SKalle Valo /* 1634bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1635bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1636bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1637bdcd8170SKalle Valo * updated. 1638bdcd8170SKalle Valo */ 1639bdcd8170SKalle Valo return -EOPNOTSUPP; 1640bdcd8170SKalle Valo } 1641bdcd8170SKalle Valo 16428c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1643bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16448c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16458c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1646bdcd8170SKalle Valo 1647240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1648bdcd8170SKalle Valo 1649240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1650bdcd8170SKalle Valo if (status) 1651bdcd8170SKalle Valo return status; 1652bdcd8170SKalle Valo 1653bdcd8170SKalle Valo if (ibss_param->privacy) { 1654240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1655240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1656bdcd8170SKalle Valo } else { 1657240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1658240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1659bdcd8170SKalle Valo } 1660bdcd8170SKalle Valo 1661f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1662bdcd8170SKalle Valo 1663bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1664bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1665bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1666bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1667bdcd8170SKalle Valo __func__, 16683450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16693450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1670f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1671bdcd8170SKalle Valo 1672334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16733450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16743450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16753450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16763450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16773450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1678f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16793ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 168059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1681bdcd8170SKalle Valo 1682bdcd8170SKalle Valo return 0; 1683bdcd8170SKalle Valo } 1684bdcd8170SKalle Valo 1685bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1686bdcd8170SKalle Valo struct net_device *dev) 1687bdcd8170SKalle Valo { 16883450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1689bdcd8170SKalle Valo 1690990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1691bdcd8170SKalle Valo return -EIO; 1692bdcd8170SKalle Valo 1693240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16943450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16953450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1696bdcd8170SKalle Valo 1697bdcd8170SKalle Valo return 0; 1698bdcd8170SKalle Valo } 1699bdcd8170SKalle Valo 1700bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1701bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1702bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1703bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1704bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1705837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 17065e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1707bdcd8170SKalle Valo }; 1708bdcd8170SKalle Valo 1709bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1710bdcd8170SKalle Valo { 1711bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1712bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1713bdcd8170SKalle Valo 36000, 48000, 54000 1714bdcd8170SKalle Valo }; 1715bdcd8170SKalle Valo u8 i; 1716bdcd8170SKalle Valo 1717bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1718bdcd8170SKalle Valo if (rate == legacy[i]) 1719bdcd8170SKalle Valo return true; 1720bdcd8170SKalle Valo 1721bdcd8170SKalle Valo return false; 1722bdcd8170SKalle Valo } 1723bdcd8170SKalle Valo 1724bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1725bdcd8170SKalle Valo { 1726bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1727bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1728bdcd8170SKalle Valo }; 1729bdcd8170SKalle Valo u8 i; 1730bdcd8170SKalle Valo 1731bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1732bdcd8170SKalle Valo if (rate == ht20[i]) { 1733bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1734bdcd8170SKalle Valo /* last rate uses sgi */ 1735bdcd8170SKalle Valo *sgi = true; 1736bdcd8170SKalle Valo else 1737bdcd8170SKalle Valo *sgi = false; 1738bdcd8170SKalle Valo 1739bdcd8170SKalle Valo *mcs = i; 1740bdcd8170SKalle Valo return true; 1741bdcd8170SKalle Valo } 1742bdcd8170SKalle Valo } 1743bdcd8170SKalle Valo return false; 1744bdcd8170SKalle Valo } 1745bdcd8170SKalle Valo 1746bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1747bdcd8170SKalle Valo { 1748bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1749bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1750bdcd8170SKalle Valo 150000 1751bdcd8170SKalle Valo }; 1752bdcd8170SKalle Valo u8 i; 1753bdcd8170SKalle Valo 1754bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1755bdcd8170SKalle Valo if (rate == ht40[i]) { 1756bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1757bdcd8170SKalle Valo /* last rate uses sgi */ 1758bdcd8170SKalle Valo *sgi = true; 1759bdcd8170SKalle Valo else 1760bdcd8170SKalle Valo *sgi = false; 1761bdcd8170SKalle Valo 1762bdcd8170SKalle Valo *mcs = i; 1763bdcd8170SKalle Valo return true; 1764bdcd8170SKalle Valo } 1765bdcd8170SKalle Valo } 1766bdcd8170SKalle Valo 1767bdcd8170SKalle Valo return false; 1768bdcd8170SKalle Valo } 1769bdcd8170SKalle Valo 1770bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 17713b3a0162SJohannes Berg const u8 *mac, struct station_info *sinfo) 1772bdcd8170SKalle Valo { 1773bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 177459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1775bdcd8170SKalle Valo long left; 1776bdcd8170SKalle Valo bool sgi; 1777bdcd8170SKalle Valo s32 rate; 1778bdcd8170SKalle Valo int ret; 1779bdcd8170SKalle Valo u8 mcs; 1780bdcd8170SKalle Valo 17818c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1782bdcd8170SKalle Valo return -ENOENT; 1783bdcd8170SKalle Valo 1784bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1785bdcd8170SKalle Valo return -EBUSY; 1786bdcd8170SKalle Valo 1787b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1788bdcd8170SKalle Valo 1789334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1790bdcd8170SKalle Valo 1791bdcd8170SKalle Valo if (ret != 0) { 1792bdcd8170SKalle Valo up(&ar->sem); 1793bdcd8170SKalle Valo return -EIO; 1794bdcd8170SKalle Valo } 1795bdcd8170SKalle Valo 1796bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1797bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1798b95907a7SVasanthakumar Thiagarajan &vif->flags), 1799bdcd8170SKalle Valo WMI_TIMEOUT); 1800bdcd8170SKalle Valo 1801bdcd8170SKalle Valo up(&ar->sem); 1802bdcd8170SKalle Valo 1803bdcd8170SKalle Valo if (left == 0) 1804bdcd8170SKalle Valo return -ETIMEDOUT; 1805bdcd8170SKalle Valo else if (left < 0) 1806bdcd8170SKalle Valo return left; 1807bdcd8170SKalle Valo 1808b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1809b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1810319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_BYTES64); 1811b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1812319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_RX_PACKETS); 1813bdcd8170SKalle Valo } 1814bdcd8170SKalle Valo 1815b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1816b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1817319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BYTES64); 1818b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1819319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_PACKETS); 1820bdcd8170SKalle Valo } 1821bdcd8170SKalle Valo 1822b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1823319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_SIGNAL); 1824bdcd8170SKalle Valo 1825b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1826bdcd8170SKalle Valo 1827bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1828bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1829bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1830bdcd8170SKalle Valo if (sgi) { 1831bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1832bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1833bdcd8170SKalle Valo } else { 1834bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1835bdcd8170SKalle Valo } 1836bdcd8170SKalle Valo 1837bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1838b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_20; 1839bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1840bdcd8170SKalle Valo if (sgi) { 1841bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1842bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1843bdcd8170SKalle Valo } else { 1844bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1845bdcd8170SKalle Valo } 1846bdcd8170SKalle Valo 1847b51f3beeSJohannes Berg sinfo->txrate.bw = RATE_INFO_BW_40; 1848bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1849bdcd8170SKalle Valo } else { 18509a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18519a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18529a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1853bdcd8170SKalle Valo return 0; 1854bdcd8170SKalle Valo } 1855bdcd8170SKalle Valo 1856319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_TX_BITRATE); 1857bdcd8170SKalle Valo 185859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 185959c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1860f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 1861319090bfSJohannes Berg sinfo->filled |= BIT(NL80211_STA_INFO_BSS_PARAM); 186232c10874SJouni Malinen sinfo->bss_param.flags = 0; 1863cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1864cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 186532c10874SJouni Malinen } 186632c10874SJouni Malinen 1867bdcd8170SKalle Valo return 0; 1868bdcd8170SKalle Valo } 1869bdcd8170SKalle Valo 1870bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1871bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1872bdcd8170SKalle Valo { 1873bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1874334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1875334234b5SVasanthakumar Thiagarajan 1876334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1877bdcd8170SKalle Valo pmksa->pmkid, true); 1878bdcd8170SKalle Valo } 1879bdcd8170SKalle Valo 1880bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1881bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1882bdcd8170SKalle Valo { 1883bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1884334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1885334234b5SVasanthakumar Thiagarajan 1886334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1887bdcd8170SKalle Valo pmksa->pmkid, false); 1888bdcd8170SKalle Valo } 1889bdcd8170SKalle Valo 1890bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1891bdcd8170SKalle Valo { 1892bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 189359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 189459c98449SVasanthakumar Thiagarajan 189559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1896334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1897334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1898bdcd8170SKalle Valo return 0; 1899bdcd8170SKalle Valo } 1900bdcd8170SKalle Valo 1901d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1902d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 19036cb3c714SRaja Mani { 1904d91e8eeeSRaja Mani int ret, pos; 19052c07cf44SThomas Pedersen u8 mask[WOW_PATTERN_SIZE]; 19066cb3c714SRaja Mani u16 i; 19076cb3c714SRaja Mani 1908d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 19096cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 19106cb3c714SRaja Mani /* 19116cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 19126cb3c714SRaja Mani * driver specific mask value and send it to the chip along 19136cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 19146cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 19156cb3c714SRaja Mani * then equivalent driver specific mask value is 19166cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 19176cb3c714SRaja Mani */ 19186cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 19196cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 19206cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 19216cb3c714SRaja Mani mask[pos] = 0xFF; 19226cb3c714SRaja Mani } 19236cb3c714SRaja Mani /* 19246cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 19256cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 19266cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 19276cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 19286cb3c714SRaja Mani */ 19296cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 19306cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 19316cb3c714SRaja Mani wow->patterns[i].pattern_len, 19326cb3c714SRaja Mani 0 /* pattern offset */, 19336cb3c714SRaja Mani wow->patterns[i].pattern, mask); 19346cb3c714SRaja Mani if (ret) 19356cb3c714SRaja Mani return ret; 19366cb3c714SRaja Mani } 19376cb3c714SRaja Mani 1938d91e8eeeSRaja Mani if (wow->disconnect) 1939d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1940d91e8eeeSRaja Mani 1941d91e8eeeSRaja Mani if (wow->magic_pkt) 1942d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1943d91e8eeeSRaja Mani 1944d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1945d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1946d91e8eeeSRaja Mani 1947d91e8eeeSRaja Mani if (wow->eap_identity_req) 1948d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1949d91e8eeeSRaja Mani 1950d91e8eeeSRaja Mani if (wow->four_way_handshake) 1951d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1952d91e8eeeSRaja Mani 1953d91e8eeeSRaja Mani return 0; 1954d91e8eeeSRaja Mani } 1955d91e8eeeSRaja Mani 1956d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1957d91e8eeeSRaja Mani { 1958d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1959d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1960d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1961d91e8eeeSRaja Mani 0x00, 0x08 }; 1962d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1963d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1964d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1965d91e8eeeSRaja Mani 0x00, 0x7f }; 1966d91e8eeeSRaja Mani u8 unicst_offset = 0; 1967d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1968d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1969d91e8eeeSRaja Mani u8 arp_offset = 20; 1970d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1971d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1972d91e8eeeSRaja Mani u8 discvr_offset = 38; 1973d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1974d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1975d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1976d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1977d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1978d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1979d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1980d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1981d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1982d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1983d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1984d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1985d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1986d91e8eeeSRaja Mani int ret; 1987d91e8eeeSRaja Mani 1988d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1989d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1990d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1991d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1992d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1993d91e8eeeSRaja Mani if (ret) { 1994d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1995d91e8eeeSRaja Mani return ret; 1996d91e8eeeSRaja Mani } 1997d91e8eeeSRaja Mani 1998d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1999d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2000d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2001d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 2002d91e8eeeSRaja Mani arp_pattern, arp_mask); 2003d91e8eeeSRaja Mani if (ret) { 2004d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 2005d91e8eeeSRaja Mani return ret; 2006d91e8eeeSRaja Mani } 2007d91e8eeeSRaja Mani 2008d91e8eeeSRaja Mani /* 2009d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2010d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2011d91e8eeeSRaja Mani */ 2012d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2013d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2014d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2015d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2016d91e8eeeSRaja Mani if (ret) { 2017d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2018d91e8eeeSRaja Mani return ret; 2019d91e8eeeSRaja Mani } 2020d91e8eeeSRaja Mani 2021d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 2022d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2023d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2024d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 2025d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 2026d91e8eeeSRaja Mani if (ret) { 2027d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 2028d91e8eeeSRaja Mani return ret; 2029d91e8eeeSRaja Mani } 2030d91e8eeeSRaja Mani 2031d91e8eeeSRaja Mani return 0; 2032d91e8eeeSRaja Mani } 2033d91e8eeeSRaja Mani 2034d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2035d91e8eeeSRaja Mani { 2036d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2037d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2038d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2039d91e8eeeSRaja Mani u8 discvr_offset = 38; 2040d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2041d91e8eeeSRaja Mani int ret; 2042d91e8eeeSRaja Mani 2043d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 204493803b33SJoe Perches eth_broadcast_addr(mac_mask); 2045d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2046d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2047d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2048d91e8eeeSRaja Mani mac_mask); 2049d91e8eeeSRaja Mani if (ret) { 2050d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2051d91e8eeeSRaja Mani return ret; 2052d91e8eeeSRaja Mani } 2053d91e8eeeSRaja Mani 2054d91e8eeeSRaja Mani /* 2055d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2056d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2057d91e8eeeSRaja Mani */ 2058d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2059d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2060d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2061d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2062d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2063d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2064d91e8eeeSRaja Mani if (ret) { 2065cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2066d91e8eeeSRaja Mani return ret; 2067d91e8eeeSRaja Mani } 2068d91e8eeeSRaja Mani } 2069d91e8eeeSRaja Mani 2070d91e8eeeSRaja Mani return 0; 2071d91e8eeeSRaja Mani } 2072d91e8eeeSRaja Mani 2073055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2074055bde49SRaja Mani { 2075055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2076055bde49SRaja Mani } 2077055bde49SRaja Mani 2078055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2079055bde49SRaja Mani { 2080055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2081055bde49SRaja Mani } 2082055bde49SRaja Mani 2083055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2084055bde49SRaja Mani { 2085055bde49SRaja Mani int ret, left; 2086055bde49SRaja Mani 2087055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2088055bde49SRaja Mani 2089055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2090055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2091055bde49SRaja Mani if (ret) 2092055bde49SRaja Mani return ret; 2093055bde49SRaja Mani 2094055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2095055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2096055bde49SRaja Mani WMI_TIMEOUT); 2097055bde49SRaja Mani if (left == 0) { 2098055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2099055bde49SRaja Mani ret = -ETIMEDOUT; 2100055bde49SRaja Mani } else if (left < 0) { 2101055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2102055bde49SRaja Mani left); 2103055bde49SRaja Mani ret = left; 2104055bde49SRaja Mani } 2105055bde49SRaja Mani 2106055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2107055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2108055bde49SRaja Mani is_ctrl_ep_empty(ar), 2109055bde49SRaja Mani WMI_TIMEOUT); 2110055bde49SRaja Mani if (left == 0) { 2111055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2112055bde49SRaja Mani ret = -ETIMEDOUT; 2113055bde49SRaja Mani } else if (left < 0) { 2114055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2115055bde49SRaja Mani ret = left; 2116055bde49SRaja Mani } 2117055bde49SRaja Mani } 2118055bde49SRaja Mani 2119055bde49SRaja Mani return ret; 2120055bde49SRaja Mani } 2121055bde49SRaja Mani 2122fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif, 2123fd4377b6SThomas Pedersen struct cfg80211_wowlan *wow, u32 *filter) 2124d91e8eeeSRaja Mani { 2125fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 2126d91e8eeeSRaja Mani struct in_device *in_dev; 2127d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2128055bde49SRaja Mani int ret; 2129ce0dc0cfSRaja Mani u16 i, bmiss_time; 2130d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2131fd4377b6SThomas Pedersen u8 index = 0; 2132d91e8eeeSRaja Mani 21336821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 21346821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21356821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21366251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21376251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21386251d801SNaveen Gangadharan if (ret) 21396251d801SNaveen Gangadharan return ret; 21406251d801SNaveen Gangadharan } 21416251d801SNaveen Gangadharan 2142d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2143d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2144d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2145d91e8eeeSRaja Mani WOW_LIST_ID, i); 2146d91e8eeeSRaja Mani 2147d91e8eeeSRaja Mani /* 2148d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2149d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2150d91e8eeeSRaja Mani * the user. 2151d91e8eeeSRaja Mani */ 2152d91e8eeeSRaja Mani if (wow) 2153fd4377b6SThomas Pedersen ret = ath6kl_wow_usr(ar, vif, wow, filter); 2154d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2155d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2156d91e8eeeSRaja Mani else 2157d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2158d91e8eeeSRaja Mani 2159d91e8eeeSRaja Mani if (ret) 2160d91e8eeeSRaja Mani return ret; 2161d91e8eeeSRaja Mani 2162390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2163390a8c8fSRaja Mani 2164ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2165ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2166ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2167ce0dc0cfSRaja Mani 0); 2168ce0dc0cfSRaja Mani if (ret) 2169ce0dc0cfSRaja Mani return ret; 2170ce0dc0cfSRaja Mani 2171ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2172ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2173ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2174ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2175ce0dc0cfSRaja Mani 2176ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2177ce0dc0cfSRaja Mani bmiss_time, 0); 2178ce0dc0cfSRaja Mani if (ret) 2179ce0dc0cfSRaja Mani return ret; 2180ce0dc0cfSRaja Mani 2181ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2182ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2183ce0dc0cfSRaja Mani 0, 0, 0, 0); 2184ce0dc0cfSRaja Mani if (ret) 2185ce0dc0cfSRaja Mani return ret; 2186ce0dc0cfSRaja Mani } 2187ce0dc0cfSRaja Mani 2188c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2189c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2190c08631c6SRaja Mani if (!in_dev) 2191fd4377b6SThomas Pedersen return 0; 2192c08631c6SRaja Mani 2193c08631c6SRaja Mani ifa = in_dev->ifa_list; 2194c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2195c08631c6SRaja Mani 2196c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2197c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2198c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2199c08631c6SRaja Mani ifa = ifa->ifa_next; 2200c08631c6SRaja Mani index++; 2201c08631c6SRaja Mani } 2202c08631c6SRaja Mani 2203c08631c6SRaja Mani if (ifa) { 2204c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2205c08631c6SRaja Mani return -EINVAL; 2206c08631c6SRaja Mani } 2207c08631c6SRaja Mani 2208c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2209c08631c6SRaja Mani if (ret) { 2210c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2211c08631c6SRaja Mani return ret; 2212c08631c6SRaja Mani } 2213c08631c6SRaja Mani 2214fd4377b6SThomas Pedersen return ret; 2215fd4377b6SThomas Pedersen } 2216fd4377b6SThomas Pedersen 2217fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2218fd4377b6SThomas Pedersen { 2219fd4377b6SThomas Pedersen struct ath6kl_vif *first_vif, *vif; 2220fd4377b6SThomas Pedersen int ret = 0; 2221fd4377b6SThomas Pedersen u32 filter = 0; 2222fd4377b6SThomas Pedersen bool connected = false; 2223fd4377b6SThomas Pedersen 2224fd4377b6SThomas Pedersen /* enter / leave wow suspend on first vif always */ 2225fd4377b6SThomas Pedersen first_vif = ath6kl_vif_first(ar); 2226bffb7db2SGeliang Tang if (WARN_ON(!first_vif) || 2227fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(first_vif)) 2228fd4377b6SThomas Pedersen return -EIO; 2229fd4377b6SThomas Pedersen 2230fd4377b6SThomas Pedersen if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2231fd4377b6SThomas Pedersen return -EINVAL; 2232fd4377b6SThomas Pedersen 2233fd4377b6SThomas Pedersen /* install filters for each connected vif */ 2234fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2235fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2236fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2237fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2238fd4377b6SThomas Pedersen continue; 2239fd4377b6SThomas Pedersen connected = true; 2240fd4377b6SThomas Pedersen 2241fd4377b6SThomas Pedersen ret = ath6kl_wow_suspend_vif(vif, wow, &filter); 2242fd4377b6SThomas Pedersen if (ret) 2243fd4377b6SThomas Pedersen break; 2244fd4377b6SThomas Pedersen } 2245fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2246fd4377b6SThomas Pedersen 2247fd4377b6SThomas Pedersen if (!connected) 2248fd4377b6SThomas Pedersen return -ENOTCONN; 2249fd4377b6SThomas Pedersen else if (ret) 2250fd4377b6SThomas Pedersen return ret; 2251fd4377b6SThomas Pedersen 2252fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_SUSPENDING; 2253fd4377b6SThomas Pedersen 2254fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx, 22556cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22566cb3c714SRaja Mani filter, 22576cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22586cb3c714SRaja Mani if (ret) 22596cb3c714SRaja Mani return ret; 22606cb3c714SRaja Mani 2261fd4377b6SThomas Pedersen return ath6kl_cfg80211_host_sleep(ar, first_vif); 22626cb3c714SRaja Mani } 22636cb3c714SRaja Mani 2264fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif) 22656cb3c714SRaja Mani { 2266fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 22676cb3c714SRaja Mani int ret; 22686cb3c714SRaja Mani 2269ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2270ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2271ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2272ce0dc0cfSRaja Mani if (ret) 2273ce0dc0cfSRaja Mani return ret; 2274ce0dc0cfSRaja Mani 2275ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2276ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2277ce0dc0cfSRaja Mani if (ret) 2278ce0dc0cfSRaja Mani return ret; 2279ce0dc0cfSRaja Mani 2280ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2281ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2282ce0dc0cfSRaja Mani if (ret) 2283ce0dc0cfSRaja Mani return ret; 2284ce0dc0cfSRaja Mani } 2285ce0dc0cfSRaja Mani 22866821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22876821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22886821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22896251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22906251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22916251d801SNaveen Gangadharan if (ret) 22926251d801SNaveen Gangadharan return ret; 22936251d801SNaveen Gangadharan } 22946251d801SNaveen Gangadharan 2295390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2296390a8c8fSRaja Mani 2297390a8c8fSRaja Mani return 0; 2298390a8c8fSRaja Mani } 2299390a8c8fSRaja Mani 2300fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar) 2301fd4377b6SThomas Pedersen { 2302fd4377b6SThomas Pedersen struct ath6kl_vif *vif; 2303fd4377b6SThomas Pedersen int ret; 2304fd4377b6SThomas Pedersen 2305fd4377b6SThomas Pedersen vif = ath6kl_vif_first(ar); 2306bffb7db2SGeliang Tang if (WARN_ON(!vif) || 2307fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2308fd4377b6SThomas Pedersen return -EIO; 2309fd4377b6SThomas Pedersen 2310fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_RESUMING; 2311fd4377b6SThomas Pedersen 2312fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2313fd4377b6SThomas Pedersen ATH6KL_HOST_MODE_AWAKE); 2314fd4377b6SThomas Pedersen if (ret) { 2315fd4377b6SThomas Pedersen ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2316fd4377b6SThomas Pedersen ret); 2317fd4377b6SThomas Pedersen goto cleanup; 2318fd4377b6SThomas Pedersen } 2319fd4377b6SThomas Pedersen 2320fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2321fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2322fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2323fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2324fd4377b6SThomas Pedersen continue; 2325fd4377b6SThomas Pedersen ret = ath6kl_wow_resume_vif(vif); 2326fd4377b6SThomas Pedersen if (ret) 2327fd4377b6SThomas Pedersen break; 2328fd4377b6SThomas Pedersen } 2329fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2330fd4377b6SThomas Pedersen 2331fd4377b6SThomas Pedersen if (ret) 2332fd4377b6SThomas Pedersen goto cleanup; 2333fd4377b6SThomas Pedersen 2334fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_ON; 2335fd4377b6SThomas Pedersen return 0; 2336fd4377b6SThomas Pedersen 2337fd4377b6SThomas Pedersen cleanup: 2338fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_WOW; 2339fd4377b6SThomas Pedersen return ret; 2340fd4377b6SThomas Pedersen } 2341fd4377b6SThomas Pedersen 234240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 234340abc2deSRaja Mani { 234440abc2deSRaja Mani struct ath6kl_vif *vif; 234540abc2deSRaja Mani int ret; 234640abc2deSRaja Mani 234740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 234840abc2deSRaja Mani if (!vif) 234940abc2deSRaja Mani return -EIO; 235040abc2deSRaja Mani 235148f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 235248f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 235340abc2deSRaja Mani return -EIO; 235448f27587SMing Jiang } 235540abc2deSRaja Mani 235640abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 235740abc2deSRaja Mani 235840abc2deSRaja Mani /* Save the current power mode before enabling power save */ 235940abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 236040abc2deSRaja Mani 236140abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 236240abc2deSRaja Mani if (ret) 236340abc2deSRaja Mani return ret; 236440abc2deSRaja Mani 236540abc2deSRaja Mani /* Disable WOW mode */ 236640abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 236740abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 236840abc2deSRaja Mani 0, 0); 236940abc2deSRaja Mani if (ret) 237040abc2deSRaja Mani return ret; 237140abc2deSRaja Mani 237240abc2deSRaja Mani /* Flush all non control pkts in TX path */ 237340abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 237440abc2deSRaja Mani 237540abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 237640abc2deSRaja Mani if (ret) 237740abc2deSRaja Mani return ret; 237840abc2deSRaja Mani 237940abc2deSRaja Mani return 0; 238040abc2deSRaja Mani } 238140abc2deSRaja Mani 238240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 238340abc2deSRaja Mani { 238440abc2deSRaja Mani struct ath6kl_vif *vif; 238540abc2deSRaja Mani int ret; 238640abc2deSRaja Mani 238740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 238840abc2deSRaja Mani 238940abc2deSRaja Mani if (!vif) 239040abc2deSRaja Mani return -EIO; 239140abc2deSRaja Mani 239240abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 239340abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 239440abc2deSRaja Mani ar->wmi->saved_pwr_mode); 239540abc2deSRaja Mani if (ret) 239640abc2deSRaja Mani return ret; 239740abc2deSRaja Mani } 239840abc2deSRaja Mani 239940abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 240040abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 240140abc2deSRaja Mani if (ret) 240240abc2deSRaja Mani return ret; 240340abc2deSRaja Mani 240440abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 240540abc2deSRaja Mani 240640abc2deSRaja Mani /* Reset scan parameter to default values */ 240740abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 240840abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 240940abc2deSRaja Mani if (ret) 241040abc2deSRaja Mani return ret; 241140abc2deSRaja Mani 241240abc2deSRaja Mani return 0; 241340abc2deSRaja Mani } 241440abc2deSRaja Mani 241552d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 24160f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 24170f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 241852d81a68SKalle Valo { 24193d79499cSVivek Natarajan struct ath6kl_vif *vif; 2420390a8c8fSRaja Mani enum ath6kl_state prev_state; 242152d81a68SKalle Valo int ret; 242252d81a68SKalle Valo 242352d81a68SKalle Valo switch (mode) { 2424d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2425d7c44e0bSRaja Mani 2426d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2427d7c44e0bSRaja Mani 2428d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2429d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2430d7c44e0bSRaja Mani 2431390a8c8fSRaja Mani prev_state = ar->state; 2432390a8c8fSRaja Mani 2433d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2434390a8c8fSRaja Mani if (ret) { 2435390a8c8fSRaja Mani ar->state = prev_state; 2436d7c44e0bSRaja Mani return ret; 2437390a8c8fSRaja Mani } 24381e9a905dSRaja Mani 2439d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2440d7c44e0bSRaja Mani break; 2441d7c44e0bSRaja Mani 244252d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2443524441e3SRaja Mani 244440abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2445524441e3SRaja Mani 244640abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 244752d81a68SKalle Valo if (ret) { 244840abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 244940abc2deSRaja Mani return ret; 245052d81a68SKalle Valo } 245152d81a68SKalle Valo 245276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 245376a9fbe2SKalle Valo 245452d81a68SKalle Valo break; 2455b4b2a0b1SKalle Valo 2456b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2457524441e3SRaja Mani 24587125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2459524441e3SRaja Mani 2460b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2461b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2462b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2463b4b2a0b1SKalle Valo break; 2464b4b2a0b1SKalle Valo } 2465b4b2a0b1SKalle Valo 2466b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2467b4b2a0b1SKalle Valo 2468b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2469b4b2a0b1SKalle Valo if (ret) { 2470b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2471b4b2a0b1SKalle Valo ret); 2472b4b2a0b1SKalle Valo } 2473b4b2a0b1SKalle Valo 2474b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2475b4b2a0b1SKalle Valo 2476b4b2a0b1SKalle Valo break; 2477b4b2a0b1SKalle Valo 2478b4b2a0b1SKalle Valo default: 2479b4b2a0b1SKalle Valo break; 248052d81a68SKalle Valo } 248152d81a68SKalle Valo 24823d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24833d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24843d79499cSVivek Natarajan 248552d81a68SKalle Valo return 0; 248652d81a68SKalle Valo } 2487d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 248852d81a68SKalle Valo 248952d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 249052d81a68SKalle Valo { 249176a9fbe2SKalle Valo int ret; 249276a9fbe2SKalle Valo 249376a9fbe2SKalle Valo switch (ar->state) { 2494d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2495d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2496d7c44e0bSRaja Mani 2497d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2498d7c44e0bSRaja Mani if (ret) { 2499d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2500d7c44e0bSRaja Mani return ret; 2501d7c44e0bSRaja Mani } 2502d7c44e0bSRaja Mani 2503d7c44e0bSRaja Mani break; 2504d7c44e0bSRaja Mani 250576a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 250640abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 250740abc2deSRaja Mani 250840abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 250976a9fbe2SKalle Valo if (ret) { 251040abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 251140abc2deSRaja Mani return ret; 251276a9fbe2SKalle Valo } 251376a9fbe2SKalle Valo break; 251476a9fbe2SKalle Valo 2515b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2516b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2517b4b2a0b1SKalle Valo 2518b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2519b4b2a0b1SKalle Valo if (ret) { 2520b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2521b4b2a0b1SKalle Valo return ret; 2522b4b2a0b1SKalle Valo } 2523d7c44e0bSRaja Mani break; 2524b4b2a0b1SKalle Valo 252576a9fbe2SKalle Valo default: 252676a9fbe2SKalle Valo break; 252752d81a68SKalle Valo } 252852d81a68SKalle Valo 252952d81a68SKalle Valo return 0; 253052d81a68SKalle Valo } 2531d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 253252d81a68SKalle Valo 2533abcb344bSKalle Valo #ifdef CONFIG_PM 253452d81a68SKalle Valo 253552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 253652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2537abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2538abcb344bSKalle Valo { 2539abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2540abcb344bSKalle Valo 254184caf800SVasanthakumar Thiagarajan ath6kl_recovery_suspend(ar); 254284caf800SVasanthakumar Thiagarajan 25430f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2544abcb344bSKalle Valo } 2545aa6cffc1SChilam Ng 254652d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2547aa6cffc1SChilam Ng { 2548aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 254984caf800SVasanthakumar Thiagarajan int err; 2550aa6cffc1SChilam Ng 255184caf800SVasanthakumar Thiagarajan err = ath6kl_hif_resume(ar); 255284caf800SVasanthakumar Thiagarajan if (err) 255384caf800SVasanthakumar Thiagarajan return err; 255484caf800SVasanthakumar Thiagarajan 255592332993SVasanthakumar Thiagarajan ath6kl_recovery_resume(ar); 255684caf800SVasanthakumar Thiagarajan 255784caf800SVasanthakumar Thiagarajan return 0; 2558aa6cffc1SChilam Ng } 2559a918fb3cSRaja Mani 2560a918fb3cSRaja Mani /* 2561a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2562a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2563a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2564a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2565a918fb3cSRaja Mani * 2566a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2567a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2568a918fb3cSRaja Mani * 2569a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2570a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2571a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2572a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2573a918fb3cSRaja Mani * 2574a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2575a918fb3cSRaja Mani */ 2576a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2577a918fb3cSRaja Mani { 2578390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2579390a8c8fSRaja Mani return; 2580390a8c8fSRaja Mani 2581a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2582a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2583a918fb3cSRaja Mani } 2584a918fb3cSRaja Mani 2585a918fb3cSRaja Mani #else 2586a918fb3cSRaja Mani 2587a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2588a918fb3cSRaja Mani { 2589a918fb3cSRaja Mani } 2590abcb344bSKalle Valo #endif 2591abcb344bSKalle Valo 259257fbcce3SJohannes Berg static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum nl80211_band band, 2593df90b369SVasanthakumar Thiagarajan bool ht_enable) 25946a7c9badSJouni Malinen { 259567b3f129SKiran Reddy struct ath6kl_htcap *htcap = &vif->htcap[band]; 2596e68f6750SSujith Manoharan 2597df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 25986a7c9badSJouni Malinen return 0; 2599df90b369SVasanthakumar Thiagarajan 2600df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2601df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2602df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 260357fbcce3SJohannes Berg htcap->cap_info = (band == NL80211_BAND_2GHZ) ? 2604df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2605df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2606df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2607df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2608df90b369SVasanthakumar Thiagarajan 2609df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2610df90b369SVasanthakumar Thiagarajan band, htcap); 26116a7c9badSJouni Malinen } 26126a7c9badSJouni Malinen 261337a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 261437a2f950SThomas Pedersen { 261537a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 261637a2f950SThomas Pedersen int band, ret = 0; 261737a2f950SThomas Pedersen 261857fbcce3SJohannes Berg for (band = 0; band < NUM_NL80211_BANDS; band++) { 261937a2f950SThomas Pedersen if (!wiphy->bands[band]) 262037a2f950SThomas Pedersen continue; 262137a2f950SThomas Pedersen 262237a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 262337a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 262437a2f950SThomas Pedersen if (ret) 262537a2f950SThomas Pedersen return ret; 262637a2f950SThomas Pedersen } 262737a2f950SThomas Pedersen 262837a2f950SThomas Pedersen return ret; 262937a2f950SThomas Pedersen } 263037a2f950SThomas Pedersen 26318bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 26328bdfbf40SJouni Malinen { 26338bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 26348bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 26358bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 26368bdfbf40SJouni Malinen } 26378bdfbf40SJouni Malinen 2638334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2639334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 26408bdfbf40SJouni Malinen { 2641334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26428bdfbf40SJouni Malinen const u8 *pos; 26438bdfbf40SJouni Malinen u8 *buf = NULL; 26448bdfbf40SJouni Malinen size_t len = 0; 26458bdfbf40SJouni Malinen int ret; 26468bdfbf40SJouni Malinen 26478bdfbf40SJouni Malinen /* 26488bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26498bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26508bdfbf40SJouni Malinen */ 26518bdfbf40SJouni Malinen 26528bdfbf40SJouni Malinen if (ies && ies_len) { 26538bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26548bdfbf40SJouni Malinen if (buf == NULL) 26558bdfbf40SJouni Malinen return -ENOMEM; 26568bdfbf40SJouni Malinen pos = ies; 26578bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26588bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26598bdfbf40SJouni Malinen break; 26608bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26618bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26628bdfbf40SJouni Malinen len += 2 + pos[1]; 26638bdfbf40SJouni Malinen } 26648bdfbf40SJouni Malinen pos += 2 + pos[1]; 26658bdfbf40SJouni Malinen } 26668bdfbf40SJouni Malinen } 26678bdfbf40SJouni Malinen 2668334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2669334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26708bdfbf40SJouni Malinen kfree(buf); 26718bdfbf40SJouni Malinen return ret; 26728bdfbf40SJouni Malinen } 26738bdfbf40SJouni Malinen 26748860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26758860020eSJohannes Berg struct cfg80211_beacon_data *info) 26768860020eSJohannes Berg { 26778860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26788860020eSJohannes Berg int res; 26798860020eSJohannes Berg 268017a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26818860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26828860020eSJohannes Berg WMI_FRAME_BEACON, 26838860020eSJohannes Berg info->beacon_ies, 26848860020eSJohannes Berg info->beacon_ies_len); 26858860020eSJohannes Berg if (res) 26868860020eSJohannes Berg return res; 26878860020eSJohannes Berg 268817a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26898860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26908860020eSJohannes Berg info->proberesp_ies_len); 26918860020eSJohannes Berg if (res) 26928860020eSJohannes Berg return res; 26938860020eSJohannes Berg 269417a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26958860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26968860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 26978860020eSJohannes Berg info->assocresp_ies, 26988860020eSJohannes Berg info->assocresp_ies_len); 26998860020eSJohannes Berg if (res) 27008860020eSJohannes Berg return res; 27018860020eSJohannes Berg 27028860020eSJohannes Berg return 0; 27038860020eSJohannes Berg } 27048860020eSJohannes Berg 2705d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2706d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2707d97c121bSVasanthakumar Thiagarajan { 2708d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2709d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2710d97c121bSVasanthakumar Thiagarajan u16 cnt; 2711d97c121bSVasanthakumar Thiagarajan 2712d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2713d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2714d97c121bSVasanthakumar Thiagarajan 2715d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2716d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2717d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2718d97c121bSVasanthakumar Thiagarajan 2719d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2720d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2721d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2722d97c121bSVasanthakumar Thiagarajan 27239e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27249e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2725d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27269e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27279e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27289e8b16dbSVasanthakumar Thiagarajan 27299e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27309e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27319e8b16dbSVasanthakumar Thiagarajan return 0; 27329e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27339e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2734d97c121bSVasanthakumar Thiagarajan 2735d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2736d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27379e8b16dbSVasanthakumar Thiagarajan return 0; 2738798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2739d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2740d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2741d97c121bSVasanthakumar Thiagarajan 2742d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2743d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27449e8b16dbSVasanthakumar Thiagarajan return 0; 2745798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2746d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2747d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2748d97c121bSVasanthakumar Thiagarajan 2749d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27509e8b16dbSVasanthakumar Thiagarajan return 0; 2751d97c121bSVasanthakumar Thiagarajan 2752d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2753d97c121bSVasanthakumar Thiagarajan 2754d97c121bSVasanthakumar Thiagarajan return 0; 2755d97c121bSVasanthakumar Thiagarajan } 2756d97c121bSVasanthakumar Thiagarajan 27578860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27588860020eSJohannes Berg struct cfg80211_ap_settings *info) 27596a7c9badSJouni Malinen { 27606a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27613450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27626a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 276367cd22e4SThomas Pedersen bool hidden = false; 27646a7c9badSJouni Malinen u8 *ies; 27656a7c9badSJouni Malinen int ies_len; 27666a7c9badSJouni Malinen struct wmi_connect_cmd p; 27676a7c9badSJouni Malinen int res; 2768be5abaafSVasanthakumar Thiagarajan int i, ret; 2769d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27707ac25eacSMohammed Shafi Shajakhan int inactivity_timeout = 0; 27716a7c9badSJouni Malinen 27728860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27736a7c9badSJouni Malinen 2774990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27756a7c9badSJouni Malinen return -EIO; 27766a7c9badSJouni Malinen 2777f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27786a7c9badSJouni Malinen return -EOPNOTSUPP; 27796a7c9badSJouni Malinen 27808860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27816a7c9badSJouni Malinen 27829a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27839a5b1318SJouni Malinen 2784eb922e4bSMohammed Shafi Shajakhan ret = ath6kl_wmi_ap_set_beacon_intvl_cmd(ar->wmi, vif->fw_vif_idx, 2785eb922e4bSMohammed Shafi Shajakhan info->beacon_interval); 2786eb922e4bSMohammed Shafi Shajakhan 2787eb922e4bSMohammed Shafi Shajakhan if (ret) 2788eb922e4bSMohammed Shafi Shajakhan ath6kl_warn("Failed to set beacon interval: %d\n", ret); 27896a7c9badSJouni Malinen 2790d154f32eSEtay Luz ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx, 2791d154f32eSEtay Luz info->dtim_period); 2792d154f32eSEtay Luz 2793d154f32eSEtay Luz /* ignore error, just print a warning and continue normally */ 2794d154f32eSEtay Luz if (ret) 2795d154f32eSEtay Luz ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret); 2796d154f32eSEtay Luz 27978860020eSJohannes Berg if (info->beacon.head == NULL) 27986a7c9badSJouni Malinen return -EINVAL; 27998860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 28006a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 28018860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 28026a7c9badSJouni Malinen return -EINVAL; 28038860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 28046a7c9badSJouni Malinen 28056a7c9badSJouni Malinen if (info->ssid == NULL) 28066a7c9badSJouni Malinen return -EINVAL; 28073450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 28083450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 28096a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 281067cd22e4SThomas Pedersen hidden = true; 281167cd22e4SThomas Pedersen 281267cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 281367cd22e4SThomas Pedersen if (res) 281467cd22e4SThomas Pedersen return res; 28156a7c9badSJouni Malinen 2816be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2817be5abaafSVasanthakumar Thiagarajan if (ret) 2818be5abaafSVasanthakumar Thiagarajan return ret; 28196a7c9badSJouni Malinen 28206a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28216a7c9badSJouni Malinen 28226a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28236a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28246a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28256a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28266a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28276a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28286a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28296a7c9badSJouni Malinen break; 28306a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28316a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28326a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28336a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28346a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28356a7c9badSJouni Malinen break; 28366a7c9badSJouni Malinen } 28376a7c9badSJouni Malinen } 28386a7c9badSJouni Malinen if (p.auth_mode == 0) 28396a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28403450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28416a7c9badSJouni Malinen 28426a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28436a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28446a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28456a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28466a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28476a7c9badSJouni Malinen break; 28486a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28496a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28506a7c9badSJouni Malinen break; 28516a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28526a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28536a7c9badSJouni Malinen break; 2854b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2855b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2856b8214df1SDai Shuibing break; 28576a7c9badSJouni Malinen } 28586a7c9badSJouni Malinen } 2859229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28606a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2861240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2862a5d8f9dfSKalle Valo } else if (info->crypto.n_ciphers_pairwise == 1) { 2863240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 2864a5d8f9dfSKalle Valo } 28656a7c9badSJouni Malinen 28666a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28676a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28686a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28696a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28706a7c9badSJouni Malinen break; 28716a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28726a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28736a7c9badSJouni Malinen break; 28746a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28756a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28766a7c9badSJouni Malinen break; 2877b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2878b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2879b8214df1SDai Shuibing break; 28806a7c9badSJouni Malinen default: 28816a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28826a7c9badSJouni Malinen break; 28836a7c9badSJouni Malinen } 2884240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28856a7c9badSJouni Malinen 28866a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2887f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28886a7c9badSJouni Malinen 28893450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28903450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28913450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2892683b6d3bSJohannes Berg p.ch = cpu_to_le16(info->chandef.chan->center_freq); 28936a7c9badSJouni Malinen 2894c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2895c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2896c1762a3fSThirumalai Pachamuthu if (res < 0) 2897c1762a3fSThirumalai Pachamuthu return res; 2898c1762a3fSThirumalai Pachamuthu 28993ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 29003ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 29013ca9d1fcSAarthi Thiruvengadam } else { 29023ca9d1fcSAarthi Thiruvengadam /* 29033ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 29043ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 29053ca9d1fcSAarthi Thiruvengadam */ 29063ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 29073ca9d1fcSAarthi Thiruvengadam } 29083ca9d1fcSAarthi Thiruvengadam 290903bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 29107ac25eacSMohammed Shafi Shajakhan inactivity_timeout = info->inactivity_timeout; 29117ac25eacSMohammed Shafi Shajakhan 2912eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_AP_INACTIVITY_MINS, 2913eba95bceSKalle Valo ar->fw_capabilities)) 29147ac25eacSMohammed Shafi Shajakhan inactivity_timeout = DIV_ROUND_UP(inactivity_timeout, 29157ac25eacSMohammed Shafi Shajakhan 60); 29167ac25eacSMohammed Shafi Shajakhan 291703bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 29187ac25eacSMohammed Shafi Shajakhan inactivity_timeout); 291903bdeb0dSVasanthakumar Thiagarajan if (res < 0) 292003bdeb0dSVasanthakumar Thiagarajan return res; 292103bdeb0dSVasanthakumar Thiagarajan } 292203bdeb0dSVasanthakumar Thiagarajan 2923683b6d3bSJohannes Berg if (ath6kl_set_htcap(vif, info->chandef.chan->band, 2924683b6d3bSJohannes Berg cfg80211_get_chandef_type(&info->chandef) 2925683b6d3bSJohannes Berg != NL80211_CHAN_NO_HT)) 2926df90b369SVasanthakumar Thiagarajan return -EIO; 2927df90b369SVasanthakumar Thiagarajan 2928d97c121bSVasanthakumar Thiagarajan /* 2929d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2930d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2931d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2932d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2933d97c121bSVasanthakumar Thiagarajan */ 2934d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2935d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2936d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2937d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2938d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2939d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2940d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2941f21243a8SThomas Pedersen vif->rsn_capab = rsn_capab; 2942d97c121bSVasanthakumar Thiagarajan if (res < 0) 2943d97c121bSVasanthakumar Thiagarajan return res; 2944d97c121bSVasanthakumar Thiagarajan } 2945d97c121bSVasanthakumar Thiagarajan 2946c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2947334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29489a5b1318SJouni Malinen if (res < 0) 29499a5b1318SJouni Malinen return res; 29509a5b1318SJouni Malinen 29519a5b1318SJouni Malinen return 0; 29526a7c9badSJouni Malinen } 29536a7c9badSJouni Malinen 29548860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29558860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29566a7c9badSJouni Malinen { 29578860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29588860020eSJohannes Berg 29598860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29608860020eSJohannes Berg return -EIO; 29618860020eSJohannes Berg 29628860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29638860020eSJohannes Berg return -EOPNOTSUPP; 29648860020eSJohannes Berg 29658860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29666a7c9badSJouni Malinen } 29676a7c9badSJouni Malinen 29688860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29696a7c9badSJouni Malinen { 29706a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 297159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29726a7c9badSJouni Malinen 2973f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29746a7c9badSJouni Malinen return -EOPNOTSUPP; 297559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29766a7c9badSJouni Malinen return -ENOTCONN; 29776a7c9badSJouni Malinen 2978334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 297959c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 298076b817f6SPierre Le Magourou netif_carrier_off(vif->ndev); 29816a7c9badSJouni Malinen 2982df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 298337a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29846a7c9badSJouni Malinen } 29856a7c9badSJouni Malinen 298633e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 298733e5308dSJouni Malinen 298833e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 298989c771e5SJouni Malinen struct station_del_parameters *params) 299033e5308dSJouni Malinen { 299133e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 299233e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 299389c771e5SJouni Malinen const u8 *addr = params->mac ? params->mac : bcast_addr; 299433e5308dSJouni Malinen 299533e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 299633e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 299733e5308dSJouni Malinen } 299833e5308dSJouni Malinen 299923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 30003b3a0162SJohannes Berg const u8 *mac, 30013b3a0162SJohannes Berg struct station_parameters *params) 300223875136SJouni Malinen { 300323875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 3004f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 300577ee7c89SJohannes Berg int err; 300623875136SJouni Malinen 3007f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 300823875136SJouni Malinen return -EOPNOTSUPP; 300923875136SJouni Malinen 301077ee7c89SJohannes Berg err = cfg80211_check_station_change(wiphy, params, 301177ee7c89SJohannes Berg CFG80211_STA_AP_MLME_CLIENT); 301277ee7c89SJohannes Berg if (err) 301377ee7c89SJohannes Berg return err; 301423875136SJouni Malinen 301523875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 3016334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3017334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 3018334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3019334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 302023875136SJouni Malinen } 302123875136SJouni Malinen 302263fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 302371bbc994SJohannes Berg struct wireless_dev *wdev, 302463fa1e0cSJouni Malinen struct ieee80211_channel *chan, 302563fa1e0cSJouni Malinen unsigned int duration, 302663fa1e0cSJouni Malinen u64 *cookie) 302763fa1e0cSJouni Malinen { 302871bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 302971bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 30301052261eSJouni Malinen u32 id; 303163fa1e0cSJouni Malinen 303263fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 303363fa1e0cSJouni Malinen * return -EBUSY */ 30341052261eSJouni Malinen id = ++vif->last_roc_id; 30351052261eSJouni Malinen if (id == 0) { 30361052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30371052261eSJouni Malinen id = ++vif->last_roc_id; 30381052261eSJouni Malinen } 30391052261eSJouni Malinen *cookie = id; 304063fa1e0cSJouni Malinen 3041334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3042334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 304363fa1e0cSJouni Malinen } 304463fa1e0cSJouni Malinen 304563fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 304671bbc994SJohannes Berg struct wireless_dev *wdev, 304763fa1e0cSJouni Malinen u64 cookie) 304863fa1e0cSJouni Malinen { 304971bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 305071bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 305163fa1e0cSJouni Malinen 30521052261eSJouni Malinen if (cookie != vif->last_roc_id) 305363fa1e0cSJouni Malinen return -ENOENT; 30541052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 305563fa1e0cSJouni Malinen 3056334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 305763fa1e0cSJouni Malinen } 305863fa1e0cSJouni Malinen 3059334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3060334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3061334234b5SVasanthakumar Thiagarajan unsigned int freq) 30628bdfbf40SJouni Malinen { 3063334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30648bdfbf40SJouni Malinen const u8 *pos; 30658bdfbf40SJouni Malinen u8 *p2p; 30668bdfbf40SJouni Malinen int p2p_len; 30678bdfbf40SJouni Malinen int ret; 30688bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30698bdfbf40SJouni Malinen 30708bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30718bdfbf40SJouni Malinen 30728bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30738bdfbf40SJouni Malinen 30748bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30758bdfbf40SJouni Malinen if (p2p == NULL) 30768bdfbf40SJouni Malinen return -ENOMEM; 30778bdfbf40SJouni Malinen p2p_len = 0; 30788bdfbf40SJouni Malinen 30798bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30808bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30818bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30828bdfbf40SJouni Malinen break; 30838bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30848bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30858bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30868bdfbf40SJouni Malinen } 30878bdfbf40SJouni Malinen pos += 2 + pos[1]; 30888bdfbf40SJouni Malinen } 30898bdfbf40SJouni Malinen 3090334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3091334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30928bdfbf40SJouni Malinen kfree(p2p); 30938bdfbf40SJouni Malinen return ret; 30948bdfbf40SJouni Malinen } 30958bdfbf40SJouni Malinen 3096d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3097d0ff7383SNaveen Gangadharan u32 id, 3098d0ff7383SNaveen Gangadharan u32 freq, 3099d0ff7383SNaveen Gangadharan u32 wait, 3100d0ff7383SNaveen Gangadharan const u8 *buf, 3101d0ff7383SNaveen Gangadharan size_t len, 3102d0ff7383SNaveen Gangadharan bool *more_data, 3103d0ff7383SNaveen Gangadharan bool no_cck) 3104d0ff7383SNaveen Gangadharan { 3105d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3106d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3107d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3108d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3109d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3110d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3111d0ff7383SNaveen Gangadharan 3112d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3113d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3114d0ff7383SNaveen Gangadharan return false; 3115d0ff7383SNaveen Gangadharan 3116d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3117d0ff7383SNaveen Gangadharan if (!conn) 3118d0ff7383SNaveen Gangadharan return false; 3119d0ff7383SNaveen Gangadharan 3120d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3121d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3122d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3123d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3124d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3125d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3126d0ff7383SNaveen Gangadharan return false; 3127d0ff7383SNaveen Gangadharan 3128d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3129d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3130d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3131d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3132d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3133d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3134d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3135d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3136d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3137d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3138d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3139d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3140d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3141d0ff7383SNaveen Gangadharan 3142d0ff7383SNaveen Gangadharan /* 3143d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3144d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3145d0ff7383SNaveen Gangadharan * STA. 3146d0ff7383SNaveen Gangadharan */ 3147d0ff7383SNaveen Gangadharan if (is_psq_empty) 3148d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3149d0ff7383SNaveen Gangadharan conn->aid, 1); 3150d0ff7383SNaveen Gangadharan return true; 3151d0ff7383SNaveen Gangadharan } 3152d0ff7383SNaveen Gangadharan 3153d0ff7383SNaveen Gangadharan /* 3154d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3155d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3156d0ff7383SNaveen Gangadharan */ 3157d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3158d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3159d0ff7383SNaveen Gangadharan *more_data = true; 3160d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3161d0ff7383SNaveen Gangadharan } 3162d0ff7383SNaveen Gangadharan 3163d0ff7383SNaveen Gangadharan return false; 3164d0ff7383SNaveen Gangadharan } 3165d0ff7383SNaveen Gangadharan 3166c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3167c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3168c86e4f44SAarthi Thiruvengadam { 3169c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3170c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3171c86e4f44SAarthi Thiruvengadam 3172c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3173c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3174c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3175c86e4f44SAarthi Thiruvengadam return true; 3176c86e4f44SAarthi Thiruvengadam } 3177c86e4f44SAarthi Thiruvengadam 3178c86e4f44SAarthi Thiruvengadam return false; 3179c86e4f44SAarthi Thiruvengadam } 3180c86e4f44SAarthi Thiruvengadam 318171bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 3182b176e629SAndrei Otcheretianski struct cfg80211_mgmt_tx_params *params, u64 *cookie) 31838a6c8060SJouni Malinen { 318471bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 318571bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 3186b176e629SAndrei Otcheretianski struct ieee80211_channel *chan = params->chan; 3187b176e629SAndrei Otcheretianski const u8 *buf = params->buf; 3188b176e629SAndrei Otcheretianski size_t len = params->len; 3189b176e629SAndrei Otcheretianski unsigned int wait = params->wait; 3190b176e629SAndrei Otcheretianski bool no_cck = params->no_cck; 3191bfd634d0SAntonio Quartulli u32 id, freq; 31928bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3193d0ff7383SNaveen Gangadharan bool more_data, queued; 31948bdfbf40SJouni Malinen 3195bfd634d0SAntonio Quartulli /* default to the current channel, but use the one specified as argument 3196bfd634d0SAntonio Quartulli * if any 3197bfd634d0SAntonio Quartulli */ 3198bfd634d0SAntonio Quartulli freq = vif->ch_hint; 3199bfd634d0SAntonio Quartulli if (chan) 3200bfd634d0SAntonio Quartulli freq = chan->center_freq; 3201bfd634d0SAntonio Quartulli 3202bfd634d0SAntonio Quartulli /* never send freq zero to the firmware */ 3203bfd634d0SAntonio Quartulli if (WARN_ON(freq == 0)) 3204bfd634d0SAntonio Quartulli return -EINVAL; 3205bfd634d0SAntonio Quartulli 32068bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3207c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3208c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3209c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 32108bdfbf40SJouni Malinen /* 3211c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 32128bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 32138bdfbf40SJouni Malinen */ 32148bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3215bfd634d0SAntonio Quartulli return ath6kl_send_go_probe_resp(vif, buf, len, freq); 32168bdfbf40SJouni Malinen } 32178a6c8060SJouni Malinen 3218cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32198a6c8060SJouni Malinen if (id == 0) { 32208a6c8060SJouni Malinen /* 32218a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 32228a6c8060SJouni Malinen * used for the command. 32238a6c8060SJouni Malinen */ 3224cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 32258a6c8060SJouni Malinen } 32268a6c8060SJouni Malinen 32278a6c8060SJouni Malinen *cookie = id; 32283ca9d1fcSAarthi Thiruvengadam 3229d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3230d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3231bfd634d0SAntonio Quartulli queued = ath6kl_mgmt_powersave_ap(vif, id, freq, wait, buf, len, 3232bfd634d0SAntonio Quartulli &more_data, no_cck); 3233d0ff7383SNaveen Gangadharan if (queued) 3234d0ff7383SNaveen Gangadharan return 0; 3235d0ff7383SNaveen Gangadharan } 3236d0ff7383SNaveen Gangadharan 3237bfd634d0SAntonio Quartulli return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, freq, 3238bfd634d0SAntonio Quartulli wait, buf, len, no_cck); 32393ca9d1fcSAarthi Thiruvengadam } 32408a6c8060SJouni Malinen 32419c2e90ffSBen Greear static int ath6kl_get_antenna(struct wiphy *wiphy, 32429c2e90ffSBen Greear u32 *tx_ant, u32 *rx_ant) 32439c2e90ffSBen Greear { 32449c2e90ffSBen Greear struct ath6kl *ar = wiphy_priv(wiphy); 32459c2e90ffSBen Greear *tx_ant = ar->hw.tx_ant; 32469c2e90ffSBen Greear *rx_ant = ar->hw.rx_ant; 32479c2e90ffSBen Greear return 0; 32489c2e90ffSBen Greear } 32499c2e90ffSBen Greear 3250ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 325171bbc994SJohannes Berg struct wireless_dev *wdev, 3252ae32c30aSJouni Malinen u16 frame_type, bool reg) 3253ae32c30aSJouni Malinen { 325471bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 3255ae32c30aSJouni Malinen 3256ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3257ae32c30aSJouni Malinen __func__, frame_type, reg); 3258ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3259ae32c30aSJouni Malinen /* 3260ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3261ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3262ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3263ae32c30aSJouni Malinen */ 3264cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3265ae32c30aSJouni Malinen } 3266ae32c30aSJouni Malinen } 3267ae32c30aSJouni Malinen 326810509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 326910509f90SKalle Valo struct net_device *dev, 327010509f90SKalle Valo struct cfg80211_sched_scan_request *request) 327110509f90SKalle Valo { 327210509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 327310509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 327410509f90SKalle Valo u16 interval; 327585b20fc2SThomas Pedersen int ret, rssi_thold; 3276ea73cbceSJohannes Berg int n_match_sets = request->n_match_sets; 3277ea73cbceSJohannes Berg 3278ea73cbceSJohannes Berg /* 3279ea73cbceSJohannes Berg * If there's a matchset w/o an SSID, then assume it's just for 3280ea73cbceSJohannes Berg * the RSSI (nothing else is currently supported) and ignore it. 3281ea73cbceSJohannes Berg * The device only supports a global RSSI filter that we set below. 3282ea73cbceSJohannes Berg */ 3283ea73cbceSJohannes Berg if (n_match_sets == 1 && !request->match_sets[0].ssid.ssid_len) 3284ea73cbceSJohannes Berg n_match_sets = 0; 328510509f90SKalle Valo 328610509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 328710509f90SKalle Valo return -EIO; 328810509f90SKalle Valo 328910509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 329010509f90SKalle Valo return -EBUSY; 329110509f90SKalle Valo 3292b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3293b4d13d3bSKalle Valo 32943b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3295dd45b759SNaveen Singh request->n_ssids, 3296dd45b759SNaveen Singh request->match_sets, 3297ea73cbceSJohannes Berg n_match_sets); 32983b8ffc6aSJouni Malinen if (ret < 0) 32993b8ffc6aSJouni Malinen return ret; 330010509f90SKalle Valo 3301ea73cbceSJohannes Berg if (!n_match_sets) { 3302dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3303dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3304dd45b759SNaveen Singh if (ret < 0) 3305dd45b759SNaveen Singh return ret; 3306dd45b759SNaveen Singh } else { 3307dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3308dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3309dd45b759SNaveen Singh if (ret < 0) 3310dd45b759SNaveen Singh return ret; 3311dd45b759SNaveen Singh } 3312dd45b759SNaveen Singh 331385b20fc2SThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD, 331485b20fc2SThomas Pedersen ar->fw_capabilities)) { 3315ea73cbceSJohannes Berg if (request->min_rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF) 331685b20fc2SThomas Pedersen rssi_thold = 0; 3317ea73cbceSJohannes Berg else if (request->min_rssi_thold < -127) 331885b20fc2SThomas Pedersen rssi_thold = -127; 331985b20fc2SThomas Pedersen else 3320ea73cbceSJohannes Berg rssi_thold = request->min_rssi_thold; 332185b20fc2SThomas Pedersen 332285b20fc2SThomas Pedersen ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx, 332385b20fc2SThomas Pedersen rssi_thold); 332485b20fc2SThomas Pedersen if (ret) { 332585b20fc2SThomas Pedersen ath6kl_err("failed to set RSSI threshold for scan\n"); 332685b20fc2SThomas Pedersen return ret; 332785b20fc2SThomas Pedersen } 332885b20fc2SThomas Pedersen } 332985b20fc2SThomas Pedersen 333010509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 33313b06d277SAvraham Stern interval = max_t(u16, 1, request->scan_plans[0].interval); 333210509f90SKalle Valo 333310509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 333410509f90SKalle Valo interval, interval, 3335d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 333610509f90SKalle Valo 333710509f90SKalle Valo /* this also clears IE in fw if it's not set */ 333810509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 333910509f90SKalle Valo WMI_FRAME_PROBE_REQ, 334010509f90SKalle Valo request->ie, request->ie_len); 334110509f90SKalle Valo if (ret) { 3342f1ff32e8SJoe Perches ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n", 334310509f90SKalle Valo ret); 334410509f90SKalle Valo return ret; 334510509f90SKalle Valo } 334610509f90SKalle Valo 3347b1f47e3aSThomas Pedersen ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true); 3348b1f47e3aSThomas Pedersen if (ret) 334910509f90SKalle Valo return ret; 335010509f90SKalle Valo 3351b1f47e3aSThomas Pedersen set_bit(SCHED_SCANNING, &vif->flags); 335210509f90SKalle Valo 3353b1f47e3aSThomas Pedersen return 0; 335410509f90SKalle Valo } 335510509f90SKalle Valo 335610509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 335710509f90SKalle Valo struct net_device *dev) 335810509f90SKalle Valo { 335910509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 336010509f90SKalle Valo bool stopped; 336110509f90SKalle Valo 336210509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 336310509f90SKalle Valo 336410509f90SKalle Valo if (!stopped) 336510509f90SKalle Valo return -EIO; 336610509f90SKalle Valo 336710509f90SKalle Valo return 0; 336810509f90SKalle Valo } 336910509f90SKalle Valo 337006e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy, 337106e360acSBala Shanmugam struct net_device *dev, 337206e360acSBala Shanmugam const u8 *addr, 337306e360acSBala Shanmugam const struct cfg80211_bitrate_mask *mask) 337406e360acSBala Shanmugam { 337506e360acSBala Shanmugam struct ath6kl *ar = ath6kl_priv(dev); 337606e360acSBala Shanmugam struct ath6kl_vif *vif = netdev_priv(dev); 337706e360acSBala Shanmugam 337806e360acSBala Shanmugam return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx, 337906e360acSBala Shanmugam mask); 338006e360acSBala Shanmugam } 338106e360acSBala Shanmugam 3382279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy, 3383279b2862SThomas Pedersen struct net_device *dev, 3384279b2862SThomas Pedersen u32 rate, u32 pkts, u32 intvl) 3385279b2862SThomas Pedersen { 3386279b2862SThomas Pedersen struct ath6kl *ar = ath6kl_priv(dev); 3387279b2862SThomas Pedersen struct ath6kl_vif *vif = netdev_priv(dev); 3388279b2862SThomas Pedersen 3389279b2862SThomas Pedersen if (vif->nw_type != INFRA_NETWORK || 3390279b2862SThomas Pedersen !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities)) 3391279b2862SThomas Pedersen return -EOPNOTSUPP; 3392279b2862SThomas Pedersen 3393279b2862SThomas Pedersen if (vif->sme_state != SME_CONNECTED) 3394279b2862SThomas Pedersen return -ENOTCONN; 3395279b2862SThomas Pedersen 3396279b2862SThomas Pedersen /* save this since the firmware won't report the interval */ 3397279b2862SThomas Pedersen vif->txe_intvl = intvl; 3398279b2862SThomas Pedersen 3399279b2862SThomas Pedersen return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx, 3400279b2862SThomas Pedersen rate, pkts, intvl); 3401279b2862SThomas Pedersen } 3402279b2862SThomas Pedersen 3403f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3404f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3405f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 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 }, 3411ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3412ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3413ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3414ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3415ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3416ba1f6fe3SJouni Malinen }, 3417f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3418f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3419f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3420f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3421f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3422f80574aeSJouni Malinen }, 3423f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3424f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3425f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3426f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3427f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3428f80574aeSJouni Malinen }, 3429f80574aeSJouni Malinen }; 3430f80574aeSJouni Malinen 3431bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 343255055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 343355055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3434bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3435bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3436bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3437bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3438bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3439bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3440bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3441bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3442bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3443bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3444bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3445bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3446bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3447bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3448bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3449bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3450bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3451bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3452003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3453abcb344bSKalle Valo #ifdef CONFIG_PM 345452d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 345552d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3456abcb344bSKalle Valo #endif 34578860020eSJohannes Berg .start_ap = ath6kl_start_ap, 34588860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 34598860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 346033e5308dSJouni Malinen .del_station = ath6kl_del_station, 346123875136SJouni Malinen .change_station = ath6kl_change_station, 346263fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 346363fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 34648a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3465ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 34669c2e90ffSBen Greear .get_antenna = ath6kl_get_antenna, 346710509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 346810509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 346906e360acSBala Shanmugam .set_bitrate_mask = ath6kl_cfg80211_set_bitrate, 3470279b2862SThomas Pedersen .set_cqm_txe_config = ath6kl_cfg80211_set_txe_config, 3471bdcd8170SKalle Valo }; 3472bdcd8170SKalle Valo 34737125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3474ec4b7f60SKalle Valo { 347510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 347610509f90SKalle Valo 3477ec4b7f60SKalle Valo switch (vif->sme_state) { 3478c97a31b0SKalle Valo case SME_DISCONNECTED: 3479c97a31b0SKalle Valo break; 3480ec4b7f60SKalle Valo case SME_CONNECTING: 3481ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3482ec4b7f60SKalle Valo NULL, 0, 3483ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3484ec4b7f60SKalle Valo GFP_KERNEL); 3485ec4b7f60SKalle Valo break; 3486ec4b7f60SKalle Valo case SME_CONNECTED: 348780279fb7SJohannes Berg cfg80211_disconnected(vif->ndev, 0, NULL, 0, true, GFP_KERNEL); 3488ec4b7f60SKalle Valo break; 3489ec4b7f60SKalle Valo } 3490ec4b7f60SKalle Valo 349158109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 349258109df6SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) || 349358109df6SVasanthakumar Thiagarajan test_bit(CONNECT_PEND, &vif->flags))) 34947125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3495ec4b7f60SKalle Valo 3496ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34971f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 34981f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3499ec4b7f60SKalle Valo 350084caf800SVasanthakumar Thiagarajan /* Stop netdev queues, needed during recovery */ 350184caf800SVasanthakumar Thiagarajan netif_stop_queue(vif->ndev); 350284caf800SVasanthakumar Thiagarajan netif_carrier_off(vif->ndev); 350384caf800SVasanthakumar Thiagarajan 3504ec4b7f60SKalle Valo /* disable scanning */ 350558109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 350658109df6SVasanthakumar Thiagarajan ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 35077125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 35087125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3509ec4b7f60SKalle Valo 3510ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3511ec4b7f60SKalle Valo } 3512ec4b7f60SKalle Valo 35137125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 35147125f01dSKalle Valo { 35157125f01dSKalle Valo struct ath6kl_vif *vif; 35167125f01dSKalle Valo 35177125f01dSKalle Valo vif = ath6kl_vif_first(ar); 351884caf800SVasanthakumar Thiagarajan if (!vif && ar->state != ATH6KL_STATE_RECOVERY) { 35197125f01dSKalle Valo /* save the current power mode before enabling power save */ 35207125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 35217125f01dSKalle Valo 35227125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3523cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 35247125f01dSKalle Valo return; 35257125f01dSKalle Valo } 35267125f01dSKalle Valo 35277125f01dSKalle Valo /* 35287125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 35297125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 35307125f01dSKalle Valo * sleeps. 35317125f01dSKalle Valo */ 35327125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 35337125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 35347125f01dSKalle Valo } 35357125f01dSKalle Valo 35360c0280bdSLuis R. Rodriguez static void ath6kl_cfg80211_reg_notify(struct wiphy *wiphy, 353784841ba2SKalle Valo struct regulatory_request *request) 353884841ba2SKalle Valo { 353984841ba2SKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 354057fbcce3SJohannes Berg u32 rates[NUM_NL80211_BANDS]; 354184841ba2SKalle Valo int ret, i; 354284841ba2SKalle Valo 354384841ba2SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 3544ff7e6867SKalle Valo "cfg reg_notify %c%c%s%s initiator %d hint_type %d\n", 354584841ba2SKalle Valo request->alpha2[0], request->alpha2[1], 354684841ba2SKalle Valo request->intersect ? " intersect" : "", 354784841ba2SKalle Valo request->processed ? " processed" : "", 3548ff7e6867SKalle Valo request->initiator, request->user_reg_hint_type); 3549ff7e6867SKalle Valo 3550ff7e6867SKalle Valo if (request->user_reg_hint_type != NL80211_USER_REG_HINT_CELL_BASE) 35510c0280bdSLuis R. Rodriguez return; 355284841ba2SKalle Valo 355384841ba2SKalle Valo ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2); 355484841ba2SKalle Valo if (ret) { 355584841ba2SKalle Valo ath6kl_err("failed to set regdomain: %d\n", ret); 35560c0280bdSLuis R. Rodriguez return; 355784841ba2SKalle Valo } 355884841ba2SKalle Valo 355984841ba2SKalle Valo /* 356084841ba2SKalle Valo * Firmware will apply the regdomain change only after a scan is 356184841ba2SKalle Valo * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been 356284841ba2SKalle Valo * changed. 356384841ba2SKalle Valo */ 356484841ba2SKalle Valo 356557fbcce3SJohannes Berg for (i = 0; i < NUM_NL80211_BANDS; i++) 356684841ba2SKalle Valo if (wiphy->bands[i]) 356784841ba2SKalle Valo rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1; 356884841ba2SKalle Valo 356984841ba2SKalle Valo 357084841ba2SKalle Valo ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false, 357184841ba2SKalle Valo false, 0, ATH6KL_FG_SCAN_INTERVAL, 357284841ba2SKalle Valo 0, NULL, false, rates); 357384841ba2SKalle Valo if (ret) { 357484841ba2SKalle Valo ath6kl_err("failed to start scan for a regdomain change: %d\n", 357584841ba2SKalle Valo ret); 35760c0280bdSLuis R. Rodriguez return; 357784841ba2SKalle Valo } 357884841ba2SKalle Valo } 357984841ba2SKalle Valo 3580c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 35818dafb70eSVasanthakumar Thiagarajan { 35827baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 35832132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 35848dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 35858dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 35868dafb70eSVasanthakumar Thiagarajan } 35878dafb70eSVasanthakumar Thiagarajan 3588de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3589108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 359010509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 359110509f90SKalle Valo (unsigned long) vif); 359210509f90SKalle Valo 3593de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3594478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 35958dafb70eSVasanthakumar Thiagarajan 359680abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 359780abaf9bSVasanthakumar Thiagarajan 35988dafb70eSVasanthakumar Thiagarajan return 0; 35998dafb70eSVasanthakumar Thiagarajan } 36008dafb70eSVasanthakumar Thiagarajan 3601355b3a98SMohammed Shafi Shajakhan void ath6kl_cfg80211_vif_stop(struct ath6kl_vif *vif, bool wmi_ready) 3602355b3a98SMohammed Shafi Shajakhan { 3603355b3a98SMohammed Shafi Shajakhan static u8 bcast_mac[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; 3604355b3a98SMohammed Shafi Shajakhan bool discon_issued; 3605355b3a98SMohammed Shafi Shajakhan 3606355b3a98SMohammed Shafi Shajakhan netif_stop_queue(vif->ndev); 3607355b3a98SMohammed Shafi Shajakhan 3608355b3a98SMohammed Shafi Shajakhan clear_bit(WLAN_ENABLED, &vif->flags); 3609355b3a98SMohammed Shafi Shajakhan 3610355b3a98SMohammed Shafi Shajakhan if (wmi_ready) { 3611355b3a98SMohammed Shafi Shajakhan discon_issued = test_bit(CONNECTED, &vif->flags) || 3612355b3a98SMohammed Shafi Shajakhan test_bit(CONNECT_PEND, &vif->flags); 3613355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect(vif); 3614355b3a98SMohammed Shafi Shajakhan del_timer(&vif->disconnect_timer); 3615355b3a98SMohammed Shafi Shajakhan 3616355b3a98SMohammed Shafi Shajakhan if (discon_issued) 3617355b3a98SMohammed Shafi Shajakhan ath6kl_disconnect_event(vif, DISCONNECT_CMD, 3618355b3a98SMohammed Shafi Shajakhan (vif->nw_type & AP_NETWORK) ? 3619355b3a98SMohammed Shafi Shajakhan bcast_mac : vif->bssid, 3620355b3a98SMohammed Shafi Shajakhan 0, NULL, 0); 3621355b3a98SMohammed Shafi Shajakhan } 3622355b3a98SMohammed Shafi Shajakhan 3623355b3a98SMohammed Shafi Shajakhan if (vif->scan_req) { 36241d76250bSAvraham Stern struct cfg80211_scan_info info = { 36251d76250bSAvraham Stern .aborted = true, 36261d76250bSAvraham Stern }; 36271d76250bSAvraham Stern 36281d76250bSAvraham Stern cfg80211_scan_done(vif->scan_req, &info); 3629355b3a98SMohammed Shafi Shajakhan vif->scan_req = NULL; 3630355b3a98SMohammed Shafi Shajakhan } 3631355b3a98SMohammed Shafi Shajakhan 3632355b3a98SMohammed Shafi Shajakhan /* need to clean up enhanced bmiss detection fw state */ 3633355b3a98SMohammed Shafi Shajakhan ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 3634355b3a98SMohammed Shafi Shajakhan } 3635355b3a98SMohammed Shafi Shajakhan 3636c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 36378dafb70eSVasanthakumar Thiagarajan { 363855055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 363980abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 364055055976SVasanthakumar Thiagarajan 36412132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3642108438bcSVasanthakumar Thiagarajan 364355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 364455055976SVasanthakumar Thiagarajan 364555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 364655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 364755055976SVasanthakumar Thiagarajan 364880abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 364980abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 365080abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 365180abaf9bSVasanthakumar Thiagarajan } 365280abaf9bSVasanthakumar Thiagarajan 365327929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 365455055976SVasanthakumar Thiagarajan 365555055976SVasanthakumar Thiagarajan ar->num_vif--; 36568dafb70eSVasanthakumar Thiagarajan } 36578dafb70eSVasanthakumar Thiagarajan 365813eff531SBen Greear static const char ath6kl_gstrings_sta_stats[][ETH_GSTRING_LEN] = { 365913eff531SBen Greear /* Common stats names used by many drivers. */ 366013eff531SBen Greear "tx_pkts_nic", "tx_bytes_nic", "rx_pkts_nic", "rx_bytes_nic", 366113eff531SBen Greear 366213eff531SBen Greear /* TX stats. */ 366313eff531SBen Greear "d_tx_ucast_pkts", "d_tx_bcast_pkts", 366413eff531SBen Greear "d_tx_ucast_bytes", "d_tx_bcast_bytes", 366513eff531SBen Greear "d_tx_rts_ok", "d_tx_error", "d_tx_fail", 366613eff531SBen Greear "d_tx_retry", "d_tx_multi_retry", "d_tx_rts_fail", 366713eff531SBen Greear "d_tx_tkip_counter_measures", 366813eff531SBen Greear 366913eff531SBen Greear /* RX Stats. */ 367013eff531SBen Greear "d_rx_ucast_pkts", "d_rx_ucast_rate", "d_rx_bcast_pkts", 367113eff531SBen Greear "d_rx_ucast_bytes", "d_rx_bcast_bytes", "d_rx_frag_pkt", 367213eff531SBen Greear "d_rx_error", "d_rx_crc_err", "d_rx_keycache_miss", 367313eff531SBen Greear "d_rx_decrypt_crc_err", "d_rx_duplicate_frames", 367413eff531SBen Greear "d_rx_mic_err", "d_rx_tkip_format_err", "d_rx_ccmp_format_err", 367513eff531SBen Greear "d_rx_ccmp_replay_err", 367613eff531SBen Greear 367713eff531SBen Greear /* Misc stats. */ 367813eff531SBen Greear "d_beacon_miss", "d_num_connects", "d_num_disconnects", 367913eff531SBen Greear "d_beacon_avg_rssi", "d_arp_received", "d_arp_matched", 368013eff531SBen Greear "d_arp_replied" 368113eff531SBen Greear }; 368213eff531SBen Greear 368313eff531SBen Greear #define ATH6KL_STATS_LEN ARRAY_SIZE(ath6kl_gstrings_sta_stats) 368413eff531SBen Greear 368513eff531SBen Greear static int ath6kl_get_sset_count(struct net_device *dev, int sset) 368613eff531SBen Greear { 368713eff531SBen Greear int rv = 0; 368813eff531SBen Greear 368913eff531SBen Greear if (sset == ETH_SS_STATS) 369013eff531SBen Greear rv += ATH6KL_STATS_LEN; 369113eff531SBen Greear 369213eff531SBen Greear if (rv == 0) 369313eff531SBen Greear return -EOPNOTSUPP; 369413eff531SBen Greear return rv; 369513eff531SBen Greear } 369613eff531SBen Greear 369713eff531SBen Greear static void ath6kl_get_stats(struct net_device *dev, 369813eff531SBen Greear struct ethtool_stats *stats, 369913eff531SBen Greear u64 *data) 370013eff531SBen Greear { 370113eff531SBen Greear struct ath6kl_vif *vif = netdev_priv(dev); 370213eff531SBen Greear struct ath6kl *ar = vif->ar; 370313eff531SBen Greear int i = 0; 370413eff531SBen Greear struct target_stats *tgt_stats; 370513eff531SBen Greear 370613eff531SBen Greear memset(data, 0, sizeof(u64) * ATH6KL_STATS_LEN); 370713eff531SBen Greear 370813eff531SBen Greear ath6kl_read_tgt_stats(ar, vif); 370913eff531SBen Greear 371013eff531SBen Greear tgt_stats = &vif->target_stats; 371113eff531SBen Greear 371213eff531SBen Greear data[i++] = tgt_stats->tx_ucast_pkt + tgt_stats->tx_bcast_pkt; 371313eff531SBen Greear data[i++] = tgt_stats->tx_ucast_byte + tgt_stats->tx_bcast_byte; 371413eff531SBen Greear data[i++] = tgt_stats->rx_ucast_pkt + tgt_stats->rx_bcast_pkt; 371513eff531SBen Greear data[i++] = tgt_stats->rx_ucast_byte + tgt_stats->rx_bcast_byte; 371613eff531SBen Greear 371713eff531SBen Greear data[i++] = tgt_stats->tx_ucast_pkt; 371813eff531SBen Greear data[i++] = tgt_stats->tx_bcast_pkt; 371913eff531SBen Greear data[i++] = tgt_stats->tx_ucast_byte; 372013eff531SBen Greear data[i++] = tgt_stats->tx_bcast_byte; 372113eff531SBen Greear data[i++] = tgt_stats->tx_rts_success_cnt; 372213eff531SBen Greear data[i++] = tgt_stats->tx_err; 372313eff531SBen Greear data[i++] = tgt_stats->tx_fail_cnt; 372413eff531SBen Greear data[i++] = tgt_stats->tx_retry_cnt; 372513eff531SBen Greear data[i++] = tgt_stats->tx_mult_retry_cnt; 372613eff531SBen Greear data[i++] = tgt_stats->tx_rts_fail_cnt; 372713eff531SBen Greear data[i++] = tgt_stats->tkip_cnter_measures_invoked; 372813eff531SBen Greear 372913eff531SBen Greear data[i++] = tgt_stats->rx_ucast_pkt; 373013eff531SBen Greear data[i++] = tgt_stats->rx_ucast_rate; 373113eff531SBen Greear data[i++] = tgt_stats->rx_bcast_pkt; 373213eff531SBen Greear data[i++] = tgt_stats->rx_ucast_byte; 373313eff531SBen Greear data[i++] = tgt_stats->rx_bcast_byte; 373413eff531SBen Greear data[i++] = tgt_stats->rx_frgment_pkt; 373513eff531SBen Greear data[i++] = tgt_stats->rx_err; 373613eff531SBen Greear data[i++] = tgt_stats->rx_crc_err; 373713eff531SBen Greear data[i++] = tgt_stats->rx_key_cache_miss; 373813eff531SBen Greear data[i++] = tgt_stats->rx_decrypt_err; 373913eff531SBen Greear data[i++] = tgt_stats->rx_dupl_frame; 374013eff531SBen Greear data[i++] = tgt_stats->tkip_local_mic_fail; 374113eff531SBen Greear data[i++] = tgt_stats->tkip_fmt_err; 374213eff531SBen Greear data[i++] = tgt_stats->ccmp_fmt_err; 374313eff531SBen Greear data[i++] = tgt_stats->ccmp_replays; 374413eff531SBen Greear 374513eff531SBen Greear data[i++] = tgt_stats->cs_bmiss_cnt; 374613eff531SBen Greear data[i++] = tgt_stats->cs_connect_cnt; 374713eff531SBen Greear data[i++] = tgt_stats->cs_discon_cnt; 374813eff531SBen Greear data[i++] = tgt_stats->cs_ave_beacon_rssi; 374913eff531SBen Greear data[i++] = tgt_stats->arp_received; 375013eff531SBen Greear data[i++] = tgt_stats->arp_matched; 375113eff531SBen Greear data[i++] = tgt_stats->arp_replied; 375213eff531SBen Greear 375313eff531SBen Greear if (i != ATH6KL_STATS_LEN) { 375413eff531SBen Greear WARN_ON_ONCE(1); 375513eff531SBen Greear ath6kl_err("ethtool stats error, i: %d STATS_LEN: %d\n", 375613eff531SBen Greear i, (int)ATH6KL_STATS_LEN); 375713eff531SBen Greear } 375813eff531SBen Greear } 375913eff531SBen Greear 376013eff531SBen Greear /* These stats are per NIC, not really per vdev, so we just ignore dev. */ 376113eff531SBen Greear static void ath6kl_get_strings(struct net_device *dev, u32 sset, u8 *data) 376213eff531SBen Greear { 376313eff531SBen Greear int sz_sta_stats = 0; 376413eff531SBen Greear 376513eff531SBen Greear if (sset == ETH_SS_STATS) { 376613eff531SBen Greear sz_sta_stats = sizeof(ath6kl_gstrings_sta_stats); 376713eff531SBen Greear memcpy(data, ath6kl_gstrings_sta_stats, sz_sta_stats); 376813eff531SBen Greear } 376913eff531SBen Greear } 377013eff531SBen Greear 377113eff531SBen Greear static const struct ethtool_ops ath6kl_ethtool_ops = { 377213eff531SBen Greear .get_drvinfo = cfg80211_get_drvinfo, 377313eff531SBen Greear .get_link = ethtool_op_get_link, 377413eff531SBen Greear .get_strings = ath6kl_get_strings, 377513eff531SBen Greear .get_ethtool_stats = ath6kl_get_stats, 377613eff531SBen Greear .get_sset_count = ath6kl_get_sset_count, 377713eff531SBen Greear }; 377813eff531SBen Greear 3779552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name, 37806bab2e19STom Gundersen unsigned char name_assign_type, 378184efbb84SJohannes Berg enum nl80211_iftype type, 378284efbb84SJohannes Berg u8 fw_vif_idx, u8 nw_type) 37838dafb70eSVasanthakumar Thiagarajan { 37848dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3785108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 37868dafb70eSVasanthakumar Thiagarajan 37876bab2e19STom Gundersen ndev = alloc_netdev(sizeof(*vif), name, name_assign_type, ether_setup); 37888dafb70eSVasanthakumar Thiagarajan if (!ndev) 37898dafb70eSVasanthakumar Thiagarajan return NULL; 37908dafb70eSVasanthakumar Thiagarajan 3791108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3792108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3793108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3794108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3795108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3796108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3797108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3798108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3799334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3800d0d670abSKalle Valo vif->nw_type = nw_type; 3801d0d670abSKalle Valo vif->next_mode = nw_type; 38028f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3803ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3804eb38987eSRaja Mani vif->bg_scan_period = 0; 380557fbcce3SJohannes Berg vif->htcap[NL80211_BAND_2GHZ].ht_enable = true; 380657fbcce3SJohannes Berg vif->htcap[NL80211_BAND_5GHZ].ht_enable = true; 38078dafb70eSVasanthakumar Thiagarajan 380855055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3809c95dcb59SAarthi Thiruvengadam if (fw_vif_idx != 0) { 381055055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 381155055976SVasanthakumar Thiagarajan 0x2; 3812c95dcb59SAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR, 3813c95dcb59SAarthi Thiruvengadam ar->fw_capabilities)) 3814c95dcb59SAarthi Thiruvengadam ndev->dev_addr[4] ^= 0x80; 3815c95dcb59SAarthi Thiruvengadam } 381655055976SVasanthakumar Thiagarajan 38178dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 38188dafb70eSVasanthakumar Thiagarajan 3819e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 38208dafb70eSVasanthakumar Thiagarajan 3821c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 38228dafb70eSVasanthakumar Thiagarajan goto err; 38238dafb70eSVasanthakumar Thiagarajan 382413eff531SBen Greear netdev_set_default_ethtool_ops(ndev, &ath6kl_ethtool_ops); 382513eff531SBen Greear 382627929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 38278dafb70eSVasanthakumar Thiagarajan goto err; 38288dafb70eSVasanthakumar Thiagarajan 382955055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 383014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 383159c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 38328dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 38338dafb70eSVasanthakumar Thiagarajan 383455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 383555055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 383655055976SVasanthakumar Thiagarajan 383711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3838990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 383911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3840990bd915SVasanthakumar Thiagarajan 384184efbb84SJohannes Berg return &vif->wdev; 38428dafb70eSVasanthakumar Thiagarajan 38438dafb70eSVasanthakumar Thiagarajan err: 384427929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 384527929723SVasanthakumar Thiagarajan free_netdev(ndev); 3846bdcd8170SKalle Valo return NULL; 3847bdcd8170SKalle Valo } 3848bdcd8170SKalle Valo 3849964dc9e2SJohannes Berg #ifdef CONFIG_PM 3850964dc9e2SJohannes Berg static const struct wiphy_wowlan_support ath6kl_wowlan_support = { 3851964dc9e2SJohannes Berg .flags = WIPHY_WOWLAN_MAGIC_PKT | 3852964dc9e2SJohannes Berg WIPHY_WOWLAN_DISCONNECT | 3853964dc9e2SJohannes Berg WIPHY_WOWLAN_GTK_REKEY_FAILURE | 3854964dc9e2SJohannes Berg WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 3855964dc9e2SJohannes Berg WIPHY_WOWLAN_EAP_IDENTITY_REQ | 3856964dc9e2SJohannes Berg WIPHY_WOWLAN_4WAY_HANDSHAKE, 3857964dc9e2SJohannes Berg .n_patterns = WOW_MAX_FILTERS_PER_LIST, 3858964dc9e2SJohannes Berg .pattern_min_len = 1, 3859964dc9e2SJohannes Berg .pattern_max_len = WOW_PATTERN_SIZE, 3860964dc9e2SJohannes Berg }; 3861964dc9e2SJohannes Berg #endif 3862964dc9e2SJohannes Berg 386346d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 386446d33a21SKalle Valo { 386546d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3866d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 386746d33a21SKalle Valo int ret; 386846d33a21SKalle Valo 386946d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 387046d33a21SKalle Valo 387146d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 387246d33a21SKalle Valo 387346d33a21SKalle Valo /* set device pointer for wiphy */ 387446d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 387546d33a21SKalle Valo 387646d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 387746d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 387846d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 387946d33a21SKalle Valo if (ar->p2p) { 388046d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 388146d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 388246d33a21SKalle Valo } 388346d33a21SKalle Valo 388497f2645fSMasahiro Yamada if (IS_ENABLED(CONFIG_ATH6KL_REGDOMAIN) && 3885ff7e6867SKalle Valo test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) { 388684841ba2SKalle Valo wiphy->reg_notifier = ath6kl_cfg80211_reg_notify; 3887ff7e6867SKalle Valo ar->wiphy->features |= NL80211_FEATURE_CELL_BASE_REG_HINTS; 3888ff7e6867SKalle Valo } 388984841ba2SKalle Valo 389046d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 38918ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3892dd45b759SNaveen Singh 3893dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3894dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3895dd45b759SNaveen Singh ar->fw_capabilities)) 3896dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3897dd45b759SNaveen Singh 389846d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3899d92917e4SThomas Pedersen switch (ar->hw.cap) { 3900d92917e4SThomas Pedersen case WMI_11AN_CAP: 3901d92917e4SThomas Pedersen ht = true; 3902d92917e4SThomas Pedersen case WMI_11A_CAP: 3903d92917e4SThomas Pedersen band_5gig = true; 3904d92917e4SThomas Pedersen break; 3905d92917e4SThomas Pedersen case WMI_11GN_CAP: 3906d92917e4SThomas Pedersen ht = true; 3907d92917e4SThomas Pedersen case WMI_11G_CAP: 3908d92917e4SThomas Pedersen band_2gig = true; 3909d92917e4SThomas Pedersen break; 3910d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3911d92917e4SThomas Pedersen ht = true; 3912d92917e4SThomas Pedersen case WMI_11AG_CAP: 3913d92917e4SThomas Pedersen band_2gig = true; 3914d92917e4SThomas Pedersen band_5gig = true; 3915d92917e4SThomas Pedersen break; 3916d92917e4SThomas Pedersen default: 3917d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3918d92917e4SThomas Pedersen return -EINVAL; 3919d92917e4SThomas Pedersen } 3920d92917e4SThomas Pedersen 39217fd1ce7eSVasanthakumar Thiagarajan /* 39227fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 39237fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 39247fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 39257fd1ce7eSVasanthakumar Thiagarajan */ 39267fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 39277fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 39287fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3929d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3930d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3931d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3932d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 39337fd98524SBen Greear 39347fd98524SBen Greear if (ht) 39357fd98524SBen Greear ath6kl_err("Firmware lacks RSN-CAP-OVERRIDE, so HT (802.11n) is disabled."); 3936d92917e4SThomas Pedersen } 393706e360acSBala Shanmugam 3938eba95bceSKalle Valo if (test_bit(ATH6KL_FW_CAPABILITY_64BIT_RATES, 3939eba95bceSKalle Valo ar->fw_capabilities)) { 394006e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 394106e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 394206e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff; 394306e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff; 394426ca14d4SBen Greear ar->hw.tx_ant = 0x3; /* mask, 2 antenna */ 394526ca14d4SBen Greear ar->hw.rx_ant = 0x3; 394606e360acSBala Shanmugam } else { 394706e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 394806e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 39499c2e90ffSBen Greear ar->hw.tx_ant = 1; 39509c2e90ffSBen Greear ar->hw.rx_ant = 1; 395106e360acSBala Shanmugam } 395206e360acSBala Shanmugam 39539c2e90ffSBen Greear wiphy->available_antennas_tx = ar->hw.tx_ant; 39549c2e90ffSBen Greear wiphy->available_antennas_rx = ar->hw.rx_ant; 39559c2e90ffSBen Greear 3956d92917e4SThomas Pedersen if (band_2gig) 395757fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3958d92917e4SThomas Pedersen if (band_5gig) 395957fbcce3SJohannes Berg wiphy->bands[NL80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3960d92917e4SThomas Pedersen 396146d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 396246d33a21SKalle Valo 396346d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 396446d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 396546d33a21SKalle Valo 3966dfb89c56SJohannes Berg #ifdef CONFIG_PM 3967964dc9e2SJohannes Berg wiphy->wowlan = &ath6kl_wowlan_support; 3968dfb89c56SJohannes Berg #endif 396946d33a21SKalle Valo 39708ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 397146d33a21SKalle Valo 3972f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3973f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3974f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3975f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3976f2afdac7SVasanthakumar Thiagarajan 3977b1f47e3aSThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities)) 3978f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3979f2afdac7SVasanthakumar Thiagarajan 398003bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 398103bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 3982b292219fSJohannes Berg ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER; 398303bdeb0dSVasanthakumar Thiagarajan 3984f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3985f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3986f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3987a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3988f2afdac7SVasanthakumar Thiagarajan 398946d33a21SKalle Valo ret = wiphy_register(wiphy); 399046d33a21SKalle Valo if (ret < 0) { 399146d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 399246d33a21SKalle Valo return ret; 399346d33a21SKalle Valo } 399446d33a21SKalle Valo 3995e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3996e5348a1eSVasanthakumar Thiagarajan 399746d33a21SKalle Valo return 0; 399846d33a21SKalle Valo } 399946d33a21SKalle Valo 400046d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 4001bdcd8170SKalle Valo { 4002be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 4003e5348a1eSVasanthakumar Thiagarajan 4004e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 400545eaa78fSKalle Valo } 400646d33a21SKalle Valo 400745eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 400845eaa78fSKalle Valo { 400945eaa78fSKalle Valo struct ath6kl *ar; 401045eaa78fSKalle Valo struct wiphy *wiphy; 401145eaa78fSKalle Valo 401245eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 401345eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 401445eaa78fSKalle Valo 401545eaa78fSKalle Valo if (!wiphy) { 401645eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 401745eaa78fSKalle Valo return NULL; 401845eaa78fSKalle Valo } 401945eaa78fSKalle Valo 402045eaa78fSKalle Valo ar = wiphy_priv(wiphy); 402145eaa78fSKalle Valo ar->wiphy = wiphy; 402245eaa78fSKalle Valo 402345eaa78fSKalle Valo return ar; 402445eaa78fSKalle Valo } 402545eaa78fSKalle Valo 402645eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 402745eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 402845eaa78fSKalle Valo { 40291d2a4456SVasanthakumar Thiagarajan int i; 40301d2a4456SVasanthakumar Thiagarajan 40311d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 40321d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 40331d2a4456SVasanthakumar Thiagarajan 4034be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 4035bdcd8170SKalle Valo } 403645eaa78fSKalle Valo 4037