1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 18516304b0SJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19516304b0SJoe Perches 206eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 21c08631c6SRaja Mani #include <linux/inetdevice.h> 22d6a434d6SKalle Valo #include <linux/export.h> 236eb07cafSPaul Gortmaker 24bdcd8170SKalle Valo #include "core.h" 25bdcd8170SKalle Valo #include "cfg80211.h" 26bdcd8170SKalle Valo #include "debug.h" 27abcb344bSKalle Valo #include "hif-ops.h" 28003353b0SKalle Valo #include "testmode.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54f599359cSBala Shanmugam #define DEFAULT_BG_SCAN_PERIOD 60 55f599359cSBala Shanmugam 56dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid { 57dd45b759SNaveen Singh struct cfg80211_ssid ssid; 58dd45b759SNaveen Singh u8 flag; 59dd45b759SNaveen Singh }; 60dd45b759SNaveen Singh 61bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 62bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 63bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 64bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 65bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 66bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 67bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 68bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 69bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 70bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 71bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 72bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 73bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 74bdcd8170SKalle Valo }; 75bdcd8170SKalle Valo 76bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 77bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 78bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 79bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 80bdcd8170SKalle Valo 81bed56e31SVasanthakumar Thiagarajan #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 82bed56e31SVasanthakumar Thiagarajan #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 83faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 84faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 85faaf1929SVasanthakumar Thiagarajan 86bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 87bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 88bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 89bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 90bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 91bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 92bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 93bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 94bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 95bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 96bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 97bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 98bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 99bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 100bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 101bdcd8170SKalle Valo }; 102bdcd8170SKalle Valo 103bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 104bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 105bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 106bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 107bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 108bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 109bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 110bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 111bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 112bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 113bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 114bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 115bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 116bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 117bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 118bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 119bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 120bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 121bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 122bdcd8170SKalle Valo CHAN5G(216, 0), 123bdcd8170SKalle Valo }; 124bdcd8170SKalle Valo 125bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 126bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 127bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 128bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 129bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 131faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 132bdcd8170SKalle Valo }; 133bdcd8170SKalle Valo 134bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 135bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 136bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 137bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 138bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 139bed56e31SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_a_htcap, 140faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 141bdcd8170SKalle Valo }; 142bdcd8170SKalle Valo 143837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 144837cb97eSJouni Malinen 14510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 14610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 14710509f90SKalle Valo { 14810509f90SKalle Valo struct ath6kl *ar = vif->ar; 14910509f90SKalle Valo 150b1f47e3aSThomas Pedersen if (!test_and_clear_bit(SCHED_SCANNING, &vif->flags)) 15110509f90SKalle Valo return false; 15210509f90SKalle Valo 15310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 154b1f47e3aSThomas Pedersen ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, false); 15510509f90SKalle Valo 15610509f90SKalle Valo return true; 15710509f90SKalle Valo } 15810509f90SKalle Valo 15910509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 16010509f90SKalle Valo { 16110509f90SKalle Valo struct ath6kl *ar = vif->ar; 16210509f90SKalle Valo bool stopped; 16310509f90SKalle Valo 16410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16510509f90SKalle Valo 16610509f90SKalle Valo if (!stopped) 16710509f90SKalle Valo return; 16810509f90SKalle Valo 16910509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 17010509f90SKalle Valo } 17110509f90SKalle Valo 172240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 173bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 174bdcd8170SKalle Valo { 175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 176bdcd8170SKalle Valo 177bdcd8170SKalle Valo if (!wpa_version) { 1783450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 179bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1803450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 181bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1823450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 183bdcd8170SKalle Valo } else { 184bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 185bdcd8170SKalle Valo return -ENOTSUPP; 186bdcd8170SKalle Valo } 187bdcd8170SKalle Valo 188bdcd8170SKalle Valo return 0; 189bdcd8170SKalle Valo } 190bdcd8170SKalle Valo 191240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 192bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 193bdcd8170SKalle Valo { 194bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 195bdcd8170SKalle Valo 196bdcd8170SKalle Valo switch (auth_type) { 197bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1983450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 199bdcd8170SKalle Valo break; 200bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2013450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 202bdcd8170SKalle Valo break; 203bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 205bdcd8170SKalle Valo break; 206bdcd8170SKalle Valo 207bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2083450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 209bdcd8170SKalle Valo break; 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo default: 2123c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 213bdcd8170SKalle Valo return -ENOTSUPP; 214bdcd8170SKalle Valo } 215bdcd8170SKalle Valo 216bdcd8170SKalle Valo return 0; 217bdcd8170SKalle Valo } 218bdcd8170SKalle Valo 219240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 220bdcd8170SKalle Valo { 2213450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2223450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2233450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 224bdcd8170SKalle Valo 225bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 226bdcd8170SKalle Valo __func__, cipher, ucast); 227bdcd8170SKalle Valo 228bdcd8170SKalle Valo switch (cipher) { 229bdcd8170SKalle Valo case 0: 230bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 231bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 232bdcd8170SKalle Valo *ar_cipher_len = 0; 233bdcd8170SKalle Valo break; 234bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 235bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 5; 237bdcd8170SKalle Valo break; 238bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 239bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 240bdcd8170SKalle Valo *ar_cipher_len = 13; 241bdcd8170SKalle Valo break; 242bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 243bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 244bdcd8170SKalle Valo *ar_cipher_len = 0; 245bdcd8170SKalle Valo break; 246bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 247bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 248bdcd8170SKalle Valo *ar_cipher_len = 0; 249bdcd8170SKalle Valo break; 2505e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2515e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2525e07021eSDai Shuibing *ar_cipher_len = 0; 2535e07021eSDai Shuibing break; 254bdcd8170SKalle Valo default: 255bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 256bdcd8170SKalle Valo return -ENOTSUPP; 257bdcd8170SKalle Valo } 258bdcd8170SKalle Valo 259bdcd8170SKalle Valo return 0; 260bdcd8170SKalle Valo } 261bdcd8170SKalle Valo 262240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 263bdcd8170SKalle Valo { 264bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 265bdcd8170SKalle Valo 266bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2673450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2683450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2693450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2703450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 271837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2723450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2733450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2743450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2753450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 276bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2773450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 278bdcd8170SKalle Valo } 279bdcd8170SKalle Valo } 280bdcd8170SKalle Valo 281990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 282bdcd8170SKalle Valo { 283990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28459c98449SVasanthakumar Thiagarajan 285bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 286bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 287bdcd8170SKalle Valo return false; 288bdcd8170SKalle Valo } 289bdcd8170SKalle Valo 29059c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 291bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 292bdcd8170SKalle Valo return false; 293bdcd8170SKalle Valo } 294bdcd8170SKalle Valo 295bdcd8170SKalle Valo return true; 296bdcd8170SKalle Valo } 297bdcd8170SKalle Valo 2986981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2996981ffdcSKevin Fang { 30004b2312aSArend van Spriel return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 3016981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3026981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3036981ffdcSKevin Fang } 3046981ffdcSKevin Fang 3056981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3066981ffdcSKevin Fang { 3076981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3086981ffdcSKevin Fang } 3096981ffdcSKevin Fang 31063541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31163541212SAarthi Thiruvengadam { 31263541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31363541212SAarthi Thiruvengadam pos[1] >= 4 && 31463541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31563541212SAarthi Thiruvengadam pos[5] == 0x04); 31663541212SAarthi Thiruvengadam } 31763541212SAarthi Thiruvengadam 318334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3196981ffdcSKevin Fang size_t ies_len) 3206981ffdcSKevin Fang { 321334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3226981ffdcSKevin Fang const u8 *pos; 3236981ffdcSKevin Fang u8 *buf = NULL; 3246981ffdcSKevin Fang size_t len = 0; 3256981ffdcSKevin Fang int ret; 3266981ffdcSKevin Fang 3276981ffdcSKevin Fang /* 32863541212SAarthi Thiruvengadam * Clear previously set flag 32963541212SAarthi Thiruvengadam */ 33063541212SAarthi Thiruvengadam 33163541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33263541212SAarthi Thiruvengadam 33363541212SAarthi Thiruvengadam /* 3346981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3356981ffdcSKevin Fang */ 3366981ffdcSKevin Fang 3376981ffdcSKevin Fang if (ies && ies_len) { 3386981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3396981ffdcSKevin Fang if (buf == NULL) 3406981ffdcSKevin Fang return -ENOMEM; 3416981ffdcSKevin Fang pos = ies; 3426981ffdcSKevin Fang 3436981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3446981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3456981ffdcSKevin Fang break; 3466981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3476981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3486981ffdcSKevin Fang len += 2 + pos[1]; 3496981ffdcSKevin Fang } 35063541212SAarthi Thiruvengadam 35163541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35263541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35363541212SAarthi Thiruvengadam 3546981ffdcSKevin Fang pos += 2 + pos[1]; 3556981ffdcSKevin Fang } 3566981ffdcSKevin Fang } 3576981ffdcSKevin Fang 358334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 359334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3606981ffdcSKevin Fang kfree(buf); 3616981ffdcSKevin Fang return ret; 3626981ffdcSKevin Fang } 3636981ffdcSKevin Fang 36455055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36555055976SVasanthakumar Thiagarajan { 36655055976SVasanthakumar Thiagarajan switch (type) { 36755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36838142644SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 36955055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37055055976SVasanthakumar Thiagarajan break; 37155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37255055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37355055976SVasanthakumar Thiagarajan break; 37455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37655055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan default: 37955055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38055055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38155055976SVasanthakumar Thiagarajan } 38255055976SVasanthakumar Thiagarajan 38355055976SVasanthakumar Thiagarajan return 0; 38455055976SVasanthakumar Thiagarajan } 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 38755055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38855055976SVasanthakumar Thiagarajan { 38955055976SVasanthakumar Thiagarajan int i; 39055055976SVasanthakumar Thiagarajan 39155055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39255055976SVasanthakumar Thiagarajan return false; 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39555055976SVasanthakumar Thiagarajan ar->num_vif)) 39655055976SVasanthakumar Thiagarajan return false; 39755055976SVasanthakumar Thiagarajan 39855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39955055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40071f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40155055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40255055976SVasanthakumar Thiagarajan *if_idx = i; 40355055976SVasanthakumar Thiagarajan return true; 40455055976SVasanthakumar Thiagarajan } 40555055976SVasanthakumar Thiagarajan } 40655055976SVasanthakumar Thiagarajan } 40755055976SVasanthakumar Thiagarajan 4083226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4093226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41071f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4113226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4123226f68aSVasanthakumar Thiagarajan *if_idx = i; 4133226f68aSVasanthakumar Thiagarajan return true; 4143226f68aSVasanthakumar Thiagarajan } 4153226f68aSVasanthakumar Thiagarajan } 4163226f68aSVasanthakumar Thiagarajan } 4173226f68aSVasanthakumar Thiagarajan 41855055976SVasanthakumar Thiagarajan return false; 41955055976SVasanthakumar Thiagarajan } 42055055976SVasanthakumar Thiagarajan 4218c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4228c9bb054SKalle Valo { 4238c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4248c9bb054SKalle Valo } 4258c9bb054SKalle Valo 4268c9bb054SKalle Valo 427bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 428bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 429bdcd8170SKalle Valo { 430bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 432bdcd8170SKalle Valo int status; 4333ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 434ce0dc0cfSRaja Mani u16 interval; 435bdcd8170SKalle Valo 43610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 43710509f90SKalle Valo 43814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 439bdcd8170SKalle Valo 440990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 441bdcd8170SKalle Valo return -EIO; 442bdcd8170SKalle Valo 443bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 444bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 445bdcd8170SKalle Valo return -EBUSY; 446bdcd8170SKalle Valo } 447bdcd8170SKalle Valo 448bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 449bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 450bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 451bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 452bdcd8170SKalle Valo return -EINVAL; 453bdcd8170SKalle Valo } 454bdcd8170SKalle Valo 455bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 456bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 457bdcd8170SKalle Valo return -ERESTARTSYS; 458bdcd8170SKalle Valo } 459bdcd8170SKalle Valo 460bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 461bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 462bdcd8170SKalle Valo up(&ar->sem); 463bdcd8170SKalle Valo return -EBUSY; 464bdcd8170SKalle Valo } 465bdcd8170SKalle Valo 466bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 467bdcd8170SKalle Valo /* 468bdcd8170SKalle Valo * sleep until the command queue drains 469bdcd8170SKalle Valo */ 470bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4718c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 472bdcd8170SKalle Valo WMI_TIMEOUT); 473bdcd8170SKalle Valo if (signal_pending(current)) { 474bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 475bdcd8170SKalle Valo up(&ar->sem); 476bdcd8170SKalle Valo return -EINTR; 477bdcd8170SKalle Valo } 478bdcd8170SKalle Valo } 479bdcd8170SKalle Valo 480334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 481743b4518SDan Carpenter if (status) { 482743b4518SDan Carpenter up(&ar->sem); 4836981ffdcSKevin Fang return status; 484743b4518SDan Carpenter } 4856e786cb1SJouni Malinen 4866e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 487542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4886981ffdcSKevin Fang 48959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4903450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4913450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 492cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 493334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 494334234b5SVasanthakumar Thiagarajan vif->req_bssid, 495f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 496bdcd8170SKalle Valo 497bdcd8170SKalle Valo up(&ar->sem); 498bdcd8170SKalle Valo if (status) { 499bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 500bdcd8170SKalle Valo return -EIO; 501bdcd8170SKalle Valo } 502bdcd8170SKalle Valo return 0; 5033450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5043450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 505240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 5083450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5093450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5103450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 511bdcd8170SKalle Valo 512bdcd8170SKalle Valo if (sme->channel) 513f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 514bdcd8170SKalle Valo 5158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 516bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5178c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 518bdcd8170SKalle Valo 519240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 520bdcd8170SKalle Valo 521240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 522bdcd8170SKalle Valo if (status) { 523bdcd8170SKalle Valo up(&ar->sem); 524bdcd8170SKalle Valo return status; 525bdcd8170SKalle Valo } 526bdcd8170SKalle Valo 527bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 528240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 529bdcd8170SKalle Valo else 530240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 531bdcd8170SKalle Valo 532240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 533bdcd8170SKalle Valo 534bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 535240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if ((sme->key_len) && 5383450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5393450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 540bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 541bdcd8170SKalle Valo 542792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 543bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 544bdcd8170SKalle Valo sme->key_idx); 545bdcd8170SKalle Valo up(&ar->sem); 546bdcd8170SKalle Valo return -ENOENT; 547bdcd8170SKalle Valo } 548bdcd8170SKalle Valo 5496f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 550bdcd8170SKalle Valo key->key_len = sme->key_len; 551bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5523450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5533450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 554bdcd8170SKalle Valo 555334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5563450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 557bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 558bdcd8170SKalle Valo key->key_len, 559f4bb9a6fSJouni Malinen NULL, 0, 560bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 561bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 562bdcd8170SKalle Valo } 563bdcd8170SKalle Valo 564bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 566240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 567240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 568bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 569bdcd8170SKalle Valo up(&ar->sem); 570bdcd8170SKalle Valo return -EIO; 571bdcd8170SKalle Valo } 572bdcd8170SKalle Valo } 573bdcd8170SKalle Valo 574f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 575bdcd8170SKalle Valo 576c422d52dSThomas Pedersen /* enable enhanced bmiss detection if applicable */ 577c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, true); 578c422d52dSThomas Pedersen 5793ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5803ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5813ca9d1fcSAarthi Thiruvengadam 582bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 583bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 584bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 585bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 586bdcd8170SKalle Valo __func__, 5873450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5883450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 589f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 590bdcd8170SKalle Valo 591cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 592ce0dc0cfSRaja Mani 593ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 594b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 595b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 596ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 597ce0dc0cfSRaja Mani interval, 598ce0dc0cfSRaja Mani 0); 599ce0dc0cfSRaja Mani if (status) { 600ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 601ce0dc0cfSRaja Mani up(&ar->sem); 602ce0dc0cfSRaja Mani return status; 603ce0dc0cfSRaja Mani } 604ce0dc0cfSRaja Mani } 605ce0dc0cfSRaja Mani 606334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6073450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6083450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6093450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6103450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6113450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 612f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6133ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 614bdcd8170SKalle Valo 615f599359cSBala Shanmugam /* disable background scan if period is 0 */ 616f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 617f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 618f599359cSBala Shanmugam 619f599359cSBala Shanmugam /* configure default value if not specified */ 620f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 621f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 622f599359cSBala Shanmugam 623f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 624f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 625f599359cSBala Shanmugam 626bdcd8170SKalle Valo up(&ar->sem); 627bdcd8170SKalle Valo 628bdcd8170SKalle Valo if (status == -EINVAL) { 6293450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6303450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 631bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 632bdcd8170SKalle Valo return -ENOENT; 633bdcd8170SKalle Valo } else if (status) { 634bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 635bdcd8170SKalle Valo return -EIO; 636bdcd8170SKalle Valo } 637bdcd8170SKalle Valo 638bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 639ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 640ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 641de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 642bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 643bdcd8170SKalle Valo } 644bdcd8170SKalle Valo 645bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 64659c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 647bdcd8170SKalle Valo 648bdcd8170SKalle Valo return 0; 649bdcd8170SKalle Valo } 650bdcd8170SKalle Valo 6515e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6525e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6534eab6f4fSRaja Mani enum network_type nw_type, 6544eab6f4fSRaja Mani const u8 *bssid, 65501cac476SJouni Malinen struct ieee80211_channel *chan, 6565e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6575e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 65801cac476SJouni Malinen { 659240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 66001cac476SJouni Malinen struct cfg80211_bss *bss; 6614eab6f4fSRaja Mani u16 cap_mask, cap_val; 66201cac476SJouni Malinen u8 *ie; 66301cac476SJouni Malinen 6644eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6654eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6664eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6674eab6f4fSRaja Mani } else { 6684eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6694eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6704eab6f4fSRaja Mani } 6714eab6f4fSRaja Mani 672be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6734eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6744eab6f4fSRaja Mani cap_mask, cap_val); 67501cac476SJouni Malinen if (bss == NULL) { 67601cac476SJouni Malinen /* 67701cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 67801cac476SJouni Malinen * generate a partial entry until the first BSS info 67901cac476SJouni Malinen * event becomes available. 68001cac476SJouni Malinen * 68101cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 68201cac476SJouni Malinen * IEs from the target. 68301cac476SJouni Malinen */ 6843450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 68501cac476SJouni Malinen if (ie == NULL) 6865e13fd35SVasanthakumar Thiagarajan return NULL; 68701cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6883450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6893450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6903450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 691be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6924eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6933450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 69401cac476SJouni Malinen 0, GFP_KERNEL); 69501cac476SJouni Malinen if (bss) 696cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 697cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 69801cac476SJouni Malinen kfree(ie); 69901cac476SJouni Malinen } else 7005e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 70101cac476SJouni Malinen 7025e13fd35SVasanthakumar Thiagarajan return bss; 70301cac476SJouni Malinen } 70401cac476SJouni Malinen 705240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 706bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 707bdcd8170SKalle Valo u16 beacon_intvl, 708bdcd8170SKalle Valo enum network_type nw_type, 709bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 710bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 711bdcd8170SKalle Valo { 71201cac476SJouni Malinen struct ieee80211_channel *chan; 713240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7145e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo /* capinfo + listen interval */ 717bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo /* capinfo + status code + associd */ 720bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 723bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 724bdcd8170SKalle Valo assoc_resp_ie_offset; 725bdcd8170SKalle Valo 726bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 727bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 728bdcd8170SKalle Valo 72932c10874SJouni Malinen /* 73032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 73132c10874SJouni Malinen * a Beacon frame from the AP is seen. 73232c10874SJouni Malinen */ 733cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 73459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 73532c10874SJouni Malinen 736bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 737551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 738bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 739bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 740bdcd8170SKalle Valo return; 741bdcd8170SKalle Valo } 742bdcd8170SKalle Valo } 743bdcd8170SKalle Valo 744bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 745551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 746551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 747bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 748bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 749bdcd8170SKalle Valo return; 750bdcd8170SKalle Valo } 751bdcd8170SKalle Valo } 752bdcd8170SKalle Valo 753be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 754bdcd8170SKalle Valo 7555e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7565e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7575e13fd35SVasanthakumar Thiagarajan if (!bss) { 7584eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 759bdcd8170SKalle Valo return; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 7624eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7634eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7644eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7654eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7665e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76701cac476SJouni Malinen return; 76801cac476SJouni Malinen } 76901cac476SJouni Malinen 77014ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 771bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 77214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 773240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 774bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 775bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 776bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7775e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77814ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 779bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7805e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 781bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo } 784bdcd8170SKalle Valo 785bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 786bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 787bdcd8170SKalle Valo { 788d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7893450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 790bdcd8170SKalle Valo 791bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 792bdcd8170SKalle Valo reason_code); 793bdcd8170SKalle Valo 79410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 79510509f90SKalle Valo 796990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 797bdcd8170SKalle Valo return -EIO; 798bdcd8170SKalle Valo 799bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 800bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 801bdcd8170SKalle Valo return -EBUSY; 802bdcd8170SKalle Valo } 803bdcd8170SKalle Valo 804bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 805bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 806bdcd8170SKalle Valo return -ERESTARTSYS; 807bdcd8170SKalle Valo } 808bdcd8170SKalle Valo 809cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 810240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8113450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8123450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 813bdcd8170SKalle Valo 814bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 816bdcd8170SKalle Valo 817bdcd8170SKalle Valo up(&ar->sem); 818bdcd8170SKalle Valo 81914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 820170826ddSVasanthakumar Thiagarajan 821bdcd8170SKalle Valo return 0; 822bdcd8170SKalle Valo } 823bdcd8170SKalle Valo 824240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 825bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 826bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 827bdcd8170SKalle Valo { 828240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 82959c98449SVasanthakumar Thiagarajan 83014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 83114ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 83214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 833bdcd8170SKalle Valo } 834bdcd8170SKalle Valo 835f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 836551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 837bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 838bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 839bdcd8170SKalle Valo return; 840bdcd8170SKalle Valo } 841bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 842240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 843bdcd8170SKalle Valo return; 844bdcd8170SKalle Valo } 845bdcd8170SKalle Valo 846f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 847551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 848551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 849bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 850bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 851bdcd8170SKalle Valo return; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo } 854bdcd8170SKalle Valo 85559c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 856bdcd8170SKalle Valo 85714ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 858240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 859bdcd8170SKalle Valo bssid, NULL, 0, 860bdcd8170SKalle Valo NULL, 0, 861bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 862bdcd8170SKalle Valo GFP_KERNEL); 86314ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 86433a6664aSThomas Pedersen cfg80211_disconnected(vif->ndev, proto_reason, 865bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 866bdcd8170SKalle Valo } 867bdcd8170SKalle Valo 86814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 86933a6664aSThomas Pedersen 87033a6664aSThomas Pedersen /* 87133a6664aSThomas Pedersen * Send a disconnect command to target when a disconnect event is 87233a6664aSThomas Pedersen * received with reason code other than 3 (DISCONNECT_CMD - disconnect 87333a6664aSThomas Pedersen * request from host) to make the firmware stop trying to connect even 87433a6664aSThomas Pedersen * after giving disconnect event. There will be one more disconnect 87533a6664aSThomas Pedersen * event for this disconnect command with reason code DISCONNECT_CMD 87633a6664aSThomas Pedersen * which won't be notified to cfg80211. 87733a6664aSThomas Pedersen */ 87833a6664aSThomas Pedersen if (reason != DISCONNECT_CMD) 87933a6664aSThomas Pedersen ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 8823b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 8833b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 884dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 885dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 886dd45b759SNaveen Singh int n_match_ssid) 8873b8ffc6aSJouni Malinen { 888dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 889dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 8903b8ffc6aSJouni Malinen 891dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 892dd45b759SNaveen Singh 893dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 894dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 8953b8ffc6aSJouni Malinen return -EINVAL; 8963b8ffc6aSJouni Malinen 8973b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 898dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 899dd45b759SNaveen Singh ssids[i].ssid, 900dd45b759SNaveen Singh ssids[i].ssid_len); 901dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 902dd45b759SNaveen Singh 903dd45b759SNaveen Singh if (ssids[i].ssid_len) 904dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 905dd45b759SNaveen Singh else 906dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 907dd45b759SNaveen Singh 908dd45b759SNaveen Singh if (n_match_ssid == 0) 909dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 910dd45b759SNaveen Singh } 911dd45b759SNaveen Singh 912dd45b759SNaveen Singh index_to_add = i; 913dd45b759SNaveen Singh 914dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 915dd45b759SNaveen Singh ssid_found = false; 916dd45b759SNaveen Singh 917dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 918dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 919dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 920dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 921dd45b759SNaveen Singh match_set[i].ssid.ssid, 922dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 923dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 924dd45b759SNaveen Singh ssid_found = true; 925dd45b759SNaveen Singh break; 926dd45b759SNaveen Singh } 927dd45b759SNaveen Singh } 928dd45b759SNaveen Singh 929dd45b759SNaveen Singh if (ssid_found) 930dd45b759SNaveen Singh continue; 931dd45b759SNaveen Singh 932dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 933dd45b759SNaveen Singh continue; 934dd45b759SNaveen Singh 935dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 936dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 937dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 938dd45b759SNaveen Singh match_set[i].ssid.ssid, 939dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 940dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 941dd45b759SNaveen Singh index_to_add++; 942dd45b759SNaveen Singh } 943dd45b759SNaveen Singh 944dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9453b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 946dd45b759SNaveen Singh ssid_list[i].flag, 947dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 948dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 949dd45b759SNaveen Singh 9503b8ffc6aSJouni Malinen } 9513b8ffc6aSJouni Malinen 9523b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 953dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9543b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9553b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9563b8ffc6aSJouni Malinen } 9573b8ffc6aSJouni Malinen 9583b8ffc6aSJouni Malinen return 0; 9593b8ffc6aSJouni Malinen } 9603b8ffc6aSJouni Malinen 961fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy, 962bdcd8170SKalle Valo struct cfg80211_scan_request *request) 963bdcd8170SKalle Valo { 964fd014284SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev); 965fd014284SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 9661276c9efSEdward Lu s8 n_channels = 0; 9671276c9efSEdward Lu u16 *channels = NULL; 968bdcd8170SKalle Valo int ret = 0; 969f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 970bdcd8170SKalle Valo 971990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 972bdcd8170SKalle Valo return -EIO; 973bdcd8170SKalle Valo 97410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 97510509f90SKalle Valo 976bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 97759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 978954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 979954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 9801b1e6ee3SJouni Malinen if (ret) { 981bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9821b1e6ee3SJouni Malinen return ret; 983bdcd8170SKalle Valo } 984bdcd8170SKalle Valo } 985bdcd8170SKalle Valo 9863b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 987dd45b759SNaveen Singh request->n_ssids, NULL, 0); 9883b8ffc6aSJouni Malinen if (ret < 0) 9893b8ffc6aSJouni Malinen return ret; 990bdcd8170SKalle Valo 991080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 992334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 993334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 994b84da8c7SJouni Malinen request->ie, request->ie_len); 995b84da8c7SJouni Malinen if (ret) { 996f1ff32e8SJoe Perches ath6kl_err("failed to set Probe Request appie for scan\n"); 997b84da8c7SJouni Malinen return ret; 998b84da8c7SJouni Malinen } 999b84da8c7SJouni Malinen 100011869befSJouni Malinen /* 100111869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 100211869befSJouni Malinen * channels. If the list is longer than the target supports, do not 100311869befSJouni Malinen * configure the list and instead, scan all available channels. 100411869befSJouni Malinen */ 100511869befSJouni Malinen if (request->n_channels > 0 && 100611869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10071276c9efSEdward Lu u8 i; 10081276c9efSEdward Lu 100911869befSJouni Malinen n_channels = request->n_channels; 10101276c9efSEdward Lu 10111276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 10121276c9efSEdward Lu if (channels == NULL) { 1013cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10141276c9efSEdward Lu n_channels = 0; 10151276c9efSEdward Lu } 10161276c9efSEdward Lu 10171276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10181276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10191276c9efSEdward Lu } 10201276c9efSEdward Lu 102159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1022f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1023f1f92179SVasanthakumar Thiagarajan 10245b35dff0SRaja Mani vif->scan_req = request; 10255b35dff0SRaja Mani 10263ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10273ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 102813423c31SVasanthakumar Thiagarajan false, 0, 102913423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 103013423c31SVasanthakumar Thiagarajan n_channels, channels, 103113423c31SVasanthakumar Thiagarajan request->no_cck, 10323ca9d1fcSAarthi Thiruvengadam request->rates); 10335b35dff0SRaja Mani if (ret) { 103411f0bfcfSKalle Valo ath6kl_err("failed to start scan: %d\n", ret); 10355b35dff0SRaja Mani vif->scan_req = NULL; 10365b35dff0SRaja Mani } 1037bdcd8170SKalle Valo 10381276c9efSEdward Lu kfree(channels); 10391276c9efSEdward Lu 1040bdcd8170SKalle Valo return ret; 1041bdcd8170SKalle Valo } 1042bdcd8170SKalle Valo 10431c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1044bdcd8170SKalle Valo { 1045240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10466fd1eaceSKalle Valo int i; 1047bdcd8170SKalle Valo 10481c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10491c17d313SKalle Valo aborted ? " aborted" : ""); 1050bdcd8170SKalle Valo 105114ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10526fd1eaceSKalle Valo return; 10536fd1eaceSKalle Valo 10541c17d313SKalle Valo if (aborted) 10556fd1eaceSKalle Valo goto out; 1056bdcd8170SKalle Valo 105714ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 105814ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1059334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1060334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1061bdcd8170SKalle Valo 0, NULL); 1062bdcd8170SKalle Valo } 1063bdcd8170SKalle Valo } 10646fd1eaceSKalle Valo 10656fd1eaceSKalle Valo out: 1066cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 106714ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1068bdcd8170SKalle Valo } 1069bdcd8170SKalle Valo 1070c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1071c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1072c4f7863eSThomas Pedersen { 1073c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1074c4f7863eSThomas Pedersen 1075c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1076c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1077c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1078c4f7863eSThomas Pedersen 1079c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1080c4f7863eSThomas Pedersen 1081c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1082c4f7863eSThomas Pedersen } 1083c4f7863eSThomas Pedersen 1084bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1085bdcd8170SKalle Valo u8 key_index, bool pairwise, 1086bdcd8170SKalle Valo const u8 *mac_addr, 1087bdcd8170SKalle Valo struct key_params *params) 1088bdcd8170SKalle Valo { 1089d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 109059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1091bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10924a8ce2fdSSujith Manoharan int seq_len; 1093bdcd8170SKalle Valo u8 key_usage; 1094bdcd8170SKalle Valo u8 key_type; 1095bdcd8170SKalle Valo 1096990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1097bdcd8170SKalle Valo return -EIO; 1098bdcd8170SKalle Valo 1099837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1100837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1101837cb97eSJouni Malinen return -EINVAL; 1102240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1103240d2799SVasanthakumar Thiagarajan params->key); 1104837cb97eSJouni Malinen } 1105837cb97eSJouni Malinen 1106792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1107bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1108bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1109bdcd8170SKalle Valo key_index); 1110bdcd8170SKalle Valo return -ENOENT; 1111bdcd8170SKalle Valo } 1112bdcd8170SKalle Valo 11136f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1114bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1115bdcd8170SKalle Valo 1116bdcd8170SKalle Valo if (pairwise) 1117bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1118bdcd8170SKalle Valo else 1119bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1120bdcd8170SKalle Valo 11214a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11225e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11235e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11245e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11255e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11265e07021eSDai Shuibing } 1127bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11285e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1129bdcd8170SKalle Valo return -EINVAL; 1130bdcd8170SKalle Valo 1131bdcd8170SKalle Valo key->key_len = params->key_len; 1132bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11335e07021eSDai Shuibing key->seq_len = seq_len; 1134bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1135bdcd8170SKalle Valo key->cipher = params->cipher; 1136bdcd8170SKalle Valo 1137bdcd8170SKalle Valo switch (key->cipher) { 1138bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1139bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1140bdcd8170SKalle Valo key_type = WEP_CRYPT; 1141bdcd8170SKalle Valo break; 1142bdcd8170SKalle Valo 1143bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1144bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1145bdcd8170SKalle Valo break; 1146bdcd8170SKalle Valo 1147bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1148bdcd8170SKalle Valo key_type = AES_CRYPT; 1149bdcd8170SKalle Valo break; 11505e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11515e07021eSDai Shuibing key_type = WAPI_CRYPT; 11525e07021eSDai Shuibing break; 1153bdcd8170SKalle Valo 1154bdcd8170SKalle Valo default: 1155bdcd8170SKalle Valo return -ENOTSUPP; 1156bdcd8170SKalle Valo } 1157bdcd8170SKalle Valo 1158ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1159ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1160ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1161de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1164bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1165bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1166bdcd8170SKalle Valo key_usage, key->seq_len); 1167bdcd8170SKalle Valo 1168f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11694703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1170cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11719a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11729a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11739a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11749a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11759a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 117659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1177cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1178cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 11799a5b1318SJouni Malinen /* 11809a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11819a5b1318SJouni Malinen * the connected event is received from the target. 11829a5b1318SJouni Malinen */ 11839a5b1318SJouni Malinen return 0; 11849a5b1318SJouni Malinen } 11859a5b1318SJouni Malinen } 11869a5b1318SJouni Malinen 1187f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 118859c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1189151411e8SJouni Malinen /* 1190151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1191151411e8SJouni Malinen * the AP mode has properly started 1192151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1193151411e8SJouni Malinen */ 1194cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1195cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 11966f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11976f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11986f2a73f9SVasanthakumar Thiagarajan key->key_len); 1199151411e8SJouni Malinen return 0; 1200151411e8SJouni Malinen } 1201151411e8SJouni Malinen 12027cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1203bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1204f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1205f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1206bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1207bdcd8170SKalle Valo } 1208bdcd8170SKalle Valo 1209bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1210bdcd8170SKalle Valo u8 key_index, bool pairwise, 1211bdcd8170SKalle Valo const u8 *mac_addr) 1212bdcd8170SKalle Valo { 1213d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12146f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1215bdcd8170SKalle Valo 1216bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1217bdcd8170SKalle Valo 1218990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1219bdcd8170SKalle Valo return -EIO; 1220bdcd8170SKalle Valo 1221792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1222bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1223bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1224bdcd8170SKalle Valo key_index); 1225bdcd8170SKalle Valo return -ENOENT; 1226bdcd8170SKalle Valo } 1227bdcd8170SKalle Valo 12286f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1229bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1230bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1231bdcd8170SKalle Valo return 0; 1232bdcd8170SKalle Valo } 1233bdcd8170SKalle Valo 12346f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1235bdcd8170SKalle Valo 1236334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1237bdcd8170SKalle Valo } 1238bdcd8170SKalle Valo 1239bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1240bdcd8170SKalle Valo u8 key_index, bool pairwise, 1241bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1242bdcd8170SKalle Valo void (*callback) (void *cookie, 1243bdcd8170SKalle Valo struct key_params *)) 1244bdcd8170SKalle Valo { 12456f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1246bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1247bdcd8170SKalle Valo struct key_params params; 1248bdcd8170SKalle Valo 1249bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1250bdcd8170SKalle Valo 1251990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1252bdcd8170SKalle Valo return -EIO; 1253bdcd8170SKalle Valo 1254792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1255bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1256bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1257bdcd8170SKalle Valo key_index); 1258bdcd8170SKalle Valo return -ENOENT; 1259bdcd8170SKalle Valo } 1260bdcd8170SKalle Valo 12616f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1262bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1263bdcd8170SKalle Valo params.cipher = key->cipher; 1264bdcd8170SKalle Valo params.key_len = key->key_len; 1265bdcd8170SKalle Valo params.seq_len = key->seq_len; 1266bdcd8170SKalle Valo params.seq = key->seq; 1267bdcd8170SKalle Valo params.key = key->key; 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo callback(cookie, ¶ms); 1270bdcd8170SKalle Valo 1271bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1272bdcd8170SKalle Valo } 1273bdcd8170SKalle Valo 1274bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1275bdcd8170SKalle Valo struct net_device *ndev, 1276bdcd8170SKalle Valo u8 key_index, bool unicast, 1277bdcd8170SKalle Valo bool multicast) 1278bdcd8170SKalle Valo { 1279d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 128059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1281bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1282bdcd8170SKalle Valo u8 key_usage; 1283229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1284bdcd8170SKalle Valo 1285bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1286bdcd8170SKalle Valo 1287990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1288bdcd8170SKalle Valo return -EIO; 1289bdcd8170SKalle Valo 1290792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1291bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1292bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1293bdcd8170SKalle Valo __func__, key_index); 1294bdcd8170SKalle Valo return -ENOENT; 1295bdcd8170SKalle Valo } 1296bdcd8170SKalle Valo 12976f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1298bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1299bdcd8170SKalle Valo __func__, key_index); 1300bdcd8170SKalle Valo return -EINVAL; 1301bdcd8170SKalle Valo } 1302bdcd8170SKalle Valo 13033450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13046f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1305bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13063450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1307bdcd8170SKalle Valo key_usage |= TX_USAGE; 1308229ed6b5SEdward Lu if (unicast) 13093450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1310229ed6b5SEdward Lu if (multicast) 13113450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1312bdcd8170SKalle Valo 1313f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13149a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13159a5b1318SJouni Malinen 1316f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1317334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1318229ed6b5SEdward Lu key_type, key_usage, 1319f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1320f4bb9a6fSJouni Malinen key->key, 1321bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1322bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo 1325240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1326bdcd8170SKalle Valo bool ismcast) 1327bdcd8170SKalle Valo { 1328bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1329bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1330bdcd8170SKalle Valo 1331240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1332bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1333bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1334bdcd8170SKalle Valo GFP_KERNEL); 1335bdcd8170SKalle Valo } 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1338bdcd8170SKalle Valo { 1339bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1340990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1341bdcd8170SKalle Valo int ret; 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1344bdcd8170SKalle Valo changed); 1345bdcd8170SKalle Valo 1346990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1347990bd915SVasanthakumar Thiagarajan if (!vif) 1348990bd915SVasanthakumar Thiagarajan return -EIO; 1349990bd915SVasanthakumar Thiagarajan 1350990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1351bdcd8170SKalle Valo return -EIO; 1352bdcd8170SKalle Valo 1353bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1354bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1355bdcd8170SKalle Valo if (ret != 0) { 1356bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1357bdcd8170SKalle Valo return -EIO; 1358bdcd8170SKalle Valo } 1359bdcd8170SKalle Valo } 1360bdcd8170SKalle Valo 1361bdcd8170SKalle Valo return 0; 1362bdcd8170SKalle Valo } 1363bdcd8170SKalle Valo 1364bdcd8170SKalle Valo /* 1365bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1366bdcd8170SKalle Valo * data type from 2.6.36 onwards 1367bdcd8170SKalle Valo */ 1368bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1369bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1370b992a285SLuis R. Rodriguez int mbm) 1371bdcd8170SKalle Valo { 1372bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1373990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1374b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1375bdcd8170SKalle Valo 1376bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1377bdcd8170SKalle Valo type, dbm); 1378bdcd8170SKalle Valo 1379990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1380990bd915SVasanthakumar Thiagarajan if (!vif) 1381990bd915SVasanthakumar Thiagarajan return -EIO; 1382990bd915SVasanthakumar Thiagarajan 1383990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1384bdcd8170SKalle Valo return -EIO; 1385bdcd8170SKalle Valo 1386bdcd8170SKalle Valo switch (type) { 1387bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1388bdcd8170SKalle Valo return 0; 1389bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1390d0d670abSKalle Valo ar->tx_pwr = dbm; 1391bdcd8170SKalle Valo break; 1392bdcd8170SKalle Valo default: 1393bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1394bdcd8170SKalle Valo __func__, type); 1395bdcd8170SKalle Valo return -EOPNOTSUPP; 1396bdcd8170SKalle Valo } 1397bdcd8170SKalle Valo 1398d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1399bdcd8170SKalle Valo 1400bdcd8170SKalle Valo return 0; 1401bdcd8170SKalle Valo } 1402bdcd8170SKalle Valo 1403bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1404bdcd8170SKalle Valo { 1405bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1406990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1407bdcd8170SKalle Valo 1408990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1409990bd915SVasanthakumar Thiagarajan if (!vif) 1410990bd915SVasanthakumar Thiagarajan return -EIO; 1411990bd915SVasanthakumar Thiagarajan 1412990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1413bdcd8170SKalle Valo return -EIO; 1414bdcd8170SKalle Valo 141559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1416bdcd8170SKalle Valo ar->tx_pwr = 0; 1417bdcd8170SKalle Valo 1418990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1419bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1420bdcd8170SKalle Valo return -EIO; 1421bdcd8170SKalle Valo } 1422bdcd8170SKalle Valo 1423bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1424bdcd8170SKalle Valo 5 * HZ); 1425bdcd8170SKalle Valo 1426bdcd8170SKalle Valo if (signal_pending(current)) { 1427bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1428bdcd8170SKalle Valo return -EINTR; 1429bdcd8170SKalle Valo } 1430bdcd8170SKalle Valo } 1431bdcd8170SKalle Valo 1432bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1433bdcd8170SKalle Valo return 0; 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1437bdcd8170SKalle Valo struct net_device *dev, 1438bdcd8170SKalle Valo bool pmgmt, int timeout) 1439bdcd8170SKalle Valo { 1440bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1441bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1442334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1445bdcd8170SKalle Valo __func__, pmgmt, timeout); 1446bdcd8170SKalle Valo 1447990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1448bdcd8170SKalle Valo return -EIO; 1449bdcd8170SKalle Valo 1450bdcd8170SKalle Valo if (pmgmt) { 1451bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1452bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1453bdcd8170SKalle Valo } else { 1454bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1455bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1456bdcd8170SKalle Valo } 1457bdcd8170SKalle Valo 1458334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1459334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1460bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1461bdcd8170SKalle Valo return -EIO; 1462bdcd8170SKalle Valo } 1463bdcd8170SKalle Valo 1464bdcd8170SKalle Valo return 0; 1465bdcd8170SKalle Valo } 1466bdcd8170SKalle Valo 146784efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1468552bff0cSJohannes Berg const char *name, 146955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 147055055976SVasanthakumar Thiagarajan u32 *flags, 147155055976SVasanthakumar Thiagarajan struct vif_params *params) 147255055976SVasanthakumar Thiagarajan { 147355055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 147484efbb84SJohannes Berg struct wireless_dev *wdev; 147555055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 147655055976SVasanthakumar Thiagarajan 147771f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 147855055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 147955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 148055055976SVasanthakumar Thiagarajan } 148155055976SVasanthakumar Thiagarajan 148255055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 148355055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 148455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 148555055976SVasanthakumar Thiagarajan } 148655055976SVasanthakumar Thiagarajan 148784efbb84SJohannes Berg wdev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 148884efbb84SJohannes Berg if (!wdev) 148955055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 149055055976SVasanthakumar Thiagarajan 149155055976SVasanthakumar Thiagarajan ar->num_vif++; 149255055976SVasanthakumar Thiagarajan 149384efbb84SJohannes Berg return wdev; 149455055976SVasanthakumar Thiagarajan } 149555055976SVasanthakumar Thiagarajan 149655055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 149784efbb84SJohannes Berg struct wireless_dev *wdev) 149855055976SVasanthakumar Thiagarajan { 149955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 150084efbb84SJohannes Berg struct ath6kl_vif *vif = netdev_priv(wdev->netdev); 150155055976SVasanthakumar Thiagarajan 150211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 150355055976SVasanthakumar Thiagarajan list_del(&vif->list); 150411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 150555055976SVasanthakumar Thiagarajan 150655055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 150755055976SVasanthakumar Thiagarajan 1508c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 150955055976SVasanthakumar Thiagarajan 151055055976SVasanthakumar Thiagarajan return 0; 151155055976SVasanthakumar Thiagarajan } 151255055976SVasanthakumar Thiagarajan 1513bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1514bdcd8170SKalle Valo struct net_device *ndev, 1515bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1516bdcd8170SKalle Valo struct vif_params *params) 1517bdcd8170SKalle Valo { 1518f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15191e8d13b0SVasanthakumar Thiagarajan int i; 1520bdcd8170SKalle Valo 1521bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1522bdcd8170SKalle Valo 15231e8d13b0SVasanthakumar Thiagarajan /* 15241e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15251e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15261e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15271e8d13b0SVasanthakumar Thiagarajan */ 15281e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15291e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15301e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15311e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15321e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15331e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15341e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15351e8d13b0SVasanthakumar Thiagarajan else 15361e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15371e8d13b0SVasanthakumar Thiagarajan } 15381e8d13b0SVasanthakumar Thiagarajan 15391e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15401e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15411e8d13b0SVasanthakumar Thiagarajan break; 15421e8d13b0SVasanthakumar Thiagarajan } 15431e8d13b0SVasanthakumar Thiagarajan 15441e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15451e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15461e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15471e8d13b0SVasanthakumar Thiagarajan } 15481e8d13b0SVasanthakumar Thiagarajan } 15491e8d13b0SVasanthakumar Thiagarajan 1550c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1551c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1552c422d52dSThomas Pedersen 15531e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1554bdcd8170SKalle Valo switch (type) { 1555bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1556f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1557bdcd8170SKalle Valo break; 1558bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1559f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1560bdcd8170SKalle Valo break; 15616e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1562f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15636e4604c8SJouni Malinen break; 15646b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1565f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15666b5e5d25SJouni Malinen break; 15676b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1568f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15696b5e5d25SJouni Malinen break; 1570bdcd8170SKalle Valo default: 1571bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1572bdcd8170SKalle Valo return -EOPNOTSUPP; 1573bdcd8170SKalle Valo } 1574bdcd8170SKalle Valo 1575551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1576bdcd8170SKalle Valo 1577bdcd8170SKalle Valo return 0; 1578bdcd8170SKalle Valo } 1579bdcd8170SKalle Valo 1580bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1581bdcd8170SKalle Valo struct net_device *dev, 1582bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1583bdcd8170SKalle Valo { 1584bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 158559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1586bdcd8170SKalle Valo int status; 1587bdcd8170SKalle Valo 1588990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1589bdcd8170SKalle Valo return -EIO; 1590bdcd8170SKalle Valo 15913450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 15923450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1593bdcd8170SKalle Valo 1594bdcd8170SKalle Valo if (ibss_param->channel) 1595f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1596bdcd8170SKalle Valo 1597bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1598bdcd8170SKalle Valo /* 1599bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1600bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1601bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1602bdcd8170SKalle Valo * updated. 1603bdcd8170SKalle Valo */ 1604bdcd8170SKalle Valo return -EOPNOTSUPP; 1605bdcd8170SKalle Valo } 1606bdcd8170SKalle Valo 16078c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1608bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16098c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16108c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1611bdcd8170SKalle Valo 1612240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1613bdcd8170SKalle Valo 1614240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1615bdcd8170SKalle Valo if (status) 1616bdcd8170SKalle Valo return status; 1617bdcd8170SKalle Valo 1618bdcd8170SKalle Valo if (ibss_param->privacy) { 1619240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1620240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1621bdcd8170SKalle Valo } else { 1622240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1623240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1624bdcd8170SKalle Valo } 1625bdcd8170SKalle Valo 1626f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1627bdcd8170SKalle Valo 1628bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1629bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1630bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1631bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1632bdcd8170SKalle Valo __func__, 16333450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16343450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1635f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1636bdcd8170SKalle Valo 1637334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16383450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16393450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16403450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16413450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16423450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1643f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16443ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 164559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1646bdcd8170SKalle Valo 1647bdcd8170SKalle Valo return 0; 1648bdcd8170SKalle Valo } 1649bdcd8170SKalle Valo 1650bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1651bdcd8170SKalle Valo struct net_device *dev) 1652bdcd8170SKalle Valo { 16533450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1654bdcd8170SKalle Valo 1655990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1656bdcd8170SKalle Valo return -EIO; 1657bdcd8170SKalle Valo 1658240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16593450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16603450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1661bdcd8170SKalle Valo 1662bdcd8170SKalle Valo return 0; 1663bdcd8170SKalle Valo } 1664bdcd8170SKalle Valo 1665bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1666bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1667bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1668bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1669bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1670837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16715e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1672bdcd8170SKalle Valo }; 1673bdcd8170SKalle Valo 1674bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1675bdcd8170SKalle Valo { 1676bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1677bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1678bdcd8170SKalle Valo 36000, 48000, 54000 1679bdcd8170SKalle Valo }; 1680bdcd8170SKalle Valo u8 i; 1681bdcd8170SKalle Valo 1682bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1683bdcd8170SKalle Valo if (rate == legacy[i]) 1684bdcd8170SKalle Valo return true; 1685bdcd8170SKalle Valo 1686bdcd8170SKalle Valo return false; 1687bdcd8170SKalle Valo } 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1690bdcd8170SKalle Valo { 1691bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1692bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1693bdcd8170SKalle Valo }; 1694bdcd8170SKalle Valo u8 i; 1695bdcd8170SKalle Valo 1696bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1697bdcd8170SKalle Valo if (rate == ht20[i]) { 1698bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1699bdcd8170SKalle Valo /* last rate uses sgi */ 1700bdcd8170SKalle Valo *sgi = true; 1701bdcd8170SKalle Valo else 1702bdcd8170SKalle Valo *sgi = false; 1703bdcd8170SKalle Valo 1704bdcd8170SKalle Valo *mcs = i; 1705bdcd8170SKalle Valo return true; 1706bdcd8170SKalle Valo } 1707bdcd8170SKalle Valo } 1708bdcd8170SKalle Valo return false; 1709bdcd8170SKalle Valo } 1710bdcd8170SKalle Valo 1711bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1712bdcd8170SKalle Valo { 1713bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1714bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1715bdcd8170SKalle Valo 150000 1716bdcd8170SKalle Valo }; 1717bdcd8170SKalle Valo u8 i; 1718bdcd8170SKalle Valo 1719bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1720bdcd8170SKalle Valo if (rate == ht40[i]) { 1721bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1722bdcd8170SKalle Valo /* last rate uses sgi */ 1723bdcd8170SKalle Valo *sgi = true; 1724bdcd8170SKalle Valo else 1725bdcd8170SKalle Valo *sgi = false; 1726bdcd8170SKalle Valo 1727bdcd8170SKalle Valo *mcs = i; 1728bdcd8170SKalle Valo return true; 1729bdcd8170SKalle Valo } 1730bdcd8170SKalle Valo } 1731bdcd8170SKalle Valo 1732bdcd8170SKalle Valo return false; 1733bdcd8170SKalle Valo } 1734bdcd8170SKalle Valo 1735bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1736bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1737bdcd8170SKalle Valo { 1738bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 173959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1740bdcd8170SKalle Valo long left; 1741bdcd8170SKalle Valo bool sgi; 1742bdcd8170SKalle Valo s32 rate; 1743bdcd8170SKalle Valo int ret; 1744bdcd8170SKalle Valo u8 mcs; 1745bdcd8170SKalle Valo 17468c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1747bdcd8170SKalle Valo return -ENOENT; 1748bdcd8170SKalle Valo 1749bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1750bdcd8170SKalle Valo return -EBUSY; 1751bdcd8170SKalle Valo 1752b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1753bdcd8170SKalle Valo 1754334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1755bdcd8170SKalle Valo 1756bdcd8170SKalle Valo if (ret != 0) { 1757bdcd8170SKalle Valo up(&ar->sem); 1758bdcd8170SKalle Valo return -EIO; 1759bdcd8170SKalle Valo } 1760bdcd8170SKalle Valo 1761bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1762bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1763b95907a7SVasanthakumar Thiagarajan &vif->flags), 1764bdcd8170SKalle Valo WMI_TIMEOUT); 1765bdcd8170SKalle Valo 1766bdcd8170SKalle Valo up(&ar->sem); 1767bdcd8170SKalle Valo 1768bdcd8170SKalle Valo if (left == 0) 1769bdcd8170SKalle Valo return -ETIMEDOUT; 1770bdcd8170SKalle Valo else if (left < 0) 1771bdcd8170SKalle Valo return left; 1772bdcd8170SKalle Valo 1773b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1774b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1775bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1776b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1777bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1778bdcd8170SKalle Valo } 1779bdcd8170SKalle Valo 1780b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1781b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1782bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1783b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1784bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1785bdcd8170SKalle Valo } 1786bdcd8170SKalle Valo 1787b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1788bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1789bdcd8170SKalle Valo 1790b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1791bdcd8170SKalle Valo 1792bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1793bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1794bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1795bdcd8170SKalle Valo if (sgi) { 1796bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1797bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1798bdcd8170SKalle Valo } else { 1799bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1800bdcd8170SKalle Valo } 1801bdcd8170SKalle Valo 1802bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1803bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1804bdcd8170SKalle Valo if (sgi) { 1805bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1806bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1807bdcd8170SKalle Valo } else { 1808bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1809bdcd8170SKalle Valo } 1810bdcd8170SKalle Valo 1811bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1812bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1813bdcd8170SKalle Valo } else { 18149a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18159a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18169a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1817bdcd8170SKalle Valo return 0; 1818bdcd8170SKalle Valo } 1819bdcd8170SKalle Valo 1820bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1821bdcd8170SKalle Valo 182259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 182359c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1824f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 182532c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 182632c10874SJouni Malinen sinfo->bss_param.flags = 0; 1827cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1828cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 182932c10874SJouni Malinen } 183032c10874SJouni Malinen 1831bdcd8170SKalle Valo return 0; 1832bdcd8170SKalle Valo } 1833bdcd8170SKalle Valo 1834bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1835bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1836bdcd8170SKalle Valo { 1837bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1838334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1839334234b5SVasanthakumar Thiagarajan 1840334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1841bdcd8170SKalle Valo pmksa->pmkid, true); 1842bdcd8170SKalle Valo } 1843bdcd8170SKalle Valo 1844bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1845bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1846bdcd8170SKalle Valo { 1847bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1848334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1849334234b5SVasanthakumar Thiagarajan 1850334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1851bdcd8170SKalle Valo pmksa->pmkid, false); 1852bdcd8170SKalle Valo } 1853bdcd8170SKalle Valo 1854bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1855bdcd8170SKalle Valo { 1856bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 185759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 185859c98449SVasanthakumar Thiagarajan 185959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1860334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1861334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1862bdcd8170SKalle Valo return 0; 1863bdcd8170SKalle Valo } 1864bdcd8170SKalle Valo 1865d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1866d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18676cb3c714SRaja Mani { 1868d91e8eeeSRaja Mani int ret, pos; 18692c07cf44SThomas Pedersen u8 mask[WOW_PATTERN_SIZE]; 18706cb3c714SRaja Mani u16 i; 18716cb3c714SRaja Mani 1872d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18736cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 18746cb3c714SRaja Mani 18756cb3c714SRaja Mani /* 18766cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 18776cb3c714SRaja Mani * driver specific mask value and send it to the chip along 18786cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 18796cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 18806cb3c714SRaja Mani * then equivalent driver specific mask value is 18816cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 18826cb3c714SRaja Mani */ 18836cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 18846cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 18856cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 18866cb3c714SRaja Mani mask[pos] = 0xFF; 18876cb3c714SRaja Mani } 18886cb3c714SRaja Mani /* 18896cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 18906cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 18916cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 18926cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 18936cb3c714SRaja Mani */ 18946cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 18956cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 18966cb3c714SRaja Mani wow->patterns[i].pattern_len, 18976cb3c714SRaja Mani 0 /* pattern offset */, 18986cb3c714SRaja Mani wow->patterns[i].pattern, mask); 18996cb3c714SRaja Mani if (ret) 19006cb3c714SRaja Mani return ret; 19016cb3c714SRaja Mani } 19026cb3c714SRaja Mani 1903d91e8eeeSRaja Mani if (wow->disconnect) 1904d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1905d91e8eeeSRaja Mani 1906d91e8eeeSRaja Mani if (wow->magic_pkt) 1907d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1908d91e8eeeSRaja Mani 1909d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1910d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1911d91e8eeeSRaja Mani 1912d91e8eeeSRaja Mani if (wow->eap_identity_req) 1913d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1914d91e8eeeSRaja Mani 1915d91e8eeeSRaja Mani if (wow->four_way_handshake) 1916d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1917d91e8eeeSRaja Mani 1918d91e8eeeSRaja Mani return 0; 1919d91e8eeeSRaja Mani } 1920d91e8eeeSRaja Mani 1921d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1922d91e8eeeSRaja Mani { 1923d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1924d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1925d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1926d91e8eeeSRaja Mani 0x00, 0x08 }; 1927d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1928d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1929d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1930d91e8eeeSRaja Mani 0x00, 0x7f }; 1931d91e8eeeSRaja Mani u8 unicst_offset = 0; 1932d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1933d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1934d91e8eeeSRaja Mani u8 arp_offset = 20; 1935d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1936d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1937d91e8eeeSRaja Mani u8 discvr_offset = 38; 1938d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1939d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1940d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1941d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1942d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1943d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1944d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1945d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1946d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1947d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1948d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1949d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1950d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1951d91e8eeeSRaja Mani int ret; 1952d91e8eeeSRaja Mani 1953d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1954d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1955d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1956d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1957d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1958d91e8eeeSRaja Mani if (ret) { 1959d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1960d91e8eeeSRaja Mani return ret; 1961d91e8eeeSRaja Mani } 1962d91e8eeeSRaja Mani 1963d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1964d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1965d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1966d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1967d91e8eeeSRaja Mani arp_pattern, arp_mask); 1968d91e8eeeSRaja Mani if (ret) { 1969d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1970d91e8eeeSRaja Mani return ret; 1971d91e8eeeSRaja Mani } 1972d91e8eeeSRaja Mani 1973d91e8eeeSRaja Mani /* 1974d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1975d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1976d91e8eeeSRaja Mani */ 1977d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1978d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1979d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1980d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1981d91e8eeeSRaja Mani if (ret) { 1982d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1983d91e8eeeSRaja Mani return ret; 1984d91e8eeeSRaja Mani } 1985d91e8eeeSRaja Mani 1986d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1987d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1988d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1989d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1990d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1991d91e8eeeSRaja Mani if (ret) { 1992d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1993d91e8eeeSRaja Mani return ret; 1994d91e8eeeSRaja Mani } 1995d91e8eeeSRaja Mani 1996d91e8eeeSRaja Mani return 0; 1997d91e8eeeSRaja Mani } 1998d91e8eeeSRaja Mani 1999d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2000d91e8eeeSRaja Mani { 2001d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2002d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2003d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2004d91e8eeeSRaja Mani u8 discvr_offset = 38; 2005d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2006d91e8eeeSRaja Mani int ret; 2007d91e8eeeSRaja Mani 2008d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 2009d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 2010d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2011d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2012d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2013d91e8eeeSRaja Mani mac_mask); 2014d91e8eeeSRaja Mani if (ret) { 2015d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2016d91e8eeeSRaja Mani return ret; 2017d91e8eeeSRaja Mani } 2018d91e8eeeSRaja Mani 2019d91e8eeeSRaja Mani /* 2020d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2021d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2022d91e8eeeSRaja Mani */ 2023d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2024d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2025d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2026d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2027d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2028d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2029d91e8eeeSRaja Mani if (ret) { 2030cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2031d91e8eeeSRaja Mani return ret; 2032d91e8eeeSRaja Mani } 2033d91e8eeeSRaja Mani } 2034d91e8eeeSRaja Mani 2035d91e8eeeSRaja Mani return 0; 2036d91e8eeeSRaja Mani } 2037d91e8eeeSRaja Mani 2038055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2039055bde49SRaja Mani { 2040055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2041055bde49SRaja Mani } 2042055bde49SRaja Mani 2043055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2044055bde49SRaja Mani { 2045055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2046055bde49SRaja Mani } 2047055bde49SRaja Mani 2048055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2049055bde49SRaja Mani { 2050055bde49SRaja Mani int ret, left; 2051055bde49SRaja Mani 2052055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2053055bde49SRaja Mani 2054055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2055055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2056055bde49SRaja Mani if (ret) 2057055bde49SRaja Mani return ret; 2058055bde49SRaja Mani 2059055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2060055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2061055bde49SRaja Mani WMI_TIMEOUT); 2062055bde49SRaja Mani if (left == 0) { 2063055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2064055bde49SRaja Mani ret = -ETIMEDOUT; 2065055bde49SRaja Mani } else if (left < 0) { 2066055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2067055bde49SRaja Mani left); 2068055bde49SRaja Mani ret = left; 2069055bde49SRaja Mani } 2070055bde49SRaja Mani 2071055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2072055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2073055bde49SRaja Mani is_ctrl_ep_empty(ar), 2074055bde49SRaja Mani WMI_TIMEOUT); 2075055bde49SRaja Mani if (left == 0) { 2076055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2077055bde49SRaja Mani ret = -ETIMEDOUT; 2078055bde49SRaja Mani } else if (left < 0) { 2079055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2080055bde49SRaja Mani ret = left; 2081055bde49SRaja Mani } 2082055bde49SRaja Mani } 2083055bde49SRaja Mani 2084055bde49SRaja Mani return ret; 2085055bde49SRaja Mani } 2086055bde49SRaja Mani 2087fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif, 2088fd4377b6SThomas Pedersen struct cfg80211_wowlan *wow, u32 *filter) 2089d91e8eeeSRaja Mani { 2090fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 2091d91e8eeeSRaja Mani struct in_device *in_dev; 2092d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2093055bde49SRaja Mani int ret; 2094ce0dc0cfSRaja Mani u16 i, bmiss_time; 2095d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2096fd4377b6SThomas Pedersen u8 index = 0; 2097d91e8eeeSRaja Mani 20986821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 20996821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21006821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21016251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21026251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21036251d801SNaveen Gangadharan if (ret) 21046251d801SNaveen Gangadharan return ret; 21056251d801SNaveen Gangadharan } 21066251d801SNaveen Gangadharan 2107d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2108d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2109d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2110d91e8eeeSRaja Mani WOW_LIST_ID, i); 2111d91e8eeeSRaja Mani 2112d91e8eeeSRaja Mani /* 2113d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2114d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2115d91e8eeeSRaja Mani * the user. 2116d91e8eeeSRaja Mani */ 2117d91e8eeeSRaja Mani if (wow) 2118fd4377b6SThomas Pedersen ret = ath6kl_wow_usr(ar, vif, wow, filter); 2119d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2120d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2121d91e8eeeSRaja Mani else 2122d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2123d91e8eeeSRaja Mani 2124d91e8eeeSRaja Mani if (ret) 2125d91e8eeeSRaja Mani return ret; 2126d91e8eeeSRaja Mani 2127390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2128390a8c8fSRaja Mani 2129ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2130ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2131ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2132ce0dc0cfSRaja Mani 0); 2133ce0dc0cfSRaja Mani if (ret) 2134ce0dc0cfSRaja Mani return ret; 2135ce0dc0cfSRaja Mani 2136ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2137ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2138ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2139ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2140ce0dc0cfSRaja Mani 2141ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2142ce0dc0cfSRaja Mani bmiss_time, 0); 2143ce0dc0cfSRaja Mani if (ret) 2144ce0dc0cfSRaja Mani return ret; 2145ce0dc0cfSRaja Mani 2146ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2147ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2148ce0dc0cfSRaja Mani 0, 0, 0, 0); 2149ce0dc0cfSRaja Mani if (ret) 2150ce0dc0cfSRaja Mani return ret; 2151ce0dc0cfSRaja Mani } 2152ce0dc0cfSRaja Mani 2153c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2154c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2155c08631c6SRaja Mani if (!in_dev) 2156fd4377b6SThomas Pedersen return 0; 2157c08631c6SRaja Mani 2158c08631c6SRaja Mani ifa = in_dev->ifa_list; 2159c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2160c08631c6SRaja Mani 2161c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2162c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2163c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2164c08631c6SRaja Mani ifa = ifa->ifa_next; 2165c08631c6SRaja Mani index++; 2166c08631c6SRaja Mani } 2167c08631c6SRaja Mani 2168c08631c6SRaja Mani if (ifa) { 2169c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2170c08631c6SRaja Mani return -EINVAL; 2171c08631c6SRaja Mani } 2172c08631c6SRaja Mani 2173c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2174c08631c6SRaja Mani if (ret) { 2175c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2176c08631c6SRaja Mani return ret; 2177c08631c6SRaja Mani } 2178c08631c6SRaja Mani 2179fd4377b6SThomas Pedersen return ret; 2180fd4377b6SThomas Pedersen } 2181fd4377b6SThomas Pedersen 2182fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2183fd4377b6SThomas Pedersen { 2184fd4377b6SThomas Pedersen struct ath6kl_vif *first_vif, *vif; 2185fd4377b6SThomas Pedersen int ret = 0; 2186fd4377b6SThomas Pedersen u32 filter = 0; 2187fd4377b6SThomas Pedersen bool connected = false; 2188fd4377b6SThomas Pedersen 2189fd4377b6SThomas Pedersen /* enter / leave wow suspend on first vif always */ 2190fd4377b6SThomas Pedersen first_vif = ath6kl_vif_first(ar); 2191fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!first_vif)) || 2192fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(first_vif)) 2193fd4377b6SThomas Pedersen return -EIO; 2194fd4377b6SThomas Pedersen 2195fd4377b6SThomas Pedersen if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2196fd4377b6SThomas Pedersen return -EINVAL; 2197fd4377b6SThomas Pedersen 2198fd4377b6SThomas Pedersen /* install filters for each connected vif */ 2199fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2200fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2201fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2202fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2203fd4377b6SThomas Pedersen continue; 2204fd4377b6SThomas Pedersen connected = true; 2205fd4377b6SThomas Pedersen 2206fd4377b6SThomas Pedersen ret = ath6kl_wow_suspend_vif(vif, wow, &filter); 2207fd4377b6SThomas Pedersen if (ret) 2208fd4377b6SThomas Pedersen break; 2209fd4377b6SThomas Pedersen } 2210fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2211fd4377b6SThomas Pedersen 2212fd4377b6SThomas Pedersen if (!connected) 2213fd4377b6SThomas Pedersen return -ENOTCONN; 2214fd4377b6SThomas Pedersen else if (ret) 2215fd4377b6SThomas Pedersen return ret; 2216fd4377b6SThomas Pedersen 2217fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_SUSPENDING; 2218fd4377b6SThomas Pedersen 2219fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx, 22206cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22216cb3c714SRaja Mani filter, 22226cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22236cb3c714SRaja Mani if (ret) 22246cb3c714SRaja Mani return ret; 22256cb3c714SRaja Mani 2226fd4377b6SThomas Pedersen return ath6kl_cfg80211_host_sleep(ar, first_vif); 22276cb3c714SRaja Mani } 22286cb3c714SRaja Mani 2229fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif) 22306cb3c714SRaja Mani { 2231fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 22326cb3c714SRaja Mani int ret; 22336cb3c714SRaja Mani 2234ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2235ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2236ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2237ce0dc0cfSRaja Mani if (ret) 2238ce0dc0cfSRaja Mani return ret; 2239ce0dc0cfSRaja Mani 2240ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2241ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2242ce0dc0cfSRaja Mani if (ret) 2243ce0dc0cfSRaja Mani return ret; 2244ce0dc0cfSRaja Mani 2245ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2246ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2247ce0dc0cfSRaja Mani if (ret) 2248ce0dc0cfSRaja Mani return ret; 2249ce0dc0cfSRaja Mani } 2250ce0dc0cfSRaja Mani 22516821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22526821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22536821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22546251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22556251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22566251d801SNaveen Gangadharan if (ret) 22576251d801SNaveen Gangadharan return ret; 22586251d801SNaveen Gangadharan } 22596251d801SNaveen Gangadharan 2260390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2261390a8c8fSRaja Mani 2262390a8c8fSRaja Mani return 0; 2263390a8c8fSRaja Mani } 2264390a8c8fSRaja Mani 2265fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar) 2266fd4377b6SThomas Pedersen { 2267fd4377b6SThomas Pedersen struct ath6kl_vif *vif; 2268fd4377b6SThomas Pedersen int ret; 2269fd4377b6SThomas Pedersen 2270fd4377b6SThomas Pedersen vif = ath6kl_vif_first(ar); 2271fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!vif)) || 2272fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2273fd4377b6SThomas Pedersen return -EIO; 2274fd4377b6SThomas Pedersen 2275fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_RESUMING; 2276fd4377b6SThomas Pedersen 2277fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2278fd4377b6SThomas Pedersen ATH6KL_HOST_MODE_AWAKE); 2279fd4377b6SThomas Pedersen if (ret) { 2280fd4377b6SThomas Pedersen ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2281fd4377b6SThomas Pedersen ret); 2282fd4377b6SThomas Pedersen goto cleanup; 2283fd4377b6SThomas Pedersen } 2284fd4377b6SThomas Pedersen 2285fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2286fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2287fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2288fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2289fd4377b6SThomas Pedersen continue; 2290fd4377b6SThomas Pedersen ret = ath6kl_wow_resume_vif(vif); 2291fd4377b6SThomas Pedersen if (ret) 2292fd4377b6SThomas Pedersen break; 2293fd4377b6SThomas Pedersen } 2294fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2295fd4377b6SThomas Pedersen 2296fd4377b6SThomas Pedersen if (ret) 2297fd4377b6SThomas Pedersen goto cleanup; 2298fd4377b6SThomas Pedersen 2299fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_ON; 2300fd4377b6SThomas Pedersen return 0; 2301fd4377b6SThomas Pedersen 2302fd4377b6SThomas Pedersen cleanup: 2303fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_WOW; 2304fd4377b6SThomas Pedersen return ret; 2305fd4377b6SThomas Pedersen } 2306fd4377b6SThomas Pedersen 230740abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 230840abc2deSRaja Mani { 230940abc2deSRaja Mani struct ath6kl_vif *vif; 231040abc2deSRaja Mani int ret; 231140abc2deSRaja Mani 231240abc2deSRaja Mani vif = ath6kl_vif_first(ar); 231340abc2deSRaja Mani if (!vif) 231440abc2deSRaja Mani return -EIO; 231540abc2deSRaja Mani 231648f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 231748f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 231840abc2deSRaja Mani return -EIO; 231948f27587SMing Jiang } 232040abc2deSRaja Mani 232140abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 232240abc2deSRaja Mani 232340abc2deSRaja Mani /* Save the current power mode before enabling power save */ 232440abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 232540abc2deSRaja Mani 232640abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 232740abc2deSRaja Mani if (ret) 232840abc2deSRaja Mani return ret; 232940abc2deSRaja Mani 233040abc2deSRaja Mani /* Disable WOW mode */ 233140abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 233240abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 233340abc2deSRaja Mani 0, 0); 233440abc2deSRaja Mani if (ret) 233540abc2deSRaja Mani return ret; 233640abc2deSRaja Mani 233740abc2deSRaja Mani /* Flush all non control pkts in TX path */ 233840abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 233940abc2deSRaja Mani 234040abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 234140abc2deSRaja Mani if (ret) 234240abc2deSRaja Mani return ret; 234340abc2deSRaja Mani 234440abc2deSRaja Mani return 0; 234540abc2deSRaja Mani } 234640abc2deSRaja Mani 234740abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 234840abc2deSRaja Mani { 234940abc2deSRaja Mani struct ath6kl_vif *vif; 235040abc2deSRaja Mani int ret; 235140abc2deSRaja Mani 235240abc2deSRaja Mani vif = ath6kl_vif_first(ar); 235340abc2deSRaja Mani 235440abc2deSRaja Mani if (!vif) 235540abc2deSRaja Mani return -EIO; 235640abc2deSRaja Mani 235740abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 235840abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 235940abc2deSRaja Mani ar->wmi->saved_pwr_mode); 236040abc2deSRaja Mani if (ret) 236140abc2deSRaja Mani return ret; 236240abc2deSRaja Mani } 236340abc2deSRaja Mani 236440abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 236540abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 236640abc2deSRaja Mani if (ret) 236740abc2deSRaja Mani return ret; 236840abc2deSRaja Mani 236940abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 237040abc2deSRaja Mani 237140abc2deSRaja Mani /* Reset scan parameter to default values */ 237240abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 237340abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 237440abc2deSRaja Mani if (ret) 237540abc2deSRaja Mani return ret; 237640abc2deSRaja Mani 237740abc2deSRaja Mani return 0; 237840abc2deSRaja Mani } 237940abc2deSRaja Mani 238052d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 23810f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 23820f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 238352d81a68SKalle Valo { 23843d79499cSVivek Natarajan struct ath6kl_vif *vif; 2385390a8c8fSRaja Mani enum ath6kl_state prev_state; 238652d81a68SKalle Valo int ret; 238752d81a68SKalle Valo 238852d81a68SKalle Valo switch (mode) { 2389d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2390d7c44e0bSRaja Mani 2391d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2392d7c44e0bSRaja Mani 2393d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2394d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2395d7c44e0bSRaja Mani 2396390a8c8fSRaja Mani prev_state = ar->state; 2397390a8c8fSRaja Mani 2398d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2399390a8c8fSRaja Mani if (ret) { 2400390a8c8fSRaja Mani ar->state = prev_state; 2401d7c44e0bSRaja Mani return ret; 2402390a8c8fSRaja Mani } 24031e9a905dSRaja Mani 2404d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2405d7c44e0bSRaja Mani break; 2406d7c44e0bSRaja Mani 240752d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2408524441e3SRaja Mani 240940abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2410524441e3SRaja Mani 241140abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 241252d81a68SKalle Valo if (ret) { 241340abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 241440abc2deSRaja Mani return ret; 241552d81a68SKalle Valo } 241652d81a68SKalle Valo 241776a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 241876a9fbe2SKalle Valo 241952d81a68SKalle Valo break; 2420b4b2a0b1SKalle Valo 2421b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2422524441e3SRaja Mani 24237125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2424524441e3SRaja Mani 2425b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2426b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2427b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2428b4b2a0b1SKalle Valo break; 2429b4b2a0b1SKalle Valo } 2430b4b2a0b1SKalle Valo 2431b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2432b4b2a0b1SKalle Valo 2433b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2434b4b2a0b1SKalle Valo if (ret) { 2435b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2436b4b2a0b1SKalle Valo ret); 2437b4b2a0b1SKalle Valo } 2438b4b2a0b1SKalle Valo 2439b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2440b4b2a0b1SKalle Valo 2441b4b2a0b1SKalle Valo break; 2442b4b2a0b1SKalle Valo 2443b4b2a0b1SKalle Valo default: 2444b4b2a0b1SKalle Valo break; 244552d81a68SKalle Valo } 244652d81a68SKalle Valo 24473d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24483d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24493d79499cSVivek Natarajan 245052d81a68SKalle Valo return 0; 245152d81a68SKalle Valo } 2452d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 245352d81a68SKalle Valo 245452d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 245552d81a68SKalle Valo { 245676a9fbe2SKalle Valo int ret; 245776a9fbe2SKalle Valo 245876a9fbe2SKalle Valo switch (ar->state) { 2459d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2460d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2461d7c44e0bSRaja Mani 2462d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2463d7c44e0bSRaja Mani if (ret) { 2464d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2465d7c44e0bSRaja Mani return ret; 2466d7c44e0bSRaja Mani } 2467d7c44e0bSRaja Mani 2468d7c44e0bSRaja Mani break; 2469d7c44e0bSRaja Mani 247076a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 247140abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 247240abc2deSRaja Mani 247340abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 247476a9fbe2SKalle Valo if (ret) { 247540abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 247640abc2deSRaja Mani return ret; 247776a9fbe2SKalle Valo } 247876a9fbe2SKalle Valo break; 247976a9fbe2SKalle Valo 2480b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2481b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2482b4b2a0b1SKalle Valo 2483b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2484b4b2a0b1SKalle Valo if (ret) { 2485b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2486b4b2a0b1SKalle Valo return ret; 2487b4b2a0b1SKalle Valo } 2488d7c44e0bSRaja Mani break; 2489b4b2a0b1SKalle Valo 249076a9fbe2SKalle Valo default: 249176a9fbe2SKalle Valo break; 249252d81a68SKalle Valo } 249352d81a68SKalle Valo 249452d81a68SKalle Valo return 0; 249552d81a68SKalle Valo } 2496d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 249752d81a68SKalle Valo 2498abcb344bSKalle Valo #ifdef CONFIG_PM 249952d81a68SKalle Valo 250052d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 250152d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2502abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2503abcb344bSKalle Valo { 2504abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2505abcb344bSKalle Valo 250684caf800SVasanthakumar Thiagarajan ath6kl_recovery_suspend(ar); 250784caf800SVasanthakumar Thiagarajan 25080f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2509abcb344bSKalle Valo } 2510aa6cffc1SChilam Ng 251152d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2512aa6cffc1SChilam Ng { 2513aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 251484caf800SVasanthakumar Thiagarajan int err; 2515aa6cffc1SChilam Ng 251684caf800SVasanthakumar Thiagarajan err = ath6kl_hif_resume(ar); 251784caf800SVasanthakumar Thiagarajan if (err) 251884caf800SVasanthakumar Thiagarajan return err; 251984caf800SVasanthakumar Thiagarajan 252084caf800SVasanthakumar Thiagarajan ar->fw_recovery.enable = true; 252184caf800SVasanthakumar Thiagarajan 252284caf800SVasanthakumar Thiagarajan return 0; 2523aa6cffc1SChilam Ng } 2524a918fb3cSRaja Mani 2525a918fb3cSRaja Mani /* 2526a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2527a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2528a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2529a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2530a918fb3cSRaja Mani * 2531a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2532a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2533a918fb3cSRaja Mani * 2534a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2535a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2536a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2537a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2538a918fb3cSRaja Mani * 2539a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2540a918fb3cSRaja Mani */ 2541a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2542a918fb3cSRaja Mani { 2543390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2544390a8c8fSRaja Mani return; 2545390a8c8fSRaja Mani 2546a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2547a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2548a918fb3cSRaja Mani } 2549a918fb3cSRaja Mani 2550a918fb3cSRaja Mani #else 2551a918fb3cSRaja Mani 2552a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2553a918fb3cSRaja Mani { 2554a918fb3cSRaja Mani } 2555abcb344bSKalle Valo #endif 2556abcb344bSKalle Valo 2557df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2558df90b369SVasanthakumar Thiagarajan bool ht_enable) 25596a7c9badSJouni Malinen { 256067b3f129SKiran Reddy struct ath6kl_htcap *htcap = &vif->htcap[band]; 2561e68f6750SSujith Manoharan 2562df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 25636a7c9badSJouni Malinen return 0; 2564df90b369SVasanthakumar Thiagarajan 2565df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2566df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2567df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2568df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2569df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2570df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2571df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2572df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2573df90b369SVasanthakumar Thiagarajan 2574df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2575df90b369SVasanthakumar Thiagarajan band, htcap); 25766a7c9badSJouni Malinen } 25776a7c9badSJouni Malinen 257837a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 257937a2f950SThomas Pedersen { 258037a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 258137a2f950SThomas Pedersen int band, ret = 0; 258237a2f950SThomas Pedersen 258337a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 258437a2f950SThomas Pedersen if (!wiphy->bands[band]) 258537a2f950SThomas Pedersen continue; 258637a2f950SThomas Pedersen 258737a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 258837a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 258937a2f950SThomas Pedersen if (ret) 259037a2f950SThomas Pedersen return ret; 259137a2f950SThomas Pedersen } 259237a2f950SThomas Pedersen 259337a2f950SThomas Pedersen return ret; 259437a2f950SThomas Pedersen } 259537a2f950SThomas Pedersen 25968bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 25978bdfbf40SJouni Malinen { 25988bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 25998bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 26008bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 26018bdfbf40SJouni Malinen } 26028bdfbf40SJouni Malinen 2603334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2604334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 26058bdfbf40SJouni Malinen { 2606334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26078bdfbf40SJouni Malinen const u8 *pos; 26088bdfbf40SJouni Malinen u8 *buf = NULL; 26098bdfbf40SJouni Malinen size_t len = 0; 26108bdfbf40SJouni Malinen int ret; 26118bdfbf40SJouni Malinen 26128bdfbf40SJouni Malinen /* 26138bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26148bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26158bdfbf40SJouni Malinen */ 26168bdfbf40SJouni Malinen 26178bdfbf40SJouni Malinen if (ies && ies_len) { 26188bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26198bdfbf40SJouni Malinen if (buf == NULL) 26208bdfbf40SJouni Malinen return -ENOMEM; 26218bdfbf40SJouni Malinen pos = ies; 26228bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26238bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26248bdfbf40SJouni Malinen break; 26258bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26268bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26278bdfbf40SJouni Malinen len += 2 + pos[1]; 26288bdfbf40SJouni Malinen } 26298bdfbf40SJouni Malinen pos += 2 + pos[1]; 26308bdfbf40SJouni Malinen } 26318bdfbf40SJouni Malinen } 26328bdfbf40SJouni Malinen 2633334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2634334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26358bdfbf40SJouni Malinen kfree(buf); 26368bdfbf40SJouni Malinen return ret; 26378bdfbf40SJouni Malinen } 26388bdfbf40SJouni Malinen 26398860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26408860020eSJohannes Berg struct cfg80211_beacon_data *info) 26418860020eSJohannes Berg { 26428860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26438860020eSJohannes Berg int 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_BEACON, 26488860020eSJohannes Berg info->beacon_ies, 26498860020eSJohannes Berg info->beacon_ies_len); 26508860020eSJohannes Berg if (res) 26518860020eSJohannes Berg return res; 26528860020eSJohannes Berg 265317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26548860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26558860020eSJohannes Berg info->proberesp_ies_len); 26568860020eSJohannes Berg if (res) 26578860020eSJohannes Berg return res; 26588860020eSJohannes Berg 265917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26608860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26618860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 26628860020eSJohannes Berg info->assocresp_ies, 26638860020eSJohannes Berg info->assocresp_ies_len); 26648860020eSJohannes Berg if (res) 26658860020eSJohannes Berg return res; 26668860020eSJohannes Berg 26678860020eSJohannes Berg return 0; 26688860020eSJohannes Berg } 26698860020eSJohannes Berg 2670c422d52dSThomas Pedersen void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, bool enable) 2671c422d52dSThomas Pedersen { 2672c422d52dSThomas Pedersen int err; 2673c422d52dSThomas Pedersen 2674c422d52dSThomas Pedersen if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag))) 2675c422d52dSThomas Pedersen return; 2676c422d52dSThomas Pedersen 2677c422d52dSThomas Pedersen if (vif->nw_type != INFRA_NETWORK) 2678c422d52dSThomas Pedersen return; 2679c422d52dSThomas Pedersen 2680c422d52dSThomas Pedersen if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE, 2681c422d52dSThomas Pedersen vif->ar->fw_capabilities)) 2682c422d52dSThomas Pedersen return; 2683c422d52dSThomas Pedersen 2684c422d52dSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n", 2685c422d52dSThomas Pedersen enable ? "enable" : "disable"); 2686c422d52dSThomas Pedersen 2687c422d52dSThomas Pedersen err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi, 2688c422d52dSThomas Pedersen vif->fw_vif_idx, enable); 2689c422d52dSThomas Pedersen if (err) 2690c422d52dSThomas Pedersen ath6kl_err("failed to %s enhanced bmiss detection: %d\n", 2691c422d52dSThomas Pedersen enable ? "enable" : "disable", err); 2692c422d52dSThomas Pedersen } 2693c422d52dSThomas Pedersen 2694d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2695d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2696d97c121bSVasanthakumar Thiagarajan { 2697d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2698d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2699d97c121bSVasanthakumar Thiagarajan u16 cnt; 2700d97c121bSVasanthakumar Thiagarajan 2701d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2702d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2703d97c121bSVasanthakumar Thiagarajan 2704d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2705d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2706d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2707d97c121bSVasanthakumar Thiagarajan 2708d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2709d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2710d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2711d97c121bSVasanthakumar Thiagarajan 27129e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27139e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2714d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27159e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27169e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27179e8b16dbSVasanthakumar Thiagarajan 27189e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27199e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27209e8b16dbSVasanthakumar Thiagarajan return 0; 27219e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27229e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2723d97c121bSVasanthakumar Thiagarajan 2724d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2725d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27269e8b16dbSVasanthakumar Thiagarajan return 0; 2727798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2728d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2729d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2730d97c121bSVasanthakumar Thiagarajan 2731d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2732d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27339e8b16dbSVasanthakumar Thiagarajan return 0; 2734798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2735d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2736d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2737d97c121bSVasanthakumar Thiagarajan 2738d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27399e8b16dbSVasanthakumar Thiagarajan return 0; 2740d97c121bSVasanthakumar Thiagarajan 2741d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2742d97c121bSVasanthakumar Thiagarajan 2743d97c121bSVasanthakumar Thiagarajan return 0; 2744d97c121bSVasanthakumar Thiagarajan } 2745d97c121bSVasanthakumar Thiagarajan 27468860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27478860020eSJohannes Berg struct cfg80211_ap_settings *info) 27486a7c9badSJouni Malinen { 27496a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27503450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27516a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 275267cd22e4SThomas Pedersen bool hidden = false; 27536a7c9badSJouni Malinen u8 *ies; 27546a7c9badSJouni Malinen int ies_len; 27556a7c9badSJouni Malinen struct wmi_connect_cmd p; 27566a7c9badSJouni Malinen int res; 2757be5abaafSVasanthakumar Thiagarajan int i, ret; 2758d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27596a7c9badSJouni Malinen 27608860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27616a7c9badSJouni Malinen 2762990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27636a7c9badSJouni Malinen return -EIO; 27646a7c9badSJouni Malinen 2765f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27666a7c9badSJouni Malinen return -EOPNOTSUPP; 27676a7c9badSJouni Malinen 27688860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27696a7c9badSJouni Malinen 27709a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27719a5b1318SJouni Malinen 27726a7c9badSJouni Malinen /* TODO: 27736a7c9badSJouni Malinen * info->interval 27746a7c9badSJouni Malinen */ 27756a7c9badSJouni Malinen 2776d154f32eSEtay Luz ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx, 2777d154f32eSEtay Luz info->dtim_period); 2778d154f32eSEtay Luz 2779d154f32eSEtay Luz /* ignore error, just print a warning and continue normally */ 2780d154f32eSEtay Luz if (ret) 2781d154f32eSEtay Luz ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret); 2782d154f32eSEtay Luz 27838860020eSJohannes Berg if (info->beacon.head == NULL) 27846a7c9badSJouni Malinen return -EINVAL; 27858860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 27866a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 27878860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 27886a7c9badSJouni Malinen return -EINVAL; 27898860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 27906a7c9badSJouni Malinen 27916a7c9badSJouni Malinen if (info->ssid == NULL) 27926a7c9badSJouni Malinen return -EINVAL; 27933450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 27943450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 27956a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 279667cd22e4SThomas Pedersen hidden = true; 279767cd22e4SThomas Pedersen 279867cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 279967cd22e4SThomas Pedersen if (res) 280067cd22e4SThomas Pedersen return res; 28016a7c9badSJouni Malinen 2802be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2803be5abaafSVasanthakumar Thiagarajan if (ret) 2804be5abaafSVasanthakumar Thiagarajan return ret; 28056a7c9badSJouni Malinen 28066a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28076a7c9badSJouni Malinen 28086a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28096a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28106a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28116a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28126a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28136a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28146a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28156a7c9badSJouni Malinen break; 28166a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28176a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28186a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28196a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28206a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28216a7c9badSJouni Malinen break; 28226a7c9badSJouni Malinen } 28236a7c9badSJouni Malinen } 28246a7c9badSJouni Malinen if (p.auth_mode == 0) 28256a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28263450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28276a7c9badSJouni Malinen 28286a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28296a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28306a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28316a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28326a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28336a7c9badSJouni Malinen break; 28346a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28356a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28366a7c9badSJouni Malinen break; 28376a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28386a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28396a7c9badSJouni Malinen break; 2840b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2841b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2842b8214df1SDai Shuibing break; 28436a7c9badSJouni Malinen } 28446a7c9badSJouni Malinen } 2845229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28466a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2847240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2848229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2849240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 28506a7c9badSJouni Malinen 28516a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28526a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28536a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28546a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28556a7c9badSJouni Malinen break; 28566a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28576a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28586a7c9badSJouni Malinen break; 28596a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28606a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28616a7c9badSJouni Malinen break; 2862b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2863b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2864b8214df1SDai Shuibing break; 28656a7c9badSJouni Malinen default: 28666a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28676a7c9badSJouni Malinen break; 28686a7c9badSJouni Malinen } 2869240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28706a7c9badSJouni Malinen 28716a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2872f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28736a7c9badSJouni Malinen 28743450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28753450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28763450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2877aa430da4SJohannes Berg p.ch = cpu_to_le16(info->channel->center_freq); 28786a7c9badSJouni Malinen 2879c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2880c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2881c1762a3fSThirumalai Pachamuthu if (res < 0) 2882c1762a3fSThirumalai Pachamuthu return res; 2883c1762a3fSThirumalai Pachamuthu 28843ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 28853ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 28863ca9d1fcSAarthi Thiruvengadam } else { 28873ca9d1fcSAarthi Thiruvengadam /* 28883ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 28893ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 28903ca9d1fcSAarthi Thiruvengadam */ 28913ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 28923ca9d1fcSAarthi Thiruvengadam } 28933ca9d1fcSAarthi Thiruvengadam 289403bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 289503bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 289603bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 289703bdeb0dSVasanthakumar Thiagarajan if (res < 0) 289803bdeb0dSVasanthakumar Thiagarajan return res; 289903bdeb0dSVasanthakumar Thiagarajan } 290003bdeb0dSVasanthakumar Thiagarajan 2901aa430da4SJohannes Berg if (ath6kl_set_htcap(vif, info->channel->band, 2902aa430da4SJohannes Berg info->channel_type != NL80211_CHAN_NO_HT)) 2903df90b369SVasanthakumar Thiagarajan return -EIO; 2904df90b369SVasanthakumar Thiagarajan 2905d97c121bSVasanthakumar Thiagarajan /* 2906d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2907d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2908d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2909d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2910d97c121bSVasanthakumar Thiagarajan */ 2911d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2912d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2913d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2914d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2915d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2916d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2917d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2918f21243a8SThomas Pedersen vif->rsn_capab = rsn_capab; 2919d97c121bSVasanthakumar Thiagarajan if (res < 0) 2920d97c121bSVasanthakumar Thiagarajan return res; 2921d97c121bSVasanthakumar Thiagarajan } 2922d97c121bSVasanthakumar Thiagarajan 2923c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2924334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29259a5b1318SJouni Malinen if (res < 0) 29269a5b1318SJouni Malinen return res; 29279a5b1318SJouni Malinen 29289a5b1318SJouni Malinen return 0; 29296a7c9badSJouni Malinen } 29306a7c9badSJouni Malinen 29318860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29328860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29336a7c9badSJouni Malinen { 29348860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29358860020eSJohannes Berg 29368860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29378860020eSJohannes Berg return -EIO; 29388860020eSJohannes Berg 29398860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29408860020eSJohannes Berg return -EOPNOTSUPP; 29418860020eSJohannes Berg 29428860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29436a7c9badSJouni Malinen } 29446a7c9badSJouni Malinen 29458860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29466a7c9badSJouni Malinen { 29476a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 294859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29496a7c9badSJouni Malinen 2950f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29516a7c9badSJouni Malinen return -EOPNOTSUPP; 295259c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29536a7c9badSJouni Malinen return -ENOTCONN; 29546a7c9badSJouni Malinen 2955334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 295659c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 29576a7c9badSJouni Malinen 2958df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 295937a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29606a7c9badSJouni Malinen } 29616a7c9badSJouni Malinen 296233e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 296333e5308dSJouni Malinen 296433e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 296533e5308dSJouni Malinen u8 *mac) 296633e5308dSJouni Malinen { 296733e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 296833e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 296933e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 297033e5308dSJouni Malinen 297133e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 297233e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 297333e5308dSJouni Malinen } 297433e5308dSJouni Malinen 297523875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 297623875136SJouni Malinen u8 *mac, struct station_parameters *params) 297723875136SJouni Malinen { 297823875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2979f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 298023875136SJouni Malinen 2981f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 298223875136SJouni Malinen return -EOPNOTSUPP; 298323875136SJouni Malinen 298423875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 298523875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 298623875136SJouni Malinen return -EOPNOTSUPP; 298723875136SJouni Malinen 298823875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2989334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2990334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2991334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2992334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 299323875136SJouni Malinen } 299423875136SJouni Malinen 299563fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 299671bbc994SJohannes Berg struct wireless_dev *wdev, 299763fa1e0cSJouni Malinen struct ieee80211_channel *chan, 299863fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 299963fa1e0cSJouni Malinen unsigned int duration, 300063fa1e0cSJouni Malinen u64 *cookie) 300163fa1e0cSJouni Malinen { 300271bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 300371bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 30041052261eSJouni Malinen u32 id; 300563fa1e0cSJouni Malinen 300663fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 300763fa1e0cSJouni Malinen * return -EBUSY */ 30081052261eSJouni Malinen id = ++vif->last_roc_id; 30091052261eSJouni Malinen if (id == 0) { 30101052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30111052261eSJouni Malinen id = ++vif->last_roc_id; 30121052261eSJouni Malinen } 30131052261eSJouni Malinen *cookie = id; 301463fa1e0cSJouni Malinen 3015334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3016334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 301763fa1e0cSJouni Malinen } 301863fa1e0cSJouni Malinen 301963fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 302071bbc994SJohannes Berg struct wireless_dev *wdev, 302163fa1e0cSJouni Malinen u64 cookie) 302263fa1e0cSJouni Malinen { 302371bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 302471bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 302563fa1e0cSJouni Malinen 30261052261eSJouni Malinen if (cookie != vif->last_roc_id) 302763fa1e0cSJouni Malinen return -ENOENT; 30281052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 302963fa1e0cSJouni Malinen 3030334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 303163fa1e0cSJouni Malinen } 303263fa1e0cSJouni Malinen 3033334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3034334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3035334234b5SVasanthakumar Thiagarajan unsigned int freq) 30368bdfbf40SJouni Malinen { 3037334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30388bdfbf40SJouni Malinen const u8 *pos; 30398bdfbf40SJouni Malinen u8 *p2p; 30408bdfbf40SJouni Malinen int p2p_len; 30418bdfbf40SJouni Malinen int ret; 30428bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30438bdfbf40SJouni Malinen 30448bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30458bdfbf40SJouni Malinen 30468bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30478bdfbf40SJouni Malinen 30488bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30498bdfbf40SJouni Malinen if (p2p == NULL) 30508bdfbf40SJouni Malinen return -ENOMEM; 30518bdfbf40SJouni Malinen p2p_len = 0; 30528bdfbf40SJouni Malinen 30538bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30548bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30558bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30568bdfbf40SJouni Malinen break; 30578bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30588bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30598bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30608bdfbf40SJouni Malinen } 30618bdfbf40SJouni Malinen pos += 2 + pos[1]; 30628bdfbf40SJouni Malinen } 30638bdfbf40SJouni Malinen 3064334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3065334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30668bdfbf40SJouni Malinen kfree(p2p); 30678bdfbf40SJouni Malinen return ret; 30688bdfbf40SJouni Malinen } 30698bdfbf40SJouni Malinen 3070d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3071d0ff7383SNaveen Gangadharan u32 id, 3072d0ff7383SNaveen Gangadharan u32 freq, 3073d0ff7383SNaveen Gangadharan u32 wait, 3074d0ff7383SNaveen Gangadharan const u8 *buf, 3075d0ff7383SNaveen Gangadharan size_t len, 3076d0ff7383SNaveen Gangadharan bool *more_data, 3077d0ff7383SNaveen Gangadharan bool no_cck) 3078d0ff7383SNaveen Gangadharan { 3079d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3080d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3081d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3082d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3083d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3084d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3085d0ff7383SNaveen Gangadharan 3086d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3087d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3088d0ff7383SNaveen Gangadharan return false; 3089d0ff7383SNaveen Gangadharan 3090d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3091d0ff7383SNaveen Gangadharan if (!conn) 3092d0ff7383SNaveen Gangadharan return false; 3093d0ff7383SNaveen Gangadharan 3094d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3095d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3096d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3097d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3098d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3099d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3100d0ff7383SNaveen Gangadharan return false; 3101d0ff7383SNaveen Gangadharan 3102d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3103d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3104d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3105d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3106d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3107d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3108d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3109d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3110d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3111d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3112d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3113d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3114d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3115d0ff7383SNaveen Gangadharan 3116d0ff7383SNaveen Gangadharan /* 3117d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3118d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3119d0ff7383SNaveen Gangadharan * STA. 3120d0ff7383SNaveen Gangadharan */ 3121d0ff7383SNaveen Gangadharan if (is_psq_empty) 3122d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3123d0ff7383SNaveen Gangadharan conn->aid, 1); 3124d0ff7383SNaveen Gangadharan return true; 3125d0ff7383SNaveen Gangadharan } 3126d0ff7383SNaveen Gangadharan 3127d0ff7383SNaveen Gangadharan /* 3128d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3129d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3130d0ff7383SNaveen Gangadharan */ 3131d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3132d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3133d0ff7383SNaveen Gangadharan *more_data = true; 3134d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3135d0ff7383SNaveen Gangadharan } 3136d0ff7383SNaveen Gangadharan 3137d0ff7383SNaveen Gangadharan return false; 3138d0ff7383SNaveen Gangadharan } 3139d0ff7383SNaveen Gangadharan 3140c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3141c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3142c86e4f44SAarthi Thiruvengadam { 3143c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3144c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3145c86e4f44SAarthi Thiruvengadam 3146c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3147c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3148c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3149c86e4f44SAarthi Thiruvengadam return true; 3150c86e4f44SAarthi Thiruvengadam } 3151c86e4f44SAarthi Thiruvengadam 3152c86e4f44SAarthi Thiruvengadam return false; 3153c86e4f44SAarthi Thiruvengadam } 3154c86e4f44SAarthi Thiruvengadam 315571bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 31568a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 31578a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 31588a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3159e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3160e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 31618a6c8060SJouni Malinen { 316271bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 316371bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 31648a6c8060SJouni Malinen u32 id; 31658bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3166d0ff7383SNaveen Gangadharan bool more_data, queued; 31678bdfbf40SJouni Malinen 31688bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3169c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3170c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3171c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 31728bdfbf40SJouni Malinen /* 3173c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 31748bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 31758bdfbf40SJouni Malinen */ 31768bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3177334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 31788bdfbf40SJouni Malinen chan->center_freq); 31798bdfbf40SJouni Malinen } 31808a6c8060SJouni Malinen 3181cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31828a6c8060SJouni Malinen if (id == 0) { 31838a6c8060SJouni Malinen /* 31848a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 31858a6c8060SJouni Malinen * used for the command. 31868a6c8060SJouni Malinen */ 3187cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31888a6c8060SJouni Malinen } 31898a6c8060SJouni Malinen 31908a6c8060SJouni Malinen *cookie = id; 31913ca9d1fcSAarthi Thiruvengadam 3192d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3193d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3194d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3195d0ff7383SNaveen Gangadharan id, chan->center_freq, 3196d0ff7383SNaveen Gangadharan wait, buf, 3197d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3198d0ff7383SNaveen Gangadharan if (queued) 3199d0ff7383SNaveen Gangadharan return 0; 3200d0ff7383SNaveen Gangadharan } 3201d0ff7383SNaveen Gangadharan 32023ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 32033ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 32043ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 32053ca9d1fcSAarthi Thiruvengadam } 32068a6c8060SJouni Malinen 3207ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 320871bbc994SJohannes Berg struct wireless_dev *wdev, 3209ae32c30aSJouni Malinen u16 frame_type, bool reg) 3210ae32c30aSJouni Malinen { 321171bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 3212ae32c30aSJouni Malinen 3213ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3214ae32c30aSJouni Malinen __func__, frame_type, reg); 3215ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3216ae32c30aSJouni Malinen /* 3217ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3218ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3219ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3220ae32c30aSJouni Malinen */ 3221cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3222ae32c30aSJouni Malinen } 3223ae32c30aSJouni Malinen } 3224ae32c30aSJouni Malinen 322510509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 322610509f90SKalle Valo struct net_device *dev, 322710509f90SKalle Valo struct cfg80211_sched_scan_request *request) 322810509f90SKalle Valo { 322910509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 323010509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 323110509f90SKalle Valo u16 interval; 323285b20fc2SThomas Pedersen int ret, rssi_thold; 323310509f90SKalle Valo 323410509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 323510509f90SKalle Valo return -EIO; 323610509f90SKalle Valo 323710509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 323810509f90SKalle Valo return -EBUSY; 323910509f90SKalle Valo 3240b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3241b4d13d3bSKalle Valo 32423b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3243dd45b759SNaveen Singh request->n_ssids, 3244dd45b759SNaveen Singh request->match_sets, 3245dd45b759SNaveen Singh request->n_match_sets); 32463b8ffc6aSJouni Malinen if (ret < 0) 32473b8ffc6aSJouni Malinen return ret; 324810509f90SKalle Valo 3249dd45b759SNaveen Singh if (!request->n_match_sets) { 3250dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3251dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3252dd45b759SNaveen Singh if (ret < 0) 3253dd45b759SNaveen Singh return ret; 3254dd45b759SNaveen Singh } else { 3255dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3256dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3257dd45b759SNaveen Singh if (ret < 0) 3258dd45b759SNaveen Singh return ret; 3259dd45b759SNaveen Singh } 3260dd45b759SNaveen Singh 326185b20fc2SThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD, 326285b20fc2SThomas Pedersen ar->fw_capabilities)) { 326385b20fc2SThomas Pedersen if (request->rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF) 326485b20fc2SThomas Pedersen rssi_thold = 0; 326585b20fc2SThomas Pedersen else if (request->rssi_thold < -127) 326685b20fc2SThomas Pedersen rssi_thold = -127; 326785b20fc2SThomas Pedersen else 326885b20fc2SThomas Pedersen rssi_thold = request->rssi_thold; 326985b20fc2SThomas Pedersen 327085b20fc2SThomas Pedersen ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx, 327185b20fc2SThomas Pedersen rssi_thold); 327285b20fc2SThomas Pedersen if (ret) { 327385b20fc2SThomas Pedersen ath6kl_err("failed to set RSSI threshold for scan\n"); 327485b20fc2SThomas Pedersen return ret; 327585b20fc2SThomas Pedersen } 327685b20fc2SThomas Pedersen } 327785b20fc2SThomas Pedersen 327810509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 327910509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 328010509f90SKalle Valo 328110509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 328210509f90SKalle Valo interval, interval, 3283d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 328410509f90SKalle Valo 328510509f90SKalle Valo /* this also clears IE in fw if it's not set */ 328610509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 328710509f90SKalle Valo WMI_FRAME_PROBE_REQ, 328810509f90SKalle Valo request->ie, request->ie_len); 328910509f90SKalle Valo if (ret) { 3290f1ff32e8SJoe Perches ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n", 329110509f90SKalle Valo ret); 329210509f90SKalle Valo return ret; 329310509f90SKalle Valo } 329410509f90SKalle Valo 3295b1f47e3aSThomas Pedersen ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true); 3296b1f47e3aSThomas Pedersen if (ret) 329710509f90SKalle Valo return ret; 329810509f90SKalle Valo 3299b1f47e3aSThomas Pedersen set_bit(SCHED_SCANNING, &vif->flags); 330010509f90SKalle Valo 3301b1f47e3aSThomas Pedersen return 0; 330210509f90SKalle Valo } 330310509f90SKalle Valo 330410509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 330510509f90SKalle Valo struct net_device *dev) 330610509f90SKalle Valo { 330710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 330810509f90SKalle Valo bool stopped; 330910509f90SKalle Valo 331010509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 331110509f90SKalle Valo 331210509f90SKalle Valo if (!stopped) 331310509f90SKalle Valo return -EIO; 331410509f90SKalle Valo 331510509f90SKalle Valo return 0; 331610509f90SKalle Valo } 331710509f90SKalle Valo 331806e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy, 331906e360acSBala Shanmugam struct net_device *dev, 332006e360acSBala Shanmugam const u8 *addr, 332106e360acSBala Shanmugam const struct cfg80211_bitrate_mask *mask) 332206e360acSBala Shanmugam { 332306e360acSBala Shanmugam struct ath6kl *ar = ath6kl_priv(dev); 332406e360acSBala Shanmugam struct ath6kl_vif *vif = netdev_priv(dev); 332506e360acSBala Shanmugam 332606e360acSBala Shanmugam return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx, 332706e360acSBala Shanmugam mask); 332806e360acSBala Shanmugam } 332906e360acSBala Shanmugam 3330279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy, 3331279b2862SThomas Pedersen struct net_device *dev, 3332279b2862SThomas Pedersen u32 rate, u32 pkts, u32 intvl) 3333279b2862SThomas Pedersen { 3334279b2862SThomas Pedersen struct ath6kl *ar = ath6kl_priv(dev); 3335279b2862SThomas Pedersen struct ath6kl_vif *vif = netdev_priv(dev); 3336279b2862SThomas Pedersen 3337279b2862SThomas Pedersen if (vif->nw_type != INFRA_NETWORK || 3338279b2862SThomas Pedersen !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities)) 3339279b2862SThomas Pedersen return -EOPNOTSUPP; 3340279b2862SThomas Pedersen 3341279b2862SThomas Pedersen if (vif->sme_state != SME_CONNECTED) 3342279b2862SThomas Pedersen return -ENOTCONN; 3343279b2862SThomas Pedersen 3344279b2862SThomas Pedersen /* save this since the firmware won't report the interval */ 3345279b2862SThomas Pedersen vif->txe_intvl = intvl; 3346279b2862SThomas Pedersen 3347279b2862SThomas Pedersen return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx, 3348279b2862SThomas Pedersen rate, pkts, intvl); 3349279b2862SThomas Pedersen } 3350279b2862SThomas Pedersen 3351f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3352f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3353f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3354f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3355f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3356f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3357f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3358f80574aeSJouni Malinen }, 3359ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3360ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3361ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3362ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3363ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3364ba1f6fe3SJouni Malinen }, 3365f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3366f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3367f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3368f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3369f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3370f80574aeSJouni Malinen }, 3371f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3372f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3373f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3374f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3375f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3376f80574aeSJouni Malinen }, 3377f80574aeSJouni Malinen }; 3378f80574aeSJouni Malinen 3379bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 338055055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 338155055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3382bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3383bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3384bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3385bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3386bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3387bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3388bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3389bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3390bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3391bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3392bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3393bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3394bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3395bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3396bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3397bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3398bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3399bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3400003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3401abcb344bSKalle Valo #ifdef CONFIG_PM 340252d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 340352d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3404abcb344bSKalle Valo #endif 34058860020eSJohannes Berg .start_ap = ath6kl_start_ap, 34068860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 34078860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 340833e5308dSJouni Malinen .del_station = ath6kl_del_station, 340923875136SJouni Malinen .change_station = ath6kl_change_station, 341063fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 341163fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 34128a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3413ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 341410509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 341510509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 341606e360acSBala Shanmugam .set_bitrate_mask = ath6kl_cfg80211_set_bitrate, 3417279b2862SThomas Pedersen .set_cqm_txe_config = ath6kl_cfg80211_set_txe_config, 3418bdcd8170SKalle Valo }; 3419bdcd8170SKalle Valo 34207125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3421ec4b7f60SKalle Valo { 342210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 342310509f90SKalle Valo 3424ec4b7f60SKalle Valo switch (vif->sme_state) { 3425c97a31b0SKalle Valo case SME_DISCONNECTED: 3426c97a31b0SKalle Valo break; 3427ec4b7f60SKalle Valo case SME_CONNECTING: 3428ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3429ec4b7f60SKalle Valo NULL, 0, 3430ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3431ec4b7f60SKalle Valo GFP_KERNEL); 3432ec4b7f60SKalle Valo break; 3433ec4b7f60SKalle Valo case SME_CONNECTED: 3434ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3435ec4b7f60SKalle Valo break; 3436ec4b7f60SKalle Valo } 3437ec4b7f60SKalle Valo 3438ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3439ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 34407125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3441ec4b7f60SKalle Valo 3442ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34431f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 34441f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3445ec4b7f60SKalle Valo 344684caf800SVasanthakumar Thiagarajan /* Stop netdev queues, needed during recovery */ 344784caf800SVasanthakumar Thiagarajan netif_stop_queue(vif->ndev); 344884caf800SVasanthakumar Thiagarajan netif_carrier_off(vif->ndev); 344984caf800SVasanthakumar Thiagarajan 3450ec4b7f60SKalle Valo /* disable scanning */ 34517125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 34527125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 34537125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3454ec4b7f60SKalle Valo 3455ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3456ec4b7f60SKalle Valo } 3457ec4b7f60SKalle Valo 34587125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 34597125f01dSKalle Valo { 34607125f01dSKalle Valo struct ath6kl_vif *vif; 34617125f01dSKalle Valo 34627125f01dSKalle Valo vif = ath6kl_vif_first(ar); 346384caf800SVasanthakumar Thiagarajan if (!vif && ar->state != ATH6KL_STATE_RECOVERY) { 34647125f01dSKalle Valo /* save the current power mode before enabling power save */ 34657125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 34667125f01dSKalle Valo 34677125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3468cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 34697125f01dSKalle Valo return; 34707125f01dSKalle Valo } 34717125f01dSKalle Valo 34727125f01dSKalle Valo /* 34737125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 34747125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 34757125f01dSKalle Valo * sleeps. 34767125f01dSKalle Valo */ 34777125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 34787125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 34797125f01dSKalle Valo } 34807125f01dSKalle Valo 348184841ba2SKalle Valo static int ath6kl_cfg80211_reg_notify(struct wiphy *wiphy, 348284841ba2SKalle Valo struct regulatory_request *request) 348384841ba2SKalle Valo { 348484841ba2SKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 348584841ba2SKalle Valo u32 rates[IEEE80211_NUM_BANDS]; 348684841ba2SKalle Valo int ret, i; 348784841ba2SKalle Valo 348884841ba2SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 348984841ba2SKalle Valo "cfg reg_notify %c%c%s%s initiator %d\n", 349084841ba2SKalle Valo request->alpha2[0], request->alpha2[1], 349184841ba2SKalle Valo request->intersect ? " intersect" : "", 349284841ba2SKalle Valo request->processed ? " processed" : "", 349384841ba2SKalle Valo request->initiator); 349484841ba2SKalle Valo 349584841ba2SKalle Valo ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2); 349684841ba2SKalle Valo if (ret) { 349784841ba2SKalle Valo ath6kl_err("failed to set regdomain: %d\n", ret); 349884841ba2SKalle Valo return ret; 349984841ba2SKalle Valo } 350084841ba2SKalle Valo 350184841ba2SKalle Valo /* 350284841ba2SKalle Valo * Firmware will apply the regdomain change only after a scan is 350384841ba2SKalle Valo * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been 350484841ba2SKalle Valo * changed. 350584841ba2SKalle Valo */ 350684841ba2SKalle Valo 350784841ba2SKalle Valo for (i = 0; i < IEEE80211_NUM_BANDS; i++) 350884841ba2SKalle Valo if (wiphy->bands[i]) 350984841ba2SKalle Valo rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1; 351084841ba2SKalle Valo 351184841ba2SKalle Valo 351284841ba2SKalle Valo ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false, 351384841ba2SKalle Valo false, 0, ATH6KL_FG_SCAN_INTERVAL, 351484841ba2SKalle Valo 0, NULL, false, rates); 351584841ba2SKalle Valo if (ret) { 351684841ba2SKalle Valo ath6kl_err("failed to start scan for a regdomain change: %d\n", 351784841ba2SKalle Valo ret); 351884841ba2SKalle Valo return ret; 351984841ba2SKalle Valo } 352084841ba2SKalle Valo 352184841ba2SKalle Valo return 0; 352284841ba2SKalle Valo } 352384841ba2SKalle Valo 3524c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 35258dafb70eSVasanthakumar Thiagarajan { 35267baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 35272132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 35288dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 35298dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 35308dafb70eSVasanthakumar Thiagarajan } 35318dafb70eSVasanthakumar Thiagarajan 3532de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3533108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 353410509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 353510509f90SKalle Valo (unsigned long) vif); 353610509f90SKalle Valo 3537de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3538478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 35398dafb70eSVasanthakumar Thiagarajan 354080abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 354180abaf9bSVasanthakumar Thiagarajan 35428dafb70eSVasanthakumar Thiagarajan return 0; 35438dafb70eSVasanthakumar Thiagarajan } 35448dafb70eSVasanthakumar Thiagarajan 3545c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 35468dafb70eSVasanthakumar Thiagarajan { 354755055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 354880abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 354955055976SVasanthakumar Thiagarajan 35502132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3551108438bcSVasanthakumar Thiagarajan 355255055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 355355055976SVasanthakumar Thiagarajan 355455055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 355555055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 355655055976SVasanthakumar Thiagarajan 355780abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 355880abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 355980abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 356080abaf9bSVasanthakumar Thiagarajan } 356180abaf9bSVasanthakumar Thiagarajan 356227929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 356355055976SVasanthakumar Thiagarajan 356455055976SVasanthakumar Thiagarajan ar->num_vif--; 35658dafb70eSVasanthakumar Thiagarajan } 35668dafb70eSVasanthakumar Thiagarajan 3567552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name, 356884efbb84SJohannes Berg enum nl80211_iftype type, 356984efbb84SJohannes Berg u8 fw_vif_idx, u8 nw_type) 35708dafb70eSVasanthakumar Thiagarajan { 35718dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3572108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 35738dafb70eSVasanthakumar Thiagarajan 357455055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 35758dafb70eSVasanthakumar Thiagarajan if (!ndev) 35768dafb70eSVasanthakumar Thiagarajan return NULL; 35778dafb70eSVasanthakumar Thiagarajan 3578108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3579108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3580108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3581108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3582108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3583108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3584108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3585108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3586334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3587d0d670abSKalle Valo vif->nw_type = nw_type; 3588d0d670abSKalle Valo vif->next_mode = nw_type; 35898f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3590ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3591eb38987eSRaja Mani vif->bg_scan_period = 0; 359267b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_2GHZ].ht_enable = true; 359367b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_5GHZ].ht_enable = true; 35948dafb70eSVasanthakumar Thiagarajan 359555055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3596c95dcb59SAarthi Thiruvengadam if (fw_vif_idx != 0) { 359755055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 359855055976SVasanthakumar Thiagarajan 0x2; 3599c95dcb59SAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR, 3600c95dcb59SAarthi Thiruvengadam ar->fw_capabilities)) 3601c95dcb59SAarthi Thiruvengadam ndev->dev_addr[4] ^= 0x80; 3602c95dcb59SAarthi Thiruvengadam } 360355055976SVasanthakumar Thiagarajan 36048dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 36058dafb70eSVasanthakumar Thiagarajan 3606e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 36078dafb70eSVasanthakumar Thiagarajan 3608c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 36098dafb70eSVasanthakumar Thiagarajan goto err; 36108dafb70eSVasanthakumar Thiagarajan 361127929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 36128dafb70eSVasanthakumar Thiagarajan goto err; 36138dafb70eSVasanthakumar Thiagarajan 361455055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 361514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 361659c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 36178dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 361859c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 36198dafb70eSVasanthakumar Thiagarajan 362055055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 362155055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 362255055976SVasanthakumar Thiagarajan 362311f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3624990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 362511f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3626990bd915SVasanthakumar Thiagarajan 362784efbb84SJohannes Berg return &vif->wdev; 36288dafb70eSVasanthakumar Thiagarajan 36298dafb70eSVasanthakumar Thiagarajan err: 363027929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 363127929723SVasanthakumar Thiagarajan free_netdev(ndev); 3632bdcd8170SKalle Valo return NULL; 3633bdcd8170SKalle Valo } 3634bdcd8170SKalle Valo 363546d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 363646d33a21SKalle Valo { 363746d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3638d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 363946d33a21SKalle Valo int ret; 364046d33a21SKalle Valo 364146d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 364246d33a21SKalle Valo 364346d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 364446d33a21SKalle Valo 364546d33a21SKalle Valo /* set device pointer for wiphy */ 364646d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 364746d33a21SKalle Valo 364846d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 364946d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 365046d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 365146d33a21SKalle Valo if (ar->p2p) { 365246d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 365346d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 365446d33a21SKalle Valo } 365546d33a21SKalle Valo 365684841ba2SKalle Valo if (config_enabled(CONFIG_ATH6KL_REGDOMAIN) && 365784841ba2SKalle Valo test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) 365884841ba2SKalle Valo wiphy->reg_notifier = ath6kl_cfg80211_reg_notify; 365984841ba2SKalle Valo 366046d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 36618ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3662dd45b759SNaveen Singh 3663dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3664dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3665dd45b759SNaveen Singh ar->fw_capabilities)) 3666dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3667dd45b759SNaveen Singh 366846d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3669d92917e4SThomas Pedersen switch (ar->hw.cap) { 3670d92917e4SThomas Pedersen case WMI_11AN_CAP: 3671d92917e4SThomas Pedersen ht = true; 3672d92917e4SThomas Pedersen case WMI_11A_CAP: 3673d92917e4SThomas Pedersen band_5gig = true; 3674d92917e4SThomas Pedersen break; 3675d92917e4SThomas Pedersen case WMI_11GN_CAP: 3676d92917e4SThomas Pedersen ht = true; 3677d92917e4SThomas Pedersen case WMI_11G_CAP: 3678d92917e4SThomas Pedersen band_2gig = true; 3679d92917e4SThomas Pedersen break; 3680d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3681d92917e4SThomas Pedersen ht = true; 3682d92917e4SThomas Pedersen case WMI_11AG_CAP: 3683d92917e4SThomas Pedersen band_2gig = true; 3684d92917e4SThomas Pedersen band_5gig = true; 3685d92917e4SThomas Pedersen break; 3686d92917e4SThomas Pedersen default: 3687d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3688d92917e4SThomas Pedersen return -EINVAL; 3689d92917e4SThomas Pedersen } 3690d92917e4SThomas Pedersen 36917fd1ce7eSVasanthakumar Thiagarajan /* 36927fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 36937fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 36947fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 36957fd1ce7eSVasanthakumar Thiagarajan */ 36967fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 36977fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 36987fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3699d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3700d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3701d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3702d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3703d92917e4SThomas Pedersen } 370406e360acSBala Shanmugam 370506e360acSBala Shanmugam if (ar->hw.flags & ATH6KL_HW_FLAG_64BIT_RATES) { 370606e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 370706e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 370806e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff; 370906e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff; 371006e360acSBala Shanmugam } else { 371106e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371206e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371306e360acSBala Shanmugam } 371406e360acSBala Shanmugam 3715d92917e4SThomas Pedersen if (band_2gig) 371646d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3717d92917e4SThomas Pedersen if (band_5gig) 371846d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3719d92917e4SThomas Pedersen 372046d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 372146d33a21SKalle Valo 372246d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 372346d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 372446d33a21SKalle Valo 3725dfb89c56SJohannes Berg #ifdef CONFIG_PM 372646d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 372746d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 372846d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 372946d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 373046d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 373146d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 373246d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 373346d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 373446d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 3735dfb89c56SJohannes Berg #endif 373646d33a21SKalle Valo 37378ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 373846d33a21SKalle Valo 3739f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3740f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3741f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3742f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3743f2afdac7SVasanthakumar Thiagarajan 3744b1f47e3aSThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities)) 3745f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3746f2afdac7SVasanthakumar Thiagarajan 374703bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 374803bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 3749b292219fSJohannes Berg ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER; 375003bdeb0dSVasanthakumar Thiagarajan 3751f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3752f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3753f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3754a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3755f2afdac7SVasanthakumar Thiagarajan 375646d33a21SKalle Valo ret = wiphy_register(wiphy); 375746d33a21SKalle Valo if (ret < 0) { 375846d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 375946d33a21SKalle Valo return ret; 376046d33a21SKalle Valo } 376146d33a21SKalle Valo 3762e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3763e5348a1eSVasanthakumar Thiagarajan 376446d33a21SKalle Valo return 0; 376546d33a21SKalle Valo } 376646d33a21SKalle Valo 376746d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3768bdcd8170SKalle Valo { 3769be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3770e5348a1eSVasanthakumar Thiagarajan 3771e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 377245eaa78fSKalle Valo } 377346d33a21SKalle Valo 377445eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 377545eaa78fSKalle Valo { 377645eaa78fSKalle Valo struct ath6kl *ar; 377745eaa78fSKalle Valo struct wiphy *wiphy; 377845eaa78fSKalle Valo 377945eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 378045eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 378145eaa78fSKalle Valo 378245eaa78fSKalle Valo if (!wiphy) { 378345eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 378445eaa78fSKalle Valo return NULL; 378545eaa78fSKalle Valo } 378645eaa78fSKalle Valo 378745eaa78fSKalle Valo ar = wiphy_priv(wiphy); 378845eaa78fSKalle Valo ar->wiphy = wiphy; 378945eaa78fSKalle Valo 379045eaa78fSKalle Valo return ar; 379145eaa78fSKalle Valo } 379245eaa78fSKalle Valo 379345eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 379445eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 379545eaa78fSKalle Valo { 37961d2a4456SVasanthakumar Thiagarajan int i; 37971d2a4456SVasanthakumar Thiagarajan 37981d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 37991d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 38001d2a4456SVasanthakumar Thiagarajan 3801be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3802bdcd8170SKalle Valo } 380345eaa78fSKalle Valo 3804