1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19516304b0SJoe Perches 206eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 21c08631c6SRaja Mani #include <linux/inetdevice.h> 22d6a434d6SKalle Valo #include <linux/export.h> 236eb07cafSPaul Gortmaker 24bdcd8170SKalle Valo #include "core.h" 25bdcd8170SKalle Valo #include "cfg80211.h" 26bdcd8170SKalle Valo #include "debug.h" 27abcb344bSKalle Valo #include "hif-ops.h" 28003353b0SKalle Valo #include "testmode.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 55f599359cSBala Shanmugam 56dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid { 57dd45b759SNaveen Singh struct cfg80211_ssid ssid; 58dd45b759SNaveen Singh u8 flag; 59dd45b759SNaveen Singh }; 60dd45b759SNaveen Singh 61bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 62bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 63bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 64bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 65bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 66bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 67bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 68bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 69bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 70bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 71bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 72bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 73bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 74bdcd8170SKalle Valo }; 75bdcd8170SKalle Valo 76bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 77bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 78bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 79bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 80bdcd8170SKalle Valo 81bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 82bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 83faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 84faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 85faaf1929SVasanthakumar Thiagarajan 86bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 87bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 88bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 89bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 90bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 91bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 92bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 93bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 94bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 95bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 96bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 97bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 98bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 99bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 100bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 101bdcd8170SKalle Valo }; 102bdcd8170SKalle Valo 103bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 104bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 105bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 106bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 107bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 108bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 109bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 110bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 111bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 112bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 113bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 114bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 115bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 116bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 117bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 118bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 119bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 120bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 121bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 122bdcd8170SKalle Valo CHAN5G(216, 0), 123bdcd8170SKalle Valo }; 124bdcd8170SKalle Valo 125bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 126bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 127bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 128bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 129bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 131faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 132bdcd8170SKalle Valo }; 133bdcd8170SKalle Valo 134bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 135bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 136bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 137bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 138bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 139bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 140faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 141bdcd8170SKalle Valo }; 142bdcd8170SKalle Valo 143837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 144837cb97eSJouni Malinen 14510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14710509f90SKalle Valo { 14810509f90SKalle Valo struct ath6kl *ar = vif->ar; 14910509f90SKalle Valo 15010509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 15110509f90SKalle Valo return false; 15210509f90SKalle Valo 15310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 15410509f90SKalle Valo 15510509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 15610509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 15710509f90SKalle Valo 15810509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 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 { 3046981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && 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: 37255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37355055976SVasanthakumar Thiagarajan break; 37455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37655055976SVasanthakumar Thiagarajan break; 37755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37955055976SVasanthakumar Thiagarajan break; 38055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 38155055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 38255055976SVasanthakumar Thiagarajan break; 38355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 38455055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 38555055976SVasanthakumar Thiagarajan break; 38655055976SVasanthakumar Thiagarajan default: 38755055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38855055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38955055976SVasanthakumar Thiagarajan } 39055055976SVasanthakumar Thiagarajan 39155055976SVasanthakumar Thiagarajan return 0; 39255055976SVasanthakumar Thiagarajan } 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 39555055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 39655055976SVasanthakumar Thiagarajan { 39755055976SVasanthakumar Thiagarajan int i; 39855055976SVasanthakumar Thiagarajan 39955055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 40055055976SVasanthakumar Thiagarajan return false; 40155055976SVasanthakumar Thiagarajan 40255055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 40355055976SVasanthakumar Thiagarajan ar->num_vif)) 40455055976SVasanthakumar Thiagarajan return false; 40555055976SVasanthakumar Thiagarajan 40655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 40755055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40871f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40955055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 41055055976SVasanthakumar Thiagarajan *if_idx = i; 41155055976SVasanthakumar Thiagarajan return true; 41255055976SVasanthakumar Thiagarajan } 41355055976SVasanthakumar Thiagarajan } 41455055976SVasanthakumar Thiagarajan } 41555055976SVasanthakumar Thiagarajan 4163226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4173226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41871f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4193226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4203226f68aSVasanthakumar Thiagarajan *if_idx = i; 4213226f68aSVasanthakumar Thiagarajan return true; 4223226f68aSVasanthakumar Thiagarajan } 4233226f68aSVasanthakumar Thiagarajan } 4243226f68aSVasanthakumar Thiagarajan } 4253226f68aSVasanthakumar Thiagarajan 42655055976SVasanthakumar Thiagarajan return false; 42755055976SVasanthakumar Thiagarajan } 42855055976SVasanthakumar Thiagarajan 4298c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4308c9bb054SKalle Valo { 4318c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4328c9bb054SKalle Valo } 4338c9bb054SKalle Valo 4348c9bb054SKalle Valo 435bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 436bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 437bdcd8170SKalle Valo { 438bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 440bdcd8170SKalle Valo int status; 4413ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 442ce0dc0cfSRaja Mani u16 interval; 443bdcd8170SKalle Valo 44410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 44510509f90SKalle Valo 44614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 447bdcd8170SKalle Valo 448990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 449bdcd8170SKalle Valo return -EIO; 450bdcd8170SKalle Valo 451bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 452bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 453bdcd8170SKalle Valo return -EBUSY; 454bdcd8170SKalle Valo } 455bdcd8170SKalle Valo 456bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 457bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 458bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 459bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 460bdcd8170SKalle Valo return -EINVAL; 461bdcd8170SKalle Valo } 462bdcd8170SKalle Valo 463bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 464bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 465bdcd8170SKalle Valo return -ERESTARTSYS; 466bdcd8170SKalle Valo } 467bdcd8170SKalle Valo 468bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 469bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 470bdcd8170SKalle Valo up(&ar->sem); 471bdcd8170SKalle Valo return -EBUSY; 472bdcd8170SKalle Valo } 473bdcd8170SKalle Valo 474bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 475bdcd8170SKalle Valo /* 476bdcd8170SKalle Valo * sleep until the command queue drains 477bdcd8170SKalle Valo */ 478bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4798c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 480bdcd8170SKalle Valo WMI_TIMEOUT); 481bdcd8170SKalle Valo if (signal_pending(current)) { 482bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 483bdcd8170SKalle Valo up(&ar->sem); 484bdcd8170SKalle Valo return -EINTR; 485bdcd8170SKalle Valo } 486bdcd8170SKalle Valo } 487bdcd8170SKalle Valo 488334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 489743b4518SDan Carpenter if (status) { 490743b4518SDan Carpenter up(&ar->sem); 4916981ffdcSKevin Fang return status; 492743b4518SDan Carpenter } 4936e786cb1SJouni Malinen 4946e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 495542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4966981ffdcSKevin Fang 49759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4983450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4993450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 500cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 501334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 502334234b5SVasanthakumar Thiagarajan vif->req_bssid, 503f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 504bdcd8170SKalle Valo 505bdcd8170SKalle Valo up(&ar->sem); 506bdcd8170SKalle Valo if (status) { 507bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 508bdcd8170SKalle Valo return -EIO; 509bdcd8170SKalle Valo } 510bdcd8170SKalle Valo return 0; 5113450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5123450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 513240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 514bdcd8170SKalle Valo } 515bdcd8170SKalle Valo 5163450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5173450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5183450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 519bdcd8170SKalle Valo 520bdcd8170SKalle Valo if (sme->channel) 521f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 522bdcd8170SKalle Valo 5238c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 524bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5258c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 526bdcd8170SKalle Valo 527240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 528bdcd8170SKalle Valo 529240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 530bdcd8170SKalle Valo if (status) { 531bdcd8170SKalle Valo up(&ar->sem); 532bdcd8170SKalle Valo return status; 533bdcd8170SKalle Valo } 534bdcd8170SKalle Valo 535bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 536240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 537bdcd8170SKalle Valo else 538240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 539bdcd8170SKalle Valo 540240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 541bdcd8170SKalle Valo 542bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 543240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 544bdcd8170SKalle Valo 545bdcd8170SKalle Valo if ((sme->key_len) && 5463450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5473450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 548bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 549bdcd8170SKalle Valo 550792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 551bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 552bdcd8170SKalle Valo sme->key_idx); 553bdcd8170SKalle Valo up(&ar->sem); 554bdcd8170SKalle Valo return -ENOENT; 555bdcd8170SKalle Valo } 556bdcd8170SKalle Valo 5576f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 558bdcd8170SKalle Valo key->key_len = sme->key_len; 559bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5603450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5613450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 562bdcd8170SKalle Valo 563334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5643450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 565bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 566bdcd8170SKalle Valo key->key_len, 567f4bb9a6fSJouni Malinen NULL, 0, 568bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 569bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 570bdcd8170SKalle Valo } 571bdcd8170SKalle Valo 572bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 57359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 574240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 575240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 576bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 577bdcd8170SKalle Valo up(&ar->sem); 578bdcd8170SKalle Valo return -EIO; 579bdcd8170SKalle Valo } 580bdcd8170SKalle Valo } 581bdcd8170SKalle Valo 582f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 583bdcd8170SKalle Valo 584c422d52dSThomas Pedersen /* enable enhanced bmiss detection if applicable */ 585c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, true); 586c422d52dSThomas Pedersen 5873ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5883ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5893ca9d1fcSAarthi Thiruvengadam 590bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 591bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 592bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 593bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 594bdcd8170SKalle Valo __func__, 5953450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5963450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 597f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 598bdcd8170SKalle Valo 599cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 600ce0dc0cfSRaja Mani 601ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 602b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 603b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 604ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 605ce0dc0cfSRaja Mani interval, 606ce0dc0cfSRaja Mani 0); 607ce0dc0cfSRaja Mani if (status) { 608ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 609ce0dc0cfSRaja Mani up(&ar->sem); 610ce0dc0cfSRaja Mani return status; 611ce0dc0cfSRaja Mani } 612ce0dc0cfSRaja Mani } 613ce0dc0cfSRaja Mani 614334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6153450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6163450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6173450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6183450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6193450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 620f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6213ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 622bdcd8170SKalle Valo 623f599359cSBala Shanmugam /* disable background scan if period is 0 */ 624f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 625f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 626f599359cSBala Shanmugam 627f599359cSBala Shanmugam /* configure default value if not specified */ 628f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 629f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 630f599359cSBala Shanmugam 631f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 632f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 633f599359cSBala Shanmugam 634bdcd8170SKalle Valo up(&ar->sem); 635bdcd8170SKalle Valo 636bdcd8170SKalle Valo if (status == -EINVAL) { 6373450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6383450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 639bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 640bdcd8170SKalle Valo return -ENOENT; 641bdcd8170SKalle Valo } else if (status) { 642bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 643bdcd8170SKalle Valo return -EIO; 644bdcd8170SKalle Valo } 645bdcd8170SKalle Valo 646bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 647ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 648ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 649de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 650bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 651bdcd8170SKalle Valo } 652bdcd8170SKalle Valo 653bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 65459c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 655bdcd8170SKalle Valo 656bdcd8170SKalle Valo return 0; 657bdcd8170SKalle Valo } 658bdcd8170SKalle Valo 6595e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6605e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6614eab6f4fSRaja Mani enum network_type nw_type, 6624eab6f4fSRaja Mani const u8 *bssid, 66301cac476SJouni Malinen struct ieee80211_channel *chan, 6645e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6655e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 66601cac476SJouni Malinen { 667240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 66801cac476SJouni Malinen struct cfg80211_bss *bss; 6694eab6f4fSRaja Mani u16 cap_mask, cap_val; 67001cac476SJouni Malinen u8 *ie; 67101cac476SJouni Malinen 6724eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6734eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6744eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6754eab6f4fSRaja Mani } else { 6764eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6774eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6784eab6f4fSRaja Mani } 6794eab6f4fSRaja Mani 680be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6814eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6824eab6f4fSRaja Mani cap_mask, cap_val); 68301cac476SJouni Malinen if (bss == NULL) { 68401cac476SJouni Malinen /* 68501cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 68601cac476SJouni Malinen * generate a partial entry until the first BSS info 68701cac476SJouni Malinen * event becomes available. 68801cac476SJouni Malinen * 68901cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 69001cac476SJouni Malinen * IEs from the target. 69101cac476SJouni Malinen */ 6923450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 69301cac476SJouni Malinen if (ie == NULL) 6945e13fd35SVasanthakumar Thiagarajan return NULL; 69501cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6963450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6973450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6983450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 699be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 7004eab6f4fSRaja Mani bssid, 0, cap_val, 100, 7013450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 70201cac476SJouni Malinen 0, GFP_KERNEL); 70301cac476SJouni Malinen if (bss) 704cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 705cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 70601cac476SJouni Malinen kfree(ie); 70701cac476SJouni Malinen } else 7085e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 70901cac476SJouni Malinen 7105e13fd35SVasanthakumar Thiagarajan return bss; 71101cac476SJouni Malinen } 71201cac476SJouni Malinen 713240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 714bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 715bdcd8170SKalle Valo u16 beacon_intvl, 716bdcd8170SKalle Valo enum network_type nw_type, 717bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 718bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 719bdcd8170SKalle Valo { 72001cac476SJouni Malinen struct ieee80211_channel *chan; 721240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7225e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 723bdcd8170SKalle Valo 724bdcd8170SKalle Valo /* capinfo + listen interval */ 725bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 726bdcd8170SKalle Valo 727bdcd8170SKalle Valo /* capinfo + status code + associd */ 728bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 729bdcd8170SKalle Valo 730bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 731bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 732bdcd8170SKalle Valo assoc_resp_ie_offset; 733bdcd8170SKalle Valo 734bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 735bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 736bdcd8170SKalle Valo 73732c10874SJouni Malinen /* 73832c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 73932c10874SJouni Malinen * a Beacon frame from the AP is seen. 74032c10874SJouni Malinen */ 741cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 74259c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 74332c10874SJouni Malinen 744bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 745551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 746bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 747bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 748bdcd8170SKalle Valo return; 749bdcd8170SKalle Valo } 750bdcd8170SKalle Valo } 751bdcd8170SKalle Valo 752bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 753551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 754551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 755bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 756bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 757bdcd8170SKalle Valo return; 758bdcd8170SKalle Valo } 759bdcd8170SKalle Valo } 760bdcd8170SKalle Valo 761be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 762bdcd8170SKalle Valo 7635e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7645e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7655e13fd35SVasanthakumar Thiagarajan if (!bss) { 7664eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 767bdcd8170SKalle Valo return; 768bdcd8170SKalle Valo } 769bdcd8170SKalle Valo 7704eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7714eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7724eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7734eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7745e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77501cac476SJouni Malinen return; 77601cac476SJouni Malinen } 77701cac476SJouni Malinen 77814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 779bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 78014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 781240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 782bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 783bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 784bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7855e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 78614ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 787bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7885e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 789bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 790bdcd8170SKalle Valo } 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo 793bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 794bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 795bdcd8170SKalle Valo { 796d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7973450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 798bdcd8170SKalle Valo 799bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 800bdcd8170SKalle Valo reason_code); 801bdcd8170SKalle Valo 80210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 80310509f90SKalle Valo 804990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 805bdcd8170SKalle Valo return -EIO; 806bdcd8170SKalle Valo 807bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 808bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 809bdcd8170SKalle Valo return -EBUSY; 810bdcd8170SKalle Valo } 811bdcd8170SKalle Valo 812bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 813bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 814bdcd8170SKalle Valo return -ERESTARTSYS; 815bdcd8170SKalle Valo } 816bdcd8170SKalle Valo 817cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 818240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8193450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8203450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 821bdcd8170SKalle Valo 822bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8238c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 824bdcd8170SKalle Valo 825bdcd8170SKalle Valo up(&ar->sem); 826bdcd8170SKalle Valo 82714ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 828170826ddSVasanthakumar Thiagarajan 829bdcd8170SKalle Valo return 0; 830bdcd8170SKalle Valo } 831bdcd8170SKalle Valo 832240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 833bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 834bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 835bdcd8170SKalle Valo { 836240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 83759c98449SVasanthakumar Thiagarajan 83814ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 83914ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 84014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 841bdcd8170SKalle Valo } 842bdcd8170SKalle Valo 843f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 844551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 845bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 846bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 847bdcd8170SKalle Valo return; 848bdcd8170SKalle Valo } 849bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 850240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 851bdcd8170SKalle Valo return; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo 854f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 855551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 856551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 857bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 858bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 859bdcd8170SKalle Valo return; 860bdcd8170SKalle Valo } 861bdcd8170SKalle Valo } 862bdcd8170SKalle Valo 8631de547d6SVasanthakumar Thiagarajan /* 8641de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8651de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8661de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8671de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8681de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8691de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8701de547d6SVasanthakumar Thiagarajan */ 871bdcd8170SKalle Valo 8721de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 873334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 874bdcd8170SKalle Valo return; 875bdcd8170SKalle Valo } 876bdcd8170SKalle Valo 87759c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 878bdcd8170SKalle Valo 87914ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 880240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 881bdcd8170SKalle Valo bssid, NULL, 0, 882bdcd8170SKalle Valo NULL, 0, 883bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 884bdcd8170SKalle Valo GFP_KERNEL); 88514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 886240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 887bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 888bdcd8170SKalle Valo } 889bdcd8170SKalle Valo 89014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 891bdcd8170SKalle Valo } 892bdcd8170SKalle Valo 8933b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 8943b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 895dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 896dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 897dd45b759SNaveen Singh int n_match_ssid) 8983b8ffc6aSJouni Malinen { 899dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 900dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 9013b8ffc6aSJouni Malinen 902dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 903dd45b759SNaveen Singh 904dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 905dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 9063b8ffc6aSJouni Malinen return -EINVAL; 9073b8ffc6aSJouni Malinen 9083b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 909dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 910dd45b759SNaveen Singh ssids[i].ssid, 911dd45b759SNaveen Singh ssids[i].ssid_len); 912dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 913dd45b759SNaveen Singh 914dd45b759SNaveen Singh if (ssids[i].ssid_len) 915dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 916dd45b759SNaveen Singh else 917dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 918dd45b759SNaveen Singh 919dd45b759SNaveen Singh if (n_match_ssid == 0) 920dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 921dd45b759SNaveen Singh } 922dd45b759SNaveen Singh 923dd45b759SNaveen Singh index_to_add = i; 924dd45b759SNaveen Singh 925dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 926dd45b759SNaveen Singh ssid_found = false; 927dd45b759SNaveen Singh 928dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 929dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 930dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 931dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 932dd45b759SNaveen Singh match_set[i].ssid.ssid, 933dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 934dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 935dd45b759SNaveen Singh ssid_found = true; 936dd45b759SNaveen Singh break; 937dd45b759SNaveen Singh } 938dd45b759SNaveen Singh } 939dd45b759SNaveen Singh 940dd45b759SNaveen Singh if (ssid_found) 941dd45b759SNaveen Singh continue; 942dd45b759SNaveen Singh 943dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 944dd45b759SNaveen Singh continue; 945dd45b759SNaveen Singh 946dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 947dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 948dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 949dd45b759SNaveen Singh match_set[i].ssid.ssid, 950dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 951dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 952dd45b759SNaveen Singh index_to_add++; 953dd45b759SNaveen Singh } 954dd45b759SNaveen Singh 955dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9563b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 957dd45b759SNaveen Singh ssid_list[i].flag, 958dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 959dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 960dd45b759SNaveen Singh 9613b8ffc6aSJouni Malinen } 9623b8ffc6aSJouni Malinen 9633b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 964dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9653b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9663b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9673b8ffc6aSJouni Malinen } 9683b8ffc6aSJouni Malinen 9693b8ffc6aSJouni Malinen return 0; 9703b8ffc6aSJouni Malinen } 9713b8ffc6aSJouni Malinen 972bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 973bdcd8170SKalle Valo struct cfg80211_scan_request *request) 974bdcd8170SKalle Valo { 975d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 97659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 9771276c9efSEdward Lu s8 n_channels = 0; 9781276c9efSEdward Lu u16 *channels = NULL; 979bdcd8170SKalle Valo int ret = 0; 980f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 981bdcd8170SKalle Valo 982990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 983bdcd8170SKalle Valo return -EIO; 984bdcd8170SKalle Valo 98510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 98610509f90SKalle Valo 987bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 98859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 989954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 990954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 9911b1e6ee3SJouni Malinen if (ret) { 992bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9931b1e6ee3SJouni Malinen return ret; 994bdcd8170SKalle Valo } 995bdcd8170SKalle Valo } 996bdcd8170SKalle Valo 9973b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 998dd45b759SNaveen Singh request->n_ssids, NULL, 0); 9993b8ffc6aSJouni Malinen if (ret < 0) 10003b8ffc6aSJouni Malinen return ret; 1001bdcd8170SKalle Valo 1002080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 1003334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1004334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 1005b84da8c7SJouni Malinen request->ie, request->ie_len); 1006b84da8c7SJouni Malinen if (ret) { 1007cdeb8602SKalle Valo ath6kl_err("failed to set Probe Request appie for scan"); 1008b84da8c7SJouni Malinen return ret; 1009b84da8c7SJouni Malinen } 1010b84da8c7SJouni Malinen 101111869befSJouni Malinen /* 101211869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 101311869befSJouni Malinen * channels. If the list is longer than the target supports, do not 101411869befSJouni Malinen * configure the list and instead, scan all available channels. 101511869befSJouni Malinen */ 101611869befSJouni Malinen if (request->n_channels > 0 && 101711869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10181276c9efSEdward Lu u8 i; 10191276c9efSEdward Lu 102011869befSJouni Malinen n_channels = request->n_channels; 10211276c9efSEdward Lu 10221276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 10231276c9efSEdward Lu if (channels == NULL) { 1024cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10251276c9efSEdward Lu n_channels = 0; 10261276c9efSEdward Lu } 10271276c9efSEdward Lu 10281276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10291276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10301276c9efSEdward Lu } 10311276c9efSEdward Lu 103259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1033f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1034f1f92179SVasanthakumar Thiagarajan 10355b35dff0SRaja Mani vif->scan_req = request; 10365b35dff0SRaja Mani 10373ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 10383ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 10393ca9d1fcSAarthi Thiruvengadam /* 10403ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 10413ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 10423ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 10433ca9d1fcSAarthi Thiruvengadam * probe requests 10443ca9d1fcSAarthi Thiruvengadam */ 10453ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10463ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 104713423c31SVasanthakumar Thiagarajan false, 0, 104813423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 104913423c31SVasanthakumar Thiagarajan n_channels, channels, 105013423c31SVasanthakumar Thiagarajan request->no_cck, 10513ca9d1fcSAarthi Thiruvengadam request->rates); 10523ca9d1fcSAarthi Thiruvengadam } else { 10533ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 10543ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 105513423c31SVasanthakumar Thiagarajan false, 0, 105613423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 105713423c31SVasanthakumar Thiagarajan n_channels, channels); 10583ca9d1fcSAarthi Thiruvengadam } 10595b35dff0SRaja Mani if (ret) { 1060bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 10615b35dff0SRaja Mani vif->scan_req = NULL; 10625b35dff0SRaja Mani } 1063bdcd8170SKalle Valo 10641276c9efSEdward Lu kfree(channels); 10651276c9efSEdward Lu 1066bdcd8170SKalle Valo return ret; 1067bdcd8170SKalle Valo } 1068bdcd8170SKalle Valo 10691c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1070bdcd8170SKalle Valo { 1071240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10726fd1eaceSKalle Valo int i; 1073bdcd8170SKalle Valo 10741c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10751c17d313SKalle Valo aborted ? " aborted" : ""); 1076bdcd8170SKalle Valo 107714ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10786fd1eaceSKalle Valo return; 10796fd1eaceSKalle Valo 10801c17d313SKalle Valo if (aborted) 10816fd1eaceSKalle Valo goto out; 1082bdcd8170SKalle Valo 108314ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 108414ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1085334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1086334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1087bdcd8170SKalle Valo 0, NULL); 1088bdcd8170SKalle Valo } 1089bdcd8170SKalle Valo } 10906fd1eaceSKalle Valo 10916fd1eaceSKalle Valo out: 1092cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 109314ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1094bdcd8170SKalle Valo } 1095bdcd8170SKalle Valo 1096c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1097c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1098c4f7863eSThomas Pedersen { 1099c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1100c4f7863eSThomas Pedersen 1101c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1102c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1103c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1104c4f7863eSThomas Pedersen 1105c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1106c4f7863eSThomas Pedersen 1107c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1108c4f7863eSThomas Pedersen } 1109c4f7863eSThomas Pedersen 1110bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1111bdcd8170SKalle Valo u8 key_index, bool pairwise, 1112bdcd8170SKalle Valo const u8 *mac_addr, 1113bdcd8170SKalle Valo struct key_params *params) 1114bdcd8170SKalle Valo { 1115d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 111659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1117bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 11184a8ce2fdSSujith Manoharan int seq_len; 1119bdcd8170SKalle Valo u8 key_usage; 1120bdcd8170SKalle Valo u8 key_type; 1121bdcd8170SKalle Valo 1122990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1123bdcd8170SKalle Valo return -EIO; 1124bdcd8170SKalle Valo 1125837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1126837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1127837cb97eSJouni Malinen return -EINVAL; 1128240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1129240d2799SVasanthakumar Thiagarajan params->key); 1130837cb97eSJouni Malinen } 1131837cb97eSJouni Malinen 1132792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1133bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1134bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1135bdcd8170SKalle Valo key_index); 1136bdcd8170SKalle Valo return -ENOENT; 1137bdcd8170SKalle Valo } 1138bdcd8170SKalle Valo 11396f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1140bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1141bdcd8170SKalle Valo 1142bdcd8170SKalle Valo if (pairwise) 1143bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1144bdcd8170SKalle Valo else 1145bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1146bdcd8170SKalle Valo 11474a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11485e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11495e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11505e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11515e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11525e07021eSDai Shuibing } 1153bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11545e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1155bdcd8170SKalle Valo return -EINVAL; 1156bdcd8170SKalle Valo 1157bdcd8170SKalle Valo key->key_len = params->key_len; 1158bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11595e07021eSDai Shuibing key->seq_len = seq_len; 1160bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1161bdcd8170SKalle Valo key->cipher = params->cipher; 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo switch (key->cipher) { 1164bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1165bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1166bdcd8170SKalle Valo key_type = WEP_CRYPT; 1167bdcd8170SKalle Valo break; 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1170bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1171bdcd8170SKalle Valo break; 1172bdcd8170SKalle Valo 1173bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1174bdcd8170SKalle Valo key_type = AES_CRYPT; 1175bdcd8170SKalle Valo break; 11765e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11775e07021eSDai Shuibing key_type = WAPI_CRYPT; 11785e07021eSDai Shuibing break; 1179bdcd8170SKalle Valo 1180bdcd8170SKalle Valo default: 1181bdcd8170SKalle Valo return -ENOTSUPP; 1182bdcd8170SKalle Valo } 1183bdcd8170SKalle Valo 1184ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1185ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1186ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1187de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1190bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1191bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1192bdcd8170SKalle Valo key_usage, key->seq_len); 1193bdcd8170SKalle Valo 1194f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11954703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1196cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11979a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11989a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11999a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 12009a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 12019a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 120259c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1203cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1204cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 12059a5b1318SJouni Malinen /* 12069a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 12079a5b1318SJouni Malinen * the connected event is received from the target. 12089a5b1318SJouni Malinen */ 12099a5b1318SJouni Malinen return 0; 12109a5b1318SJouni Malinen } 12119a5b1318SJouni Malinen } 12129a5b1318SJouni Malinen 1213f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 121459c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1215151411e8SJouni Malinen /* 1216151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1217151411e8SJouni Malinen * the AP mode has properly started 1218151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1219151411e8SJouni Malinen */ 1220cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1221cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 12226f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 12236f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 12246f2a73f9SVasanthakumar Thiagarajan key->key_len); 1225151411e8SJouni Malinen return 0; 1226151411e8SJouni Malinen } 1227151411e8SJouni Malinen 12287cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1229bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1230f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1231f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1232bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1233bdcd8170SKalle Valo } 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1236bdcd8170SKalle Valo u8 key_index, bool pairwise, 1237bdcd8170SKalle Valo const u8 *mac_addr) 1238bdcd8170SKalle Valo { 1239d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12406f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1241bdcd8170SKalle Valo 1242bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1243bdcd8170SKalle Valo 1244990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1245bdcd8170SKalle Valo return -EIO; 1246bdcd8170SKalle Valo 1247792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1248bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1249bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1250bdcd8170SKalle Valo key_index); 1251bdcd8170SKalle Valo return -ENOENT; 1252bdcd8170SKalle Valo } 1253bdcd8170SKalle Valo 12546f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1255bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1256bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1257bdcd8170SKalle Valo return 0; 1258bdcd8170SKalle Valo } 1259bdcd8170SKalle Valo 12606f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1261bdcd8170SKalle Valo 1262334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1263bdcd8170SKalle Valo } 1264bdcd8170SKalle Valo 1265bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1266bdcd8170SKalle Valo u8 key_index, bool pairwise, 1267bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1268bdcd8170SKalle Valo void (*callback) (void *cookie, 1269bdcd8170SKalle Valo struct key_params *)) 1270bdcd8170SKalle Valo { 12716f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1272bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1273bdcd8170SKalle Valo struct key_params params; 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1276bdcd8170SKalle Valo 1277990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1278bdcd8170SKalle Valo return -EIO; 1279bdcd8170SKalle Valo 1280792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1281bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1282bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1283bdcd8170SKalle Valo key_index); 1284bdcd8170SKalle Valo return -ENOENT; 1285bdcd8170SKalle Valo } 1286bdcd8170SKalle Valo 12876f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1288bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1289bdcd8170SKalle Valo params.cipher = key->cipher; 1290bdcd8170SKalle Valo params.key_len = key->key_len; 1291bdcd8170SKalle Valo params.seq_len = key->seq_len; 1292bdcd8170SKalle Valo params.seq = key->seq; 1293bdcd8170SKalle Valo params.key = key->key; 1294bdcd8170SKalle Valo 1295bdcd8170SKalle Valo callback(cookie, ¶ms); 1296bdcd8170SKalle Valo 1297bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1298bdcd8170SKalle Valo } 1299bdcd8170SKalle Valo 1300bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1301bdcd8170SKalle Valo struct net_device *ndev, 1302bdcd8170SKalle Valo u8 key_index, bool unicast, 1303bdcd8170SKalle Valo bool multicast) 1304bdcd8170SKalle Valo { 1305d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 130659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1307bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1308bdcd8170SKalle Valo u8 key_usage; 1309229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1310bdcd8170SKalle Valo 1311bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1312bdcd8170SKalle Valo 1313990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1314bdcd8170SKalle Valo return -EIO; 1315bdcd8170SKalle Valo 1316792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1317bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1318bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1319bdcd8170SKalle Valo __func__, key_index); 1320bdcd8170SKalle Valo return -ENOENT; 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo 13236f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1324bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1325bdcd8170SKalle Valo __func__, key_index); 1326bdcd8170SKalle Valo return -EINVAL; 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo 13293450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13306f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1331bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13323450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1333bdcd8170SKalle Valo key_usage |= TX_USAGE; 1334229ed6b5SEdward Lu if (unicast) 13353450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1336229ed6b5SEdward Lu if (multicast) 13373450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1338bdcd8170SKalle Valo 1339f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13409a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13419a5b1318SJouni Malinen 1342f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1343334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1344229ed6b5SEdward Lu key_type, key_usage, 1345f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1346f4bb9a6fSJouni Malinen key->key, 1347bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1348bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1349bdcd8170SKalle Valo } 1350bdcd8170SKalle Valo 1351240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1352bdcd8170SKalle Valo bool ismcast) 1353bdcd8170SKalle Valo { 1354bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1355bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1356bdcd8170SKalle Valo 1357240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1358bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1359bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1360bdcd8170SKalle Valo GFP_KERNEL); 1361bdcd8170SKalle Valo } 1362bdcd8170SKalle Valo 1363bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1364bdcd8170SKalle Valo { 1365bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1366990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1367bdcd8170SKalle Valo int ret; 1368bdcd8170SKalle Valo 1369bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1370bdcd8170SKalle Valo changed); 1371bdcd8170SKalle Valo 1372990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1373990bd915SVasanthakumar Thiagarajan if (!vif) 1374990bd915SVasanthakumar Thiagarajan return -EIO; 1375990bd915SVasanthakumar Thiagarajan 1376990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1377bdcd8170SKalle Valo return -EIO; 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1380bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1381bdcd8170SKalle Valo if (ret != 0) { 1382bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo } 1385bdcd8170SKalle Valo } 1386bdcd8170SKalle Valo 1387bdcd8170SKalle Valo return 0; 1388bdcd8170SKalle Valo } 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo /* 1391bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1392bdcd8170SKalle Valo * data type from 2.6.36 onwards 1393bdcd8170SKalle Valo */ 1394bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1395bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1396b992a285SLuis R. Rodriguez int mbm) 1397bdcd8170SKalle Valo { 1398bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1399990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1400b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1401bdcd8170SKalle Valo 1402bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1403bdcd8170SKalle Valo type, dbm); 1404bdcd8170SKalle Valo 1405990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1406990bd915SVasanthakumar Thiagarajan if (!vif) 1407990bd915SVasanthakumar Thiagarajan return -EIO; 1408990bd915SVasanthakumar Thiagarajan 1409990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1410bdcd8170SKalle Valo return -EIO; 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo switch (type) { 1413bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1414bdcd8170SKalle Valo return 0; 1415bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1416d0d670abSKalle Valo ar->tx_pwr = dbm; 1417bdcd8170SKalle Valo break; 1418bdcd8170SKalle Valo default: 1419bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1420bdcd8170SKalle Valo __func__, type); 1421bdcd8170SKalle Valo return -EOPNOTSUPP; 1422bdcd8170SKalle Valo } 1423bdcd8170SKalle Valo 1424d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1425bdcd8170SKalle Valo 1426bdcd8170SKalle Valo return 0; 1427bdcd8170SKalle Valo } 1428bdcd8170SKalle Valo 1429bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1430bdcd8170SKalle Valo { 1431bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1432990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1433bdcd8170SKalle Valo 1434990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1435990bd915SVasanthakumar Thiagarajan if (!vif) 1436990bd915SVasanthakumar Thiagarajan return -EIO; 1437990bd915SVasanthakumar Thiagarajan 1438990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1439bdcd8170SKalle Valo return -EIO; 1440bdcd8170SKalle Valo 144159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1442bdcd8170SKalle Valo ar->tx_pwr = 0; 1443bdcd8170SKalle Valo 1444990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1445bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1446bdcd8170SKalle Valo return -EIO; 1447bdcd8170SKalle Valo } 1448bdcd8170SKalle Valo 1449bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1450bdcd8170SKalle Valo 5 * HZ); 1451bdcd8170SKalle Valo 1452bdcd8170SKalle Valo if (signal_pending(current)) { 1453bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1454bdcd8170SKalle Valo return -EINTR; 1455bdcd8170SKalle Valo } 1456bdcd8170SKalle Valo } 1457bdcd8170SKalle Valo 1458bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1459bdcd8170SKalle Valo return 0; 1460bdcd8170SKalle Valo } 1461bdcd8170SKalle Valo 1462bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1463bdcd8170SKalle Valo struct net_device *dev, 1464bdcd8170SKalle Valo bool pmgmt, int timeout) 1465bdcd8170SKalle Valo { 1466bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1467bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1468334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1469bdcd8170SKalle Valo 1470bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1471bdcd8170SKalle Valo __func__, pmgmt, timeout); 1472bdcd8170SKalle Valo 1473990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1474bdcd8170SKalle Valo return -EIO; 1475bdcd8170SKalle Valo 1476bdcd8170SKalle Valo if (pmgmt) { 1477bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1478bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1479bdcd8170SKalle Valo } else { 1480bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1481bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1482bdcd8170SKalle Valo } 1483bdcd8170SKalle Valo 1484334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1485334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1486bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1487bdcd8170SKalle Valo return -EIO; 1488bdcd8170SKalle Valo } 1489bdcd8170SKalle Valo 1490bdcd8170SKalle Valo return 0; 1491bdcd8170SKalle Valo } 1492bdcd8170SKalle Valo 149355055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 149455055976SVasanthakumar Thiagarajan char *name, 149555055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 149655055976SVasanthakumar Thiagarajan u32 *flags, 149755055976SVasanthakumar Thiagarajan struct vif_params *params) 149855055976SVasanthakumar Thiagarajan { 149955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 150055055976SVasanthakumar Thiagarajan struct net_device *ndev; 150155055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 150255055976SVasanthakumar Thiagarajan 150371f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 150455055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 150555055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 150655055976SVasanthakumar Thiagarajan } 150755055976SVasanthakumar Thiagarajan 150855055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 150955055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 151055055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 151155055976SVasanthakumar Thiagarajan } 151255055976SVasanthakumar Thiagarajan 151355055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 151455055976SVasanthakumar Thiagarajan if (!ndev) 151555055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 151655055976SVasanthakumar Thiagarajan 151755055976SVasanthakumar Thiagarajan ar->num_vif++; 151855055976SVasanthakumar Thiagarajan 151955055976SVasanthakumar Thiagarajan return ndev; 152055055976SVasanthakumar Thiagarajan } 152155055976SVasanthakumar Thiagarajan 152255055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 152355055976SVasanthakumar Thiagarajan struct net_device *ndev) 152455055976SVasanthakumar Thiagarajan { 152555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 152655055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 152755055976SVasanthakumar Thiagarajan 152811f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 152955055976SVasanthakumar Thiagarajan list_del(&vif->list); 153011f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 153155055976SVasanthakumar Thiagarajan 153255055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 153355055976SVasanthakumar Thiagarajan 1534c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 153555055976SVasanthakumar Thiagarajan 153655055976SVasanthakumar Thiagarajan return 0; 153755055976SVasanthakumar Thiagarajan } 153855055976SVasanthakumar Thiagarajan 1539bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1540bdcd8170SKalle Valo struct net_device *ndev, 1541bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1542bdcd8170SKalle Valo struct vif_params *params) 1543bdcd8170SKalle Valo { 1544f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15451e8d13b0SVasanthakumar Thiagarajan int i; 1546bdcd8170SKalle Valo 1547bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1548bdcd8170SKalle Valo 15491e8d13b0SVasanthakumar Thiagarajan /* 15501e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15511e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15521e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15531e8d13b0SVasanthakumar Thiagarajan */ 15541e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15551e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15561e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15571e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15581e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15591e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15601e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15611e8d13b0SVasanthakumar Thiagarajan else 15621e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15631e8d13b0SVasanthakumar Thiagarajan } 15641e8d13b0SVasanthakumar Thiagarajan 15651e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15661e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15671e8d13b0SVasanthakumar Thiagarajan break; 15681e8d13b0SVasanthakumar Thiagarajan } 15691e8d13b0SVasanthakumar Thiagarajan 15701e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15711e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15721e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15731e8d13b0SVasanthakumar Thiagarajan } 15741e8d13b0SVasanthakumar Thiagarajan } 15751e8d13b0SVasanthakumar Thiagarajan 1576c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1577c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1578c422d52dSThomas Pedersen 15791e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1580bdcd8170SKalle Valo switch (type) { 1581bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1582f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1583bdcd8170SKalle Valo break; 1584bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1585f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1586bdcd8170SKalle Valo break; 15876e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1588f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15896e4604c8SJouni Malinen break; 15906b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1591f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15926b5e5d25SJouni Malinen break; 15936b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1594f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15956b5e5d25SJouni Malinen break; 1596bdcd8170SKalle Valo default: 1597bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1598bdcd8170SKalle Valo return -EOPNOTSUPP; 1599bdcd8170SKalle Valo } 1600bdcd8170SKalle Valo 1601551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1602bdcd8170SKalle Valo 1603bdcd8170SKalle Valo return 0; 1604bdcd8170SKalle Valo } 1605bdcd8170SKalle Valo 1606bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1607bdcd8170SKalle Valo struct net_device *dev, 1608bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1609bdcd8170SKalle Valo { 1610bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 161159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1612bdcd8170SKalle Valo int status; 1613bdcd8170SKalle Valo 1614990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1615bdcd8170SKalle Valo return -EIO; 1616bdcd8170SKalle Valo 16173450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 16183450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1619bdcd8170SKalle Valo 1620bdcd8170SKalle Valo if (ibss_param->channel) 1621f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1622bdcd8170SKalle Valo 1623bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1624bdcd8170SKalle Valo /* 1625bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1626bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1627bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1628bdcd8170SKalle Valo * updated. 1629bdcd8170SKalle Valo */ 1630bdcd8170SKalle Valo return -EOPNOTSUPP; 1631bdcd8170SKalle Valo } 1632bdcd8170SKalle Valo 16338c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1634bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16358c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16368c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1637bdcd8170SKalle Valo 1638240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1639bdcd8170SKalle Valo 1640240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1641bdcd8170SKalle Valo if (status) 1642bdcd8170SKalle Valo return status; 1643bdcd8170SKalle Valo 1644bdcd8170SKalle Valo if (ibss_param->privacy) { 1645240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1646240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1647bdcd8170SKalle Valo } else { 1648240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1649240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1650bdcd8170SKalle Valo } 1651bdcd8170SKalle Valo 1652f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1653bdcd8170SKalle Valo 1654bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1655bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1656bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1657bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1658bdcd8170SKalle Valo __func__, 16593450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16603450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1661f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1662bdcd8170SKalle Valo 1663334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16643450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16653450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16663450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16673450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16683450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1669f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16703ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 167159c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1672bdcd8170SKalle Valo 1673bdcd8170SKalle Valo return 0; 1674bdcd8170SKalle Valo } 1675bdcd8170SKalle Valo 1676bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1677bdcd8170SKalle Valo struct net_device *dev) 1678bdcd8170SKalle Valo { 16793450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1680bdcd8170SKalle Valo 1681990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1682bdcd8170SKalle Valo return -EIO; 1683bdcd8170SKalle Valo 1684240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16853450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16863450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1687bdcd8170SKalle Valo 1688bdcd8170SKalle Valo return 0; 1689bdcd8170SKalle Valo } 1690bdcd8170SKalle Valo 1691bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1692bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1693bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1694bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1695bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1696837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16975e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1698bdcd8170SKalle Valo }; 1699bdcd8170SKalle Valo 1700bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1701bdcd8170SKalle Valo { 1702bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1703bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1704bdcd8170SKalle Valo 36000, 48000, 54000 1705bdcd8170SKalle Valo }; 1706bdcd8170SKalle Valo u8 i; 1707bdcd8170SKalle Valo 1708bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1709bdcd8170SKalle Valo if (rate == legacy[i]) 1710bdcd8170SKalle Valo return true; 1711bdcd8170SKalle Valo 1712bdcd8170SKalle Valo return false; 1713bdcd8170SKalle Valo } 1714bdcd8170SKalle Valo 1715bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1716bdcd8170SKalle Valo { 1717bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1718bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1719bdcd8170SKalle Valo }; 1720bdcd8170SKalle Valo u8 i; 1721bdcd8170SKalle Valo 1722bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1723bdcd8170SKalle Valo if (rate == ht20[i]) { 1724bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1725bdcd8170SKalle Valo /* last rate uses sgi */ 1726bdcd8170SKalle Valo *sgi = true; 1727bdcd8170SKalle Valo else 1728bdcd8170SKalle Valo *sgi = false; 1729bdcd8170SKalle Valo 1730bdcd8170SKalle Valo *mcs = i; 1731bdcd8170SKalle Valo return true; 1732bdcd8170SKalle Valo } 1733bdcd8170SKalle Valo } 1734bdcd8170SKalle Valo return false; 1735bdcd8170SKalle Valo } 1736bdcd8170SKalle Valo 1737bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1738bdcd8170SKalle Valo { 1739bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1740bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1741bdcd8170SKalle Valo 150000 1742bdcd8170SKalle Valo }; 1743bdcd8170SKalle Valo u8 i; 1744bdcd8170SKalle Valo 1745bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1746bdcd8170SKalle Valo if (rate == ht40[i]) { 1747bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1748bdcd8170SKalle Valo /* last rate uses sgi */ 1749bdcd8170SKalle Valo *sgi = true; 1750bdcd8170SKalle Valo else 1751bdcd8170SKalle Valo *sgi = false; 1752bdcd8170SKalle Valo 1753bdcd8170SKalle Valo *mcs = i; 1754bdcd8170SKalle Valo return true; 1755bdcd8170SKalle Valo } 1756bdcd8170SKalle Valo } 1757bdcd8170SKalle Valo 1758bdcd8170SKalle Valo return false; 1759bdcd8170SKalle Valo } 1760bdcd8170SKalle Valo 1761bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1762bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1763bdcd8170SKalle Valo { 1764bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 176559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1766bdcd8170SKalle Valo long left; 1767bdcd8170SKalle Valo bool sgi; 1768bdcd8170SKalle Valo s32 rate; 1769bdcd8170SKalle Valo int ret; 1770bdcd8170SKalle Valo u8 mcs; 1771bdcd8170SKalle Valo 17728c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1773bdcd8170SKalle Valo return -ENOENT; 1774bdcd8170SKalle Valo 1775bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1776bdcd8170SKalle Valo return -EBUSY; 1777bdcd8170SKalle Valo 1778b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1779bdcd8170SKalle Valo 1780334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1781bdcd8170SKalle Valo 1782bdcd8170SKalle Valo if (ret != 0) { 1783bdcd8170SKalle Valo up(&ar->sem); 1784bdcd8170SKalle Valo return -EIO; 1785bdcd8170SKalle Valo } 1786bdcd8170SKalle Valo 1787bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1788bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1789b95907a7SVasanthakumar Thiagarajan &vif->flags), 1790bdcd8170SKalle Valo WMI_TIMEOUT); 1791bdcd8170SKalle Valo 1792bdcd8170SKalle Valo up(&ar->sem); 1793bdcd8170SKalle Valo 1794bdcd8170SKalle Valo if (left == 0) 1795bdcd8170SKalle Valo return -ETIMEDOUT; 1796bdcd8170SKalle Valo else if (left < 0) 1797bdcd8170SKalle Valo return left; 1798bdcd8170SKalle Valo 1799b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1800b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1801bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1802b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1803bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1804bdcd8170SKalle Valo } 1805bdcd8170SKalle Valo 1806b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1807b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1808bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1809b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1810bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1811bdcd8170SKalle Valo } 1812bdcd8170SKalle Valo 1813b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1814bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1815bdcd8170SKalle Valo 1816b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1817bdcd8170SKalle Valo 1818bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1819bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1820bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1821bdcd8170SKalle Valo if (sgi) { 1822bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1823bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1824bdcd8170SKalle Valo } else { 1825bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1826bdcd8170SKalle Valo } 1827bdcd8170SKalle Valo 1828bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1829bdcd8170SKalle Valo } else if (is_rate_ht40(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_40_MHZ_WIDTH; 1838bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1839bdcd8170SKalle Valo } else { 18409a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18419a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18429a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1843bdcd8170SKalle Valo return 0; 1844bdcd8170SKalle Valo } 1845bdcd8170SKalle Valo 1846bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1847bdcd8170SKalle Valo 184859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 184959c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1850f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 185132c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 185232c10874SJouni Malinen sinfo->bss_param.flags = 0; 1853cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1854cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 185532c10874SJouni Malinen } 185632c10874SJouni Malinen 1857bdcd8170SKalle Valo return 0; 1858bdcd8170SKalle Valo } 1859bdcd8170SKalle Valo 1860bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1861bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1862bdcd8170SKalle Valo { 1863bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1864334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1865334234b5SVasanthakumar Thiagarajan 1866334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1867bdcd8170SKalle Valo pmksa->pmkid, true); 1868bdcd8170SKalle Valo } 1869bdcd8170SKalle Valo 1870bdcd8170SKalle Valo static int ath6kl_del_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, false); 1878bdcd8170SKalle Valo } 1879bdcd8170SKalle Valo 1880bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1881bdcd8170SKalle Valo { 1882bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 188359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 188459c98449SVasanthakumar Thiagarajan 188559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1886334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1887334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1888bdcd8170SKalle Valo return 0; 1889bdcd8170SKalle Valo } 1890bdcd8170SKalle Valo 1891d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1892d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18936cb3c714SRaja Mani { 1894d91e8eeeSRaja Mani int ret, pos; 1895d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 18966cb3c714SRaja Mani u16 i; 18976cb3c714SRaja Mani 1898d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18996cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 19006cb3c714SRaja Mani 19016cb3c714SRaja Mani /* 19026cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 19036cb3c714SRaja Mani * driver specific mask value and send it to the chip along 19046cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 19056cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 19066cb3c714SRaja Mani * then equivalent driver specific mask value is 19076cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 19086cb3c714SRaja Mani */ 19096cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 19106cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 19116cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 19126cb3c714SRaja Mani mask[pos] = 0xFF; 19136cb3c714SRaja Mani } 19146cb3c714SRaja Mani /* 19156cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 19166cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 19176cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 19186cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 19196cb3c714SRaja Mani */ 19206cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 19216cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 19226cb3c714SRaja Mani wow->patterns[i].pattern_len, 19236cb3c714SRaja Mani 0 /* pattern offset */, 19246cb3c714SRaja Mani wow->patterns[i].pattern, mask); 19256cb3c714SRaja Mani if (ret) 19266cb3c714SRaja Mani return ret; 19276cb3c714SRaja Mani } 19286cb3c714SRaja Mani 1929d91e8eeeSRaja Mani if (wow->disconnect) 1930d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1931d91e8eeeSRaja Mani 1932d91e8eeeSRaja Mani if (wow->magic_pkt) 1933d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1934d91e8eeeSRaja Mani 1935d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1936d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1937d91e8eeeSRaja Mani 1938d91e8eeeSRaja Mani if (wow->eap_identity_req) 1939d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1940d91e8eeeSRaja Mani 1941d91e8eeeSRaja Mani if (wow->four_way_handshake) 1942d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1943d91e8eeeSRaja Mani 1944d91e8eeeSRaja Mani return 0; 1945d91e8eeeSRaja Mani } 1946d91e8eeeSRaja Mani 1947d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1948d91e8eeeSRaja Mani { 1949d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1950d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1951d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1952d91e8eeeSRaja Mani 0x00, 0x08 }; 1953d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1954d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1955d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1956d91e8eeeSRaja Mani 0x00, 0x7f }; 1957d91e8eeeSRaja Mani u8 unicst_offset = 0; 1958d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1959d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1960d91e8eeeSRaja Mani u8 arp_offset = 20; 1961d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1962d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1963d91e8eeeSRaja Mani u8 discvr_offset = 38; 1964d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1965d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1966d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1967d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1968d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1969d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1970d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1971d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1972d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1973d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1974d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1975d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1976d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1977d91e8eeeSRaja Mani int ret; 1978d91e8eeeSRaja Mani 1979d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1980d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1981d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1982d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1983d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1984d91e8eeeSRaja Mani if (ret) { 1985d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1986d91e8eeeSRaja Mani return ret; 1987d91e8eeeSRaja Mani } 1988d91e8eeeSRaja Mani 1989d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1990d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1991d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1992d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1993d91e8eeeSRaja Mani arp_pattern, arp_mask); 1994d91e8eeeSRaja Mani if (ret) { 1995d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1996d91e8eeeSRaja Mani return ret; 1997d91e8eeeSRaja Mani } 1998d91e8eeeSRaja Mani 1999d91e8eeeSRaja Mani /* 2000d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2001d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2002d91e8eeeSRaja Mani */ 2003d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2004d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2005d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2006d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2007d91e8eeeSRaja Mani if (ret) { 2008d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2009d91e8eeeSRaja Mani return ret; 2010d91e8eeeSRaja Mani } 2011d91e8eeeSRaja Mani 2012d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 2013d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2014d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2015d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 2016d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 2017d91e8eeeSRaja Mani if (ret) { 2018d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 2019d91e8eeeSRaja Mani return ret; 2020d91e8eeeSRaja Mani } 2021d91e8eeeSRaja Mani 2022d91e8eeeSRaja Mani return 0; 2023d91e8eeeSRaja Mani } 2024d91e8eeeSRaja Mani 2025d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2026d91e8eeeSRaja Mani { 2027d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2028d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2029d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2030d91e8eeeSRaja Mani u8 discvr_offset = 38; 2031d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2032d91e8eeeSRaja Mani int ret; 2033d91e8eeeSRaja Mani 2034d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 2035d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 2036d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2037d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2038d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2039d91e8eeeSRaja Mani mac_mask); 2040d91e8eeeSRaja Mani if (ret) { 2041d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2042d91e8eeeSRaja Mani return ret; 2043d91e8eeeSRaja Mani } 2044d91e8eeeSRaja Mani 2045d91e8eeeSRaja Mani /* 2046d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2047d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2048d91e8eeeSRaja Mani */ 2049d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2050d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2051d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2052d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2053d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2054d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2055d91e8eeeSRaja Mani if (ret) { 2056cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2057d91e8eeeSRaja Mani return ret; 2058d91e8eeeSRaja Mani } 2059d91e8eeeSRaja Mani } 2060d91e8eeeSRaja Mani 2061d91e8eeeSRaja Mani return 0; 2062d91e8eeeSRaja Mani } 2063d91e8eeeSRaja Mani 2064055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2065055bde49SRaja Mani { 2066055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2067055bde49SRaja Mani } 2068055bde49SRaja Mani 2069055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2070055bde49SRaja Mani { 2071055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2072055bde49SRaja Mani } 2073055bde49SRaja Mani 2074055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2075055bde49SRaja Mani { 2076055bde49SRaja Mani int ret, left; 2077055bde49SRaja Mani 2078055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2079055bde49SRaja Mani 2080055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2081055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2082055bde49SRaja Mani if (ret) 2083055bde49SRaja Mani return ret; 2084055bde49SRaja Mani 2085055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2086055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2087055bde49SRaja Mani WMI_TIMEOUT); 2088055bde49SRaja Mani if (left == 0) { 2089055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2090055bde49SRaja Mani ret = -ETIMEDOUT; 2091055bde49SRaja Mani } else if (left < 0) { 2092055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2093055bde49SRaja Mani left); 2094055bde49SRaja Mani ret = left; 2095055bde49SRaja Mani } 2096055bde49SRaja Mani 2097055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2098055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2099055bde49SRaja Mani is_ctrl_ep_empty(ar), 2100055bde49SRaja Mani WMI_TIMEOUT); 2101055bde49SRaja Mani if (left == 0) { 2102055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2103055bde49SRaja Mani ret = -ETIMEDOUT; 2104055bde49SRaja Mani } else if (left < 0) { 2105055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2106055bde49SRaja Mani ret = left; 2107055bde49SRaja Mani } 2108055bde49SRaja Mani } 2109055bde49SRaja Mani 2110055bde49SRaja Mani return ret; 2111055bde49SRaja Mani } 2112055bde49SRaja Mani 2113d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2114d91e8eeeSRaja Mani { 2115d91e8eeeSRaja Mani struct in_device *in_dev; 2116d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2117d91e8eeeSRaja Mani struct ath6kl_vif *vif; 2118055bde49SRaja Mani int ret; 2119d91e8eeeSRaja Mani u32 filter = 0; 2120ce0dc0cfSRaja Mani u16 i, bmiss_time; 2121d91e8eeeSRaja Mani u8 index = 0; 2122d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2123d91e8eeeSRaja Mani 212477ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 212577ed4e45SThomas Pedersen if (ar->num_vif > 1) 212677ed4e45SThomas Pedersen return -EIO; 212777ed4e45SThomas Pedersen 2128d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 2129d91e8eeeSRaja Mani if (!vif) 2130d91e8eeeSRaja Mani return -EIO; 2131d91e8eeeSRaja Mani 2132d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 2133d91e8eeeSRaja Mani return -EIO; 2134d91e8eeeSRaja Mani 2135d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 21363c411a43SRaja Mani return -ENOTCONN; 2137d91e8eeeSRaja Mani 2138d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2139d91e8eeeSRaja Mani return -EINVAL; 2140d91e8eeeSRaja Mani 21416821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 21426821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21436821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21446251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21456251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21466251d801SNaveen Gangadharan if (ret) 21476251d801SNaveen Gangadharan return ret; 21486251d801SNaveen Gangadharan } 21496251d801SNaveen Gangadharan 2150d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2151d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2152d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2153d91e8eeeSRaja Mani WOW_LIST_ID, i); 2154d91e8eeeSRaja Mani 2155d91e8eeeSRaja Mani /* 2156d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2157d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2158d91e8eeeSRaja Mani * the user. 2159d91e8eeeSRaja Mani */ 2160d91e8eeeSRaja Mani if (wow) 2161d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2162d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2163d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2164d91e8eeeSRaja Mani else 2165d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2166d91e8eeeSRaja Mani 2167d91e8eeeSRaja Mani if (ret) 2168d91e8eeeSRaja Mani return ret; 2169d91e8eeeSRaja Mani 2170390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2171390a8c8fSRaja Mani 2172ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2173ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2174ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2175ce0dc0cfSRaja Mani 0); 2176ce0dc0cfSRaja Mani if (ret) 2177ce0dc0cfSRaja Mani return ret; 2178ce0dc0cfSRaja Mani 2179ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2180ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2181ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2182ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2183ce0dc0cfSRaja Mani 2184ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2185ce0dc0cfSRaja Mani bmiss_time, 0); 2186ce0dc0cfSRaja Mani if (ret) 2187ce0dc0cfSRaja Mani return ret; 2188ce0dc0cfSRaja Mani 2189ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2190ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2191ce0dc0cfSRaja Mani 0, 0, 0, 0); 2192ce0dc0cfSRaja Mani if (ret) 2193ce0dc0cfSRaja Mani return ret; 2194ce0dc0cfSRaja Mani } 2195ce0dc0cfSRaja Mani 2196390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2197390a8c8fSRaja Mani 2198c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2199c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2200c08631c6SRaja Mani if (!in_dev) 2201c08631c6SRaja Mani goto skip_arp; 2202c08631c6SRaja Mani 2203c08631c6SRaja Mani ifa = in_dev->ifa_list; 2204c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2205c08631c6SRaja Mani 2206c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2207c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2208c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2209c08631c6SRaja Mani ifa = ifa->ifa_next; 2210c08631c6SRaja Mani index++; 2211c08631c6SRaja Mani } 2212c08631c6SRaja Mani 2213c08631c6SRaja Mani if (ifa) { 2214c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2215c08631c6SRaja Mani return -EINVAL; 2216c08631c6SRaja Mani } 2217c08631c6SRaja Mani 2218c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2219c08631c6SRaja Mani if (ret) { 2220c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2221c08631c6SRaja Mani return ret; 2222c08631c6SRaja Mani } 2223c08631c6SRaja Mani 2224c08631c6SRaja Mani skip_arp: 22256cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 22266cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22276cb3c714SRaja Mani filter, 22286cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22296cb3c714SRaja Mani if (ret) 22306cb3c714SRaja Mani return ret; 22316cb3c714SRaja Mani 2232055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 22336cb3c714SRaja Mani if (ret) 22346cb3c714SRaja Mani return ret; 22356cb3c714SRaja Mani 2236055bde49SRaja Mani return 0; 22376cb3c714SRaja Mani } 22386cb3c714SRaja Mani 22396cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 22406cb3c714SRaja Mani { 22416cb3c714SRaja Mani struct ath6kl_vif *vif; 22426cb3c714SRaja Mani int ret; 22436cb3c714SRaja Mani 22446cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 22456cb3c714SRaja Mani if (!vif) 22466cb3c714SRaja Mani return -EIO; 22476cb3c714SRaja Mani 2248390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2249390a8c8fSRaja Mani 22506cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 22516cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2252390a8c8fSRaja Mani if (ret) { 2253cdeb8602SKalle Valo ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2254cdeb8602SKalle Valo ret); 2255390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 22566cb3c714SRaja Mani return ret; 22576cb3c714SRaja Mani } 22586cb3c714SRaja Mani 2259ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2260ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2261ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2262ce0dc0cfSRaja Mani if (ret) 2263ce0dc0cfSRaja Mani return ret; 2264ce0dc0cfSRaja Mani 2265ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2266ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2267ce0dc0cfSRaja Mani if (ret) 2268ce0dc0cfSRaja Mani return ret; 2269ce0dc0cfSRaja Mani 2270ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2271ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2272ce0dc0cfSRaja Mani if (ret) 2273ce0dc0cfSRaja Mani return ret; 2274ce0dc0cfSRaja Mani } 2275ce0dc0cfSRaja Mani 2276390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2277390a8c8fSRaja Mani 22786821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22796821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22806821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22816251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22826251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22836251d801SNaveen Gangadharan if (ret) 22846251d801SNaveen Gangadharan return ret; 22856251d801SNaveen Gangadharan } 22866251d801SNaveen Gangadharan 2287390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2288390a8c8fSRaja Mani 2289390a8c8fSRaja Mani return 0; 2290390a8c8fSRaja Mani } 2291390a8c8fSRaja Mani 229240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 229340abc2deSRaja Mani { 229440abc2deSRaja Mani struct ath6kl_vif *vif; 229540abc2deSRaja Mani int ret; 229640abc2deSRaja Mani 229740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 229840abc2deSRaja Mani if (!vif) 229940abc2deSRaja Mani return -EIO; 230040abc2deSRaja Mani 230148f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 230248f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 230340abc2deSRaja Mani return -EIO; 230448f27587SMing Jiang } 230540abc2deSRaja Mani 230640abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 230740abc2deSRaja Mani 230840abc2deSRaja Mani /* Save the current power mode before enabling power save */ 230940abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 231040abc2deSRaja Mani 231140abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 231240abc2deSRaja Mani if (ret) 231340abc2deSRaja Mani return ret; 231440abc2deSRaja Mani 231540abc2deSRaja Mani /* Disable WOW mode */ 231640abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 231740abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 231840abc2deSRaja Mani 0, 0); 231940abc2deSRaja Mani if (ret) 232040abc2deSRaja Mani return ret; 232140abc2deSRaja Mani 232240abc2deSRaja Mani /* Flush all non control pkts in TX path */ 232340abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 232440abc2deSRaja Mani 232540abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 232640abc2deSRaja Mani if (ret) 232740abc2deSRaja Mani return ret; 232840abc2deSRaja Mani 232940abc2deSRaja Mani return 0; 233040abc2deSRaja Mani } 233140abc2deSRaja Mani 233240abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 233340abc2deSRaja Mani { 233440abc2deSRaja Mani struct ath6kl_vif *vif; 233540abc2deSRaja Mani int ret; 233640abc2deSRaja Mani 233740abc2deSRaja Mani vif = ath6kl_vif_first(ar); 233840abc2deSRaja Mani 233940abc2deSRaja Mani if (!vif) 234040abc2deSRaja Mani return -EIO; 234140abc2deSRaja Mani 234240abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 234340abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 234440abc2deSRaja Mani ar->wmi->saved_pwr_mode); 234540abc2deSRaja Mani if (ret) 234640abc2deSRaja Mani return ret; 234740abc2deSRaja Mani } 234840abc2deSRaja Mani 234940abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 235040abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 235140abc2deSRaja Mani if (ret) 235240abc2deSRaja Mani return ret; 235340abc2deSRaja Mani 235440abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 235540abc2deSRaja Mani 235640abc2deSRaja Mani /* Reset scan parameter to default values */ 235740abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 235840abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 235940abc2deSRaja Mani if (ret) 236040abc2deSRaja Mani return ret; 236140abc2deSRaja Mani 236240abc2deSRaja Mani return 0; 236340abc2deSRaja Mani } 236440abc2deSRaja Mani 236552d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 23660f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 23670f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 236852d81a68SKalle Valo { 23693d79499cSVivek Natarajan struct ath6kl_vif *vif; 2370390a8c8fSRaja Mani enum ath6kl_state prev_state; 237152d81a68SKalle Valo int ret; 237252d81a68SKalle Valo 237352d81a68SKalle Valo switch (mode) { 2374d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2375d7c44e0bSRaja Mani 2376d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2377d7c44e0bSRaja Mani 2378d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2379d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2380d7c44e0bSRaja Mani 2381390a8c8fSRaja Mani prev_state = ar->state; 2382390a8c8fSRaja Mani 2383d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2384390a8c8fSRaja Mani if (ret) { 2385390a8c8fSRaja Mani ar->state = prev_state; 2386d7c44e0bSRaja Mani return ret; 2387390a8c8fSRaja Mani } 23881e9a905dSRaja Mani 2389d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2390d7c44e0bSRaja Mani break; 2391d7c44e0bSRaja Mani 239252d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2393524441e3SRaja Mani 239440abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2395524441e3SRaja Mani 239640abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 239752d81a68SKalle Valo if (ret) { 239840abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 239940abc2deSRaja Mani return ret; 240052d81a68SKalle Valo } 240152d81a68SKalle Valo 240276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 240376a9fbe2SKalle Valo 240452d81a68SKalle Valo break; 2405b4b2a0b1SKalle Valo 2406b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2407524441e3SRaja Mani 24087125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2409524441e3SRaja Mani 2410b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2411b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2412b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2413b4b2a0b1SKalle Valo break; 2414b4b2a0b1SKalle Valo } 2415b4b2a0b1SKalle Valo 2416b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2417b4b2a0b1SKalle Valo 2418b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2419b4b2a0b1SKalle Valo if (ret) { 2420b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2421b4b2a0b1SKalle Valo ret); 2422b4b2a0b1SKalle Valo } 2423b4b2a0b1SKalle Valo 2424b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2425b4b2a0b1SKalle Valo 2426b4b2a0b1SKalle Valo break; 2427b4b2a0b1SKalle Valo 242810509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 242910509f90SKalle Valo /* 243010509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 243110509f90SKalle Valo * wow mode and sleeping most of the time. 243210509f90SKalle Valo */ 243310509f90SKalle Valo break; 243410509f90SKalle Valo 2435b4b2a0b1SKalle Valo default: 2436b4b2a0b1SKalle Valo break; 243752d81a68SKalle Valo } 243852d81a68SKalle Valo 24393d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24403d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24413d79499cSVivek Natarajan 244252d81a68SKalle Valo return 0; 244352d81a68SKalle Valo } 2444d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 244552d81a68SKalle Valo 244652d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 244752d81a68SKalle Valo { 244876a9fbe2SKalle Valo int ret; 244976a9fbe2SKalle Valo 245076a9fbe2SKalle Valo switch (ar->state) { 2451d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2452d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2453d7c44e0bSRaja Mani 2454d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2455d7c44e0bSRaja Mani if (ret) { 2456d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2457d7c44e0bSRaja Mani return ret; 2458d7c44e0bSRaja Mani } 2459d7c44e0bSRaja Mani 2460d7c44e0bSRaja Mani break; 2461d7c44e0bSRaja Mani 246276a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 246340abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 246440abc2deSRaja Mani 246540abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 246676a9fbe2SKalle Valo if (ret) { 246740abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 246840abc2deSRaja Mani return ret; 246976a9fbe2SKalle Valo } 247076a9fbe2SKalle Valo break; 247176a9fbe2SKalle Valo 2472b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2473b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2474b4b2a0b1SKalle Valo 2475b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2476b4b2a0b1SKalle Valo if (ret) { 2477b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2478b4b2a0b1SKalle Valo return ret; 2479b4b2a0b1SKalle Valo } 2480d7c44e0bSRaja Mani break; 2481b4b2a0b1SKalle Valo 248210509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 248310509f90SKalle Valo break; 248410509f90SKalle Valo 248576a9fbe2SKalle Valo default: 248676a9fbe2SKalle Valo break; 248752d81a68SKalle Valo } 248852d81a68SKalle Valo 248952d81a68SKalle Valo return 0; 249052d81a68SKalle Valo } 2491d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 249252d81a68SKalle Valo 2493abcb344bSKalle Valo #ifdef CONFIG_PM 249452d81a68SKalle Valo 249552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 249652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2497abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2498abcb344bSKalle Valo { 2499abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2500abcb344bSKalle Valo 25010f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2502abcb344bSKalle Valo } 2503aa6cffc1SChilam Ng 250452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2505aa6cffc1SChilam Ng { 2506aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2507aa6cffc1SChilam Ng 2508aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2509aa6cffc1SChilam Ng } 2510a918fb3cSRaja Mani 2511a918fb3cSRaja Mani /* 2512a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2513a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2514a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2515a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2516a918fb3cSRaja Mani * 2517a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2518a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2519a918fb3cSRaja Mani * 2520a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2521a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2522a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2523a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2524a918fb3cSRaja Mani * 2525a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2526a918fb3cSRaja Mani */ 2527a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2528a918fb3cSRaja Mani { 2529390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2530390a8c8fSRaja Mani return; 2531390a8c8fSRaja Mani 2532a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2533a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2534a918fb3cSRaja Mani } 2535a918fb3cSRaja Mani 2536a918fb3cSRaja Mani #else 2537a918fb3cSRaja Mani 2538a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2539a918fb3cSRaja Mani { 2540a918fb3cSRaja Mani } 2541abcb344bSKalle Valo #endif 2542abcb344bSKalle Valo 2543df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2544df90b369SVasanthakumar Thiagarajan bool ht_enable) 25456a7c9badSJouni Malinen { 2546df90b369SVasanthakumar Thiagarajan struct ath6kl_htcap *htcap = &vif->htcap; 2547e68f6750SSujith Manoharan 2548df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 25496a7c9badSJouni Malinen return 0; 2550df90b369SVasanthakumar Thiagarajan 2551df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2552df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2553df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2554df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2555df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2556df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2557df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2558df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2559df90b369SVasanthakumar Thiagarajan 2560df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2561df90b369SVasanthakumar Thiagarajan band, htcap); 25626a7c9badSJouni Malinen } 25636a7c9badSJouni Malinen 256437a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 256537a2f950SThomas Pedersen { 256637a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 256737a2f950SThomas Pedersen int band, ret = 0; 256837a2f950SThomas Pedersen 256937a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 257037a2f950SThomas Pedersen if (!wiphy->bands[band]) 257137a2f950SThomas Pedersen continue; 257237a2f950SThomas Pedersen 257337a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 257437a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 257537a2f950SThomas Pedersen if (ret) 257637a2f950SThomas Pedersen return ret; 257737a2f950SThomas Pedersen } 257837a2f950SThomas Pedersen 257937a2f950SThomas Pedersen return ret; 258037a2f950SThomas Pedersen } 258137a2f950SThomas Pedersen 25828bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 25838bdfbf40SJouni Malinen { 25848bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 25858bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 25868bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 25878bdfbf40SJouni Malinen } 25888bdfbf40SJouni Malinen 2589334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2590334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 25918bdfbf40SJouni Malinen { 2592334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 25938bdfbf40SJouni Malinen const u8 *pos; 25948bdfbf40SJouni Malinen u8 *buf = NULL; 25958bdfbf40SJouni Malinen size_t len = 0; 25968bdfbf40SJouni Malinen int ret; 25978bdfbf40SJouni Malinen 25988bdfbf40SJouni Malinen /* 25998bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26008bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26018bdfbf40SJouni Malinen */ 26028bdfbf40SJouni Malinen 26038bdfbf40SJouni Malinen if (ies && ies_len) { 26048bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26058bdfbf40SJouni Malinen if (buf == NULL) 26068bdfbf40SJouni Malinen return -ENOMEM; 26078bdfbf40SJouni Malinen pos = ies; 26088bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26098bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26108bdfbf40SJouni Malinen break; 26118bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26128bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26138bdfbf40SJouni Malinen len += 2 + pos[1]; 26148bdfbf40SJouni Malinen } 26158bdfbf40SJouni Malinen pos += 2 + pos[1]; 26168bdfbf40SJouni Malinen } 26178bdfbf40SJouni Malinen } 26188bdfbf40SJouni Malinen 2619334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2620334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26218bdfbf40SJouni Malinen kfree(buf); 26228bdfbf40SJouni Malinen return ret; 26238bdfbf40SJouni Malinen } 26248bdfbf40SJouni Malinen 26258860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26268860020eSJohannes Berg struct cfg80211_beacon_data *info) 26278860020eSJohannes Berg { 26288860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26298860020eSJohannes Berg int res; 26308860020eSJohannes Berg 263117a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26328860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26338860020eSJohannes Berg WMI_FRAME_BEACON, 26348860020eSJohannes Berg info->beacon_ies, 26358860020eSJohannes Berg info->beacon_ies_len); 26368860020eSJohannes Berg if (res) 26378860020eSJohannes Berg return res; 26388860020eSJohannes Berg 263917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26408860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26418860020eSJohannes Berg info->proberesp_ies_len); 26428860020eSJohannes Berg if (res) 26438860020eSJohannes Berg return res; 26448860020eSJohannes Berg 264517a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26468860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26478860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 26488860020eSJohannes Berg info->assocresp_ies, 26498860020eSJohannes Berg info->assocresp_ies_len); 26508860020eSJohannes Berg if (res) 26518860020eSJohannes Berg return res; 26528860020eSJohannes Berg 26538860020eSJohannes Berg return 0; 26548860020eSJohannes Berg } 26558860020eSJohannes Berg 2656df90b369SVasanthakumar Thiagarajan static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2657df90b369SVasanthakumar Thiagarajan struct ieee80211_channel *chan, 2658df90b369SVasanthakumar Thiagarajan enum nl80211_channel_type channel_type) 2659df90b369SVasanthakumar Thiagarajan { 2660df90b369SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 2661df90b369SVasanthakumar Thiagarajan 2662df90b369SVasanthakumar Thiagarajan /* 2663df90b369SVasanthakumar Thiagarajan * 'dev' could be NULL if a channel change is required for the hardware 2664df90b369SVasanthakumar Thiagarajan * device itself, instead of a particular VIF. 2665df90b369SVasanthakumar Thiagarajan * 2666df90b369SVasanthakumar Thiagarajan * FIXME: To be handled properly when monitor mode is supported. 2667df90b369SVasanthakumar Thiagarajan */ 2668df90b369SVasanthakumar Thiagarajan if (!dev) 2669df90b369SVasanthakumar Thiagarajan return -EBUSY; 2670df90b369SVasanthakumar Thiagarajan 2671df90b369SVasanthakumar Thiagarajan vif = netdev_priv(dev); 2672df90b369SVasanthakumar Thiagarajan 2673df90b369SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 2674df90b369SVasanthakumar Thiagarajan return -EIO; 2675df90b369SVasanthakumar Thiagarajan 2676df90b369SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2677df90b369SVasanthakumar Thiagarajan __func__, chan->center_freq, chan->hw_value); 2678df90b369SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 2679df90b369SVasanthakumar Thiagarajan vif->next_ch_type = channel_type; 2680df90b369SVasanthakumar Thiagarajan vif->next_ch_band = chan->band; 2681df90b369SVasanthakumar Thiagarajan 2682df90b369SVasanthakumar Thiagarajan return 0; 2683df90b369SVasanthakumar Thiagarajan } 2684df90b369SVasanthakumar Thiagarajan 2685c422d52dSThomas Pedersen void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, bool enable) 2686c422d52dSThomas Pedersen { 2687c422d52dSThomas Pedersen int err; 2688c422d52dSThomas Pedersen 2689c422d52dSThomas Pedersen if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag))) 2690c422d52dSThomas Pedersen return; 2691c422d52dSThomas Pedersen 2692c422d52dSThomas Pedersen if (vif->nw_type != INFRA_NETWORK) 2693c422d52dSThomas Pedersen return; 2694c422d52dSThomas Pedersen 2695c422d52dSThomas Pedersen if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE, 2696c422d52dSThomas Pedersen vif->ar->fw_capabilities)) 2697c422d52dSThomas Pedersen return; 2698c422d52dSThomas Pedersen 2699c422d52dSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n", 2700c422d52dSThomas Pedersen enable ? "enable" : "disable"); 2701c422d52dSThomas Pedersen 2702c422d52dSThomas Pedersen err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi, 2703c422d52dSThomas Pedersen vif->fw_vif_idx, enable); 2704c422d52dSThomas Pedersen if (err) 2705c422d52dSThomas Pedersen ath6kl_err("failed to %s enhanced bmiss detection: %d\n", 2706c422d52dSThomas Pedersen enable ? "enable" : "disable", err); 2707c422d52dSThomas Pedersen } 2708c422d52dSThomas Pedersen 2709d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2710d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2711d97c121bSVasanthakumar Thiagarajan { 2712d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2713d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2714d97c121bSVasanthakumar Thiagarajan u16 cnt; 2715d97c121bSVasanthakumar Thiagarajan 2716d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2717d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2718d97c121bSVasanthakumar Thiagarajan 2719d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2720d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2721d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2722d97c121bSVasanthakumar Thiagarajan 2723d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2724d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2725d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2726d97c121bSVasanthakumar Thiagarajan 27279e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27289e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2729d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27309e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27319e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27329e8b16dbSVasanthakumar Thiagarajan 27339e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27349e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27359e8b16dbSVasanthakumar Thiagarajan return 0; 27369e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27379e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2738d97c121bSVasanthakumar Thiagarajan 2739d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2740d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27419e8b16dbSVasanthakumar Thiagarajan return 0; 2742798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2743d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2744d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2745d97c121bSVasanthakumar Thiagarajan 2746d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2747d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27489e8b16dbSVasanthakumar Thiagarajan return 0; 2749798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2750d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2751d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2752d97c121bSVasanthakumar Thiagarajan 2753d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27549e8b16dbSVasanthakumar Thiagarajan return 0; 2755d97c121bSVasanthakumar Thiagarajan 2756d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2757d97c121bSVasanthakumar Thiagarajan 2758d97c121bSVasanthakumar Thiagarajan return 0; 2759d97c121bSVasanthakumar Thiagarajan } 2760d97c121bSVasanthakumar Thiagarajan 27618860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27628860020eSJohannes Berg struct cfg80211_ap_settings *info) 27636a7c9badSJouni Malinen { 27646a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27653450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27666a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 276767cd22e4SThomas Pedersen bool hidden = false; 27686a7c9badSJouni Malinen u8 *ies; 27696a7c9badSJouni Malinen int ies_len; 27706a7c9badSJouni Malinen struct wmi_connect_cmd p; 27716a7c9badSJouni Malinen int res; 2772be5abaafSVasanthakumar Thiagarajan int i, ret; 2773d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27746a7c9badSJouni Malinen 27758860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27766a7c9badSJouni Malinen 2777990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27786a7c9badSJouni Malinen return -EIO; 27796a7c9badSJouni Malinen 2780f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27816a7c9badSJouni Malinen return -EOPNOTSUPP; 27826a7c9badSJouni Malinen 27838860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27846a7c9badSJouni Malinen 27859a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27869a5b1318SJouni Malinen 27876a7c9badSJouni Malinen /* TODO: 27886a7c9badSJouni Malinen * info->interval 27896a7c9badSJouni Malinen * info->dtim_period 27906a7c9badSJouni Malinen */ 27916a7c9badSJouni Malinen 27928860020eSJohannes Berg if (info->beacon.head == NULL) 27936a7c9badSJouni Malinen return -EINVAL; 27948860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 27956a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 27968860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 27976a7c9badSJouni Malinen return -EINVAL; 27988860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 27996a7c9badSJouni Malinen 28006a7c9badSJouni Malinen if (info->ssid == NULL) 28016a7c9badSJouni Malinen return -EINVAL; 28023450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 28033450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 28046a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 280567cd22e4SThomas Pedersen hidden = true; 280667cd22e4SThomas Pedersen 280767cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 280867cd22e4SThomas Pedersen if (res) 280967cd22e4SThomas Pedersen return res; 28106a7c9badSJouni Malinen 2811be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2812be5abaafSVasanthakumar Thiagarajan if (ret) 2813be5abaafSVasanthakumar Thiagarajan return ret; 28146a7c9badSJouni Malinen 28156a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28166a7c9badSJouni Malinen 28176a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28186a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28196a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28206a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28216a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28226a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28236a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28246a7c9badSJouni Malinen break; 28256a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28266a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28276a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28286a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28296a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28306a7c9badSJouni Malinen break; 28316a7c9badSJouni Malinen } 28326a7c9badSJouni Malinen } 28336a7c9badSJouni Malinen if (p.auth_mode == 0) 28346a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28353450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28366a7c9badSJouni Malinen 28376a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28386a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28396a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28406a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28416a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28426a7c9badSJouni Malinen break; 28436a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28446a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28456a7c9badSJouni Malinen break; 28466a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28476a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28486a7c9badSJouni Malinen break; 2849b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2850b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2851b8214df1SDai Shuibing break; 28526a7c9badSJouni Malinen } 28536a7c9badSJouni Malinen } 2854229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28556a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2856240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2857229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2858240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 28596a7c9badSJouni Malinen 28606a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28616a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28626a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28636a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28646a7c9badSJouni Malinen break; 28656a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28666a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28676a7c9badSJouni Malinen break; 28686a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28696a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28706a7c9badSJouni Malinen break; 2871b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2872b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2873b8214df1SDai Shuibing break; 28746a7c9badSJouni Malinen default: 28756a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28766a7c9badSJouni Malinen break; 28776a7c9badSJouni Malinen } 2878240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28796a7c9badSJouni Malinen 28806a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2881f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28826a7c9badSJouni Malinen 28833450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28843450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28853450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2886cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 28876a7c9badSJouni Malinen 2888c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2889c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2890c1762a3fSThirumalai Pachamuthu if (res < 0) 2891c1762a3fSThirumalai Pachamuthu return res; 2892c1762a3fSThirumalai Pachamuthu 28933ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 28943ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 28953ca9d1fcSAarthi Thiruvengadam } else { 28963ca9d1fcSAarthi Thiruvengadam /* 28973ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 28983ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 28993ca9d1fcSAarthi Thiruvengadam */ 29003ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 29013ca9d1fcSAarthi Thiruvengadam } 29023ca9d1fcSAarthi Thiruvengadam 290303bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 290403bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 290503bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 290603bdeb0dSVasanthakumar Thiagarajan if (res < 0) 290703bdeb0dSVasanthakumar Thiagarajan return res; 290803bdeb0dSVasanthakumar Thiagarajan } 290903bdeb0dSVasanthakumar Thiagarajan 2910df90b369SVasanthakumar Thiagarajan if (ath6kl_set_htcap(vif, vif->next_ch_band, 2911df90b369SVasanthakumar Thiagarajan vif->next_ch_type != NL80211_CHAN_NO_HT)) 2912df90b369SVasanthakumar Thiagarajan return -EIO; 2913df90b369SVasanthakumar Thiagarajan 2914d97c121bSVasanthakumar Thiagarajan /* 2915d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2916d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2917d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2918d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2919d97c121bSVasanthakumar Thiagarajan */ 2920d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2921d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2922d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2923d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2924d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2925d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2926d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2927d97c121bSVasanthakumar Thiagarajan if (res < 0) 2928d97c121bSVasanthakumar Thiagarajan return res; 2929d97c121bSVasanthakumar Thiagarajan } 2930d97c121bSVasanthakumar Thiagarajan 2931c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2932334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29339a5b1318SJouni Malinen if (res < 0) 29349a5b1318SJouni Malinen return res; 29359a5b1318SJouni Malinen 29369a5b1318SJouni Malinen return 0; 29376a7c9badSJouni Malinen } 29386a7c9badSJouni Malinen 29398860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29408860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29416a7c9badSJouni Malinen { 29428860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29438860020eSJohannes Berg 29448860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29458860020eSJohannes Berg return -EIO; 29468860020eSJohannes Berg 29478860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29488860020eSJohannes Berg return -EOPNOTSUPP; 29498860020eSJohannes Berg 29508860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29516a7c9badSJouni Malinen } 29526a7c9badSJouni Malinen 29538860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29546a7c9badSJouni Malinen { 29556a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 295659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29576a7c9badSJouni Malinen 2958f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29596a7c9badSJouni Malinen return -EOPNOTSUPP; 296059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29616a7c9badSJouni Malinen return -ENOTCONN; 29626a7c9badSJouni Malinen 2963334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 296459c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 29656a7c9badSJouni Malinen 2966df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 296737a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29686a7c9badSJouni Malinen } 29696a7c9badSJouni Malinen 297033e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 297133e5308dSJouni Malinen 297233e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 297333e5308dSJouni Malinen u8 *mac) 297433e5308dSJouni Malinen { 297533e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 297633e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 297733e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 297833e5308dSJouni Malinen 297933e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 298033e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 298133e5308dSJouni Malinen } 298233e5308dSJouni Malinen 298323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 298423875136SJouni Malinen u8 *mac, struct station_parameters *params) 298523875136SJouni Malinen { 298623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2987f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 298823875136SJouni Malinen 2989f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 299023875136SJouni Malinen return -EOPNOTSUPP; 299123875136SJouni Malinen 299223875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 299323875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 299423875136SJouni Malinen return -EOPNOTSUPP; 299523875136SJouni Malinen 299623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2997334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2998334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2999334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 3000334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 300123875136SJouni Malinen } 300223875136SJouni Malinen 300363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 300463fa1e0cSJouni Malinen struct net_device *dev, 300563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 300663fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 300763fa1e0cSJouni Malinen unsigned int duration, 300863fa1e0cSJouni Malinen u64 *cookie) 300963fa1e0cSJouni Malinen { 301063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 3011334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 30121052261eSJouni Malinen u32 id; 301363fa1e0cSJouni Malinen 301463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 301563fa1e0cSJouni Malinen * return -EBUSY */ 30161052261eSJouni Malinen id = ++vif->last_roc_id; 30171052261eSJouni Malinen if (id == 0) { 30181052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30191052261eSJouni Malinen id = ++vif->last_roc_id; 30201052261eSJouni Malinen } 30211052261eSJouni Malinen *cookie = id; 302263fa1e0cSJouni Malinen 3023334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3024334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 302563fa1e0cSJouni Malinen } 302663fa1e0cSJouni Malinen 302763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 302863fa1e0cSJouni Malinen struct net_device *dev, 302963fa1e0cSJouni Malinen u64 cookie) 303063fa1e0cSJouni Malinen { 303163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 3032334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 303363fa1e0cSJouni Malinen 30341052261eSJouni Malinen if (cookie != vif->last_roc_id) 303563fa1e0cSJouni Malinen return -ENOENT; 30361052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 303763fa1e0cSJouni Malinen 3038334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 303963fa1e0cSJouni Malinen } 304063fa1e0cSJouni Malinen 3041334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3042334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3043334234b5SVasanthakumar Thiagarajan unsigned int freq) 30448bdfbf40SJouni Malinen { 3045334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30468bdfbf40SJouni Malinen const u8 *pos; 30478bdfbf40SJouni Malinen u8 *p2p; 30488bdfbf40SJouni Malinen int p2p_len; 30498bdfbf40SJouni Malinen int ret; 30508bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30518bdfbf40SJouni Malinen 30528bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30538bdfbf40SJouni Malinen 30548bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30558bdfbf40SJouni Malinen 30568bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30578bdfbf40SJouni Malinen if (p2p == NULL) 30588bdfbf40SJouni Malinen return -ENOMEM; 30598bdfbf40SJouni Malinen p2p_len = 0; 30608bdfbf40SJouni Malinen 30618bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30628bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30638bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30648bdfbf40SJouni Malinen break; 30658bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30668bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30678bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30688bdfbf40SJouni Malinen } 30698bdfbf40SJouni Malinen pos += 2 + pos[1]; 30708bdfbf40SJouni Malinen } 30718bdfbf40SJouni Malinen 3072334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3073334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30748bdfbf40SJouni Malinen kfree(p2p); 30758bdfbf40SJouni Malinen return ret; 30768bdfbf40SJouni Malinen } 30778bdfbf40SJouni Malinen 3078d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3079d0ff7383SNaveen Gangadharan u32 id, 3080d0ff7383SNaveen Gangadharan u32 freq, 3081d0ff7383SNaveen Gangadharan u32 wait, 3082d0ff7383SNaveen Gangadharan const u8 *buf, 3083d0ff7383SNaveen Gangadharan size_t len, 3084d0ff7383SNaveen Gangadharan bool *more_data, 3085d0ff7383SNaveen Gangadharan bool no_cck) 3086d0ff7383SNaveen Gangadharan { 3087d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3088d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3089d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3090d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3091d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3092d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3093d0ff7383SNaveen Gangadharan 3094d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3095d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3096d0ff7383SNaveen Gangadharan return false; 3097d0ff7383SNaveen Gangadharan 3098d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3099d0ff7383SNaveen Gangadharan if (!conn) 3100d0ff7383SNaveen Gangadharan return false; 3101d0ff7383SNaveen Gangadharan 3102d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3103d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3104d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3105d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3106d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3107d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3108d0ff7383SNaveen Gangadharan return false; 3109d0ff7383SNaveen Gangadharan 3110d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3111d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3112d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3113d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3114d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3115d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3116d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3117d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3118d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3119d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3120d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3121d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3122d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3123d0ff7383SNaveen Gangadharan 3124d0ff7383SNaveen Gangadharan /* 3125d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3126d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3127d0ff7383SNaveen Gangadharan * STA. 3128d0ff7383SNaveen Gangadharan */ 3129d0ff7383SNaveen Gangadharan if (is_psq_empty) 3130d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3131d0ff7383SNaveen Gangadharan conn->aid, 1); 3132d0ff7383SNaveen Gangadharan return true; 3133d0ff7383SNaveen Gangadharan } 3134d0ff7383SNaveen Gangadharan 3135d0ff7383SNaveen Gangadharan /* 3136d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3137d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3138d0ff7383SNaveen Gangadharan */ 3139d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3140d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3141d0ff7383SNaveen Gangadharan *more_data = true; 3142d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3143d0ff7383SNaveen Gangadharan } 3144d0ff7383SNaveen Gangadharan 3145d0ff7383SNaveen Gangadharan return false; 3146d0ff7383SNaveen Gangadharan } 3147d0ff7383SNaveen Gangadharan 3148c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3149c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3150c86e4f44SAarthi Thiruvengadam { 3151c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3152c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3153c86e4f44SAarthi Thiruvengadam 3154c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3155c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3156c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3157c86e4f44SAarthi Thiruvengadam return true; 3158c86e4f44SAarthi Thiruvengadam } 3159c86e4f44SAarthi Thiruvengadam 3160c86e4f44SAarthi Thiruvengadam return false; 3161c86e4f44SAarthi Thiruvengadam } 3162c86e4f44SAarthi Thiruvengadam 31638a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 31648a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 31658a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 31668a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3167e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3168e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 31698a6c8060SJouni Malinen { 31708a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 317159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 31728a6c8060SJouni Malinen u32 id; 31738bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3174d0ff7383SNaveen Gangadharan bool more_data, queued; 31758bdfbf40SJouni Malinen 31768bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3177c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3178c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3179c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 31808bdfbf40SJouni Malinen /* 3181c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 31828bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 31838bdfbf40SJouni Malinen */ 31848bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3185334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 31868bdfbf40SJouni Malinen chan->center_freq); 31878bdfbf40SJouni Malinen } 31888a6c8060SJouni Malinen 3189cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31908a6c8060SJouni Malinen if (id == 0) { 31918a6c8060SJouni Malinen /* 31928a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 31938a6c8060SJouni Malinen * used for the command. 31948a6c8060SJouni Malinen */ 3195cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31968a6c8060SJouni Malinen } 31978a6c8060SJouni Malinen 31988a6c8060SJouni Malinen *cookie = id; 31993ca9d1fcSAarthi Thiruvengadam 3200d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3201d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3202d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3203d0ff7383SNaveen Gangadharan id, chan->center_freq, 3204d0ff7383SNaveen Gangadharan wait, buf, 3205d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3206d0ff7383SNaveen Gangadharan if (queued) 3207d0ff7383SNaveen Gangadharan return 0; 3208d0ff7383SNaveen Gangadharan } 3209d0ff7383SNaveen Gangadharan 32103ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 32113ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 32123ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 32133ca9d1fcSAarthi Thiruvengadam } 32148a6c8060SJouni Malinen 3215ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3216ae32c30aSJouni Malinen struct net_device *dev, 3217ae32c30aSJouni Malinen u16 frame_type, bool reg) 3218ae32c30aSJouni Malinen { 3219cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 3220ae32c30aSJouni Malinen 3221ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3222ae32c30aSJouni Malinen __func__, frame_type, reg); 3223ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3224ae32c30aSJouni Malinen /* 3225ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3226ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3227ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3228ae32c30aSJouni Malinen */ 3229cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3230ae32c30aSJouni Malinen } 3231ae32c30aSJouni Malinen } 3232ae32c30aSJouni Malinen 323310509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 323410509f90SKalle Valo struct net_device *dev, 323510509f90SKalle Valo struct cfg80211_sched_scan_request *request) 323610509f90SKalle Valo { 323710509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 323810509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 323910509f90SKalle Valo u16 interval; 324010509f90SKalle Valo int ret; 324110509f90SKalle Valo 324210509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 324310509f90SKalle Valo return -EIO; 324410509f90SKalle Valo 324510509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 324610509f90SKalle Valo return -EBUSY; 324710509f90SKalle Valo 324877ed4e45SThomas Pedersen /* The FW currently can't support multi-vif WoW properly. */ 324977ed4e45SThomas Pedersen if (ar->num_vif > 1) 325077ed4e45SThomas Pedersen return -EIO; 325177ed4e45SThomas Pedersen 3252b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3253b4d13d3bSKalle Valo 32543b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3255dd45b759SNaveen Singh request->n_ssids, 3256dd45b759SNaveen Singh request->match_sets, 3257dd45b759SNaveen Singh request->n_match_sets); 32583b8ffc6aSJouni Malinen if (ret < 0) 32593b8ffc6aSJouni Malinen return ret; 326010509f90SKalle Valo 3261dd45b759SNaveen Singh if (!request->n_match_sets) { 3262dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3263dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3264dd45b759SNaveen Singh if (ret < 0) 3265dd45b759SNaveen Singh return ret; 3266dd45b759SNaveen Singh } else { 3267dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3268dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3269dd45b759SNaveen Singh if (ret < 0) 3270dd45b759SNaveen Singh return ret; 3271dd45b759SNaveen Singh } 3272dd45b759SNaveen Singh 327310509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 327410509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 327510509f90SKalle Valo 327610509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 327710509f90SKalle Valo interval, interval, 3278d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 327910509f90SKalle Valo 328010509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 328110509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 328210509f90SKalle Valo WOW_FILTER_SSID, 328310509f90SKalle Valo WOW_HOST_REQ_DELAY); 328410509f90SKalle Valo if (ret) { 328510509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 328610509f90SKalle Valo return ret; 328710509f90SKalle Valo } 328810509f90SKalle Valo 328910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 329010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 329110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 329210509f90SKalle Valo request->ie, request->ie_len); 329310509f90SKalle Valo if (ret) { 329410509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 329510509f90SKalle Valo ret); 329610509f90SKalle Valo return ret; 329710509f90SKalle Valo } 329810509f90SKalle Valo 329910509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 330010509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 330110509f90SKalle Valo if (ret) { 330210509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 330310509f90SKalle Valo ret); 330410509f90SKalle Valo return ret; 330510509f90SKalle Valo } 330610509f90SKalle Valo 330710509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 330810509f90SKalle Valo 330910509f90SKalle Valo return ret; 331010509f90SKalle Valo } 331110509f90SKalle Valo 331210509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 331310509f90SKalle Valo struct net_device *dev) 331410509f90SKalle Valo { 331510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 331610509f90SKalle Valo bool stopped; 331710509f90SKalle Valo 331810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 331910509f90SKalle Valo 332010509f90SKalle Valo if (!stopped) 332110509f90SKalle Valo return -EIO; 332210509f90SKalle Valo 332310509f90SKalle Valo return 0; 332410509f90SKalle Valo } 332510509f90SKalle Valo 3326f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3327f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3328f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3329f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3330f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3331f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3332f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3333f80574aeSJouni Malinen }, 3334ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3335ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3336ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3337ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3338ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3339ba1f6fe3SJouni Malinen }, 3340f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3341f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3342f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3343f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3344f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3345f80574aeSJouni Malinen }, 3346f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3347f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3348f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3349f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3350f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3351f80574aeSJouni Malinen }, 3352f80574aeSJouni Malinen }; 3353f80574aeSJouni Malinen 3354bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 335555055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 335655055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3357bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3358bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3359bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3360bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3361bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3362bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3363bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3364bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3365bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3366bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3367bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3368bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3369bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3370bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3371bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3372bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3373bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3374bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3375003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3376abcb344bSKalle Valo #ifdef CONFIG_PM 337752d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 337852d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3379abcb344bSKalle Valo #endif 33806a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 33818860020eSJohannes Berg .start_ap = ath6kl_start_ap, 33828860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 33838860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 338433e5308dSJouni Malinen .del_station = ath6kl_del_station, 338523875136SJouni Malinen .change_station = ath6kl_change_station, 338663fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 338763fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 33888a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3389ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 339010509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 339110509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3392bdcd8170SKalle Valo }; 3393bdcd8170SKalle Valo 33947125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3395ec4b7f60SKalle Valo { 339610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 339710509f90SKalle Valo 3398ec4b7f60SKalle Valo switch (vif->sme_state) { 3399c97a31b0SKalle Valo case SME_DISCONNECTED: 3400c97a31b0SKalle Valo break; 3401ec4b7f60SKalle Valo case SME_CONNECTING: 3402ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3403ec4b7f60SKalle Valo NULL, 0, 3404ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3405ec4b7f60SKalle Valo GFP_KERNEL); 3406ec4b7f60SKalle Valo break; 3407ec4b7f60SKalle Valo case SME_CONNECTED: 3408ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3409ec4b7f60SKalle Valo break; 3410ec4b7f60SKalle Valo } 3411ec4b7f60SKalle Valo 3412ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3413ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 34147125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3415ec4b7f60SKalle Valo 3416ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34171f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 34181f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3419ec4b7f60SKalle Valo 3420ec4b7f60SKalle Valo /* disable scanning */ 34217125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 34227125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 34237125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3424ec4b7f60SKalle Valo 3425ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3426ec4b7f60SKalle Valo } 3427ec4b7f60SKalle Valo 34287125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 34297125f01dSKalle Valo { 34307125f01dSKalle Valo struct ath6kl_vif *vif; 34317125f01dSKalle Valo 34327125f01dSKalle Valo vif = ath6kl_vif_first(ar); 34337125f01dSKalle Valo if (!vif) { 34347125f01dSKalle Valo /* save the current power mode before enabling power save */ 34357125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 34367125f01dSKalle Valo 34377125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3438cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 34397125f01dSKalle Valo return; 34407125f01dSKalle Valo } 34417125f01dSKalle Valo 34427125f01dSKalle Valo /* 34437125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 34447125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 34457125f01dSKalle Valo * sleeps. 34467125f01dSKalle Valo */ 34477125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 34487125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 34497125f01dSKalle Valo } 34507125f01dSKalle Valo 3451c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 34528dafb70eSVasanthakumar Thiagarajan { 34537baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 34542132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 34558dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 34568dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 34578dafb70eSVasanthakumar Thiagarajan } 34588dafb70eSVasanthakumar Thiagarajan 3459de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3460108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 346110509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 346210509f90SKalle Valo (unsigned long) vif); 346310509f90SKalle Valo 3464de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3465478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 34668dafb70eSVasanthakumar Thiagarajan 346780abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 346880abaf9bSVasanthakumar Thiagarajan 34698dafb70eSVasanthakumar Thiagarajan return 0; 34708dafb70eSVasanthakumar Thiagarajan } 34718dafb70eSVasanthakumar Thiagarajan 3472c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 34738dafb70eSVasanthakumar Thiagarajan { 347455055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 347580abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 347655055976SVasanthakumar Thiagarajan 34772132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3478108438bcSVasanthakumar Thiagarajan 347955055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 348055055976SVasanthakumar Thiagarajan 348155055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 348255055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 348355055976SVasanthakumar Thiagarajan 348480abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 348580abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 348680abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 348780abaf9bSVasanthakumar Thiagarajan } 348880abaf9bSVasanthakumar Thiagarajan 348927929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 349055055976SVasanthakumar Thiagarajan 349155055976SVasanthakumar Thiagarajan ar->num_vif--; 34928dafb70eSVasanthakumar Thiagarajan } 34938dafb70eSVasanthakumar Thiagarajan 34948dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 349555055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 349655055976SVasanthakumar Thiagarajan u8 nw_type) 34978dafb70eSVasanthakumar Thiagarajan { 34988dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3499108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 35008dafb70eSVasanthakumar Thiagarajan 350155055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 35028dafb70eSVasanthakumar Thiagarajan if (!ndev) 35038dafb70eSVasanthakumar Thiagarajan return NULL; 35048dafb70eSVasanthakumar Thiagarajan 3505108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3506108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3507108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3508108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3509108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3510108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3511108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3512108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3513334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3514d0d670abSKalle Valo vif->nw_type = nw_type; 3515d0d670abSKalle Valo vif->next_mode = nw_type; 35168f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3517ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3518eb38987eSRaja Mani vif->bg_scan_period = 0; 3519df90b369SVasanthakumar Thiagarajan vif->htcap.ht_enable = true; 35208dafb70eSVasanthakumar Thiagarajan 352155055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 352255055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 352355055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 352455055976SVasanthakumar Thiagarajan 0x2; 352555055976SVasanthakumar Thiagarajan 35268dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 35278dafb70eSVasanthakumar Thiagarajan 3528e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 35298dafb70eSVasanthakumar Thiagarajan 3530c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 35318dafb70eSVasanthakumar Thiagarajan goto err; 35328dafb70eSVasanthakumar Thiagarajan 353327929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 35348dafb70eSVasanthakumar Thiagarajan goto err; 35358dafb70eSVasanthakumar Thiagarajan 353655055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 353714ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 353859c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 35398dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 354059c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 35418dafb70eSVasanthakumar Thiagarajan 354255055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 354355055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 354455055976SVasanthakumar Thiagarajan 354511f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3546990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 354711f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3548990bd915SVasanthakumar Thiagarajan 35498dafb70eSVasanthakumar Thiagarajan return ndev; 35508dafb70eSVasanthakumar Thiagarajan 35518dafb70eSVasanthakumar Thiagarajan err: 355227929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 355327929723SVasanthakumar Thiagarajan free_netdev(ndev); 3554bdcd8170SKalle Valo return NULL; 3555bdcd8170SKalle Valo } 3556bdcd8170SKalle Valo 355746d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 355846d33a21SKalle Valo { 355946d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3560d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 356146d33a21SKalle Valo int ret; 356246d33a21SKalle Valo 356346d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 356446d33a21SKalle Valo 356546d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 356646d33a21SKalle Valo 356746d33a21SKalle Valo /* set device pointer for wiphy */ 356846d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 356946d33a21SKalle Valo 357046d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 357146d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 357246d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 357346d33a21SKalle Valo if (ar->p2p) { 357446d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 357546d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 357646d33a21SKalle Valo } 357746d33a21SKalle Valo 357846d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 35798ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3580dd45b759SNaveen Singh 3581dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3582dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3583dd45b759SNaveen Singh ar->fw_capabilities)) 3584dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3585dd45b759SNaveen Singh 358646d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3587d92917e4SThomas Pedersen switch (ar->hw.cap) { 3588d92917e4SThomas Pedersen case WMI_11AN_CAP: 3589d92917e4SThomas Pedersen ht = true; 3590d92917e4SThomas Pedersen case WMI_11A_CAP: 3591d92917e4SThomas Pedersen band_5gig = true; 3592d92917e4SThomas Pedersen break; 3593d92917e4SThomas Pedersen case WMI_11GN_CAP: 3594d92917e4SThomas Pedersen ht = true; 3595d92917e4SThomas Pedersen case WMI_11G_CAP: 3596d92917e4SThomas Pedersen band_2gig = true; 3597d92917e4SThomas Pedersen break; 3598d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3599d92917e4SThomas Pedersen ht = true; 3600d92917e4SThomas Pedersen case WMI_11AG_CAP: 3601d92917e4SThomas Pedersen band_2gig = true; 3602d92917e4SThomas Pedersen band_5gig = true; 3603d92917e4SThomas Pedersen break; 3604d92917e4SThomas Pedersen default: 3605d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3606d92917e4SThomas Pedersen return -EINVAL; 3607d92917e4SThomas Pedersen } 3608d92917e4SThomas Pedersen 36097fd1ce7eSVasanthakumar Thiagarajan /* 36107fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 36117fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 36127fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 36137fd1ce7eSVasanthakumar Thiagarajan */ 36147fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 36157fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 36167fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3617d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3618d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3619d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3620d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3621d92917e4SThomas Pedersen } 3622d92917e4SThomas Pedersen if (band_2gig) 362346d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3624d92917e4SThomas Pedersen if (band_5gig) 362546d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3626d92917e4SThomas Pedersen 362746d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 362846d33a21SKalle Valo 362946d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 363046d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 363146d33a21SKalle Valo 363246d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 363346d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 363446d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 363546d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 363646d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 363746d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 363846d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 363946d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 364046d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 364146d33a21SKalle Valo 36428ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 364346d33a21SKalle Valo 3644f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3645f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3646f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3647f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3648f2afdac7SVasanthakumar Thiagarajan 3649f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3650f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3651f2afdac7SVasanthakumar Thiagarajan 365203bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 365303bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 365403bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 365503bdeb0dSVasanthakumar Thiagarajan 3656f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3657f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3658f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3659a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3660f2afdac7SVasanthakumar Thiagarajan 366146d33a21SKalle Valo ret = wiphy_register(wiphy); 366246d33a21SKalle Valo if (ret < 0) { 366346d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 366446d33a21SKalle Valo return ret; 366546d33a21SKalle Valo } 366646d33a21SKalle Valo 3667e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3668e5348a1eSVasanthakumar Thiagarajan 366946d33a21SKalle Valo return 0; 367046d33a21SKalle Valo } 367146d33a21SKalle Valo 367246d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3673bdcd8170SKalle Valo { 3674be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3675e5348a1eSVasanthakumar Thiagarajan 3676e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 367745eaa78fSKalle Valo } 367846d33a21SKalle Valo 367945eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 368045eaa78fSKalle Valo { 368145eaa78fSKalle Valo struct ath6kl *ar; 368245eaa78fSKalle Valo struct wiphy *wiphy; 368345eaa78fSKalle Valo 368445eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 368545eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 368645eaa78fSKalle Valo 368745eaa78fSKalle Valo if (!wiphy) { 368845eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 368945eaa78fSKalle Valo return NULL; 369045eaa78fSKalle Valo } 369145eaa78fSKalle Valo 369245eaa78fSKalle Valo ar = wiphy_priv(wiphy); 369345eaa78fSKalle Valo ar->wiphy = wiphy; 369445eaa78fSKalle Valo 369545eaa78fSKalle Valo return ar; 369645eaa78fSKalle Valo } 369745eaa78fSKalle Valo 369845eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 369945eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 370045eaa78fSKalle Valo { 37011d2a4456SVasanthakumar Thiagarajan int i; 37021d2a4456SVasanthakumar Thiagarajan 37031d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 37041d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 37051d2a4456SVasanthakumar Thiagarajan 3706be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3707bdcd8170SKalle Valo } 370845eaa78fSKalle Valo 3709