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); 15458109df6SVasanthakumar Thiagarajan 15558109df6SVasanthakumar Thiagarajan if (ar->state == ATH6KL_STATE_RECOVERY) 15658109df6SVasanthakumar Thiagarajan return true; 15758109df6SVasanthakumar Thiagarajan 158b1f47e3aSThomas Pedersen ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, false); 15910509f90SKalle Valo 16010509f90SKalle Valo return true; 16110509f90SKalle Valo } 16210509f90SKalle Valo 16310509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 16410509f90SKalle Valo { 16510509f90SKalle Valo struct ath6kl *ar = vif->ar; 16610509f90SKalle Valo bool stopped; 16710509f90SKalle Valo 16810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16910509f90SKalle Valo 17010509f90SKalle Valo if (!stopped) 17110509f90SKalle Valo return; 17210509f90SKalle Valo 17310509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 17410509f90SKalle Valo } 17510509f90SKalle Valo 176240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 177bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 178bdcd8170SKalle Valo { 179bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 180bdcd8170SKalle Valo 181bdcd8170SKalle Valo if (!wpa_version) { 1823450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 183bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1843450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 185bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1863450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 187bdcd8170SKalle Valo } else { 188bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 189bdcd8170SKalle Valo return -ENOTSUPP; 190bdcd8170SKalle Valo } 191bdcd8170SKalle Valo 192bdcd8170SKalle Valo return 0; 193bdcd8170SKalle Valo } 194bdcd8170SKalle Valo 195240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 196bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 197bdcd8170SKalle Valo { 198bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 199bdcd8170SKalle Valo 200bdcd8170SKalle Valo switch (auth_type) { 201bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 2023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 203bdcd8170SKalle Valo break; 204bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 2053450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 206bdcd8170SKalle Valo break; 207bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2083450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 209bdcd8170SKalle Valo break; 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2123450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 213bdcd8170SKalle Valo break; 214bdcd8170SKalle Valo 215bdcd8170SKalle Valo default: 2163c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 217bdcd8170SKalle Valo return -ENOTSUPP; 218bdcd8170SKalle Valo } 219bdcd8170SKalle Valo 220bdcd8170SKalle Valo return 0; 221bdcd8170SKalle Valo } 222bdcd8170SKalle Valo 223240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 224bdcd8170SKalle Valo { 2253450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2263450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2273450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 228bdcd8170SKalle Valo 229bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 230bdcd8170SKalle Valo __func__, cipher, ucast); 231bdcd8170SKalle Valo 232bdcd8170SKalle Valo switch (cipher) { 233bdcd8170SKalle Valo case 0: 234bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 235bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 0; 237bdcd8170SKalle Valo break; 238bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 239bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 240bdcd8170SKalle Valo *ar_cipher_len = 5; 241bdcd8170SKalle Valo break; 242bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 243bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 244bdcd8170SKalle Valo *ar_cipher_len = 13; 245bdcd8170SKalle Valo break; 246bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 247bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 248bdcd8170SKalle Valo *ar_cipher_len = 0; 249bdcd8170SKalle Valo break; 250bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 251bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 252bdcd8170SKalle Valo *ar_cipher_len = 0; 253bdcd8170SKalle Valo break; 2545e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2555e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2565e07021eSDai Shuibing *ar_cipher_len = 0; 2575e07021eSDai Shuibing break; 258bdcd8170SKalle Valo default: 259bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 260bdcd8170SKalle Valo return -ENOTSUPP; 261bdcd8170SKalle Valo } 262bdcd8170SKalle Valo 263bdcd8170SKalle Valo return 0; 264bdcd8170SKalle Valo } 265bdcd8170SKalle Valo 266240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 267bdcd8170SKalle Valo { 268bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 269bdcd8170SKalle Valo 270bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2713450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2723450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2733450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 275837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2763450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2773450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2783450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2793450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 280bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2813450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo } 284bdcd8170SKalle Valo 285990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 286bdcd8170SKalle Valo { 287990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28859c98449SVasanthakumar Thiagarajan 289bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 290bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 291bdcd8170SKalle Valo return false; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 29459c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 295bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 296bdcd8170SKalle Valo return false; 297bdcd8170SKalle Valo } 298bdcd8170SKalle Valo 299bdcd8170SKalle Valo return true; 300bdcd8170SKalle Valo } 301bdcd8170SKalle Valo 3026981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 3036981ffdcSKevin Fang { 30404b2312aSArend van Spriel return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 3056981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 3066981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 3076981ffdcSKevin Fang } 3086981ffdcSKevin Fang 3096981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3106981ffdcSKevin Fang { 3116981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3126981ffdcSKevin Fang } 3136981ffdcSKevin Fang 31463541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 31563541212SAarthi Thiruvengadam { 31663541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 31763541212SAarthi Thiruvengadam pos[1] >= 4 && 31863541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31963541212SAarthi Thiruvengadam pos[5] == 0x04); 32063541212SAarthi Thiruvengadam } 32163541212SAarthi Thiruvengadam 322334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3236981ffdcSKevin Fang size_t ies_len) 3246981ffdcSKevin Fang { 325334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3266981ffdcSKevin Fang const u8 *pos; 3276981ffdcSKevin Fang u8 *buf = NULL; 3286981ffdcSKevin Fang size_t len = 0; 3296981ffdcSKevin Fang int ret; 3306981ffdcSKevin Fang 3316981ffdcSKevin Fang /* 33263541212SAarthi Thiruvengadam * Clear previously set flag 33363541212SAarthi Thiruvengadam */ 33463541212SAarthi Thiruvengadam 33563541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 33663541212SAarthi Thiruvengadam 33763541212SAarthi Thiruvengadam /* 3386981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3396981ffdcSKevin Fang */ 3406981ffdcSKevin Fang 3416981ffdcSKevin Fang if (ies && ies_len) { 3426981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3436981ffdcSKevin Fang if (buf == NULL) 3446981ffdcSKevin Fang return -ENOMEM; 3456981ffdcSKevin Fang pos = ies; 3466981ffdcSKevin Fang 3476981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3486981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3496981ffdcSKevin Fang break; 3506981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3516981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3526981ffdcSKevin Fang len += 2 + pos[1]; 3536981ffdcSKevin Fang } 35463541212SAarthi Thiruvengadam 35563541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 35663541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 35763541212SAarthi Thiruvengadam 3586981ffdcSKevin Fang pos += 2 + pos[1]; 3596981ffdcSKevin Fang } 3606981ffdcSKevin Fang } 3616981ffdcSKevin Fang 362334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 363334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3646981ffdcSKevin Fang kfree(buf); 3656981ffdcSKevin Fang return ret; 3666981ffdcSKevin Fang } 3676981ffdcSKevin Fang 36855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36955055976SVasanthakumar Thiagarajan { 37055055976SVasanthakumar Thiagarajan switch (type) { 37155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 37238142644SMohammed Shafi Shajakhan case NL80211_IFTYPE_P2P_CLIENT: 37355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 37655055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 38055055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 38155055976SVasanthakumar Thiagarajan break; 38255055976SVasanthakumar Thiagarajan default: 38355055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38455055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38555055976SVasanthakumar Thiagarajan } 38655055976SVasanthakumar Thiagarajan 38755055976SVasanthakumar Thiagarajan return 0; 38855055976SVasanthakumar Thiagarajan } 38955055976SVasanthakumar Thiagarajan 39055055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 39155055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 39255055976SVasanthakumar Thiagarajan { 39355055976SVasanthakumar Thiagarajan int i; 39455055976SVasanthakumar Thiagarajan 39555055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39655055976SVasanthakumar Thiagarajan return false; 39755055976SVasanthakumar Thiagarajan 39855055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39955055976SVasanthakumar Thiagarajan ar->num_vif)) 40055055976SVasanthakumar Thiagarajan return false; 40155055976SVasanthakumar Thiagarajan 40255055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 40355055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40471f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40555055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40655055976SVasanthakumar Thiagarajan *if_idx = i; 40755055976SVasanthakumar Thiagarajan return true; 40855055976SVasanthakumar Thiagarajan } 40955055976SVasanthakumar Thiagarajan } 41055055976SVasanthakumar Thiagarajan } 41155055976SVasanthakumar Thiagarajan 4123226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4133226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41471f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4153226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4163226f68aSVasanthakumar Thiagarajan *if_idx = i; 4173226f68aSVasanthakumar Thiagarajan return true; 4183226f68aSVasanthakumar Thiagarajan } 4193226f68aSVasanthakumar Thiagarajan } 4203226f68aSVasanthakumar Thiagarajan } 4213226f68aSVasanthakumar Thiagarajan 42255055976SVasanthakumar Thiagarajan return false; 42355055976SVasanthakumar Thiagarajan } 42455055976SVasanthakumar Thiagarajan 4258c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4268c9bb054SKalle Valo { 4278c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4288c9bb054SKalle Valo } 4298c9bb054SKalle Valo 4308c9bb054SKalle Valo 431bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 432bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 433bdcd8170SKalle Valo { 434bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 436bdcd8170SKalle Valo int status; 4373ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 438ce0dc0cfSRaja Mani u16 interval; 439bdcd8170SKalle Valo 44010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 44110509f90SKalle Valo 44214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 443bdcd8170SKalle Valo 444990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 445bdcd8170SKalle Valo return -EIO; 446bdcd8170SKalle Valo 447bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 448bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 449bdcd8170SKalle Valo return -EBUSY; 450bdcd8170SKalle Valo } 451bdcd8170SKalle Valo 452bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 453bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 454bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 455bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 456bdcd8170SKalle Valo return -EINVAL; 457bdcd8170SKalle Valo } 458bdcd8170SKalle Valo 459bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 460bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 461bdcd8170SKalle Valo return -ERESTARTSYS; 462bdcd8170SKalle Valo } 463bdcd8170SKalle Valo 464bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 465bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 466bdcd8170SKalle Valo up(&ar->sem); 467bdcd8170SKalle Valo return -EBUSY; 468bdcd8170SKalle Valo } 469bdcd8170SKalle Valo 470bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 471bdcd8170SKalle Valo /* 472bdcd8170SKalle Valo * sleep until the command queue drains 473bdcd8170SKalle Valo */ 474bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4758c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 476bdcd8170SKalle Valo WMI_TIMEOUT); 477bdcd8170SKalle Valo if (signal_pending(current)) { 478bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 479bdcd8170SKalle Valo up(&ar->sem); 480bdcd8170SKalle Valo return -EINTR; 481bdcd8170SKalle Valo } 482bdcd8170SKalle Valo } 483bdcd8170SKalle Valo 484334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 485743b4518SDan Carpenter if (status) { 486743b4518SDan Carpenter up(&ar->sem); 4876981ffdcSKevin Fang return status; 488743b4518SDan Carpenter } 4896e786cb1SJouni Malinen 4906e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 491542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4926981ffdcSKevin Fang 49359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4943450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4953450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 496cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 497334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 498334234b5SVasanthakumar Thiagarajan vif->req_bssid, 499f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 500bdcd8170SKalle Valo 501bdcd8170SKalle Valo up(&ar->sem); 502bdcd8170SKalle Valo if (status) { 503bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 504bdcd8170SKalle Valo return -EIO; 505bdcd8170SKalle Valo } 506bdcd8170SKalle Valo return 0; 5073450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5083450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 509240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 510bdcd8170SKalle Valo } 511bdcd8170SKalle Valo 5123450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5133450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5143450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 515bdcd8170SKalle Valo 516bdcd8170SKalle Valo if (sme->channel) 517f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 518bdcd8170SKalle Valo 5198c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 520bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5218c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 522bdcd8170SKalle Valo 523240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 524bdcd8170SKalle Valo 525240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 526bdcd8170SKalle Valo if (status) { 527bdcd8170SKalle Valo up(&ar->sem); 528bdcd8170SKalle Valo return status; 529bdcd8170SKalle Valo } 530bdcd8170SKalle Valo 531bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 532240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 533bdcd8170SKalle Valo else 534240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 535bdcd8170SKalle Valo 536240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 537bdcd8170SKalle Valo 538bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 539240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 540bdcd8170SKalle Valo 541bdcd8170SKalle Valo if ((sme->key_len) && 5423450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5433450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 544bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 545bdcd8170SKalle Valo 546792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 547bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 548bdcd8170SKalle Valo sme->key_idx); 549bdcd8170SKalle Valo up(&ar->sem); 550bdcd8170SKalle Valo return -ENOENT; 551bdcd8170SKalle Valo } 552bdcd8170SKalle Valo 5536f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 554bdcd8170SKalle Valo key->key_len = sme->key_len; 555bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5563450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5573450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 558bdcd8170SKalle Valo 559334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5603450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 561bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 562bdcd8170SKalle Valo key->key_len, 563f4bb9a6fSJouni Malinen NULL, 0, 564bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 565bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 566bdcd8170SKalle Valo } 567bdcd8170SKalle Valo 568bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56959c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 570240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 571240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 572bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 573bdcd8170SKalle Valo up(&ar->sem); 574bdcd8170SKalle Valo return -EIO; 575bdcd8170SKalle Valo } 576bdcd8170SKalle Valo } 577bdcd8170SKalle Valo 578f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 579bdcd8170SKalle Valo 580c422d52dSThomas Pedersen /* enable enhanced bmiss detection if applicable */ 581c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, true); 582c422d52dSThomas Pedersen 5833ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5843ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5853ca9d1fcSAarthi Thiruvengadam 586bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 587bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 588bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 589bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 590bdcd8170SKalle Valo __func__, 5913450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5923450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 593f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 594bdcd8170SKalle Valo 595cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 596ce0dc0cfSRaja Mani 597ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 598b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 599b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 600ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 601ce0dc0cfSRaja Mani interval, 602ce0dc0cfSRaja Mani 0); 603ce0dc0cfSRaja Mani if (status) { 604ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 605ce0dc0cfSRaja Mani up(&ar->sem); 606ce0dc0cfSRaja Mani return status; 607ce0dc0cfSRaja Mani } 608ce0dc0cfSRaja Mani } 609ce0dc0cfSRaja Mani 610334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6113450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6123450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6133450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6143450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6153450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 616f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6173ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 618bdcd8170SKalle Valo 619f599359cSBala Shanmugam /* disable background scan if period is 0 */ 620f599359cSBala Shanmugam if (sme->bg_scan_period == 0) 621f599359cSBala Shanmugam sme->bg_scan_period = 0xffff; 622f599359cSBala Shanmugam 623f599359cSBala Shanmugam /* configure default value if not specified */ 624f599359cSBala Shanmugam if (sme->bg_scan_period == -1) 625f599359cSBala Shanmugam sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 626f599359cSBala Shanmugam 627f599359cSBala Shanmugam ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 628f599359cSBala Shanmugam sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 629f599359cSBala Shanmugam 630bdcd8170SKalle Valo up(&ar->sem); 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo if (status == -EINVAL) { 6333450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6343450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 635bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 636bdcd8170SKalle Valo return -ENOENT; 637bdcd8170SKalle Valo } else if (status) { 638bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 639bdcd8170SKalle Valo return -EIO; 640bdcd8170SKalle Valo } 641bdcd8170SKalle Valo 642bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 643ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 644ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 645de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 646bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 647bdcd8170SKalle Valo } 648bdcd8170SKalle Valo 649bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 65059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 651bdcd8170SKalle Valo 652bdcd8170SKalle Valo return 0; 653bdcd8170SKalle Valo } 654bdcd8170SKalle Valo 6555e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6565e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6574eab6f4fSRaja Mani enum network_type nw_type, 6584eab6f4fSRaja Mani const u8 *bssid, 65901cac476SJouni Malinen struct ieee80211_channel *chan, 6605e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6615e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 66201cac476SJouni Malinen { 663240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 66401cac476SJouni Malinen struct cfg80211_bss *bss; 6654eab6f4fSRaja Mani u16 cap_mask, cap_val; 66601cac476SJouni Malinen u8 *ie; 66701cac476SJouni Malinen 6684eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6694eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6704eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6714eab6f4fSRaja Mani } else { 6724eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6734eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6744eab6f4fSRaja Mani } 6754eab6f4fSRaja Mani 676be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6774eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6784eab6f4fSRaja Mani cap_mask, cap_val); 67901cac476SJouni Malinen if (bss == NULL) { 68001cac476SJouni Malinen /* 68101cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 68201cac476SJouni Malinen * generate a partial entry until the first BSS info 68301cac476SJouni Malinen * event becomes available. 68401cac476SJouni Malinen * 68501cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 68601cac476SJouni Malinen * IEs from the target. 68701cac476SJouni Malinen */ 6883450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 68901cac476SJouni Malinen if (ie == NULL) 6905e13fd35SVasanthakumar Thiagarajan return NULL; 69101cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6923450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6933450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6943450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 695be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6964eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6973450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 69801cac476SJouni Malinen 0, GFP_KERNEL); 69901cac476SJouni Malinen if (bss) 700cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 701cdeb8602SKalle Valo "added bss %pM to cfg80211\n", bssid); 70201cac476SJouni Malinen kfree(ie); 70301cac476SJouni Malinen } else 7045e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 70501cac476SJouni Malinen 7065e13fd35SVasanthakumar Thiagarajan return bss; 70701cac476SJouni Malinen } 70801cac476SJouni Malinen 709240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 710bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 711bdcd8170SKalle Valo u16 beacon_intvl, 712bdcd8170SKalle Valo enum network_type nw_type, 713bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 714bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 715bdcd8170SKalle Valo { 71601cac476SJouni Malinen struct ieee80211_channel *chan; 717240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7185e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 719bdcd8170SKalle Valo 720bdcd8170SKalle Valo /* capinfo + listen interval */ 721bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 722bdcd8170SKalle Valo 723bdcd8170SKalle Valo /* capinfo + status code + associd */ 724bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 725bdcd8170SKalle Valo 726bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 727bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 728bdcd8170SKalle Valo assoc_resp_ie_offset; 729bdcd8170SKalle Valo 730bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 731bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 732bdcd8170SKalle Valo 73332c10874SJouni Malinen /* 73432c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 73532c10874SJouni Malinen * a Beacon frame from the AP is seen. 73632c10874SJouni Malinen */ 737cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 73859c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 73932c10874SJouni Malinen 740bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 741551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 742bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 743bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 744bdcd8170SKalle Valo return; 745bdcd8170SKalle Valo } 746bdcd8170SKalle Valo } 747bdcd8170SKalle Valo 748bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 749551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 750551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 751bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 752bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 753bdcd8170SKalle Valo return; 754bdcd8170SKalle Valo } 755bdcd8170SKalle Valo } 756bdcd8170SKalle Valo 757be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 758bdcd8170SKalle Valo 7595e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7605e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7615e13fd35SVasanthakumar Thiagarajan if (!bss) { 7624eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 763bdcd8170SKalle Valo return; 764bdcd8170SKalle Valo } 765bdcd8170SKalle Valo 7664eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7674eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7684eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7694eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7705e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 77101cac476SJouni Malinen return; 77201cac476SJouni Malinen } 77301cac476SJouni Malinen 77414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 775bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 77614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 777240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 778bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 779bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 780bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7815e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 78214ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 783bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7845e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 785bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 786bdcd8170SKalle Valo } 787bdcd8170SKalle Valo } 788bdcd8170SKalle Valo 789bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 790bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 791bdcd8170SKalle Valo { 792d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7933450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 794bdcd8170SKalle Valo 795bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 796bdcd8170SKalle Valo reason_code); 797bdcd8170SKalle Valo 79810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 79910509f90SKalle Valo 800990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 801bdcd8170SKalle Valo return -EIO; 802bdcd8170SKalle Valo 803bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 804bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 805bdcd8170SKalle Valo return -EBUSY; 806bdcd8170SKalle Valo } 807bdcd8170SKalle Valo 808bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 809bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 810bdcd8170SKalle Valo return -ERESTARTSYS; 811bdcd8170SKalle Valo } 812bdcd8170SKalle Valo 813cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 814240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 8153450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 8163450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 817bdcd8170SKalle Valo 818bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8198c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 820bdcd8170SKalle Valo 821bdcd8170SKalle Valo up(&ar->sem); 822bdcd8170SKalle Valo 82314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 824170826ddSVasanthakumar Thiagarajan 825bdcd8170SKalle Valo return 0; 826bdcd8170SKalle Valo } 827bdcd8170SKalle Valo 828240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 829bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 830bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 831bdcd8170SKalle Valo { 832240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 83359c98449SVasanthakumar Thiagarajan 83414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 83514ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 83614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 839f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 840551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 841bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 842bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 843bdcd8170SKalle Valo return; 844bdcd8170SKalle Valo } 845bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 846240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 847bdcd8170SKalle Valo return; 848bdcd8170SKalle Valo } 849bdcd8170SKalle Valo 850f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 851551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 852551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 853bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 854bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 855bdcd8170SKalle Valo return; 856bdcd8170SKalle Valo } 857bdcd8170SKalle Valo } 858bdcd8170SKalle Valo 85959c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 860bdcd8170SKalle Valo 86114ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 862240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 863bdcd8170SKalle Valo bssid, NULL, 0, 864bdcd8170SKalle Valo NULL, 0, 865bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 866bdcd8170SKalle Valo GFP_KERNEL); 86714ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 86833a6664aSThomas Pedersen cfg80211_disconnected(vif->ndev, proto_reason, 869bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 870bdcd8170SKalle Valo } 871bdcd8170SKalle Valo 87214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 87333a6664aSThomas Pedersen 87433a6664aSThomas Pedersen /* 87533a6664aSThomas Pedersen * Send a disconnect command to target when a disconnect event is 87633a6664aSThomas Pedersen * received with reason code other than 3 (DISCONNECT_CMD - disconnect 87733a6664aSThomas Pedersen * request from host) to make the firmware stop trying to connect even 87833a6664aSThomas Pedersen * after giving disconnect event. There will be one more disconnect 87933a6664aSThomas Pedersen * event for this disconnect command with reason code DISCONNECT_CMD 88033a6664aSThomas Pedersen * which won't be notified to cfg80211. 88133a6664aSThomas Pedersen */ 88233a6664aSThomas Pedersen if (reason != DISCONNECT_CMD) 88333a6664aSThomas Pedersen ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 884bdcd8170SKalle Valo } 885bdcd8170SKalle Valo 8863b8ffc6aSJouni Malinen static int ath6kl_set_probed_ssids(struct ath6kl *ar, 8873b8ffc6aSJouni Malinen struct ath6kl_vif *vif, 888dd45b759SNaveen Singh struct cfg80211_ssid *ssids, int n_ssids, 889dd45b759SNaveen Singh struct cfg80211_match_set *match_set, 890dd45b759SNaveen Singh int n_match_ssid) 8913b8ffc6aSJouni Malinen { 892dd45b759SNaveen Singh u8 i, j, index_to_add, ssid_found = false; 893dd45b759SNaveen Singh struct ath6kl_cfg80211_match_probe_ssid ssid_list[MAX_PROBED_SSIDS]; 8943b8ffc6aSJouni Malinen 895dd45b759SNaveen Singh memset(ssid_list, 0, sizeof(ssid_list)); 896dd45b759SNaveen Singh 897dd45b759SNaveen Singh if (n_ssids > MAX_PROBED_SSIDS || 898dd45b759SNaveen Singh n_match_ssid > MAX_PROBED_SSIDS) 8993b8ffc6aSJouni Malinen return -EINVAL; 9003b8ffc6aSJouni Malinen 9013b8ffc6aSJouni Malinen for (i = 0; i < n_ssids; i++) { 902dd45b759SNaveen Singh memcpy(ssid_list[i].ssid.ssid, 903dd45b759SNaveen Singh ssids[i].ssid, 904dd45b759SNaveen Singh ssids[i].ssid_len); 905dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len = ssids[i].ssid_len; 906dd45b759SNaveen Singh 907dd45b759SNaveen Singh if (ssids[i].ssid_len) 908dd45b759SNaveen Singh ssid_list[i].flag = SPECIFIC_SSID_FLAG; 909dd45b759SNaveen Singh else 910dd45b759SNaveen Singh ssid_list[i].flag = ANY_SSID_FLAG; 911dd45b759SNaveen Singh 912dd45b759SNaveen Singh if (n_match_ssid == 0) 913dd45b759SNaveen Singh ssid_list[i].flag |= MATCH_SSID_FLAG; 914dd45b759SNaveen Singh } 915dd45b759SNaveen Singh 916dd45b759SNaveen Singh index_to_add = i; 917dd45b759SNaveen Singh 918dd45b759SNaveen Singh for (i = 0; i < n_match_ssid; i++) { 919dd45b759SNaveen Singh ssid_found = false; 920dd45b759SNaveen Singh 921dd45b759SNaveen Singh for (j = 0; j < n_ssids; j++) { 922dd45b759SNaveen Singh if ((match_set[i].ssid.ssid_len == 923dd45b759SNaveen Singh ssid_list[j].ssid.ssid_len) && 924dd45b759SNaveen Singh (!memcmp(ssid_list[j].ssid.ssid, 925dd45b759SNaveen Singh match_set[i].ssid.ssid, 926dd45b759SNaveen Singh match_set[i].ssid.ssid_len))) { 927dd45b759SNaveen Singh ssid_list[j].flag |= MATCH_SSID_FLAG; 928dd45b759SNaveen Singh ssid_found = true; 929dd45b759SNaveen Singh break; 930dd45b759SNaveen Singh } 931dd45b759SNaveen Singh } 932dd45b759SNaveen Singh 933dd45b759SNaveen Singh if (ssid_found) 934dd45b759SNaveen Singh continue; 935dd45b759SNaveen Singh 936dd45b759SNaveen Singh if (index_to_add >= MAX_PROBED_SSIDS) 937dd45b759SNaveen Singh continue; 938dd45b759SNaveen Singh 939dd45b759SNaveen Singh ssid_list[index_to_add].ssid.ssid_len = 940dd45b759SNaveen Singh match_set[i].ssid.ssid_len; 941dd45b759SNaveen Singh memcpy(ssid_list[index_to_add].ssid.ssid, 942dd45b759SNaveen Singh match_set[i].ssid.ssid, 943dd45b759SNaveen Singh match_set[i].ssid.ssid_len); 944dd45b759SNaveen Singh ssid_list[index_to_add].flag |= MATCH_SSID_FLAG; 945dd45b759SNaveen Singh index_to_add++; 946dd45b759SNaveen Singh } 947dd45b759SNaveen Singh 948dd45b759SNaveen Singh for (i = 0; i < index_to_add; i++) { 9493b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 950dd45b759SNaveen Singh ssid_list[i].flag, 951dd45b759SNaveen Singh ssid_list[i].ssid.ssid_len, 952dd45b759SNaveen Singh ssid_list[i].ssid.ssid); 953dd45b759SNaveen Singh 9543b8ffc6aSJouni Malinen } 9553b8ffc6aSJouni Malinen 9563b8ffc6aSJouni Malinen /* Make sure no old entries are left behind */ 957dd45b759SNaveen Singh for (i = index_to_add; i < MAX_PROBED_SSIDS; i++) { 9583b8ffc6aSJouni Malinen ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 9593b8ffc6aSJouni Malinen DISABLE_SSID_FLAG, 0, NULL); 9603b8ffc6aSJouni Malinen } 9613b8ffc6aSJouni Malinen 9623b8ffc6aSJouni Malinen return 0; 9633b8ffc6aSJouni Malinen } 9643b8ffc6aSJouni Malinen 965fd014284SJohannes Berg static int ath6kl_cfg80211_scan(struct wiphy *wiphy, 966bdcd8170SKalle Valo struct cfg80211_scan_request *request) 967bdcd8170SKalle Valo { 968fd014284SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(request->wdev); 969fd014284SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 9701276c9efSEdward Lu s8 n_channels = 0; 9711276c9efSEdward Lu u16 *channels = NULL; 972bdcd8170SKalle Valo int ret = 0; 973f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 974bdcd8170SKalle Valo 975990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 976bdcd8170SKalle Valo return -EIO; 977bdcd8170SKalle Valo 97810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 97910509f90SKalle Valo 980bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 98159c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 982954e6ce5SVasanthakumar Thiagarajan ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 983954e6ce5SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0); 9841b1e6ee3SJouni Malinen if (ret) { 985bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 9861b1e6ee3SJouni Malinen return ret; 987bdcd8170SKalle Valo } 988bdcd8170SKalle Valo } 989bdcd8170SKalle Valo 9903b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 991dd45b759SNaveen Singh request->n_ssids, NULL, 0); 9923b8ffc6aSJouni Malinen if (ret < 0) 9933b8ffc6aSJouni Malinen return ret; 994bdcd8170SKalle Valo 995080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 996334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 997334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 998b84da8c7SJouni Malinen request->ie, request->ie_len); 999b84da8c7SJouni Malinen if (ret) { 1000f1ff32e8SJoe Perches ath6kl_err("failed to set Probe Request appie for scan\n"); 1001b84da8c7SJouni Malinen return ret; 1002b84da8c7SJouni Malinen } 1003b84da8c7SJouni Malinen 100411869befSJouni Malinen /* 100511869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 100611869befSJouni Malinen * channels. If the list is longer than the target supports, do not 100711869befSJouni Malinen * configure the list and instead, scan all available channels. 100811869befSJouni Malinen */ 100911869befSJouni Malinen if (request->n_channels > 0 && 101011869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 10111276c9efSEdward Lu u8 i; 10121276c9efSEdward Lu 101311869befSJouni Malinen n_channels = request->n_channels; 10141276c9efSEdward Lu 10151276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 10161276c9efSEdward Lu if (channels == NULL) { 1017cdeb8602SKalle Valo ath6kl_warn("failed to set scan channels, scan all channels"); 10181276c9efSEdward Lu n_channels = 0; 10191276c9efSEdward Lu } 10201276c9efSEdward Lu 10211276c9efSEdward Lu for (i = 0; i < n_channels; i++) 10221276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 10231276c9efSEdward Lu } 10241276c9efSEdward Lu 102559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1026f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 1027f1f92179SVasanthakumar Thiagarajan 10285b35dff0SRaja Mani vif->scan_req = request; 10295b35dff0SRaja Mani 10303ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 10313ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 103213423c31SVasanthakumar Thiagarajan false, 0, 103313423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 103413423c31SVasanthakumar Thiagarajan n_channels, channels, 103513423c31SVasanthakumar Thiagarajan request->no_cck, 10363ca9d1fcSAarthi Thiruvengadam request->rates); 10375b35dff0SRaja Mani if (ret) { 103811f0bfcfSKalle Valo ath6kl_err("failed to start scan: %d\n", ret); 10395b35dff0SRaja Mani vif->scan_req = NULL; 10405b35dff0SRaja Mani } 1041bdcd8170SKalle Valo 10421276c9efSEdward Lu kfree(channels); 10431276c9efSEdward Lu 1044bdcd8170SKalle Valo return ret; 1045bdcd8170SKalle Valo } 1046bdcd8170SKalle Valo 10471c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1048bdcd8170SKalle Valo { 1049240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 10506fd1eaceSKalle Valo int i; 1051bdcd8170SKalle Valo 10521c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 10531c17d313SKalle Valo aborted ? " aborted" : ""); 1054bdcd8170SKalle Valo 105514ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 10566fd1eaceSKalle Valo return; 10576fd1eaceSKalle Valo 10581c17d313SKalle Valo if (aborted) 10596fd1eaceSKalle Valo goto out; 1060bdcd8170SKalle Valo 106114ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 106214ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 1063334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1064334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 1065bdcd8170SKalle Valo 0, NULL); 1066bdcd8170SKalle Valo } 1067bdcd8170SKalle Valo } 10686fd1eaceSKalle Valo 10696fd1eaceSKalle Valo out: 1070cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 107114ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1072bdcd8170SKalle Valo } 1073bdcd8170SKalle Valo 1074c4f7863eSThomas Pedersen void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1075c4f7863eSThomas Pedersen enum wmi_phy_mode mode) 1076c4f7863eSThomas Pedersen { 1077c4f7863eSThomas Pedersen enum nl80211_channel_type type; 1078c4f7863eSThomas Pedersen 1079c4f7863eSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1080c4f7863eSThomas Pedersen "channel switch notify nw_type %d freq %d mode %d\n", 1081c4f7863eSThomas Pedersen vif->nw_type, freq, mode); 1082c4f7863eSThomas Pedersen 1083c4f7863eSThomas Pedersen type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1084c4f7863eSThomas Pedersen 1085c4f7863eSThomas Pedersen cfg80211_ch_switch_notify(vif->ndev, freq, type); 1086c4f7863eSThomas Pedersen } 1087c4f7863eSThomas Pedersen 1088bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1089bdcd8170SKalle Valo u8 key_index, bool pairwise, 1090bdcd8170SKalle Valo const u8 *mac_addr, 1091bdcd8170SKalle Valo struct key_params *params) 1092bdcd8170SKalle Valo { 1093d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 109459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1095bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10964a8ce2fdSSujith Manoharan int seq_len; 1097bdcd8170SKalle Valo u8 key_usage; 1098bdcd8170SKalle Valo u8 key_type; 1099bdcd8170SKalle Valo 1100990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1101bdcd8170SKalle Valo return -EIO; 1102bdcd8170SKalle Valo 1103837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1104837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1105837cb97eSJouni Malinen return -EINVAL; 1106240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1107240d2799SVasanthakumar Thiagarajan params->key); 1108837cb97eSJouni Malinen } 1109837cb97eSJouni Malinen 1110792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1111bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1112bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1113bdcd8170SKalle Valo key_index); 1114bdcd8170SKalle Valo return -ENOENT; 1115bdcd8170SKalle Valo } 1116bdcd8170SKalle Valo 11176f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1118bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1119bdcd8170SKalle Valo 1120bdcd8170SKalle Valo if (pairwise) 1121bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1122bdcd8170SKalle Valo else 1123bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1124bdcd8170SKalle Valo 11254a8ce2fdSSujith Manoharan seq_len = params->seq_len; 11265e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 11275e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 11285e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 11295e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 11305e07021eSDai Shuibing } 1131bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 11325e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1133bdcd8170SKalle Valo return -EINVAL; 1134bdcd8170SKalle Valo 1135bdcd8170SKalle Valo key->key_len = params->key_len; 1136bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 11375e07021eSDai Shuibing key->seq_len = seq_len; 1138bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1139bdcd8170SKalle Valo key->cipher = params->cipher; 1140bdcd8170SKalle Valo 1141bdcd8170SKalle Valo switch (key->cipher) { 1142bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1143bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1144bdcd8170SKalle Valo key_type = WEP_CRYPT; 1145bdcd8170SKalle Valo break; 1146bdcd8170SKalle Valo 1147bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1148bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1149bdcd8170SKalle Valo break; 1150bdcd8170SKalle Valo 1151bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1152bdcd8170SKalle Valo key_type = AES_CRYPT; 1153bdcd8170SKalle Valo break; 11545e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 11555e07021eSDai Shuibing key_type = WAPI_CRYPT; 11565e07021eSDai Shuibing break; 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo default: 1159bdcd8170SKalle Valo return -ENOTSUPP; 1160bdcd8170SKalle Valo } 1161bdcd8170SKalle Valo 1162ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1163ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1164ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1165de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1166bdcd8170SKalle Valo 1167bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1168bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1169bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1170bdcd8170SKalle Valo key_usage, key->seq_len); 1171bdcd8170SKalle Valo 1172f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 11734703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1174cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 11759a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 11769a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 11779a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 11789a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 11799a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 118059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 1181cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1182cdeb8602SKalle Valo "Delay initial group key configuration until AP mode has been started\n"); 11839a5b1318SJouni Malinen /* 11849a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11859a5b1318SJouni Malinen * the connected event is received from the target. 11869a5b1318SJouni Malinen */ 11879a5b1318SJouni Malinen return 0; 11889a5b1318SJouni Malinen } 11899a5b1318SJouni Malinen } 11909a5b1318SJouni Malinen 1191f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 119259c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1193151411e8SJouni Malinen /* 1194151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1195151411e8SJouni Malinen * the AP mode has properly started 1196151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1197151411e8SJouni Malinen */ 1198cdeb8602SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1199cdeb8602SKalle Valo "Delay WEP key configuration until AP mode has been started\n"); 12006f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 12016f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 12026f2a73f9SVasanthakumar Thiagarajan key->key_len); 1203151411e8SJouni Malinen return 0; 1204151411e8SJouni Malinen } 1205151411e8SJouni Malinen 12067cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1207bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1208f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1209f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1210bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1211bdcd8170SKalle Valo } 1212bdcd8170SKalle Valo 1213bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1214bdcd8170SKalle Valo u8 key_index, bool pairwise, 1215bdcd8170SKalle Valo const u8 *mac_addr) 1216bdcd8170SKalle Valo { 1217d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 12186f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1219bdcd8170SKalle Valo 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1221bdcd8170SKalle Valo 1222990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1223bdcd8170SKalle Valo return -EIO; 1224bdcd8170SKalle Valo 1225792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1226bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1227bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1228bdcd8170SKalle Valo key_index); 1229bdcd8170SKalle Valo return -ENOENT; 1230bdcd8170SKalle Valo } 1231bdcd8170SKalle Valo 12326f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1233bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1234bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1235bdcd8170SKalle Valo return 0; 1236bdcd8170SKalle Valo } 1237bdcd8170SKalle Valo 12386f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1239bdcd8170SKalle Valo 1240334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1241bdcd8170SKalle Valo } 1242bdcd8170SKalle Valo 1243bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1244bdcd8170SKalle Valo u8 key_index, bool pairwise, 1245bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1246bdcd8170SKalle Valo void (*callback) (void *cookie, 1247bdcd8170SKalle Valo struct key_params *)) 1248bdcd8170SKalle Valo { 12496f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1250bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1251bdcd8170SKalle Valo struct key_params params; 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1254bdcd8170SKalle Valo 1255990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1256bdcd8170SKalle Valo return -EIO; 1257bdcd8170SKalle Valo 1258792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1259bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1260bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1261bdcd8170SKalle Valo key_index); 1262bdcd8170SKalle Valo return -ENOENT; 1263bdcd8170SKalle Valo } 1264bdcd8170SKalle Valo 12656f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1266bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1267bdcd8170SKalle Valo params.cipher = key->cipher; 1268bdcd8170SKalle Valo params.key_len = key->key_len; 1269bdcd8170SKalle Valo params.seq_len = key->seq_len; 1270bdcd8170SKalle Valo params.seq = key->seq; 1271bdcd8170SKalle Valo params.key = key->key; 1272bdcd8170SKalle Valo 1273bdcd8170SKalle Valo callback(cookie, ¶ms); 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1276bdcd8170SKalle Valo } 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1279bdcd8170SKalle Valo struct net_device *ndev, 1280bdcd8170SKalle Valo u8 key_index, bool unicast, 1281bdcd8170SKalle Valo bool multicast) 1282bdcd8170SKalle Valo { 1283d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 128459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1285bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1286bdcd8170SKalle Valo u8 key_usage; 1287229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1288bdcd8170SKalle Valo 1289bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1290bdcd8170SKalle Valo 1291990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1292bdcd8170SKalle Valo return -EIO; 1293bdcd8170SKalle Valo 1294792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1295bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1296bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1297bdcd8170SKalle Valo __func__, key_index); 1298bdcd8170SKalle Valo return -ENOENT; 1299bdcd8170SKalle Valo } 1300bdcd8170SKalle Valo 13016f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1302bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1303bdcd8170SKalle Valo __func__, key_index); 1304bdcd8170SKalle Valo return -EINVAL; 1305bdcd8170SKalle Valo } 1306bdcd8170SKalle Valo 13073450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 13086f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1309bdcd8170SKalle Valo key_usage = GROUP_USAGE; 13103450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1311bdcd8170SKalle Valo key_usage |= TX_USAGE; 1312229ed6b5SEdward Lu if (unicast) 13133450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1314229ed6b5SEdward Lu if (multicast) 13153450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1316bdcd8170SKalle Valo 1317f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 13189a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 13199a5b1318SJouni Malinen 1320f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1321334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1322229ed6b5SEdward Lu key_type, key_usage, 1323f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1324f4bb9a6fSJouni Malinen key->key, 1325bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1326bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo 1329240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1330bdcd8170SKalle Valo bool ismcast) 1331bdcd8170SKalle Valo { 1332bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1333bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1334bdcd8170SKalle Valo 1335240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1336bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1337bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1338bdcd8170SKalle Valo GFP_KERNEL); 1339bdcd8170SKalle Valo } 1340bdcd8170SKalle Valo 1341bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1342bdcd8170SKalle Valo { 1343bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1344990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1345bdcd8170SKalle Valo int ret; 1346bdcd8170SKalle Valo 1347bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1348bdcd8170SKalle Valo changed); 1349bdcd8170SKalle Valo 1350990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1351990bd915SVasanthakumar Thiagarajan if (!vif) 1352990bd915SVasanthakumar Thiagarajan return -EIO; 1353990bd915SVasanthakumar Thiagarajan 1354990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1355bdcd8170SKalle Valo return -EIO; 1356bdcd8170SKalle Valo 1357bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1358bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1359bdcd8170SKalle Valo if (ret != 0) { 1360bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1361bdcd8170SKalle Valo return -EIO; 1362bdcd8170SKalle Valo } 1363bdcd8170SKalle Valo } 1364bdcd8170SKalle Valo 1365bdcd8170SKalle Valo return 0; 1366bdcd8170SKalle Valo } 1367bdcd8170SKalle Valo 1368bdcd8170SKalle Valo /* 1369bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1370bdcd8170SKalle Valo * data type from 2.6.36 onwards 1371bdcd8170SKalle Valo */ 1372bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1373bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1374b992a285SLuis R. Rodriguez int mbm) 1375bdcd8170SKalle Valo { 1376bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1377990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1378b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1379bdcd8170SKalle Valo 1380bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1381bdcd8170SKalle Valo type, dbm); 1382bdcd8170SKalle Valo 1383990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1384990bd915SVasanthakumar Thiagarajan if (!vif) 1385990bd915SVasanthakumar Thiagarajan return -EIO; 1386990bd915SVasanthakumar Thiagarajan 1387990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1388bdcd8170SKalle Valo return -EIO; 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo switch (type) { 1391bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1392bdcd8170SKalle Valo return 0; 1393bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1394d0d670abSKalle Valo ar->tx_pwr = dbm; 1395bdcd8170SKalle Valo break; 1396bdcd8170SKalle Valo default: 1397bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1398bdcd8170SKalle Valo __func__, type); 1399bdcd8170SKalle Valo return -EOPNOTSUPP; 1400bdcd8170SKalle Valo } 1401bdcd8170SKalle Valo 1402d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1403bdcd8170SKalle Valo 1404bdcd8170SKalle Valo return 0; 1405bdcd8170SKalle Valo } 1406bdcd8170SKalle Valo 1407bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1408bdcd8170SKalle Valo { 1409bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1410990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1411bdcd8170SKalle Valo 1412990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1413990bd915SVasanthakumar Thiagarajan if (!vif) 1414990bd915SVasanthakumar Thiagarajan return -EIO; 1415990bd915SVasanthakumar Thiagarajan 1416990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1417bdcd8170SKalle Valo return -EIO; 1418bdcd8170SKalle Valo 141959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1420bdcd8170SKalle Valo ar->tx_pwr = 0; 1421bdcd8170SKalle Valo 1422990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1423bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1424bdcd8170SKalle Valo return -EIO; 1425bdcd8170SKalle Valo } 1426bdcd8170SKalle Valo 1427bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1428bdcd8170SKalle Valo 5 * HZ); 1429bdcd8170SKalle Valo 1430bdcd8170SKalle Valo if (signal_pending(current)) { 1431bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1432bdcd8170SKalle Valo return -EINTR; 1433bdcd8170SKalle Valo } 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1437bdcd8170SKalle Valo return 0; 1438bdcd8170SKalle Valo } 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1441bdcd8170SKalle Valo struct net_device *dev, 1442bdcd8170SKalle Valo bool pmgmt, int timeout) 1443bdcd8170SKalle Valo { 1444bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1445bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1446334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1447bdcd8170SKalle Valo 1448bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1449bdcd8170SKalle Valo __func__, pmgmt, timeout); 1450bdcd8170SKalle Valo 1451990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1452bdcd8170SKalle Valo return -EIO; 1453bdcd8170SKalle Valo 1454bdcd8170SKalle Valo if (pmgmt) { 1455bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1456bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1457bdcd8170SKalle Valo } else { 1458bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1459bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1460bdcd8170SKalle Valo } 1461bdcd8170SKalle Valo 1462334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1463334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1464bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1465bdcd8170SKalle Valo return -EIO; 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo return 0; 1469bdcd8170SKalle Valo } 1470bdcd8170SKalle Valo 147184efbb84SJohannes Berg static struct wireless_dev *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1472552bff0cSJohannes Berg const char *name, 147355055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 147455055976SVasanthakumar Thiagarajan u32 *flags, 147555055976SVasanthakumar Thiagarajan struct vif_params *params) 147655055976SVasanthakumar Thiagarajan { 147755055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 147884efbb84SJohannes Berg struct wireless_dev *wdev; 147955055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 148055055976SVasanthakumar Thiagarajan 148171f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 148255055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 148355055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 148455055976SVasanthakumar Thiagarajan } 148555055976SVasanthakumar Thiagarajan 148655055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 148755055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 148855055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 148955055976SVasanthakumar Thiagarajan } 149055055976SVasanthakumar Thiagarajan 149184efbb84SJohannes Berg wdev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 149284efbb84SJohannes Berg if (!wdev) 149355055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 149455055976SVasanthakumar Thiagarajan 149555055976SVasanthakumar Thiagarajan ar->num_vif++; 149655055976SVasanthakumar Thiagarajan 149784efbb84SJohannes Berg return wdev; 149855055976SVasanthakumar Thiagarajan } 149955055976SVasanthakumar Thiagarajan 150055055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 150184efbb84SJohannes Berg struct wireless_dev *wdev) 150255055976SVasanthakumar Thiagarajan { 150355055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 150484efbb84SJohannes Berg struct ath6kl_vif *vif = netdev_priv(wdev->netdev); 150555055976SVasanthakumar Thiagarajan 150611f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 150755055976SVasanthakumar Thiagarajan list_del(&vif->list); 150811f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 150955055976SVasanthakumar Thiagarajan 151055055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 151155055976SVasanthakumar Thiagarajan 1512c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 151355055976SVasanthakumar Thiagarajan 151455055976SVasanthakumar Thiagarajan return 0; 151555055976SVasanthakumar Thiagarajan } 151655055976SVasanthakumar Thiagarajan 1517bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1518bdcd8170SKalle Valo struct net_device *ndev, 1519bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1520bdcd8170SKalle Valo struct vif_params *params) 1521bdcd8170SKalle Valo { 1522f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 15231e8d13b0SVasanthakumar Thiagarajan int i; 1524bdcd8170SKalle Valo 1525bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1526bdcd8170SKalle Valo 15271e8d13b0SVasanthakumar Thiagarajan /* 15281e8d13b0SVasanthakumar Thiagarajan * Don't bring up p2p on an interface which is not initialized 15291e8d13b0SVasanthakumar Thiagarajan * for p2p operation where fw does not have capability to switch 15301e8d13b0SVasanthakumar Thiagarajan * dynamically between non-p2p and p2p type interface. 15311e8d13b0SVasanthakumar Thiagarajan */ 15321e8d13b0SVasanthakumar Thiagarajan if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 15331e8d13b0SVasanthakumar Thiagarajan vif->ar->fw_capabilities) && 15341e8d13b0SVasanthakumar Thiagarajan (type == NL80211_IFTYPE_P2P_CLIENT || 15351e8d13b0SVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO)) { 15361e8d13b0SVasanthakumar Thiagarajan if (vif->ar->vif_max == 1) { 15371e8d13b0SVasanthakumar Thiagarajan if (vif->fw_vif_idx != 0) 15381e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15391e8d13b0SVasanthakumar Thiagarajan else 15401e8d13b0SVasanthakumar Thiagarajan goto set_iface_type; 15411e8d13b0SVasanthakumar Thiagarajan } 15421e8d13b0SVasanthakumar Thiagarajan 15431e8d13b0SVasanthakumar Thiagarajan for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 15441e8d13b0SVasanthakumar Thiagarajan if (i == vif->fw_vif_idx) 15451e8d13b0SVasanthakumar Thiagarajan break; 15461e8d13b0SVasanthakumar Thiagarajan } 15471e8d13b0SVasanthakumar Thiagarajan 15481e8d13b0SVasanthakumar Thiagarajan if (i == vif->ar->vif_max) { 15491e8d13b0SVasanthakumar Thiagarajan ath6kl_err("Invalid interface to bring up P2P\n"); 15501e8d13b0SVasanthakumar Thiagarajan return -EINVAL; 15511e8d13b0SVasanthakumar Thiagarajan } 15521e8d13b0SVasanthakumar Thiagarajan } 15531e8d13b0SVasanthakumar Thiagarajan 1554c422d52dSThomas Pedersen /* need to clean up enhanced bmiss detection fw state */ 1555c422d52dSThomas Pedersen ath6kl_cfg80211_sta_bmiss_enhance(vif, false); 1556c422d52dSThomas Pedersen 15571e8d13b0SVasanthakumar Thiagarajan set_iface_type: 1558bdcd8170SKalle Valo switch (type) { 1559bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1560f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1561bdcd8170SKalle Valo break; 1562bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1563f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1564bdcd8170SKalle Valo break; 15656e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1566f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15676e4604c8SJouni Malinen break; 15686b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1569f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 15706b5e5d25SJouni Malinen break; 15716b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1572f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 15736b5e5d25SJouni Malinen break; 1574bdcd8170SKalle Valo default: 1575bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1576bdcd8170SKalle Valo return -EOPNOTSUPP; 1577bdcd8170SKalle Valo } 1578bdcd8170SKalle Valo 1579551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1580bdcd8170SKalle Valo 1581bdcd8170SKalle Valo return 0; 1582bdcd8170SKalle Valo } 1583bdcd8170SKalle Valo 1584bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1585bdcd8170SKalle Valo struct net_device *dev, 1586bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1587bdcd8170SKalle Valo { 1588bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 158959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1590bdcd8170SKalle Valo int status; 1591bdcd8170SKalle Valo 1592990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1593bdcd8170SKalle Valo return -EIO; 1594bdcd8170SKalle Valo 15953450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 15963450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1597bdcd8170SKalle Valo 1598bdcd8170SKalle Valo if (ibss_param->channel) 1599f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1600bdcd8170SKalle Valo 1601bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1602bdcd8170SKalle Valo /* 1603bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1604bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1605bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1606bdcd8170SKalle Valo * updated. 1607bdcd8170SKalle Valo */ 1608bdcd8170SKalle Valo return -EOPNOTSUPP; 1609bdcd8170SKalle Valo } 1610bdcd8170SKalle Valo 16118c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1612bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 16138c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 16148c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1615bdcd8170SKalle Valo 1616240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1617bdcd8170SKalle Valo 1618240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1619bdcd8170SKalle Valo if (status) 1620bdcd8170SKalle Valo return status; 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo if (ibss_param->privacy) { 1623240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1624240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1625bdcd8170SKalle Valo } else { 1626240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1627240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1628bdcd8170SKalle Valo } 1629bdcd8170SKalle Valo 1630f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1633bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1634bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1635bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1636bdcd8170SKalle Valo __func__, 16373450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 16383450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1639f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1640bdcd8170SKalle Valo 1641334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 16423450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 16433450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 16443450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 16453450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 16463450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1647f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 16483ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 164959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1650bdcd8170SKalle Valo 1651bdcd8170SKalle Valo return 0; 1652bdcd8170SKalle Valo } 1653bdcd8170SKalle Valo 1654bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1655bdcd8170SKalle Valo struct net_device *dev) 1656bdcd8170SKalle Valo { 16573450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1658bdcd8170SKalle Valo 1659990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1660bdcd8170SKalle Valo return -EIO; 1661bdcd8170SKalle Valo 1662240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 16633450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 16643450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1665bdcd8170SKalle Valo 1666bdcd8170SKalle Valo return 0; 1667bdcd8170SKalle Valo } 1668bdcd8170SKalle Valo 1669bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1670bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1671bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1672bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1673bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1674837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 16755e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1676bdcd8170SKalle Valo }; 1677bdcd8170SKalle Valo 1678bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1679bdcd8170SKalle Valo { 1680bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1681bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1682bdcd8170SKalle Valo 36000, 48000, 54000 1683bdcd8170SKalle Valo }; 1684bdcd8170SKalle Valo u8 i; 1685bdcd8170SKalle Valo 1686bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1687bdcd8170SKalle Valo if (rate == legacy[i]) 1688bdcd8170SKalle Valo return true; 1689bdcd8170SKalle Valo 1690bdcd8170SKalle Valo return false; 1691bdcd8170SKalle Valo } 1692bdcd8170SKalle Valo 1693bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1694bdcd8170SKalle Valo { 1695bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1696bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1697bdcd8170SKalle Valo }; 1698bdcd8170SKalle Valo u8 i; 1699bdcd8170SKalle Valo 1700bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1701bdcd8170SKalle Valo if (rate == ht20[i]) { 1702bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1703bdcd8170SKalle Valo /* last rate uses sgi */ 1704bdcd8170SKalle Valo *sgi = true; 1705bdcd8170SKalle Valo else 1706bdcd8170SKalle Valo *sgi = false; 1707bdcd8170SKalle Valo 1708bdcd8170SKalle Valo *mcs = i; 1709bdcd8170SKalle Valo return true; 1710bdcd8170SKalle Valo } 1711bdcd8170SKalle Valo } 1712bdcd8170SKalle Valo return false; 1713bdcd8170SKalle Valo } 1714bdcd8170SKalle Valo 1715bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1716bdcd8170SKalle Valo { 1717bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1718bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1719bdcd8170SKalle Valo 150000 1720bdcd8170SKalle Valo }; 1721bdcd8170SKalle Valo u8 i; 1722bdcd8170SKalle Valo 1723bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1724bdcd8170SKalle Valo if (rate == ht40[i]) { 1725bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1726bdcd8170SKalle Valo /* last rate uses sgi */ 1727bdcd8170SKalle Valo *sgi = true; 1728bdcd8170SKalle Valo else 1729bdcd8170SKalle Valo *sgi = false; 1730bdcd8170SKalle Valo 1731bdcd8170SKalle Valo *mcs = i; 1732bdcd8170SKalle Valo return true; 1733bdcd8170SKalle Valo } 1734bdcd8170SKalle Valo } 1735bdcd8170SKalle Valo 1736bdcd8170SKalle Valo return false; 1737bdcd8170SKalle Valo } 1738bdcd8170SKalle Valo 1739bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1740bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1741bdcd8170SKalle Valo { 1742bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 174359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1744bdcd8170SKalle Valo long left; 1745bdcd8170SKalle Valo bool sgi; 1746bdcd8170SKalle Valo s32 rate; 1747bdcd8170SKalle Valo int ret; 1748bdcd8170SKalle Valo u8 mcs; 1749bdcd8170SKalle Valo 17508c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1751bdcd8170SKalle Valo return -ENOENT; 1752bdcd8170SKalle Valo 1753bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1754bdcd8170SKalle Valo return -EBUSY; 1755bdcd8170SKalle Valo 1756b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1757bdcd8170SKalle Valo 1758334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1759bdcd8170SKalle Valo 1760bdcd8170SKalle Valo if (ret != 0) { 1761bdcd8170SKalle Valo up(&ar->sem); 1762bdcd8170SKalle Valo return -EIO; 1763bdcd8170SKalle Valo } 1764bdcd8170SKalle Valo 1765bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1766bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1767b95907a7SVasanthakumar Thiagarajan &vif->flags), 1768bdcd8170SKalle Valo WMI_TIMEOUT); 1769bdcd8170SKalle Valo 1770bdcd8170SKalle Valo up(&ar->sem); 1771bdcd8170SKalle Valo 1772bdcd8170SKalle Valo if (left == 0) 1773bdcd8170SKalle Valo return -ETIMEDOUT; 1774bdcd8170SKalle Valo else if (left < 0) 1775bdcd8170SKalle Valo return left; 1776bdcd8170SKalle Valo 1777b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1778b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1779bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1780b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1781bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1782bdcd8170SKalle Valo } 1783bdcd8170SKalle Valo 1784b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1785b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1786bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1787b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1788bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1789bdcd8170SKalle Valo } 1790bdcd8170SKalle Valo 1791b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1792bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1793bdcd8170SKalle Valo 1794b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1795bdcd8170SKalle Valo 1796bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1797bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1798bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1799bdcd8170SKalle Valo if (sgi) { 1800bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1801bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1802bdcd8170SKalle Valo } else { 1803bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1804bdcd8170SKalle Valo } 1805bdcd8170SKalle Valo 1806bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1807bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1808bdcd8170SKalle Valo if (sgi) { 1809bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1810bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1811bdcd8170SKalle Valo } else { 1812bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1813bdcd8170SKalle Valo } 1814bdcd8170SKalle Valo 1815bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1816bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1817bdcd8170SKalle Valo } else { 18189a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 18199a730834SKalle Valo "invalid rate from stats: %d\n", rate); 18209a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1821bdcd8170SKalle Valo return 0; 1822bdcd8170SKalle Valo } 1823bdcd8170SKalle Valo 1824bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1825bdcd8170SKalle Valo 182659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 182759c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1828f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 182932c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 183032c10874SJouni Malinen sinfo->bss_param.flags = 0; 1831cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1832cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 183332c10874SJouni Malinen } 183432c10874SJouni Malinen 1835bdcd8170SKalle Valo return 0; 1836bdcd8170SKalle Valo } 1837bdcd8170SKalle Valo 1838bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1839bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1840bdcd8170SKalle Valo { 1841bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1842334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1843334234b5SVasanthakumar Thiagarajan 1844334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1845bdcd8170SKalle Valo pmksa->pmkid, true); 1846bdcd8170SKalle Valo } 1847bdcd8170SKalle Valo 1848bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1849bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1850bdcd8170SKalle Valo { 1851bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1852334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1853334234b5SVasanthakumar Thiagarajan 1854334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1855bdcd8170SKalle Valo pmksa->pmkid, false); 1856bdcd8170SKalle Valo } 1857bdcd8170SKalle Valo 1858bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1859bdcd8170SKalle Valo { 1860bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 186159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 186259c98449SVasanthakumar Thiagarajan 186359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1864334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1865334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1866bdcd8170SKalle Valo return 0; 1867bdcd8170SKalle Valo } 1868bdcd8170SKalle Valo 1869d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1870d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 18716cb3c714SRaja Mani { 1872d91e8eeeSRaja Mani int ret, pos; 18732c07cf44SThomas Pedersen u8 mask[WOW_PATTERN_SIZE]; 18746cb3c714SRaja Mani u16 i; 18756cb3c714SRaja Mani 1876d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 18776cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 18786cb3c714SRaja Mani 18796cb3c714SRaja Mani /* 18806cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 18816cb3c714SRaja Mani * driver specific mask value and send it to the chip along 18826cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 18836cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 18846cb3c714SRaja Mani * then equivalent driver specific mask value is 18856cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 18866cb3c714SRaja Mani */ 18876cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 18886cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 18896cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 18906cb3c714SRaja Mani mask[pos] = 0xFF; 18916cb3c714SRaja Mani } 18926cb3c714SRaja Mani /* 18936cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 18946cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 18956cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 18966cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 18976cb3c714SRaja Mani */ 18986cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 18996cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 19006cb3c714SRaja Mani wow->patterns[i].pattern_len, 19016cb3c714SRaja Mani 0 /* pattern offset */, 19026cb3c714SRaja Mani wow->patterns[i].pattern, mask); 19036cb3c714SRaja Mani if (ret) 19046cb3c714SRaja Mani return ret; 19056cb3c714SRaja Mani } 19066cb3c714SRaja Mani 1907d91e8eeeSRaja Mani if (wow->disconnect) 1908d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1909d91e8eeeSRaja Mani 1910d91e8eeeSRaja Mani if (wow->magic_pkt) 1911d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1912d91e8eeeSRaja Mani 1913d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1914d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1915d91e8eeeSRaja Mani 1916d91e8eeeSRaja Mani if (wow->eap_identity_req) 1917d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1918d91e8eeeSRaja Mani 1919d91e8eeeSRaja Mani if (wow->four_way_handshake) 1920d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1921d91e8eeeSRaja Mani 1922d91e8eeeSRaja Mani return 0; 1923d91e8eeeSRaja Mani } 1924d91e8eeeSRaja Mani 1925d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1926d91e8eeeSRaja Mani { 1927d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 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, 0x08 }; 1931d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1932d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1933d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1934d91e8eeeSRaja Mani 0x00, 0x7f }; 1935d91e8eeeSRaja Mani u8 unicst_offset = 0; 1936d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1937d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1938d91e8eeeSRaja Mani u8 arp_offset = 20; 1939d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1940d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1941d91e8eeeSRaja Mani u8 discvr_offset = 38; 1942d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1943d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1944d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1945d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1946d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1947d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1948d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1949d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1950d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1951d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1952d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1953d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1954d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1955d91e8eeeSRaja Mani int ret; 1956d91e8eeeSRaja Mani 1957d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1958d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1959d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1960d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1961d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1962d91e8eeeSRaja Mani if (ret) { 1963d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1964d91e8eeeSRaja Mani return ret; 1965d91e8eeeSRaja Mani } 1966d91e8eeeSRaja Mani 1967d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1968d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1969d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1970d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1971d91e8eeeSRaja Mani arp_pattern, arp_mask); 1972d91e8eeeSRaja Mani if (ret) { 1973d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1974d91e8eeeSRaja Mani return ret; 1975d91e8eeeSRaja Mani } 1976d91e8eeeSRaja Mani 1977d91e8eeeSRaja Mani /* 1978d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1979d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1980d91e8eeeSRaja Mani */ 1981d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1982d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1983d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1984d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1985d91e8eeeSRaja Mani if (ret) { 1986d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1987d91e8eeeSRaja Mani return ret; 1988d91e8eeeSRaja Mani } 1989d91e8eeeSRaja Mani 1990d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1991d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1992d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1993d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1994d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1995d91e8eeeSRaja Mani if (ret) { 1996d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1997d91e8eeeSRaja Mani return ret; 1998d91e8eeeSRaja Mani } 1999d91e8eeeSRaja Mani 2000d91e8eeeSRaja Mani return 0; 2001d91e8eeeSRaja Mani } 2002d91e8eeeSRaja Mani 2003d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 2004d91e8eeeSRaja Mani { 2005d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 2006d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 2007d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 2008d91e8eeeSRaja Mani u8 discvr_offset = 38; 2009d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 2010d91e8eeeSRaja Mani int ret; 2011d91e8eeeSRaja Mani 2012d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 2013d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 2014d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2015d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2016d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 2017d91e8eeeSRaja Mani mac_mask); 2018d91e8eeeSRaja Mani if (ret) { 2019d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 2020d91e8eeeSRaja Mani return ret; 2021d91e8eeeSRaja Mani } 2022d91e8eeeSRaja Mani 2023d91e8eeeSRaja Mani /* 2024d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 2025d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 2026d91e8eeeSRaja Mani */ 2027d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 2028d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 2029d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 2030d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 2031d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 2032d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 2033d91e8eeeSRaja Mani if (ret) { 2034cdeb8602SKalle Valo ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 2035d91e8eeeSRaja Mani return ret; 2036d91e8eeeSRaja Mani } 2037d91e8eeeSRaja Mani } 2038d91e8eeeSRaja Mani 2039d91e8eeeSRaja Mani return 0; 2040d91e8eeeSRaja Mani } 2041d91e8eeeSRaja Mani 2042055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2043055bde49SRaja Mani { 2044055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2045055bde49SRaja Mani } 2046055bde49SRaja Mani 2047055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 2048055bde49SRaja Mani { 2049055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 2050055bde49SRaja Mani } 2051055bde49SRaja Mani 2052055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2053055bde49SRaja Mani { 2054055bde49SRaja Mani int ret, left; 2055055bde49SRaja Mani 2056055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2057055bde49SRaja Mani 2058055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2059055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 2060055bde49SRaja Mani if (ret) 2061055bde49SRaja Mani return ret; 2062055bde49SRaja Mani 2063055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2064055bde49SRaja Mani is_hsleep_mode_procsed(vif), 2065055bde49SRaja Mani WMI_TIMEOUT); 2066055bde49SRaja Mani if (left == 0) { 2067055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2068055bde49SRaja Mani ret = -ETIMEDOUT; 2069055bde49SRaja Mani } else if (left < 0) { 2070055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2071055bde49SRaja Mani left); 2072055bde49SRaja Mani ret = left; 2073055bde49SRaja Mani } 2074055bde49SRaja Mani 2075055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 2076055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2077055bde49SRaja Mani is_ctrl_ep_empty(ar), 2078055bde49SRaja Mani WMI_TIMEOUT); 2079055bde49SRaja Mani if (left == 0) { 2080055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 2081055bde49SRaja Mani ret = -ETIMEDOUT; 2082055bde49SRaja Mani } else if (left < 0) { 2083055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2084055bde49SRaja Mani ret = left; 2085055bde49SRaja Mani } 2086055bde49SRaja Mani } 2087055bde49SRaja Mani 2088055bde49SRaja Mani return ret; 2089055bde49SRaja Mani } 2090055bde49SRaja Mani 2091fd4377b6SThomas Pedersen static int ath6kl_wow_suspend_vif(struct ath6kl_vif *vif, 2092fd4377b6SThomas Pedersen struct cfg80211_wowlan *wow, u32 *filter) 2093d91e8eeeSRaja Mani { 2094fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 2095d91e8eeeSRaja Mani struct in_device *in_dev; 2096d91e8eeeSRaja Mani struct in_ifaddr *ifa; 2097055bde49SRaja Mani int ret; 2098ce0dc0cfSRaja Mani u16 i, bmiss_time; 2099d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 2100fd4377b6SThomas Pedersen u8 index = 0; 2101d91e8eeeSRaja Mani 21026821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_ON, &vif->flags) && 21036821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 21046821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 21056251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 21066251d801SNaveen Gangadharan vif->fw_vif_idx, false); 21076251d801SNaveen Gangadharan if (ret) 21086251d801SNaveen Gangadharan return ret; 21096251d801SNaveen Gangadharan } 21106251d801SNaveen Gangadharan 2111d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2112d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2113d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2114d91e8eeeSRaja Mani WOW_LIST_ID, i); 2115d91e8eeeSRaja Mani 2116d91e8eeeSRaja Mani /* 2117d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2118d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2119d91e8eeeSRaja Mani * the user. 2120d91e8eeeSRaja Mani */ 2121d91e8eeeSRaja Mani if (wow) 2122fd4377b6SThomas Pedersen ret = ath6kl_wow_usr(ar, vif, wow, filter); 2123d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2124d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2125d91e8eeeSRaja Mani else 2126d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2127d91e8eeeSRaja Mani 2128d91e8eeeSRaja Mani if (ret) 2129d91e8eeeSRaja Mani return ret; 2130d91e8eeeSRaja Mani 2131390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2132390a8c8fSRaja Mani 2133ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2134ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2135ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2136ce0dc0cfSRaja Mani 0); 2137ce0dc0cfSRaja Mani if (ret) 2138ce0dc0cfSRaja Mani return ret; 2139ce0dc0cfSRaja Mani 2140ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2141ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2142ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2143ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2144ce0dc0cfSRaja Mani 2145ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2146ce0dc0cfSRaja Mani bmiss_time, 0); 2147ce0dc0cfSRaja Mani if (ret) 2148ce0dc0cfSRaja Mani return ret; 2149ce0dc0cfSRaja Mani 2150ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2151ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2152ce0dc0cfSRaja Mani 0, 0, 0, 0); 2153ce0dc0cfSRaja Mani if (ret) 2154ce0dc0cfSRaja Mani return ret; 2155ce0dc0cfSRaja Mani } 2156ce0dc0cfSRaja Mani 2157c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2158c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2159c08631c6SRaja Mani if (!in_dev) 2160fd4377b6SThomas Pedersen return 0; 2161c08631c6SRaja Mani 2162c08631c6SRaja Mani ifa = in_dev->ifa_list; 2163c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2164c08631c6SRaja Mani 2165c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2166c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2167c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2168c08631c6SRaja Mani ifa = ifa->ifa_next; 2169c08631c6SRaja Mani index++; 2170c08631c6SRaja Mani } 2171c08631c6SRaja Mani 2172c08631c6SRaja Mani if (ifa) { 2173c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2174c08631c6SRaja Mani return -EINVAL; 2175c08631c6SRaja Mani } 2176c08631c6SRaja Mani 2177c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2178c08631c6SRaja Mani if (ret) { 2179c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2180c08631c6SRaja Mani return ret; 2181c08631c6SRaja Mani } 2182c08631c6SRaja Mani 2183fd4377b6SThomas Pedersen return ret; 2184fd4377b6SThomas Pedersen } 2185fd4377b6SThomas Pedersen 2186fd4377b6SThomas Pedersen static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2187fd4377b6SThomas Pedersen { 2188fd4377b6SThomas Pedersen struct ath6kl_vif *first_vif, *vif; 2189fd4377b6SThomas Pedersen int ret = 0; 2190fd4377b6SThomas Pedersen u32 filter = 0; 2191fd4377b6SThomas Pedersen bool connected = false; 2192fd4377b6SThomas Pedersen 2193fd4377b6SThomas Pedersen /* enter / leave wow suspend on first vif always */ 2194fd4377b6SThomas Pedersen first_vif = ath6kl_vif_first(ar); 2195fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!first_vif)) || 2196fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(first_vif)) 2197fd4377b6SThomas Pedersen return -EIO; 2198fd4377b6SThomas Pedersen 2199fd4377b6SThomas Pedersen if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2200fd4377b6SThomas Pedersen return -EINVAL; 2201fd4377b6SThomas Pedersen 2202fd4377b6SThomas Pedersen /* install filters for each connected vif */ 2203fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2204fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2205fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2206fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2207fd4377b6SThomas Pedersen continue; 2208fd4377b6SThomas Pedersen connected = true; 2209fd4377b6SThomas Pedersen 2210fd4377b6SThomas Pedersen ret = ath6kl_wow_suspend_vif(vif, wow, &filter); 2211fd4377b6SThomas Pedersen if (ret) 2212fd4377b6SThomas Pedersen break; 2213fd4377b6SThomas Pedersen } 2214fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2215fd4377b6SThomas Pedersen 2216fd4377b6SThomas Pedersen if (!connected) 2217fd4377b6SThomas Pedersen return -ENOTCONN; 2218fd4377b6SThomas Pedersen else if (ret) 2219fd4377b6SThomas Pedersen return ret; 2220fd4377b6SThomas Pedersen 2221fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_SUSPENDING; 2222fd4377b6SThomas Pedersen 2223fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, first_vif->fw_vif_idx, 22246cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 22256cb3c714SRaja Mani filter, 22266cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 22276cb3c714SRaja Mani if (ret) 22286cb3c714SRaja Mani return ret; 22296cb3c714SRaja Mani 2230fd4377b6SThomas Pedersen return ath6kl_cfg80211_host_sleep(ar, first_vif); 22316cb3c714SRaja Mani } 22326cb3c714SRaja Mani 2233fd4377b6SThomas Pedersen static int ath6kl_wow_resume_vif(struct ath6kl_vif *vif) 22346cb3c714SRaja Mani { 2235fd4377b6SThomas Pedersen struct ath6kl *ar = vif->ar; 22366cb3c714SRaja Mani int ret; 22376cb3c714SRaja Mani 2238ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2239ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2240ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2241ce0dc0cfSRaja Mani if (ret) 2242ce0dc0cfSRaja Mani return ret; 2243ce0dc0cfSRaja Mani 2244ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2245ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2246ce0dc0cfSRaja Mani if (ret) 2247ce0dc0cfSRaja Mani return ret; 2248ce0dc0cfSRaja Mani 2249ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2250ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2251ce0dc0cfSRaja Mani if (ret) 2252ce0dc0cfSRaja Mani return ret; 2253ce0dc0cfSRaja Mani } 2254ce0dc0cfSRaja Mani 22556821d4f0SNaveen Gangadharan if (!test_bit(NETDEV_MCAST_ALL_OFF, &vif->flags) && 22566821d4f0SNaveen Gangadharan test_bit(ATH6KL_FW_CAPABILITY_WOW_MULTICAST_FILTER, 22576821d4f0SNaveen Gangadharan ar->fw_capabilities)) { 22586251d801SNaveen Gangadharan ret = ath6kl_wmi_mcast_filter_cmd(vif->ar->wmi, 22596251d801SNaveen Gangadharan vif->fw_vif_idx, true); 22606251d801SNaveen Gangadharan if (ret) 22616251d801SNaveen Gangadharan return ret; 22626251d801SNaveen Gangadharan } 22636251d801SNaveen Gangadharan 2264390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2265390a8c8fSRaja Mani 2266390a8c8fSRaja Mani return 0; 2267390a8c8fSRaja Mani } 2268390a8c8fSRaja Mani 2269fd4377b6SThomas Pedersen static int ath6kl_wow_resume(struct ath6kl *ar) 2270fd4377b6SThomas Pedersen { 2271fd4377b6SThomas Pedersen struct ath6kl_vif *vif; 2272fd4377b6SThomas Pedersen int ret; 2273fd4377b6SThomas Pedersen 2274fd4377b6SThomas Pedersen vif = ath6kl_vif_first(ar); 2275fd4377b6SThomas Pedersen if (WARN_ON(unlikely(!vif)) || 2276fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2277fd4377b6SThomas Pedersen return -EIO; 2278fd4377b6SThomas Pedersen 2279fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_RESUMING; 2280fd4377b6SThomas Pedersen 2281fd4377b6SThomas Pedersen ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2282fd4377b6SThomas Pedersen ATH6KL_HOST_MODE_AWAKE); 2283fd4377b6SThomas Pedersen if (ret) { 2284fd4377b6SThomas Pedersen ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2285fd4377b6SThomas Pedersen ret); 2286fd4377b6SThomas Pedersen goto cleanup; 2287fd4377b6SThomas Pedersen } 2288fd4377b6SThomas Pedersen 2289fd4377b6SThomas Pedersen spin_lock_bh(&ar->list_lock); 2290fd4377b6SThomas Pedersen list_for_each_entry(vif, &ar->vif_list, list) { 2291fd4377b6SThomas Pedersen if (!test_bit(CONNECTED, &vif->flags) || 2292fd4377b6SThomas Pedersen !ath6kl_cfg80211_ready(vif)) 2293fd4377b6SThomas Pedersen continue; 2294fd4377b6SThomas Pedersen ret = ath6kl_wow_resume_vif(vif); 2295fd4377b6SThomas Pedersen if (ret) 2296fd4377b6SThomas Pedersen break; 2297fd4377b6SThomas Pedersen } 2298fd4377b6SThomas Pedersen spin_unlock_bh(&ar->list_lock); 2299fd4377b6SThomas Pedersen 2300fd4377b6SThomas Pedersen if (ret) 2301fd4377b6SThomas Pedersen goto cleanup; 2302fd4377b6SThomas Pedersen 2303fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_ON; 2304fd4377b6SThomas Pedersen return 0; 2305fd4377b6SThomas Pedersen 2306fd4377b6SThomas Pedersen cleanup: 2307fd4377b6SThomas Pedersen ar->state = ATH6KL_STATE_WOW; 2308fd4377b6SThomas Pedersen return ret; 2309fd4377b6SThomas Pedersen } 2310fd4377b6SThomas Pedersen 231140abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 231240abc2deSRaja Mani { 231340abc2deSRaja Mani struct ath6kl_vif *vif; 231440abc2deSRaja Mani int ret; 231540abc2deSRaja Mani 231640abc2deSRaja Mani vif = ath6kl_vif_first(ar); 231740abc2deSRaja Mani if (!vif) 231840abc2deSRaja Mani return -EIO; 231940abc2deSRaja Mani 232048f27587SMing Jiang if (!test_bit(WMI_READY, &ar->flag)) { 232148f27587SMing Jiang ath6kl_err("deepsleep failed as wmi is not ready\n"); 232240abc2deSRaja Mani return -EIO; 232348f27587SMing Jiang } 232440abc2deSRaja Mani 232540abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 232640abc2deSRaja Mani 232740abc2deSRaja Mani /* Save the current power mode before enabling power save */ 232840abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 232940abc2deSRaja Mani 233040abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 233140abc2deSRaja Mani if (ret) 233240abc2deSRaja Mani return ret; 233340abc2deSRaja Mani 233440abc2deSRaja Mani /* Disable WOW mode */ 233540abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 233640abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 233740abc2deSRaja Mani 0, 0); 233840abc2deSRaja Mani if (ret) 233940abc2deSRaja Mani return ret; 234040abc2deSRaja Mani 234140abc2deSRaja Mani /* Flush all non control pkts in TX path */ 234240abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 234340abc2deSRaja Mani 234440abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 234540abc2deSRaja Mani if (ret) 234640abc2deSRaja Mani return ret; 234740abc2deSRaja Mani 234840abc2deSRaja Mani return 0; 234940abc2deSRaja Mani } 235040abc2deSRaja Mani 235140abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 235240abc2deSRaja Mani { 235340abc2deSRaja Mani struct ath6kl_vif *vif; 235440abc2deSRaja Mani int ret; 235540abc2deSRaja Mani 235640abc2deSRaja Mani vif = ath6kl_vif_first(ar); 235740abc2deSRaja Mani 235840abc2deSRaja Mani if (!vif) 235940abc2deSRaja Mani return -EIO; 236040abc2deSRaja Mani 236140abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 236240abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 236340abc2deSRaja Mani ar->wmi->saved_pwr_mode); 236440abc2deSRaja Mani if (ret) 236540abc2deSRaja Mani return ret; 236640abc2deSRaja Mani } 236740abc2deSRaja Mani 236840abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 236940abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 237040abc2deSRaja Mani if (ret) 237140abc2deSRaja Mani return ret; 237240abc2deSRaja Mani 237340abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 237440abc2deSRaja Mani 237540abc2deSRaja Mani /* Reset scan parameter to default values */ 237640abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 237740abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 237840abc2deSRaja Mani if (ret) 237940abc2deSRaja Mani return ret; 238040abc2deSRaja Mani 238140abc2deSRaja Mani return 0; 238240abc2deSRaja Mani } 238340abc2deSRaja Mani 238452d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 23850f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 23860f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 238752d81a68SKalle Valo { 23883d79499cSVivek Natarajan struct ath6kl_vif *vif; 2389390a8c8fSRaja Mani enum ath6kl_state prev_state; 239052d81a68SKalle Valo int ret; 239152d81a68SKalle Valo 239252d81a68SKalle Valo switch (mode) { 2393d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2394d7c44e0bSRaja Mani 2395d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2396d7c44e0bSRaja Mani 2397d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2398d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2399d7c44e0bSRaja Mani 2400390a8c8fSRaja Mani prev_state = ar->state; 2401390a8c8fSRaja Mani 2402d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2403390a8c8fSRaja Mani if (ret) { 2404390a8c8fSRaja Mani ar->state = prev_state; 2405d7c44e0bSRaja Mani return ret; 2406390a8c8fSRaja Mani } 24071e9a905dSRaja Mani 2408d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2409d7c44e0bSRaja Mani break; 2410d7c44e0bSRaja Mani 241152d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2412524441e3SRaja Mani 241340abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2414524441e3SRaja Mani 241540abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 241652d81a68SKalle Valo if (ret) { 241740abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 241840abc2deSRaja Mani return ret; 241952d81a68SKalle Valo } 242052d81a68SKalle Valo 242176a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 242276a9fbe2SKalle Valo 242352d81a68SKalle Valo break; 2424b4b2a0b1SKalle Valo 2425b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2426524441e3SRaja Mani 24277125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2428524441e3SRaja Mani 2429b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2430b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2431b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2432b4b2a0b1SKalle Valo break; 2433b4b2a0b1SKalle Valo } 2434b4b2a0b1SKalle Valo 2435b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2436b4b2a0b1SKalle Valo 2437b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2438b4b2a0b1SKalle Valo if (ret) { 2439b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2440b4b2a0b1SKalle Valo ret); 2441b4b2a0b1SKalle Valo } 2442b4b2a0b1SKalle Valo 2443b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2444b4b2a0b1SKalle Valo 2445b4b2a0b1SKalle Valo break; 2446b4b2a0b1SKalle Valo 2447b4b2a0b1SKalle Valo default: 2448b4b2a0b1SKalle Valo break; 244952d81a68SKalle Valo } 245052d81a68SKalle Valo 24513d79499cSVivek Natarajan list_for_each_entry(vif, &ar->vif_list, list) 24523d79499cSVivek Natarajan ath6kl_cfg80211_scan_complete_event(vif, true); 24533d79499cSVivek Natarajan 245452d81a68SKalle Valo return 0; 245552d81a68SKalle Valo } 2456d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 245752d81a68SKalle Valo 245852d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 245952d81a68SKalle Valo { 246076a9fbe2SKalle Valo int ret; 246176a9fbe2SKalle Valo 246276a9fbe2SKalle Valo switch (ar->state) { 2463d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2464d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2465d7c44e0bSRaja Mani 2466d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2467d7c44e0bSRaja Mani if (ret) { 2468d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2469d7c44e0bSRaja Mani return ret; 2470d7c44e0bSRaja Mani } 2471d7c44e0bSRaja Mani 2472d7c44e0bSRaja Mani break; 2473d7c44e0bSRaja Mani 247476a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 247540abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 247640abc2deSRaja Mani 247740abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 247876a9fbe2SKalle Valo if (ret) { 247940abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 248040abc2deSRaja Mani return ret; 248176a9fbe2SKalle Valo } 248276a9fbe2SKalle Valo break; 248376a9fbe2SKalle Valo 2484b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2485b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2486b4b2a0b1SKalle Valo 2487b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2488b4b2a0b1SKalle Valo if (ret) { 2489b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2490b4b2a0b1SKalle Valo return ret; 2491b4b2a0b1SKalle Valo } 2492d7c44e0bSRaja Mani break; 2493b4b2a0b1SKalle Valo 249476a9fbe2SKalle Valo default: 249576a9fbe2SKalle Valo break; 249652d81a68SKalle Valo } 249752d81a68SKalle Valo 249852d81a68SKalle Valo return 0; 249952d81a68SKalle Valo } 2500d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 250152d81a68SKalle Valo 2502abcb344bSKalle Valo #ifdef CONFIG_PM 250352d81a68SKalle Valo 250452d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 250552d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2506abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2507abcb344bSKalle Valo { 2508abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2509abcb344bSKalle Valo 251084caf800SVasanthakumar Thiagarajan ath6kl_recovery_suspend(ar); 251184caf800SVasanthakumar Thiagarajan 25120f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2513abcb344bSKalle Valo } 2514aa6cffc1SChilam Ng 251552d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2516aa6cffc1SChilam Ng { 2517aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 251884caf800SVasanthakumar Thiagarajan int err; 2519aa6cffc1SChilam Ng 252084caf800SVasanthakumar Thiagarajan err = ath6kl_hif_resume(ar); 252184caf800SVasanthakumar Thiagarajan if (err) 252284caf800SVasanthakumar Thiagarajan return err; 252384caf800SVasanthakumar Thiagarajan 252492332993SVasanthakumar Thiagarajan ath6kl_recovery_resume(ar); 252584caf800SVasanthakumar Thiagarajan 252684caf800SVasanthakumar Thiagarajan return 0; 2527aa6cffc1SChilam Ng } 2528a918fb3cSRaja Mani 2529a918fb3cSRaja Mani /* 2530a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2531a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2532a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2533a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2534a918fb3cSRaja Mani * 2535a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2536a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2537a918fb3cSRaja Mani * 2538a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2539a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2540a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2541a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2542a918fb3cSRaja Mani * 2543a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2544a918fb3cSRaja Mani */ 2545a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2546a918fb3cSRaja Mani { 2547390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2548390a8c8fSRaja Mani return; 2549390a8c8fSRaja Mani 2550a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2551a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2552a918fb3cSRaja Mani } 2553a918fb3cSRaja Mani 2554a918fb3cSRaja Mani #else 2555a918fb3cSRaja Mani 2556a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2557a918fb3cSRaja Mani { 2558a918fb3cSRaja Mani } 2559abcb344bSKalle Valo #endif 2560abcb344bSKalle Valo 2561df90b369SVasanthakumar Thiagarajan static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2562df90b369SVasanthakumar Thiagarajan bool ht_enable) 25636a7c9badSJouni Malinen { 256467b3f129SKiran Reddy struct ath6kl_htcap *htcap = &vif->htcap[band]; 2565e68f6750SSujith Manoharan 2566df90b369SVasanthakumar Thiagarajan if (htcap->ht_enable == ht_enable) 25676a7c9badSJouni Malinen return 0; 2568df90b369SVasanthakumar Thiagarajan 2569df90b369SVasanthakumar Thiagarajan if (ht_enable) { 2570df90b369SVasanthakumar Thiagarajan /* Set default ht capabilities */ 2571df90b369SVasanthakumar Thiagarajan htcap->ht_enable = true; 2572df90b369SVasanthakumar Thiagarajan htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2573df90b369SVasanthakumar Thiagarajan ath6kl_g_htcap : ath6kl_a_htcap; 2574df90b369SVasanthakumar Thiagarajan htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2575df90b369SVasanthakumar Thiagarajan } else /* Disable ht */ 2576df90b369SVasanthakumar Thiagarajan memset(htcap, 0, sizeof(*htcap)); 2577df90b369SVasanthakumar Thiagarajan 2578df90b369SVasanthakumar Thiagarajan return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2579df90b369SVasanthakumar Thiagarajan band, htcap); 25806a7c9badSJouni Malinen } 25816a7c9badSJouni Malinen 258237a2f950SThomas Pedersen static int ath6kl_restore_htcap(struct ath6kl_vif *vif) 258337a2f950SThomas Pedersen { 258437a2f950SThomas Pedersen struct wiphy *wiphy = vif->ar->wiphy; 258537a2f950SThomas Pedersen int band, ret = 0; 258637a2f950SThomas Pedersen 258737a2f950SThomas Pedersen for (band = 0; band < IEEE80211_NUM_BANDS; band++) { 258837a2f950SThomas Pedersen if (!wiphy->bands[band]) 258937a2f950SThomas Pedersen continue; 259037a2f950SThomas Pedersen 259137a2f950SThomas Pedersen ret = ath6kl_set_htcap(vif, band, 259237a2f950SThomas Pedersen wiphy->bands[band]->ht_cap.ht_supported); 259337a2f950SThomas Pedersen if (ret) 259437a2f950SThomas Pedersen return ret; 259537a2f950SThomas Pedersen } 259637a2f950SThomas Pedersen 259737a2f950SThomas Pedersen return ret; 259837a2f950SThomas Pedersen } 259937a2f950SThomas Pedersen 26008bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 26018bdfbf40SJouni Malinen { 26028bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 26038bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 26048bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 26058bdfbf40SJouni Malinen } 26068bdfbf40SJouni Malinen 2607334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2608334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 26098bdfbf40SJouni Malinen { 2610334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26118bdfbf40SJouni Malinen const u8 *pos; 26128bdfbf40SJouni Malinen u8 *buf = NULL; 26138bdfbf40SJouni Malinen size_t len = 0; 26148bdfbf40SJouni Malinen int ret; 26158bdfbf40SJouni Malinen 26168bdfbf40SJouni Malinen /* 26178bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 26188bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 26198bdfbf40SJouni Malinen */ 26208bdfbf40SJouni Malinen 26218bdfbf40SJouni Malinen if (ies && ies_len) { 26228bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 26238bdfbf40SJouni Malinen if (buf == NULL) 26248bdfbf40SJouni Malinen return -ENOMEM; 26258bdfbf40SJouni Malinen pos = ies; 26268bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 26278bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 26288bdfbf40SJouni Malinen break; 26298bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 26308bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 26318bdfbf40SJouni Malinen len += 2 + pos[1]; 26328bdfbf40SJouni Malinen } 26338bdfbf40SJouni Malinen pos += 2 + pos[1]; 26348bdfbf40SJouni Malinen } 26358bdfbf40SJouni Malinen } 26368bdfbf40SJouni Malinen 2637334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2638334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 26398bdfbf40SJouni Malinen kfree(buf); 26408bdfbf40SJouni Malinen return ret; 26418bdfbf40SJouni Malinen } 26428bdfbf40SJouni Malinen 26438860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 26448860020eSJohannes Berg struct cfg80211_beacon_data *info) 26458860020eSJohannes Berg { 26468860020eSJohannes Berg struct ath6kl *ar = vif->ar; 26478860020eSJohannes Berg int res; 26488860020eSJohannes Berg 264917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26508860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26518860020eSJohannes Berg WMI_FRAME_BEACON, 26528860020eSJohannes Berg info->beacon_ies, 26538860020eSJohannes Berg info->beacon_ies_len); 26548860020eSJohannes Berg if (res) 26558860020eSJohannes Berg return res; 26568860020eSJohannes Berg 265717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26588860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 26598860020eSJohannes Berg info->proberesp_ies_len); 26608860020eSJohannes Berg if (res) 26618860020eSJohannes Berg return res; 26628860020eSJohannes Berg 266317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 26648860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 26658860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 26668860020eSJohannes Berg info->assocresp_ies, 26678860020eSJohannes Berg info->assocresp_ies_len); 26688860020eSJohannes Berg if (res) 26698860020eSJohannes Berg return res; 26708860020eSJohannes Berg 26718860020eSJohannes Berg return 0; 26728860020eSJohannes Berg } 26738860020eSJohannes Berg 2674c422d52dSThomas Pedersen void ath6kl_cfg80211_sta_bmiss_enhance(struct ath6kl_vif *vif, bool enable) 2675c422d52dSThomas Pedersen { 2676c422d52dSThomas Pedersen int err; 2677c422d52dSThomas Pedersen 2678c422d52dSThomas Pedersen if (WARN_ON(!test_bit(WMI_READY, &vif->ar->flag))) 2679c422d52dSThomas Pedersen return; 2680c422d52dSThomas Pedersen 2681c422d52dSThomas Pedersen if (vif->nw_type != INFRA_NETWORK) 2682c422d52dSThomas Pedersen return; 2683c422d52dSThomas Pedersen 2684c422d52dSThomas Pedersen if (!test_bit(ATH6KL_FW_CAPABILITY_BMISS_ENHANCE, 2685c422d52dSThomas Pedersen vif->ar->fw_capabilities)) 2686c422d52dSThomas Pedersen return; 2687c422d52dSThomas Pedersen 2688c422d52dSThomas Pedersen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s fw bmiss enhance\n", 2689c422d52dSThomas Pedersen enable ? "enable" : "disable"); 2690c422d52dSThomas Pedersen 2691c422d52dSThomas Pedersen err = ath6kl_wmi_sta_bmiss_enhance_cmd(vif->ar->wmi, 2692c422d52dSThomas Pedersen vif->fw_vif_idx, enable); 2693c422d52dSThomas Pedersen if (err) 2694c422d52dSThomas Pedersen ath6kl_err("failed to %s enhanced bmiss detection: %d\n", 2695c422d52dSThomas Pedersen enable ? "enable" : "disable", err); 2696c422d52dSThomas Pedersen } 2697c422d52dSThomas Pedersen 2698d97c121bSVasanthakumar Thiagarajan static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2699d97c121bSVasanthakumar Thiagarajan u8 *rsn_capab) 2700d97c121bSVasanthakumar Thiagarajan { 2701d97c121bSVasanthakumar Thiagarajan const u8 *rsn_ie; 2702d97c121bSVasanthakumar Thiagarajan size_t rsn_ie_len; 2703d97c121bSVasanthakumar Thiagarajan u16 cnt; 2704d97c121bSVasanthakumar Thiagarajan 2705d97c121bSVasanthakumar Thiagarajan if (!beacon->tail) 2706d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2707d97c121bSVasanthakumar Thiagarajan 2708d97c121bSVasanthakumar Thiagarajan rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2709d97c121bSVasanthakumar Thiagarajan if (!rsn_ie) 2710d97c121bSVasanthakumar Thiagarajan return -EINVAL; 2711d97c121bSVasanthakumar Thiagarajan 2712d97c121bSVasanthakumar Thiagarajan rsn_ie_len = *(rsn_ie + 1); 2713d97c121bSVasanthakumar Thiagarajan /* skip element id and length */ 2714d97c121bSVasanthakumar Thiagarajan rsn_ie += 2; 2715d97c121bSVasanthakumar Thiagarajan 27169e8b16dbSVasanthakumar Thiagarajan /* skip version */ 27179e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 2718d97c121bSVasanthakumar Thiagarajan return -EINVAL; 27199e8b16dbSVasanthakumar Thiagarajan rsn_ie += 2; 27209e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 2; 27219e8b16dbSVasanthakumar Thiagarajan 27229e8b16dbSVasanthakumar Thiagarajan /* skip group cipher suite */ 27239e8b16dbSVasanthakumar Thiagarajan if (rsn_ie_len < 4) 27249e8b16dbSVasanthakumar Thiagarajan return 0; 27259e8b16dbSVasanthakumar Thiagarajan rsn_ie += 4; 27269e8b16dbSVasanthakumar Thiagarajan rsn_ie_len -= 4; 2727d97c121bSVasanthakumar Thiagarajan 2728d97c121bSVasanthakumar Thiagarajan /* skip pairwise cipher suite */ 2729d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27309e8b16dbSVasanthakumar Thiagarajan return 0; 2731798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2732d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2733d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2734d97c121bSVasanthakumar Thiagarajan 2735d97c121bSVasanthakumar Thiagarajan /* skip akm suite */ 2736d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27379e8b16dbSVasanthakumar Thiagarajan return 0; 2738798985c6SVasanthakumar Thiagarajan cnt = get_unaligned_le16(rsn_ie); 2739d97c121bSVasanthakumar Thiagarajan rsn_ie += (2 + cnt * 4); 2740d97c121bSVasanthakumar Thiagarajan rsn_ie_len -= (2 + cnt * 4); 2741d97c121bSVasanthakumar Thiagarajan 2742d97c121bSVasanthakumar Thiagarajan if (rsn_ie_len < 2) 27439e8b16dbSVasanthakumar Thiagarajan return 0; 2744d97c121bSVasanthakumar Thiagarajan 2745d97c121bSVasanthakumar Thiagarajan memcpy(rsn_capab, rsn_ie, 2); 2746d97c121bSVasanthakumar Thiagarajan 2747d97c121bSVasanthakumar Thiagarajan return 0; 2748d97c121bSVasanthakumar Thiagarajan } 2749d97c121bSVasanthakumar Thiagarajan 27508860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 27518860020eSJohannes Berg struct cfg80211_ap_settings *info) 27526a7c9badSJouni Malinen { 27536a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 27543450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27556a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 275667cd22e4SThomas Pedersen bool hidden = false; 27576a7c9badSJouni Malinen u8 *ies; 27586a7c9badSJouni Malinen int ies_len; 27596a7c9badSJouni Malinen struct wmi_connect_cmd p; 27606a7c9badSJouni Malinen int res; 2761be5abaafSVasanthakumar Thiagarajan int i, ret; 2762d97c121bSVasanthakumar Thiagarajan u16 rsn_capab = 0; 27636a7c9badSJouni Malinen 27648860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 27656a7c9badSJouni Malinen 2766990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 27676a7c9badSJouni Malinen return -EIO; 27686a7c9badSJouni Malinen 2769f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 27706a7c9badSJouni Malinen return -EOPNOTSUPP; 27716a7c9badSJouni Malinen 27728860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 27736a7c9badSJouni Malinen 27749a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 27759a5b1318SJouni Malinen 27766a7c9badSJouni Malinen /* TODO: 27776a7c9badSJouni Malinen * info->interval 27786a7c9badSJouni Malinen */ 27796a7c9badSJouni Malinen 2780d154f32eSEtay Luz ret = ath6kl_wmi_ap_set_dtim_cmd(ar->wmi, vif->fw_vif_idx, 2781d154f32eSEtay Luz info->dtim_period); 2782d154f32eSEtay Luz 2783d154f32eSEtay Luz /* ignore error, just print a warning and continue normally */ 2784d154f32eSEtay Luz if (ret) 2785d154f32eSEtay Luz ath6kl_warn("Failed to set dtim_period in beacon: %d\n", ret); 2786d154f32eSEtay Luz 27878860020eSJohannes Berg if (info->beacon.head == NULL) 27886a7c9badSJouni Malinen return -EINVAL; 27898860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 27906a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 27918860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 27926a7c9badSJouni Malinen return -EINVAL; 27938860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 27946a7c9badSJouni Malinen 27956a7c9badSJouni Malinen if (info->ssid == NULL) 27966a7c9badSJouni Malinen return -EINVAL; 27973450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 27983450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 27996a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 280067cd22e4SThomas Pedersen hidden = true; 280167cd22e4SThomas Pedersen 280267cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 280367cd22e4SThomas Pedersen if (res) 280467cd22e4SThomas Pedersen return res; 28056a7c9badSJouni Malinen 2806be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2807be5abaafSVasanthakumar Thiagarajan if (ret) 2808be5abaafSVasanthakumar Thiagarajan return ret; 28096a7c9badSJouni Malinen 28106a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 28116a7c9badSJouni Malinen 28126a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 28136a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 28146a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 28156a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28166a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 28176a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28186a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 28196a7c9badSJouni Malinen break; 28206a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 28216a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 28226a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 28236a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 28246a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 28256a7c9badSJouni Malinen break; 28266a7c9badSJouni Malinen } 28276a7c9badSJouni Malinen } 28286a7c9badSJouni Malinen if (p.auth_mode == 0) 28296a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 28303450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 28316a7c9badSJouni Malinen 28326a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 28336a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 28346a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28366a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 28376a7c9badSJouni Malinen break; 28386a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28396a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 28406a7c9badSJouni Malinen break; 28416a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28426a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 28436a7c9badSJouni Malinen break; 2844b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2845b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2846b8214df1SDai Shuibing break; 28476a7c9badSJouni Malinen } 28486a7c9badSJouni Malinen } 2849229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 28506a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2851240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2852229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2853240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 28546a7c9badSJouni Malinen 28556a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 28566a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 28576a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 28586a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 28596a7c9badSJouni Malinen break; 28606a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 28616a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 28626a7c9badSJouni Malinen break; 28636a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 28646a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 28656a7c9badSJouni Malinen break; 2866b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2867b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2868b8214df1SDai Shuibing break; 28696a7c9badSJouni Malinen default: 28706a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 28716a7c9badSJouni Malinen break; 28726a7c9badSJouni Malinen } 2873240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 28746a7c9badSJouni Malinen 28756a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2876f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 28776a7c9badSJouni Malinen 28783450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 28793450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 28803450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2881aa430da4SJohannes Berg p.ch = cpu_to_le16(info->channel->center_freq); 28826a7c9badSJouni Malinen 2883c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2884c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2885c1762a3fSThirumalai Pachamuthu if (res < 0) 2886c1762a3fSThirumalai Pachamuthu return res; 2887c1762a3fSThirumalai Pachamuthu 28883ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 28893ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 28903ca9d1fcSAarthi Thiruvengadam } else { 28913ca9d1fcSAarthi Thiruvengadam /* 28923ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 28933ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 28943ca9d1fcSAarthi Thiruvengadam */ 28953ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 28963ca9d1fcSAarthi Thiruvengadam } 28973ca9d1fcSAarthi Thiruvengadam 289803bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 289903bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 290003bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 290103bdeb0dSVasanthakumar Thiagarajan if (res < 0) 290203bdeb0dSVasanthakumar Thiagarajan return res; 290303bdeb0dSVasanthakumar Thiagarajan } 290403bdeb0dSVasanthakumar Thiagarajan 2905aa430da4SJohannes Berg if (ath6kl_set_htcap(vif, info->channel->band, 2906aa430da4SJohannes Berg info->channel_type != NL80211_CHAN_NO_HT)) 2907df90b369SVasanthakumar Thiagarajan return -EIO; 2908df90b369SVasanthakumar Thiagarajan 2909d97c121bSVasanthakumar Thiagarajan /* 2910d97c121bSVasanthakumar Thiagarajan * Get the PTKSA replay counter in the RSN IE. Supplicant 2911d97c121bSVasanthakumar Thiagarajan * will use the RSN IE in M3 message and firmware has to 2912d97c121bSVasanthakumar Thiagarajan * advertise the same in beacon/probe response. Send 2913d97c121bSVasanthakumar Thiagarajan * the complete RSN IE capability field to firmware 2914d97c121bSVasanthakumar Thiagarajan */ 2915d97c121bSVasanthakumar Thiagarajan if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2916d97c121bSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2917d97c121bSVasanthakumar Thiagarajan ar->fw_capabilities)) { 2918d97c121bSVasanthakumar Thiagarajan res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2919d97c121bSVasanthakumar Thiagarajan WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2920d97c121bSVasanthakumar Thiagarajan (const u8 *) &rsn_capab, 2921d97c121bSVasanthakumar Thiagarajan sizeof(rsn_capab)); 2922f21243a8SThomas Pedersen vif->rsn_capab = rsn_capab; 2923d97c121bSVasanthakumar Thiagarajan if (res < 0) 2924d97c121bSVasanthakumar Thiagarajan return res; 2925d97c121bSVasanthakumar Thiagarajan } 2926d97c121bSVasanthakumar Thiagarajan 2927c4f7863eSThomas Pedersen memcpy(&vif->profile, &p, sizeof(p)); 2928334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 29299a5b1318SJouni Malinen if (res < 0) 29309a5b1318SJouni Malinen return res; 29319a5b1318SJouni Malinen 29329a5b1318SJouni Malinen return 0; 29336a7c9badSJouni Malinen } 29346a7c9badSJouni Malinen 29358860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 29368860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 29376a7c9badSJouni Malinen { 29388860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 29398860020eSJohannes Berg 29408860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 29418860020eSJohannes Berg return -EIO; 29428860020eSJohannes Berg 29438860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 29448860020eSJohannes Berg return -EOPNOTSUPP; 29458860020eSJohannes Berg 29468860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 29476a7c9badSJouni Malinen } 29486a7c9badSJouni Malinen 29498860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 29506a7c9badSJouni Malinen { 29516a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 295259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 29536a7c9badSJouni Malinen 2954f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 29556a7c9badSJouni Malinen return -EOPNOTSUPP; 295659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 29576a7c9badSJouni Malinen return -ENOTCONN; 29586a7c9badSJouni Malinen 2959334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 296059c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 29616a7c9badSJouni Malinen 2962df90b369SVasanthakumar Thiagarajan /* Restore ht setting in firmware */ 296337a2f950SThomas Pedersen return ath6kl_restore_htcap(vif); 29646a7c9badSJouni Malinen } 29656a7c9badSJouni Malinen 296633e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 296733e5308dSJouni Malinen 296833e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 296933e5308dSJouni Malinen u8 *mac) 297033e5308dSJouni Malinen { 297133e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 297233e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 297333e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 297433e5308dSJouni Malinen 297533e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 297633e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 297733e5308dSJouni Malinen } 297833e5308dSJouni Malinen 297923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 298023875136SJouni Malinen u8 *mac, struct station_parameters *params) 298123875136SJouni Malinen { 298223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2983f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 298423875136SJouni Malinen 2985f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 298623875136SJouni Malinen return -EOPNOTSUPP; 298723875136SJouni Malinen 298823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 298923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 299023875136SJouni Malinen return -EOPNOTSUPP; 299123875136SJouni Malinen 299223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2993334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2994334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2995334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2996334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 299723875136SJouni Malinen } 299823875136SJouni Malinen 299963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 300071bbc994SJohannes Berg struct wireless_dev *wdev, 300163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 300263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 300363fa1e0cSJouni Malinen unsigned int duration, 300463fa1e0cSJouni Malinen u64 *cookie) 300563fa1e0cSJouni Malinen { 300671bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 300771bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 30081052261eSJouni Malinen u32 id; 300963fa1e0cSJouni Malinen 301063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 301163fa1e0cSJouni Malinen * return -EBUSY */ 30121052261eSJouni Malinen id = ++vif->last_roc_id; 30131052261eSJouni Malinen if (id == 0) { 30141052261eSJouni Malinen /* Do not use 0 as the cookie value */ 30151052261eSJouni Malinen id = ++vif->last_roc_id; 30161052261eSJouni Malinen } 30171052261eSJouni Malinen *cookie = id; 301863fa1e0cSJouni Malinen 3019334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 3020334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 302163fa1e0cSJouni Malinen } 302263fa1e0cSJouni Malinen 302363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 302471bbc994SJohannes Berg struct wireless_dev *wdev, 302563fa1e0cSJouni Malinen u64 cookie) 302663fa1e0cSJouni Malinen { 302771bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 302871bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 302963fa1e0cSJouni Malinen 30301052261eSJouni Malinen if (cookie != vif->last_roc_id) 303163fa1e0cSJouni Malinen return -ENOENT; 30321052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 303363fa1e0cSJouni Malinen 3034334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 303563fa1e0cSJouni Malinen } 303663fa1e0cSJouni Malinen 3037334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 3038334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 3039334234b5SVasanthakumar Thiagarajan unsigned int freq) 30408bdfbf40SJouni Malinen { 3041334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 30428bdfbf40SJouni Malinen const u8 *pos; 30438bdfbf40SJouni Malinen u8 *p2p; 30448bdfbf40SJouni Malinen int p2p_len; 30458bdfbf40SJouni Malinen int ret; 30468bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 30478bdfbf40SJouni Malinen 30488bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 30498bdfbf40SJouni Malinen 30508bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 30518bdfbf40SJouni Malinen 30528bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 30538bdfbf40SJouni Malinen if (p2p == NULL) 30548bdfbf40SJouni Malinen return -ENOMEM; 30558bdfbf40SJouni Malinen p2p_len = 0; 30568bdfbf40SJouni Malinen 30578bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 30588bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 30598bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 30608bdfbf40SJouni Malinen break; 30618bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 30628bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 30638bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 30648bdfbf40SJouni Malinen } 30658bdfbf40SJouni Malinen pos += 2 + pos[1]; 30668bdfbf40SJouni Malinen } 30678bdfbf40SJouni Malinen 3068334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 3069334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 30708bdfbf40SJouni Malinen kfree(p2p); 30718bdfbf40SJouni Malinen return ret; 30728bdfbf40SJouni Malinen } 30738bdfbf40SJouni Malinen 3074d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 3075d0ff7383SNaveen Gangadharan u32 id, 3076d0ff7383SNaveen Gangadharan u32 freq, 3077d0ff7383SNaveen Gangadharan u32 wait, 3078d0ff7383SNaveen Gangadharan const u8 *buf, 3079d0ff7383SNaveen Gangadharan size_t len, 3080d0ff7383SNaveen Gangadharan bool *more_data, 3081d0ff7383SNaveen Gangadharan bool no_cck) 3082d0ff7383SNaveen Gangadharan { 3083d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 3084d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 3085d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 3086d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 3087d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 3088d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 3089d0ff7383SNaveen Gangadharan 3090d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 3091d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 3092d0ff7383SNaveen Gangadharan return false; 3093d0ff7383SNaveen Gangadharan 3094d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 3095d0ff7383SNaveen Gangadharan if (!conn) 3096d0ff7383SNaveen Gangadharan return false; 3097d0ff7383SNaveen Gangadharan 3098d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 3099d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 3100d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 3101d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 3102d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 3103d0ff7383SNaveen Gangadharan if (!mgmt_buf) 3104d0ff7383SNaveen Gangadharan return false; 3105d0ff7383SNaveen Gangadharan 3106d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 3107d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 3108d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 3109d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 3110d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 3111d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 3112d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 3113d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3114d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 3115d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 3116d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3117d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 3118d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3119d0ff7383SNaveen Gangadharan 3120d0ff7383SNaveen Gangadharan /* 3121d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 3122d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 3123d0ff7383SNaveen Gangadharan * STA. 3124d0ff7383SNaveen Gangadharan */ 3125d0ff7383SNaveen Gangadharan if (is_psq_empty) 3126d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3127d0ff7383SNaveen Gangadharan conn->aid, 1); 3128d0ff7383SNaveen Gangadharan return true; 3129d0ff7383SNaveen Gangadharan } 3130d0ff7383SNaveen Gangadharan 3131d0ff7383SNaveen Gangadharan /* 3132d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 3133d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 3134d0ff7383SNaveen Gangadharan */ 3135d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 3136d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3137d0ff7383SNaveen Gangadharan *more_data = true; 3138d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 3139d0ff7383SNaveen Gangadharan } 3140d0ff7383SNaveen Gangadharan 3141d0ff7383SNaveen Gangadharan return false; 3142d0ff7383SNaveen Gangadharan } 3143d0ff7383SNaveen Gangadharan 3144c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 3145c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3146c86e4f44SAarthi Thiruvengadam { 3147c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 3148c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 3149c86e4f44SAarthi Thiruvengadam 3150c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 3151c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3152c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3153c86e4f44SAarthi Thiruvengadam return true; 3154c86e4f44SAarthi Thiruvengadam } 3155c86e4f44SAarthi Thiruvengadam 3156c86e4f44SAarthi Thiruvengadam return false; 3157c86e4f44SAarthi Thiruvengadam } 3158c86e4f44SAarthi Thiruvengadam 315971bbc994SJohannes Berg static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, 31608a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 31618a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 31628a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 3163e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 3164e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 31658a6c8060SJouni Malinen { 316671bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 316771bbc994SJohannes Berg struct ath6kl *ar = ath6kl_priv(vif->ndev); 31688a6c8060SJouni Malinen u32 id; 31698bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 3170d0ff7383SNaveen Gangadharan bool more_data, queued; 31718bdfbf40SJouni Malinen 31728bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 3173c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3174c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 3175c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 31768bdfbf40SJouni Malinen /* 3177c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 31788bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 31798bdfbf40SJouni Malinen */ 31808bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 3181334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 31828bdfbf40SJouni Malinen chan->center_freq); 31838bdfbf40SJouni Malinen } 31848a6c8060SJouni Malinen 3185cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31868a6c8060SJouni Malinen if (id == 0) { 31878a6c8060SJouni Malinen /* 31888a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 31898a6c8060SJouni Malinen * used for the command. 31908a6c8060SJouni Malinen */ 3191cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 31928a6c8060SJouni Malinen } 31938a6c8060SJouni Malinen 31948a6c8060SJouni Malinen *cookie = id; 31953ca9d1fcSAarthi Thiruvengadam 3196d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 3197d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 3198d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 3199d0ff7383SNaveen Gangadharan id, chan->center_freq, 3200d0ff7383SNaveen Gangadharan wait, buf, 3201d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 3202d0ff7383SNaveen Gangadharan if (queued) 3203d0ff7383SNaveen Gangadharan return 0; 3204d0ff7383SNaveen Gangadharan } 3205d0ff7383SNaveen Gangadharan 32063ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 32073ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 32083ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 32093ca9d1fcSAarthi Thiruvengadam } 32108a6c8060SJouni Malinen 3211ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 321271bbc994SJohannes Berg struct wireless_dev *wdev, 3213ae32c30aSJouni Malinen u16 frame_type, bool reg) 3214ae32c30aSJouni Malinen { 321571bbc994SJohannes Berg struct ath6kl_vif *vif = ath6kl_vif_from_wdev(wdev); 3216ae32c30aSJouni Malinen 3217ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3218ae32c30aSJouni Malinen __func__, frame_type, reg); 3219ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3220ae32c30aSJouni Malinen /* 3221ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 3222ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3223ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 3224ae32c30aSJouni Malinen */ 3225cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 3226ae32c30aSJouni Malinen } 3227ae32c30aSJouni Malinen } 3228ae32c30aSJouni Malinen 322910509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 323010509f90SKalle Valo struct net_device *dev, 323110509f90SKalle Valo struct cfg80211_sched_scan_request *request) 323210509f90SKalle Valo { 323310509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 323410509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 323510509f90SKalle Valo u16 interval; 323685b20fc2SThomas Pedersen int ret, rssi_thold; 323710509f90SKalle Valo 323810509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 323910509f90SKalle Valo return -EIO; 324010509f90SKalle Valo 324110509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 324210509f90SKalle Valo return -EBUSY; 324310509f90SKalle Valo 3244b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3245b4d13d3bSKalle Valo 32463b8ffc6aSJouni Malinen ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3247dd45b759SNaveen Singh request->n_ssids, 3248dd45b759SNaveen Singh request->match_sets, 3249dd45b759SNaveen Singh request->n_match_sets); 32503b8ffc6aSJouni Malinen if (ret < 0) 32513b8ffc6aSJouni Malinen return ret; 325210509f90SKalle Valo 3253dd45b759SNaveen Singh if (!request->n_match_sets) { 3254dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3255dd45b759SNaveen Singh ALL_BSS_FILTER, 0); 3256dd45b759SNaveen Singh if (ret < 0) 3257dd45b759SNaveen Singh return ret; 3258dd45b759SNaveen Singh } else { 3259dd45b759SNaveen Singh ret = ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 3260dd45b759SNaveen Singh MATCHED_SSID_FILTER, 0); 3261dd45b759SNaveen Singh if (ret < 0) 3262dd45b759SNaveen Singh return ret; 3263dd45b759SNaveen Singh } 3264dd45b759SNaveen Singh 326585b20fc2SThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_RSSI_SCAN_THOLD, 326685b20fc2SThomas Pedersen ar->fw_capabilities)) { 326785b20fc2SThomas Pedersen if (request->rssi_thold <= NL80211_SCAN_RSSI_THOLD_OFF) 326885b20fc2SThomas Pedersen rssi_thold = 0; 326985b20fc2SThomas Pedersen else if (request->rssi_thold < -127) 327085b20fc2SThomas Pedersen rssi_thold = -127; 327185b20fc2SThomas Pedersen else 327285b20fc2SThomas Pedersen rssi_thold = request->rssi_thold; 327385b20fc2SThomas Pedersen 327485b20fc2SThomas Pedersen ret = ath6kl_wmi_set_rssi_filter_cmd(ar->wmi, vif->fw_vif_idx, 327585b20fc2SThomas Pedersen rssi_thold); 327685b20fc2SThomas Pedersen if (ret) { 327785b20fc2SThomas Pedersen ath6kl_err("failed to set RSSI threshold for scan\n"); 327885b20fc2SThomas Pedersen return ret; 327985b20fc2SThomas Pedersen } 328085b20fc2SThomas Pedersen } 328185b20fc2SThomas Pedersen 328210509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 328310509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 328410509f90SKalle Valo 328510509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 328610509f90SKalle Valo interval, interval, 3287d472b5e4SSubramania Sharma Thandaveswaran vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 328810509f90SKalle Valo 328910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 329010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 329110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 329210509f90SKalle Valo request->ie, request->ie_len); 329310509f90SKalle Valo if (ret) { 3294f1ff32e8SJoe Perches ath6kl_warn("Failed to set probe request IE for scheduled scan: %d\n", 329510509f90SKalle Valo ret); 329610509f90SKalle Valo return ret; 329710509f90SKalle Valo } 329810509f90SKalle Valo 3299b1f47e3aSThomas Pedersen ret = ath6kl_wmi_enable_sched_scan_cmd(ar->wmi, vif->fw_vif_idx, true); 3300b1f47e3aSThomas Pedersen if (ret) 330110509f90SKalle Valo return ret; 330210509f90SKalle Valo 3303b1f47e3aSThomas Pedersen set_bit(SCHED_SCANNING, &vif->flags); 330410509f90SKalle Valo 3305b1f47e3aSThomas Pedersen return 0; 330610509f90SKalle Valo } 330710509f90SKalle Valo 330810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 330910509f90SKalle Valo struct net_device *dev) 331010509f90SKalle Valo { 331110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 331210509f90SKalle Valo bool stopped; 331310509f90SKalle Valo 331410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 331510509f90SKalle Valo 331610509f90SKalle Valo if (!stopped) 331710509f90SKalle Valo return -EIO; 331810509f90SKalle Valo 331910509f90SKalle Valo return 0; 332010509f90SKalle Valo } 332110509f90SKalle Valo 332206e360acSBala Shanmugam static int ath6kl_cfg80211_set_bitrate(struct wiphy *wiphy, 332306e360acSBala Shanmugam struct net_device *dev, 332406e360acSBala Shanmugam const u8 *addr, 332506e360acSBala Shanmugam const struct cfg80211_bitrate_mask *mask) 332606e360acSBala Shanmugam { 332706e360acSBala Shanmugam struct ath6kl *ar = ath6kl_priv(dev); 332806e360acSBala Shanmugam struct ath6kl_vif *vif = netdev_priv(dev); 332906e360acSBala Shanmugam 333006e360acSBala Shanmugam return ath6kl_wmi_set_bitrate_mask(ar->wmi, vif->fw_vif_idx, 333106e360acSBala Shanmugam mask); 333206e360acSBala Shanmugam } 333306e360acSBala Shanmugam 3334279b2862SThomas Pedersen static int ath6kl_cfg80211_set_txe_config(struct wiphy *wiphy, 3335279b2862SThomas Pedersen struct net_device *dev, 3336279b2862SThomas Pedersen u32 rate, u32 pkts, u32 intvl) 3337279b2862SThomas Pedersen { 3338279b2862SThomas Pedersen struct ath6kl *ar = ath6kl_priv(dev); 3339279b2862SThomas Pedersen struct ath6kl_vif *vif = netdev_priv(dev); 3340279b2862SThomas Pedersen 3341279b2862SThomas Pedersen if (vif->nw_type != INFRA_NETWORK || 3342279b2862SThomas Pedersen !test_bit(ATH6KL_FW_CAPABILITY_TX_ERR_NOTIFY, ar->fw_capabilities)) 3343279b2862SThomas Pedersen return -EOPNOTSUPP; 3344279b2862SThomas Pedersen 3345279b2862SThomas Pedersen if (vif->sme_state != SME_CONNECTED) 3346279b2862SThomas Pedersen return -ENOTCONN; 3347279b2862SThomas Pedersen 3348279b2862SThomas Pedersen /* save this since the firmware won't report the interval */ 3349279b2862SThomas Pedersen vif->txe_intvl = intvl; 3350279b2862SThomas Pedersen 3351279b2862SThomas Pedersen return ath6kl_wmi_set_txe_notify(ar->wmi, vif->fw_vif_idx, 3352279b2862SThomas Pedersen rate, pkts, intvl); 3353279b2862SThomas Pedersen } 3354279b2862SThomas Pedersen 3355f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3356f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3357f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3358f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3359f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3360f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3361f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3362f80574aeSJouni Malinen }, 3363ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3364ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3365ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3366ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3367ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3368ba1f6fe3SJouni Malinen }, 3369f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3370f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3371f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3372f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3373f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3374f80574aeSJouni Malinen }, 3375f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3376f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3377f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3378f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3379f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3380f80574aeSJouni Malinen }, 3381f80574aeSJouni Malinen }; 3382f80574aeSJouni Malinen 3383bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 338455055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 338555055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3386bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3387bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3388bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3389bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3390bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3391bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3392bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3393bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3394bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3395bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3396bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3397bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3398bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3399bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3400bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3401bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3402bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3403bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3404003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3405abcb344bSKalle Valo #ifdef CONFIG_PM 340652d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 340752d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3408abcb344bSKalle Valo #endif 34098860020eSJohannes Berg .start_ap = ath6kl_start_ap, 34108860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 34118860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 341233e5308dSJouni Malinen .del_station = ath6kl_del_station, 341323875136SJouni Malinen .change_station = ath6kl_change_station, 341463fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 341563fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 34168a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3417ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 341810509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 341910509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 342006e360acSBala Shanmugam .set_bitrate_mask = ath6kl_cfg80211_set_bitrate, 3421279b2862SThomas Pedersen .set_cqm_txe_config = ath6kl_cfg80211_set_txe_config, 3422bdcd8170SKalle Valo }; 3423bdcd8170SKalle Valo 34247125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3425ec4b7f60SKalle Valo { 342610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 342710509f90SKalle Valo 3428ec4b7f60SKalle Valo switch (vif->sme_state) { 3429c97a31b0SKalle Valo case SME_DISCONNECTED: 3430c97a31b0SKalle Valo break; 3431ec4b7f60SKalle Valo case SME_CONNECTING: 3432ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3433ec4b7f60SKalle Valo NULL, 0, 3434ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3435ec4b7f60SKalle Valo GFP_KERNEL); 3436ec4b7f60SKalle Valo break; 3437ec4b7f60SKalle Valo case SME_CONNECTED: 3438ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3439ec4b7f60SKalle Valo break; 3440ec4b7f60SKalle Valo } 3441ec4b7f60SKalle Valo 344258109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 344358109df6SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) || 344458109df6SVasanthakumar Thiagarajan test_bit(CONNECT_PEND, &vif->flags))) 34457125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3446ec4b7f60SKalle Valo 3447ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 34481f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 34491f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3450ec4b7f60SKalle Valo 345184caf800SVasanthakumar Thiagarajan /* Stop netdev queues, needed during recovery */ 345284caf800SVasanthakumar Thiagarajan netif_stop_queue(vif->ndev); 345384caf800SVasanthakumar Thiagarajan netif_carrier_off(vif->ndev); 345484caf800SVasanthakumar Thiagarajan 3455ec4b7f60SKalle Valo /* disable scanning */ 345658109df6SVasanthakumar Thiagarajan if (vif->ar->state != ATH6KL_STATE_RECOVERY && 345758109df6SVasanthakumar Thiagarajan ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 34587125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 34597125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3460ec4b7f60SKalle Valo 3461ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3462ec4b7f60SKalle Valo } 3463ec4b7f60SKalle Valo 34647125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 34657125f01dSKalle Valo { 34667125f01dSKalle Valo struct ath6kl_vif *vif; 34677125f01dSKalle Valo 34687125f01dSKalle Valo vif = ath6kl_vif_first(ar); 346984caf800SVasanthakumar Thiagarajan if (!vif && ar->state != ATH6KL_STATE_RECOVERY) { 34707125f01dSKalle Valo /* save the current power mode before enabling power save */ 34717125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 34727125f01dSKalle Valo 34737125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3474cdeb8602SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 34757125f01dSKalle Valo return; 34767125f01dSKalle Valo } 34777125f01dSKalle Valo 34787125f01dSKalle Valo /* 34797125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 34807125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 34817125f01dSKalle Valo * sleeps. 34827125f01dSKalle Valo */ 34837125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 34847125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 34857125f01dSKalle Valo } 34867125f01dSKalle Valo 348784841ba2SKalle Valo static int ath6kl_cfg80211_reg_notify(struct wiphy *wiphy, 348884841ba2SKalle Valo struct regulatory_request *request) 348984841ba2SKalle Valo { 349084841ba2SKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 349184841ba2SKalle Valo u32 rates[IEEE80211_NUM_BANDS]; 349284841ba2SKalle Valo int ret, i; 349384841ba2SKalle Valo 349484841ba2SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 349584841ba2SKalle Valo "cfg reg_notify %c%c%s%s initiator %d\n", 349684841ba2SKalle Valo request->alpha2[0], request->alpha2[1], 349784841ba2SKalle Valo request->intersect ? " intersect" : "", 349884841ba2SKalle Valo request->processed ? " processed" : "", 349984841ba2SKalle Valo request->initiator); 350084841ba2SKalle Valo 350184841ba2SKalle Valo ret = ath6kl_wmi_set_regdomain_cmd(ar->wmi, request->alpha2); 350284841ba2SKalle Valo if (ret) { 350384841ba2SKalle Valo ath6kl_err("failed to set regdomain: %d\n", ret); 350484841ba2SKalle Valo return ret; 350584841ba2SKalle Valo } 350684841ba2SKalle Valo 350784841ba2SKalle Valo /* 350884841ba2SKalle Valo * Firmware will apply the regdomain change only after a scan is 350984841ba2SKalle Valo * issued and it will send a WMI_REGDOMAIN_EVENTID when it has been 351084841ba2SKalle Valo * changed. 351184841ba2SKalle Valo */ 351284841ba2SKalle Valo 351384841ba2SKalle Valo for (i = 0; i < IEEE80211_NUM_BANDS; i++) 351484841ba2SKalle Valo if (wiphy->bands[i]) 351584841ba2SKalle Valo rates[i] = (1 << wiphy->bands[i]->n_bitrates) - 1; 351684841ba2SKalle Valo 351784841ba2SKalle Valo 351884841ba2SKalle Valo ret = ath6kl_wmi_beginscan_cmd(ar->wmi, 0, WMI_LONG_SCAN, false, 351984841ba2SKalle Valo false, 0, ATH6KL_FG_SCAN_INTERVAL, 352084841ba2SKalle Valo 0, NULL, false, rates); 352184841ba2SKalle Valo if (ret) { 352284841ba2SKalle Valo ath6kl_err("failed to start scan for a regdomain change: %d\n", 352384841ba2SKalle Valo ret); 352484841ba2SKalle Valo return ret; 352584841ba2SKalle Valo } 352684841ba2SKalle Valo 352784841ba2SKalle Valo return 0; 352884841ba2SKalle Valo } 352984841ba2SKalle Valo 3530c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 35318dafb70eSVasanthakumar Thiagarajan { 35327baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 35332132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 35348dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 35358dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 35368dafb70eSVasanthakumar Thiagarajan } 35378dafb70eSVasanthakumar Thiagarajan 3538de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3539108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 354010509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 354110509f90SKalle Valo (unsigned long) vif); 354210509f90SKalle Valo 3543de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3544478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 35458dafb70eSVasanthakumar Thiagarajan 354680abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 354780abaf9bSVasanthakumar Thiagarajan 35488dafb70eSVasanthakumar Thiagarajan return 0; 35498dafb70eSVasanthakumar Thiagarajan } 35508dafb70eSVasanthakumar Thiagarajan 3551c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 35528dafb70eSVasanthakumar Thiagarajan { 355355055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 355480abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 355555055976SVasanthakumar Thiagarajan 35562132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3557108438bcSVasanthakumar Thiagarajan 355855055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 355955055976SVasanthakumar Thiagarajan 356055055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 356155055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 356255055976SVasanthakumar Thiagarajan 356380abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 356480abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 356580abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 356680abaf9bSVasanthakumar Thiagarajan } 356780abaf9bSVasanthakumar Thiagarajan 356827929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 356955055976SVasanthakumar Thiagarajan 357055055976SVasanthakumar Thiagarajan ar->num_vif--; 35718dafb70eSVasanthakumar Thiagarajan } 35728dafb70eSVasanthakumar Thiagarajan 3573552bff0cSJohannes Berg struct wireless_dev *ath6kl_interface_add(struct ath6kl *ar, const char *name, 357484efbb84SJohannes Berg enum nl80211_iftype type, 357584efbb84SJohannes Berg u8 fw_vif_idx, u8 nw_type) 35768dafb70eSVasanthakumar Thiagarajan { 35778dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3578108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 35798dafb70eSVasanthakumar Thiagarajan 358055055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 35818dafb70eSVasanthakumar Thiagarajan if (!ndev) 35828dafb70eSVasanthakumar Thiagarajan return NULL; 35838dafb70eSVasanthakumar Thiagarajan 3584108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3585108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3586108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3587108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3588108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3589108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3590108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3591108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3592334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3593d0d670abSKalle Valo vif->nw_type = nw_type; 3594d0d670abSKalle Valo vif->next_mode = nw_type; 35958f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3596ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3597eb38987eSRaja Mani vif->bg_scan_period = 0; 359867b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_2GHZ].ht_enable = true; 359967b3f129SKiran Reddy vif->htcap[IEEE80211_BAND_5GHZ].ht_enable = true; 36008dafb70eSVasanthakumar Thiagarajan 360155055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3602c95dcb59SAarthi Thiruvengadam if (fw_vif_idx != 0) { 360355055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 360455055976SVasanthakumar Thiagarajan 0x2; 3605c95dcb59SAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_CUSTOM_MAC_ADDR, 3606c95dcb59SAarthi Thiruvengadam ar->fw_capabilities)) 3607c95dcb59SAarthi Thiruvengadam ndev->dev_addr[4] ^= 0x80; 3608c95dcb59SAarthi Thiruvengadam } 360955055976SVasanthakumar Thiagarajan 36108dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 36118dafb70eSVasanthakumar Thiagarajan 3612e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 36138dafb70eSVasanthakumar Thiagarajan 3614c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 36158dafb70eSVasanthakumar Thiagarajan goto err; 36168dafb70eSVasanthakumar Thiagarajan 361727929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 36188dafb70eSVasanthakumar Thiagarajan goto err; 36198dafb70eSVasanthakumar Thiagarajan 362055055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 362114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 362259c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 36238dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 362459c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 36258dafb70eSVasanthakumar Thiagarajan 362655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 362755055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 362855055976SVasanthakumar Thiagarajan 362911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3630990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 363111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3632990bd915SVasanthakumar Thiagarajan 363384efbb84SJohannes Berg return &vif->wdev; 36348dafb70eSVasanthakumar Thiagarajan 36358dafb70eSVasanthakumar Thiagarajan err: 363627929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 363727929723SVasanthakumar Thiagarajan free_netdev(ndev); 3638bdcd8170SKalle Valo return NULL; 3639bdcd8170SKalle Valo } 3640bdcd8170SKalle Valo 364146d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 364246d33a21SKalle Valo { 364346d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 3644d92917e4SThomas Pedersen bool band_2gig = false, band_5gig = false, ht = false; 364546d33a21SKalle Valo int ret; 364646d33a21SKalle Valo 364746d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 364846d33a21SKalle Valo 364946d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 365046d33a21SKalle Valo 365146d33a21SKalle Valo /* set device pointer for wiphy */ 365246d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 365346d33a21SKalle Valo 365446d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 365546d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 365646d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 365746d33a21SKalle Valo if (ar->p2p) { 365846d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 365946d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 366046d33a21SKalle Valo } 366146d33a21SKalle Valo 366284841ba2SKalle Valo if (config_enabled(CONFIG_ATH6KL_REGDOMAIN) && 366384841ba2SKalle Valo test_bit(ATH6KL_FW_CAPABILITY_REGDOMAIN, ar->fw_capabilities)) 366484841ba2SKalle Valo wiphy->reg_notifier = ath6kl_cfg80211_reg_notify; 366584841ba2SKalle Valo 366646d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 36678ab5415dSJouni Malinen wiphy->max_scan_ssids = MAX_PROBED_SSIDS; 3668dd45b759SNaveen Singh 3669dd45b759SNaveen Singh /* max num of ssids that can be matched after scan */ 3670dd45b759SNaveen Singh if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_MATCH_LIST, 3671dd45b759SNaveen Singh ar->fw_capabilities)) 3672dd45b759SNaveen Singh wiphy->max_match_sets = MAX_PROBED_SSIDS; 3673dd45b759SNaveen Singh 367446d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3675d92917e4SThomas Pedersen switch (ar->hw.cap) { 3676d92917e4SThomas Pedersen case WMI_11AN_CAP: 3677d92917e4SThomas Pedersen ht = true; 3678d92917e4SThomas Pedersen case WMI_11A_CAP: 3679d92917e4SThomas Pedersen band_5gig = true; 3680d92917e4SThomas Pedersen break; 3681d92917e4SThomas Pedersen case WMI_11GN_CAP: 3682d92917e4SThomas Pedersen ht = true; 3683d92917e4SThomas Pedersen case WMI_11G_CAP: 3684d92917e4SThomas Pedersen band_2gig = true; 3685d92917e4SThomas Pedersen break; 3686d92917e4SThomas Pedersen case WMI_11AGN_CAP: 3687d92917e4SThomas Pedersen ht = true; 3688d92917e4SThomas Pedersen case WMI_11AG_CAP: 3689d92917e4SThomas Pedersen band_2gig = true; 3690d92917e4SThomas Pedersen band_5gig = true; 3691d92917e4SThomas Pedersen break; 3692d92917e4SThomas Pedersen default: 3693d92917e4SThomas Pedersen ath6kl_err("invalid phy capability!\n"); 3694d92917e4SThomas Pedersen return -EINVAL; 3695d92917e4SThomas Pedersen } 3696d92917e4SThomas Pedersen 36977fd1ce7eSVasanthakumar Thiagarajan /* 36987fd1ce7eSVasanthakumar Thiagarajan * Even if the fw has HT support, advertise HT cap only when 36997fd1ce7eSVasanthakumar Thiagarajan * the firmware has support to override RSN capability, otherwise 37007fd1ce7eSVasanthakumar Thiagarajan * 4-way handshake would fail. 37017fd1ce7eSVasanthakumar Thiagarajan */ 37027fd1ce7eSVasanthakumar Thiagarajan if (!(ht && 37037fd1ce7eSVasanthakumar Thiagarajan test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 37047fd1ce7eSVasanthakumar Thiagarajan ar->fw_capabilities))) { 3705d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.cap = 0; 3706d92917e4SThomas Pedersen ath6kl_band_2ghz.ht_cap.ht_supported = false; 3707d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.cap = 0; 3708d92917e4SThomas Pedersen ath6kl_band_5ghz.ht_cap.ht_supported = false; 3709d92917e4SThomas Pedersen } 371006e360acSBala Shanmugam 3711c0b34e2bSMohammed Shafi Shajakhan if (ar->hw.flags & ATH6KL_HW_64BIT_RATES) { 371206e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371306e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371406e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[1] = 0xff; 371506e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[1] = 0xff; 371606e360acSBala Shanmugam } else { 371706e360acSBala Shanmugam ath6kl_band_2ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371806e360acSBala Shanmugam ath6kl_band_5ghz.ht_cap.mcs.rx_mask[0] = 0xff; 371906e360acSBala Shanmugam } 372006e360acSBala Shanmugam 3721d92917e4SThomas Pedersen if (band_2gig) 372246d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3723d92917e4SThomas Pedersen if (band_5gig) 372446d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3725d92917e4SThomas Pedersen 372646d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 372746d33a21SKalle Valo 372846d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 372946d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 373046d33a21SKalle Valo 3731dfb89c56SJohannes Berg #ifdef CONFIG_PM 373246d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 373346d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 373446d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 373546d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 373646d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 373746d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 373846d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 373946d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 374046d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 3741dfb89c56SJohannes Berg #endif 374246d33a21SKalle Valo 37438ab5415dSJouni Malinen wiphy->max_sched_scan_ssids = MAX_PROBED_SSIDS; 374446d33a21SKalle Valo 3745f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3746f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3747f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3748f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3749f2afdac7SVasanthakumar Thiagarajan 3750b1f47e3aSThomas Pedersen if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN_V2, ar->fw_capabilities)) 3751f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3752f2afdac7SVasanthakumar Thiagarajan 375303bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 375403bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 3755b292219fSJohannes Berg ar->wiphy->features |= NL80211_FEATURE_INACTIVITY_TIMER; 375603bdeb0dSVasanthakumar Thiagarajan 3757f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3758f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3759f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3760a432e7ccSJouni Malinen NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3761f2afdac7SVasanthakumar Thiagarajan 376246d33a21SKalle Valo ret = wiphy_register(wiphy); 376346d33a21SKalle Valo if (ret < 0) { 376446d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 376546d33a21SKalle Valo return ret; 376646d33a21SKalle Valo } 376746d33a21SKalle Valo 3768e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3769e5348a1eSVasanthakumar Thiagarajan 377046d33a21SKalle Valo return 0; 377146d33a21SKalle Valo } 377246d33a21SKalle Valo 377346d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3774bdcd8170SKalle Valo { 3775be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3776e5348a1eSVasanthakumar Thiagarajan 3777e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 377845eaa78fSKalle Valo } 377946d33a21SKalle Valo 378045eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 378145eaa78fSKalle Valo { 378245eaa78fSKalle Valo struct ath6kl *ar; 378345eaa78fSKalle Valo struct wiphy *wiphy; 378445eaa78fSKalle Valo 378545eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 378645eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 378745eaa78fSKalle Valo 378845eaa78fSKalle Valo if (!wiphy) { 378945eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 379045eaa78fSKalle Valo return NULL; 379145eaa78fSKalle Valo } 379245eaa78fSKalle Valo 379345eaa78fSKalle Valo ar = wiphy_priv(wiphy); 379445eaa78fSKalle Valo ar->wiphy = wiphy; 379545eaa78fSKalle Valo 379645eaa78fSKalle Valo return ar; 379745eaa78fSKalle Valo } 379845eaa78fSKalle Valo 379945eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 380045eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 380145eaa78fSKalle Valo { 38021d2a4456SVasanthakumar Thiagarajan int i; 38031d2a4456SVasanthakumar Thiagarajan 38041d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 38051d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 38061d2a4456SVasanthakumar Thiagarajan 3807be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3808bdcd8170SKalle Valo } 380945eaa78fSKalle Valo 3810