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 54bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 55bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 56bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 57bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 58bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 59bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 60bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 61bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 62bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 63bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 64bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 65bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 66bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 67bdcd8170SKalle Valo }; 68bdcd8170SKalle Valo 69bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 70bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 71bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 72bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 73bdcd8170SKalle Valo 74faaf1929SVasanthakumar Thiagarajan #define ath6kl_g_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 75faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 76faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 77faaf1929SVasanthakumar Thiagarajan 78bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 79bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 80bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 81bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 82bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 83bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 84bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 85bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 86bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 87bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 88bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 89bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 90bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 91bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 92bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 93bdcd8170SKalle Valo }; 94bdcd8170SKalle Valo 95bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 96bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 97bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 98bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 99bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 100bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 101bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 102bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 103bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 104bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 105bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 106bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 107bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 108bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 109bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 110bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 111bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 112bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 113bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 114bdcd8170SKalle Valo CHAN5G(216, 0), 115bdcd8170SKalle Valo }; 116bdcd8170SKalle Valo 117bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 118bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 119bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 120bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 121bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 122faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 123faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 124bdcd8170SKalle Valo }; 125bdcd8170SKalle Valo 126bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 127bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 128bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 129bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 130bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 131faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 132faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 133bdcd8170SKalle Valo }; 134bdcd8170SKalle Valo 135837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 136837cb97eSJouni Malinen 13710509f90SKalle Valo /* returns true if scheduled scan was stopped */ 13810509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 13910509f90SKalle Valo { 14010509f90SKalle Valo struct ath6kl *ar = vif->ar; 14110509f90SKalle Valo 14210509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14310509f90SKalle Valo return false; 14410509f90SKalle Valo 14510509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14610509f90SKalle Valo 14710509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 14810509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 14910509f90SKalle Valo 15010509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 15110509f90SKalle Valo 15210509f90SKalle Valo return true; 15310509f90SKalle Valo } 15410509f90SKalle Valo 15510509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15610509f90SKalle Valo { 15710509f90SKalle Valo struct ath6kl *ar = vif->ar; 15810509f90SKalle Valo bool stopped; 15910509f90SKalle Valo 16010509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 16110509f90SKalle Valo 16210509f90SKalle Valo if (!stopped) 16310509f90SKalle Valo return; 16410509f90SKalle Valo 16510509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16610509f90SKalle Valo } 16710509f90SKalle Valo 168240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 169bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 170bdcd8170SKalle Valo { 171bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 172bdcd8170SKalle Valo 173bdcd8170SKalle Valo if (!wpa_version) { 1743450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 175bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1763450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 177bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1783450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 179bdcd8170SKalle Valo } else { 180bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 181bdcd8170SKalle Valo return -ENOTSUPP; 182bdcd8170SKalle Valo } 183bdcd8170SKalle Valo 184bdcd8170SKalle Valo return 0; 185bdcd8170SKalle Valo } 186bdcd8170SKalle Valo 187240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 188bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 189bdcd8170SKalle Valo { 190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 191bdcd8170SKalle Valo 192bdcd8170SKalle Valo switch (auth_type) { 193bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1943450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 195bdcd8170SKalle Valo break; 196bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1973450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 198bdcd8170SKalle Valo break; 199bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 2003450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 201bdcd8170SKalle Valo break; 202bdcd8170SKalle Valo 203bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 205bdcd8170SKalle Valo break; 206bdcd8170SKalle Valo 207bdcd8170SKalle Valo default: 2083c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 209bdcd8170SKalle Valo return -ENOTSUPP; 210bdcd8170SKalle Valo } 211bdcd8170SKalle Valo 212bdcd8170SKalle Valo return 0; 213bdcd8170SKalle Valo } 214bdcd8170SKalle Valo 215240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 216bdcd8170SKalle Valo { 2173450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2183450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2193450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 220bdcd8170SKalle Valo 221bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 222bdcd8170SKalle Valo __func__, cipher, ucast); 223bdcd8170SKalle Valo 224bdcd8170SKalle Valo switch (cipher) { 225bdcd8170SKalle Valo case 0: 226bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 227bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 228bdcd8170SKalle Valo *ar_cipher_len = 0; 229bdcd8170SKalle Valo break; 230bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 231bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 232bdcd8170SKalle Valo *ar_cipher_len = 5; 233bdcd8170SKalle Valo break; 234bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 235bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 13; 237bdcd8170SKalle Valo break; 238bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 239bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 240bdcd8170SKalle Valo *ar_cipher_len = 0; 241bdcd8170SKalle Valo break; 242bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 243bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 244bdcd8170SKalle Valo *ar_cipher_len = 0; 245bdcd8170SKalle Valo break; 2465e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2475e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2485e07021eSDai Shuibing *ar_cipher_len = 0; 2495e07021eSDai Shuibing break; 250bdcd8170SKalle Valo default: 251bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 252bdcd8170SKalle Valo return -ENOTSUPP; 253bdcd8170SKalle Valo } 254bdcd8170SKalle Valo 255bdcd8170SKalle Valo return 0; 256bdcd8170SKalle Valo } 257bdcd8170SKalle Valo 258240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 259bdcd8170SKalle Valo { 260bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 261bdcd8170SKalle Valo 262bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2633450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2643450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2653450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2663450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 267837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2683450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2703450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2713450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 272bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2733450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 274bdcd8170SKalle Valo } 275bdcd8170SKalle Valo } 276bdcd8170SKalle Valo 277990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 278bdcd8170SKalle Valo { 279990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 28059c98449SVasanthakumar Thiagarajan 281bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 282bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 283bdcd8170SKalle Valo return false; 284bdcd8170SKalle Valo } 285bdcd8170SKalle Valo 28659c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 287bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 288bdcd8170SKalle Valo return false; 289bdcd8170SKalle Valo } 290bdcd8170SKalle Valo 291bdcd8170SKalle Valo return true; 292bdcd8170SKalle Valo } 293bdcd8170SKalle Valo 2946981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2956981ffdcSKevin Fang { 2966981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2976981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2986981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2996981ffdcSKevin Fang } 3006981ffdcSKevin Fang 3016981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3026981ffdcSKevin Fang { 3036981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3046981ffdcSKevin Fang } 3056981ffdcSKevin Fang 30663541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 30763541212SAarthi Thiruvengadam { 30863541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 30963541212SAarthi Thiruvengadam pos[1] >= 4 && 31063541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 31163541212SAarthi Thiruvengadam pos[5] == 0x04); 31263541212SAarthi Thiruvengadam } 31363541212SAarthi Thiruvengadam 314334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3156981ffdcSKevin Fang size_t ies_len) 3166981ffdcSKevin Fang { 317334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3186981ffdcSKevin Fang const u8 *pos; 3196981ffdcSKevin Fang u8 *buf = NULL; 3206981ffdcSKevin Fang size_t len = 0; 3216981ffdcSKevin Fang int ret; 3226981ffdcSKevin Fang 3236981ffdcSKevin Fang /* 32463541212SAarthi Thiruvengadam * Clear previously set flag 32563541212SAarthi Thiruvengadam */ 32663541212SAarthi Thiruvengadam 32763541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 32863541212SAarthi Thiruvengadam 32963541212SAarthi Thiruvengadam /* 3306981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3316981ffdcSKevin Fang */ 3326981ffdcSKevin Fang 3336981ffdcSKevin Fang if (ies && ies_len) { 3346981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3356981ffdcSKevin Fang if (buf == NULL) 3366981ffdcSKevin Fang return -ENOMEM; 3376981ffdcSKevin Fang pos = ies; 3386981ffdcSKevin Fang 3396981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3406981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3416981ffdcSKevin Fang break; 3426981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3436981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3446981ffdcSKevin Fang len += 2 + pos[1]; 3456981ffdcSKevin Fang } 34663541212SAarthi Thiruvengadam 34763541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 34863541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 34963541212SAarthi Thiruvengadam 3506981ffdcSKevin Fang pos += 2 + pos[1]; 3516981ffdcSKevin Fang } 3526981ffdcSKevin Fang } 3536981ffdcSKevin Fang 354334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 355334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3566981ffdcSKevin Fang kfree(buf); 3576981ffdcSKevin Fang return ret; 3586981ffdcSKevin Fang } 3596981ffdcSKevin Fang 36055055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 36155055976SVasanthakumar Thiagarajan { 36255055976SVasanthakumar Thiagarajan switch (type) { 36355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36455055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36555055976SVasanthakumar Thiagarajan break; 36655055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 36755055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 36855055976SVasanthakumar Thiagarajan break; 36955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 37055055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37155055976SVasanthakumar Thiagarajan break; 37255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37455055976SVasanthakumar Thiagarajan break; 37555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37655055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37755055976SVasanthakumar Thiagarajan break; 37855055976SVasanthakumar Thiagarajan default: 37955055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 38055055976SVasanthakumar Thiagarajan return -ENOTSUPP; 38155055976SVasanthakumar Thiagarajan } 38255055976SVasanthakumar Thiagarajan 38355055976SVasanthakumar Thiagarajan return 0; 38455055976SVasanthakumar Thiagarajan } 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 38755055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38855055976SVasanthakumar Thiagarajan { 38955055976SVasanthakumar Thiagarajan int i; 39055055976SVasanthakumar Thiagarajan 39155055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39255055976SVasanthakumar Thiagarajan return false; 39355055976SVasanthakumar Thiagarajan 39455055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39555055976SVasanthakumar Thiagarajan ar->num_vif)) 39655055976SVasanthakumar Thiagarajan return false; 39755055976SVasanthakumar Thiagarajan 39855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39955055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 40071f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 40155055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40255055976SVasanthakumar Thiagarajan *if_idx = i; 40355055976SVasanthakumar Thiagarajan return true; 40455055976SVasanthakumar Thiagarajan } 40555055976SVasanthakumar Thiagarajan } 40655055976SVasanthakumar Thiagarajan } 40755055976SVasanthakumar Thiagarajan 4083226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4093226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 41071f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4113226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4123226f68aSVasanthakumar Thiagarajan *if_idx = i; 4133226f68aSVasanthakumar Thiagarajan return true; 4143226f68aSVasanthakumar Thiagarajan } 4153226f68aSVasanthakumar Thiagarajan } 4163226f68aSVasanthakumar Thiagarajan } 4173226f68aSVasanthakumar Thiagarajan 41855055976SVasanthakumar Thiagarajan return false; 41955055976SVasanthakumar Thiagarajan } 42055055976SVasanthakumar Thiagarajan 4218c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4228c9bb054SKalle Valo { 4238c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4248c9bb054SKalle Valo } 4258c9bb054SKalle Valo 4268c9bb054SKalle Valo 427bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 428bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 429bdcd8170SKalle Valo { 430bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 43159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 432bdcd8170SKalle Valo int status; 4333ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 434ce0dc0cfSRaja Mani u16 interval; 435bdcd8170SKalle Valo 43610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 43710509f90SKalle Valo 43814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 439bdcd8170SKalle Valo 440990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 441bdcd8170SKalle Valo return -EIO; 442bdcd8170SKalle Valo 443bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 444bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 445bdcd8170SKalle Valo return -EBUSY; 446bdcd8170SKalle Valo } 447bdcd8170SKalle Valo 448bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 449bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 450bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 451bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 452bdcd8170SKalle Valo return -EINVAL; 453bdcd8170SKalle Valo } 454bdcd8170SKalle Valo 455bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 456bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 457bdcd8170SKalle Valo return -ERESTARTSYS; 458bdcd8170SKalle Valo } 459bdcd8170SKalle Valo 460bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 461bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 462bdcd8170SKalle Valo up(&ar->sem); 463bdcd8170SKalle Valo return -EBUSY; 464bdcd8170SKalle Valo } 465bdcd8170SKalle Valo 466bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 467bdcd8170SKalle Valo /* 468bdcd8170SKalle Valo * sleep until the command queue drains 469bdcd8170SKalle Valo */ 470bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4718c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 472bdcd8170SKalle Valo WMI_TIMEOUT); 473bdcd8170SKalle Valo if (signal_pending(current)) { 474bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 475bdcd8170SKalle Valo up(&ar->sem); 476bdcd8170SKalle Valo return -EINTR; 477bdcd8170SKalle Valo } 478bdcd8170SKalle Valo } 479bdcd8170SKalle Valo 480334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 481743b4518SDan Carpenter if (status) { 482743b4518SDan Carpenter up(&ar->sem); 4836981ffdcSKevin Fang return status; 484743b4518SDan Carpenter } 4856e786cb1SJouni Malinen 4866e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 487542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4886981ffdcSKevin Fang 48959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4903450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4913450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 492cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 493334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 494334234b5SVasanthakumar Thiagarajan vif->req_bssid, 495f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 496bdcd8170SKalle Valo 497bdcd8170SKalle Valo up(&ar->sem); 498bdcd8170SKalle Valo if (status) { 499bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 500bdcd8170SKalle Valo return -EIO; 501bdcd8170SKalle Valo } 502bdcd8170SKalle Valo return 0; 5033450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5043450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 505240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 5083450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5093450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5103450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 511bdcd8170SKalle Valo 512bdcd8170SKalle Valo if (sme->channel) 513f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 514bdcd8170SKalle Valo 5158c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 516bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5178c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 518bdcd8170SKalle Valo 519240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 520bdcd8170SKalle Valo 521240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 522bdcd8170SKalle Valo if (status) { 523bdcd8170SKalle Valo up(&ar->sem); 524bdcd8170SKalle Valo return status; 525bdcd8170SKalle Valo } 526bdcd8170SKalle Valo 527bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 528240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 529bdcd8170SKalle Valo else 530240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 531bdcd8170SKalle Valo 532240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 533bdcd8170SKalle Valo 534bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 535240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if ((sme->key_len) && 5383450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5393450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 540bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 541bdcd8170SKalle Valo 542792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 543bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 544bdcd8170SKalle Valo sme->key_idx); 545bdcd8170SKalle Valo up(&ar->sem); 546bdcd8170SKalle Valo return -ENOENT; 547bdcd8170SKalle Valo } 548bdcd8170SKalle Valo 5496f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 550bdcd8170SKalle Valo key->key_len = sme->key_len; 551bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5523450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5533450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 554bdcd8170SKalle Valo 555334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5563450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 557bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 558bdcd8170SKalle Valo key->key_len, 559f4bb9a6fSJouni Malinen NULL, 0, 560bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 561bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 562bdcd8170SKalle Valo } 563bdcd8170SKalle Valo 564bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 566240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 567240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 568bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 569bdcd8170SKalle Valo up(&ar->sem); 570bdcd8170SKalle Valo return -EIO; 571bdcd8170SKalle Valo } 572bdcd8170SKalle Valo } 573bdcd8170SKalle Valo 574f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 575bdcd8170SKalle Valo 5763ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5773ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5783ca9d1fcSAarthi Thiruvengadam 579bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 580bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 581bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 582bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 583bdcd8170SKalle Valo __func__, 5843450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5853450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 586f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 587bdcd8170SKalle Valo 588cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 589ce0dc0cfSRaja Mani 590ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 591b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 592b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 593ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 594ce0dc0cfSRaja Mani interval, 595ce0dc0cfSRaja Mani 0); 596ce0dc0cfSRaja Mani if (status) { 597ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 598ce0dc0cfSRaja Mani up(&ar->sem); 599ce0dc0cfSRaja Mani return status; 600ce0dc0cfSRaja Mani } 601ce0dc0cfSRaja Mani } 602ce0dc0cfSRaja Mani 603334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6053450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6063450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6073450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6083450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 609f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6103ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 611bdcd8170SKalle Valo 612bdcd8170SKalle Valo up(&ar->sem); 613bdcd8170SKalle Valo 614bdcd8170SKalle Valo if (status == -EINVAL) { 6153450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6163450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 617bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 618bdcd8170SKalle Valo return -ENOENT; 619bdcd8170SKalle Valo } else if (status) { 620bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 621bdcd8170SKalle Valo return -EIO; 622bdcd8170SKalle Valo } 623bdcd8170SKalle Valo 624bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 625ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 626ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 627de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 628bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 629bdcd8170SKalle Valo } 630bdcd8170SKalle Valo 631bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 63259c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 633bdcd8170SKalle Valo 634bdcd8170SKalle Valo return 0; 635bdcd8170SKalle Valo } 636bdcd8170SKalle Valo 6375e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6385e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6394eab6f4fSRaja Mani enum network_type nw_type, 6404eab6f4fSRaja Mani const u8 *bssid, 64101cac476SJouni Malinen struct ieee80211_channel *chan, 6425e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6435e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 64401cac476SJouni Malinen { 645240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 64601cac476SJouni Malinen struct cfg80211_bss *bss; 6474eab6f4fSRaja Mani u16 cap_mask, cap_val; 64801cac476SJouni Malinen u8 *ie; 64901cac476SJouni Malinen 6504eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6514eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6524eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6534eab6f4fSRaja Mani } else { 6544eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6554eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6564eab6f4fSRaja Mani } 6574eab6f4fSRaja Mani 658be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6594eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6604eab6f4fSRaja Mani cap_mask, cap_val); 66101cac476SJouni Malinen if (bss == NULL) { 66201cac476SJouni Malinen /* 66301cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 66401cac476SJouni Malinen * generate a partial entry until the first BSS info 66501cac476SJouni Malinen * event becomes available. 66601cac476SJouni Malinen * 66701cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 66801cac476SJouni Malinen * IEs from the target. 66901cac476SJouni Malinen */ 6703450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 67101cac476SJouni Malinen if (ie == NULL) 6725e13fd35SVasanthakumar Thiagarajan return NULL; 67301cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6743450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6753450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6763450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 677be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6784eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6793450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 68001cac476SJouni Malinen 0, GFP_KERNEL); 68101cac476SJouni Malinen if (bss) 6824eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6834eab6f4fSRaja Mani "cfg80211\n", bssid); 68401cac476SJouni Malinen kfree(ie); 68501cac476SJouni Malinen } else 6865e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 68701cac476SJouni Malinen 6885e13fd35SVasanthakumar Thiagarajan return bss; 68901cac476SJouni Malinen } 69001cac476SJouni Malinen 691240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 692bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 693bdcd8170SKalle Valo u16 beacon_intvl, 694bdcd8170SKalle Valo enum network_type nw_type, 695bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 696bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 697bdcd8170SKalle Valo { 69801cac476SJouni Malinen struct ieee80211_channel *chan; 699240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 7005e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 701bdcd8170SKalle Valo 702bdcd8170SKalle Valo /* capinfo + listen interval */ 703bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 704bdcd8170SKalle Valo 705bdcd8170SKalle Valo /* capinfo + status code + associd */ 706bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 707bdcd8170SKalle Valo 708bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 709bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 710bdcd8170SKalle Valo assoc_resp_ie_offset; 711bdcd8170SKalle Valo 712bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 713bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 714bdcd8170SKalle Valo 71532c10874SJouni Malinen /* 71632c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 71732c10874SJouni Malinen * a Beacon frame from the AP is seen. 71832c10874SJouni Malinen */ 719cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 72059c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 72132c10874SJouni Malinen 722bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 723551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 724bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 725bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 726bdcd8170SKalle Valo return; 727bdcd8170SKalle Valo } 728bdcd8170SKalle Valo } 729bdcd8170SKalle Valo 730bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 731551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 732551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 733bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 734bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 735bdcd8170SKalle Valo return; 736bdcd8170SKalle Valo } 737bdcd8170SKalle Valo } 738bdcd8170SKalle Valo 739be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 740bdcd8170SKalle Valo 7415e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7425e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7435e13fd35SVasanthakumar Thiagarajan if (!bss) { 7444eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 745bdcd8170SKalle Valo return; 746bdcd8170SKalle Valo } 747bdcd8170SKalle Valo 7484eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7494eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7504eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7514eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7525e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 75301cac476SJouni Malinen return; 75401cac476SJouni Malinen } 75501cac476SJouni Malinen 75614ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 757bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 75814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 759240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 760bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 761bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 762bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7635e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76414ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 765bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7665e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 767bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 768bdcd8170SKalle Valo } 769bdcd8170SKalle Valo } 770bdcd8170SKalle Valo 771bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 772bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 773bdcd8170SKalle Valo { 774d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7753450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 776bdcd8170SKalle Valo 777bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 778bdcd8170SKalle Valo reason_code); 779bdcd8170SKalle Valo 78010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 78110509f90SKalle Valo 782990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 783bdcd8170SKalle Valo return -EIO; 784bdcd8170SKalle Valo 785bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 786bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 787bdcd8170SKalle Valo return -EBUSY; 788bdcd8170SKalle Valo } 789bdcd8170SKalle Valo 790bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 791bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 792bdcd8170SKalle Valo return -ERESTARTSYS; 793bdcd8170SKalle Valo } 794bdcd8170SKalle Valo 795cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 796240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7973450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7983450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 799bdcd8170SKalle Valo 800bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 8018c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 802bdcd8170SKalle Valo 803bdcd8170SKalle Valo up(&ar->sem); 804bdcd8170SKalle Valo 80514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 806170826ddSVasanthakumar Thiagarajan 807bdcd8170SKalle Valo return 0; 808bdcd8170SKalle Valo } 809bdcd8170SKalle Valo 810240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 811bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 812bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 813bdcd8170SKalle Valo { 814240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 81559c98449SVasanthakumar Thiagarajan 81614ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 81714ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 81814ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 819bdcd8170SKalle Valo } 820bdcd8170SKalle Valo 821f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 822551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 823bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 824bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 825bdcd8170SKalle Valo return; 826bdcd8170SKalle Valo } 827bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 828240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 829bdcd8170SKalle Valo return; 830bdcd8170SKalle Valo } 831bdcd8170SKalle Valo 832f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 833551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 834551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 835bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 836bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 837bdcd8170SKalle Valo return; 838bdcd8170SKalle Valo } 839bdcd8170SKalle Valo } 840bdcd8170SKalle Valo 8411de547d6SVasanthakumar Thiagarajan /* 8421de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8431de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8441de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8451de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8461de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8471de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8481de547d6SVasanthakumar Thiagarajan */ 849bdcd8170SKalle Valo 8501de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 851334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 852bdcd8170SKalle Valo return; 853bdcd8170SKalle Valo } 854bdcd8170SKalle Valo 85559c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 856bdcd8170SKalle Valo 85714ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 858240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 859bdcd8170SKalle Valo bssid, NULL, 0, 860bdcd8170SKalle Valo NULL, 0, 861bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 862bdcd8170SKalle Valo GFP_KERNEL); 86314ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 864240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 865bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 866bdcd8170SKalle Valo } 867bdcd8170SKalle Valo 86814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 869bdcd8170SKalle Valo } 870bdcd8170SKalle Valo 871bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 872bdcd8170SKalle Valo struct cfg80211_scan_request *request) 873bdcd8170SKalle Valo { 874d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 87559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8761276c9efSEdward Lu s8 n_channels = 0; 8771276c9efSEdward Lu u16 *channels = NULL; 878bdcd8170SKalle Valo int ret = 0; 879f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 880bdcd8170SKalle Valo 881990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 882bdcd8170SKalle Valo return -EIO; 883bdcd8170SKalle Valo 88410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 88510509f90SKalle Valo 886bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 88759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8881b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 889240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 89059c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8911b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8921b1e6ee3SJouni Malinen if (ret) { 893bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8941b1e6ee3SJouni Malinen return ret; 895bdcd8170SKalle Valo } 896bdcd8170SKalle Valo } 897bdcd8170SKalle Valo 898bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 899bdcd8170SKalle Valo u8 i; 900bdcd8170SKalle Valo 901bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 902bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 903bdcd8170SKalle Valo 904bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 905334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 906334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 907bdcd8170SKalle Valo request->ssids[i].ssid_len, 908bdcd8170SKalle Valo request->ssids[i].ssid); 909bdcd8170SKalle Valo } 910bdcd8170SKalle Valo 911080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 912334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 913334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 914b84da8c7SJouni Malinen request->ie, request->ie_len); 915b84da8c7SJouni Malinen if (ret) { 916b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 917b84da8c7SJouni Malinen "scan"); 918b84da8c7SJouni Malinen return ret; 919b84da8c7SJouni Malinen } 920b84da8c7SJouni Malinen 92111869befSJouni Malinen /* 92211869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 92311869befSJouni Malinen * channels. If the list is longer than the target supports, do not 92411869befSJouni Malinen * configure the list and instead, scan all available channels. 92511869befSJouni Malinen */ 92611869befSJouni Malinen if (request->n_channels > 0 && 92711869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9281276c9efSEdward Lu u8 i; 9291276c9efSEdward Lu 93011869befSJouni Malinen n_channels = request->n_channels; 9311276c9efSEdward Lu 9321276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9331276c9efSEdward Lu if (channels == NULL) { 9341276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9351276c9efSEdward Lu "scan all channels"); 9361276c9efSEdward Lu n_channels = 0; 9371276c9efSEdward Lu } 9381276c9efSEdward Lu 9391276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9401276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9411276c9efSEdward Lu } 9421276c9efSEdward Lu 94359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 944f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 945f1f92179SVasanthakumar Thiagarajan 9463ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9473ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9483ca9d1fcSAarthi Thiruvengadam /* 9493ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9503ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9513ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9523ca9d1fcSAarthi Thiruvengadam * probe requests 9533ca9d1fcSAarthi Thiruvengadam */ 9543ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9553ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 95613423c31SVasanthakumar Thiagarajan false, 0, 95713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95813423c31SVasanthakumar Thiagarajan n_channels, channels, 95913423c31SVasanthakumar Thiagarajan request->no_cck, 9603ca9d1fcSAarthi Thiruvengadam request->rates); 9613ca9d1fcSAarthi Thiruvengadam } else { 9623ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9633ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 96413423c31SVasanthakumar Thiagarajan false, 0, 96513423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 96613423c31SVasanthakumar Thiagarajan n_channels, channels); 9673ca9d1fcSAarthi Thiruvengadam } 9681b1e6ee3SJouni Malinen if (ret) 969bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 97011869befSJouni Malinen else 97114ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 972bdcd8170SKalle Valo 9731276c9efSEdward Lu kfree(channels); 9741276c9efSEdward Lu 975bdcd8170SKalle Valo return ret; 976bdcd8170SKalle Valo } 977bdcd8170SKalle Valo 9781c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 979bdcd8170SKalle Valo { 980240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9816fd1eaceSKalle Valo int i; 982bdcd8170SKalle Valo 9831c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9841c17d313SKalle Valo aborted ? " aborted" : ""); 985bdcd8170SKalle Valo 98614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9876fd1eaceSKalle Valo return; 9886fd1eaceSKalle Valo 9891c17d313SKalle Valo if (aborted) 9906fd1eaceSKalle Valo goto out; 991bdcd8170SKalle Valo 99214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 99314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 994334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 995334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 996bdcd8170SKalle Valo 0, NULL); 997bdcd8170SKalle Valo } 998bdcd8170SKalle Valo } 9996fd1eaceSKalle Valo 10006fd1eaceSKalle Valo out: 1001cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 100214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1003bdcd8170SKalle Valo } 1004bdcd8170SKalle Valo 1005bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1006bdcd8170SKalle Valo u8 key_index, bool pairwise, 1007bdcd8170SKalle Valo const u8 *mac_addr, 1008bdcd8170SKalle Valo struct key_params *params) 1009bdcd8170SKalle Valo { 1010d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 101159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1012bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10134a8ce2fdSSujith Manoharan int seq_len; 1014bdcd8170SKalle Valo u8 key_usage; 1015bdcd8170SKalle Valo u8 key_type; 1016bdcd8170SKalle Valo 1017990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1018bdcd8170SKalle Valo return -EIO; 1019bdcd8170SKalle Valo 1020837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1021837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1022837cb97eSJouni Malinen return -EINVAL; 1023240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1024240d2799SVasanthakumar Thiagarajan params->key); 1025837cb97eSJouni Malinen } 1026837cb97eSJouni Malinen 1027792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1028bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1029bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1030bdcd8170SKalle Valo key_index); 1031bdcd8170SKalle Valo return -ENOENT; 1032bdcd8170SKalle Valo } 1033bdcd8170SKalle Valo 10346f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1035bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1036bdcd8170SKalle Valo 1037bdcd8170SKalle Valo if (pairwise) 1038bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1039bdcd8170SKalle Valo else 1040bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1041bdcd8170SKalle Valo 10424a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10435e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10445e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10455e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10465e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10475e07021eSDai Shuibing } 1048bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10495e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1050bdcd8170SKalle Valo return -EINVAL; 1051bdcd8170SKalle Valo 1052bdcd8170SKalle Valo key->key_len = params->key_len; 1053bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10545e07021eSDai Shuibing key->seq_len = seq_len; 1055bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1056bdcd8170SKalle Valo key->cipher = params->cipher; 1057bdcd8170SKalle Valo 1058bdcd8170SKalle Valo switch (key->cipher) { 1059bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1060bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1061bdcd8170SKalle Valo key_type = WEP_CRYPT; 1062bdcd8170SKalle Valo break; 1063bdcd8170SKalle Valo 1064bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1065bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1066bdcd8170SKalle Valo break; 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1069bdcd8170SKalle Valo key_type = AES_CRYPT; 1070bdcd8170SKalle Valo break; 10715e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10725e07021eSDai Shuibing key_type = WAPI_CRYPT; 10735e07021eSDai Shuibing break; 1074bdcd8170SKalle Valo 1075bdcd8170SKalle Valo default: 1076bdcd8170SKalle Valo return -ENOTSUPP; 1077bdcd8170SKalle Valo } 1078bdcd8170SKalle Valo 1079ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1080ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1081ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1082de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1083bdcd8170SKalle Valo 1084bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1085bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1086bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1087bdcd8170SKalle Valo key_usage, key->seq_len); 1088bdcd8170SKalle Valo 1089f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10904703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1091cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10929a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10939a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10949a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10959a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10969a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 109759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10989a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10999a5b1318SJouni Malinen "key configuration until AP mode has been " 11009a5b1318SJouni Malinen "started\n"); 11019a5b1318SJouni Malinen /* 11029a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11039a5b1318SJouni Malinen * the connected event is received from the target. 11049a5b1318SJouni Malinen */ 11059a5b1318SJouni Malinen return 0; 11069a5b1318SJouni Malinen } 11079a5b1318SJouni Malinen } 11089a5b1318SJouni Malinen 1109f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 111059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1111151411e8SJouni Malinen /* 1112151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1113151411e8SJouni Malinen * the AP mode has properly started 1114151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1115151411e8SJouni Malinen */ 1116151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1117151411e8SJouni Malinen "until AP mode has been started\n"); 11186f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11196f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11206f2a73f9SVasanthakumar Thiagarajan key->key_len); 1121151411e8SJouni Malinen return 0; 1122151411e8SJouni Malinen } 1123151411e8SJouni Malinen 11247cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1125bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1126f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1127f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1128bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1129bdcd8170SKalle Valo } 1130bdcd8170SKalle Valo 1131bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1132bdcd8170SKalle Valo u8 key_index, bool pairwise, 1133bdcd8170SKalle Valo const u8 *mac_addr) 1134bdcd8170SKalle Valo { 1135d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11366f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1137bdcd8170SKalle Valo 1138bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1139bdcd8170SKalle Valo 1140990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1141bdcd8170SKalle Valo return -EIO; 1142bdcd8170SKalle Valo 1143792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1145bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1146bdcd8170SKalle Valo key_index); 1147bdcd8170SKalle Valo return -ENOENT; 1148bdcd8170SKalle Valo } 1149bdcd8170SKalle Valo 11506f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1151bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1152bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1153bdcd8170SKalle Valo return 0; 1154bdcd8170SKalle Valo } 1155bdcd8170SKalle Valo 11566f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1157bdcd8170SKalle Valo 1158334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1159bdcd8170SKalle Valo } 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1162bdcd8170SKalle Valo u8 key_index, bool pairwise, 1163bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1164bdcd8170SKalle Valo void (*callback) (void *cookie, 1165bdcd8170SKalle Valo struct key_params *)) 1166bdcd8170SKalle Valo { 11676f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1168bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1169bdcd8170SKalle Valo struct key_params params; 1170bdcd8170SKalle Valo 1171bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1172bdcd8170SKalle Valo 1173990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1174bdcd8170SKalle Valo return -EIO; 1175bdcd8170SKalle Valo 1176792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1177bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1178bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1179bdcd8170SKalle Valo key_index); 1180bdcd8170SKalle Valo return -ENOENT; 1181bdcd8170SKalle Valo } 1182bdcd8170SKalle Valo 11836f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1184bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1185bdcd8170SKalle Valo params.cipher = key->cipher; 1186bdcd8170SKalle Valo params.key_len = key->key_len; 1187bdcd8170SKalle Valo params.seq_len = key->seq_len; 1188bdcd8170SKalle Valo params.seq = key->seq; 1189bdcd8170SKalle Valo params.key = key->key; 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo callback(cookie, ¶ms); 1192bdcd8170SKalle Valo 1193bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1194bdcd8170SKalle Valo } 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1197bdcd8170SKalle Valo struct net_device *ndev, 1198bdcd8170SKalle Valo u8 key_index, bool unicast, 1199bdcd8170SKalle Valo bool multicast) 1200bdcd8170SKalle Valo { 1201d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 120259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1203bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1204bdcd8170SKalle Valo u8 key_usage; 1205229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1206bdcd8170SKalle Valo 1207bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1208bdcd8170SKalle Valo 1209990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1210bdcd8170SKalle Valo return -EIO; 1211bdcd8170SKalle Valo 1212792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1213bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1214bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1215bdcd8170SKalle Valo __func__, key_index); 1216bdcd8170SKalle Valo return -ENOENT; 1217bdcd8170SKalle Valo } 1218bdcd8170SKalle Valo 12196f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1221bdcd8170SKalle Valo __func__, key_index); 1222bdcd8170SKalle Valo return -EINVAL; 1223bdcd8170SKalle Valo } 1224bdcd8170SKalle Valo 12253450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12266f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1227bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12283450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1229bdcd8170SKalle Valo key_usage |= TX_USAGE; 1230229ed6b5SEdward Lu if (unicast) 12313450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1232229ed6b5SEdward Lu if (multicast) 12333450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1234bdcd8170SKalle Valo 1235f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12369a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12379a5b1318SJouni Malinen 1238f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1239334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1240229ed6b5SEdward Lu key_type, key_usage, 1241f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1242f4bb9a6fSJouni Malinen key->key, 1243bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1244bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1245bdcd8170SKalle Valo } 1246bdcd8170SKalle Valo 1247240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1248bdcd8170SKalle Valo bool ismcast) 1249bdcd8170SKalle Valo { 1250bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1251bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1252bdcd8170SKalle Valo 1253240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1254bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1255bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1256bdcd8170SKalle Valo GFP_KERNEL); 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo 1259bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1260bdcd8170SKalle Valo { 1261bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1262990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1263bdcd8170SKalle Valo int ret; 1264bdcd8170SKalle Valo 1265bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1266bdcd8170SKalle Valo changed); 1267bdcd8170SKalle Valo 1268990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1269990bd915SVasanthakumar Thiagarajan if (!vif) 1270990bd915SVasanthakumar Thiagarajan return -EIO; 1271990bd915SVasanthakumar Thiagarajan 1272990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1273bdcd8170SKalle Valo return -EIO; 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1276bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1277bdcd8170SKalle Valo if (ret != 0) { 1278bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1279bdcd8170SKalle Valo return -EIO; 1280bdcd8170SKalle Valo } 1281bdcd8170SKalle Valo } 1282bdcd8170SKalle Valo 1283bdcd8170SKalle Valo return 0; 1284bdcd8170SKalle Valo } 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo /* 1287bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1288bdcd8170SKalle Valo * data type from 2.6.36 onwards 1289bdcd8170SKalle Valo */ 1290bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1291bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1292b992a285SLuis R. Rodriguez int mbm) 1293bdcd8170SKalle Valo { 1294bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1295990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1296b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1297bdcd8170SKalle Valo 1298bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1299bdcd8170SKalle Valo type, dbm); 1300bdcd8170SKalle Valo 1301990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1302990bd915SVasanthakumar Thiagarajan if (!vif) 1303990bd915SVasanthakumar Thiagarajan return -EIO; 1304990bd915SVasanthakumar Thiagarajan 1305990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1306bdcd8170SKalle Valo return -EIO; 1307bdcd8170SKalle Valo 1308bdcd8170SKalle Valo switch (type) { 1309bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1310bdcd8170SKalle Valo return 0; 1311bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1312d0d670abSKalle Valo ar->tx_pwr = dbm; 1313bdcd8170SKalle Valo break; 1314bdcd8170SKalle Valo default: 1315bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1316bdcd8170SKalle Valo __func__, type); 1317bdcd8170SKalle Valo return -EOPNOTSUPP; 1318bdcd8170SKalle Valo } 1319bdcd8170SKalle Valo 1320d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo return 0; 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1326bdcd8170SKalle Valo { 1327bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1328990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1329bdcd8170SKalle Valo 1330990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1331990bd915SVasanthakumar Thiagarajan if (!vif) 1332990bd915SVasanthakumar Thiagarajan return -EIO; 1333990bd915SVasanthakumar Thiagarajan 1334990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1335bdcd8170SKalle Valo return -EIO; 1336bdcd8170SKalle Valo 133759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1338bdcd8170SKalle Valo ar->tx_pwr = 0; 1339bdcd8170SKalle Valo 1340990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1341bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1342bdcd8170SKalle Valo return -EIO; 1343bdcd8170SKalle Valo } 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1346bdcd8170SKalle Valo 5 * HZ); 1347bdcd8170SKalle Valo 1348bdcd8170SKalle Valo if (signal_pending(current)) { 1349bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1350bdcd8170SKalle Valo return -EINTR; 1351bdcd8170SKalle Valo } 1352bdcd8170SKalle Valo } 1353bdcd8170SKalle Valo 1354bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1355bdcd8170SKalle Valo return 0; 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1359bdcd8170SKalle Valo struct net_device *dev, 1360bdcd8170SKalle Valo bool pmgmt, int timeout) 1361bdcd8170SKalle Valo { 1362bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1363bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1364334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1365bdcd8170SKalle Valo 1366bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1367bdcd8170SKalle Valo __func__, pmgmt, timeout); 1368bdcd8170SKalle Valo 1369990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1370bdcd8170SKalle Valo return -EIO; 1371bdcd8170SKalle Valo 1372bdcd8170SKalle Valo if (pmgmt) { 1373bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1374bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1375bdcd8170SKalle Valo } else { 1376bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1377bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1378bdcd8170SKalle Valo } 1379bdcd8170SKalle Valo 1380334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1381334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1382bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo } 1385bdcd8170SKalle Valo 1386bdcd8170SKalle Valo return 0; 1387bdcd8170SKalle Valo } 1388bdcd8170SKalle Valo 138955055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 139055055976SVasanthakumar Thiagarajan char *name, 139155055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 139255055976SVasanthakumar Thiagarajan u32 *flags, 139355055976SVasanthakumar Thiagarajan struct vif_params *params) 139455055976SVasanthakumar Thiagarajan { 139555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139655055976SVasanthakumar Thiagarajan struct net_device *ndev; 139755055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 139855055976SVasanthakumar Thiagarajan 139971f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 140055055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 140155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140255055976SVasanthakumar Thiagarajan } 140355055976SVasanthakumar Thiagarajan 140455055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 140555055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 140655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140755055976SVasanthakumar Thiagarajan } 140855055976SVasanthakumar Thiagarajan 140955055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 141055055976SVasanthakumar Thiagarajan if (!ndev) 141155055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 141255055976SVasanthakumar Thiagarajan 141355055976SVasanthakumar Thiagarajan ar->num_vif++; 141455055976SVasanthakumar Thiagarajan 141555055976SVasanthakumar Thiagarajan return ndev; 141655055976SVasanthakumar Thiagarajan } 141755055976SVasanthakumar Thiagarajan 141855055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 141955055976SVasanthakumar Thiagarajan struct net_device *ndev) 142055055976SVasanthakumar Thiagarajan { 142155055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 142255055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 142355055976SVasanthakumar Thiagarajan 142411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 142555055976SVasanthakumar Thiagarajan list_del(&vif->list); 142611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 142755055976SVasanthakumar Thiagarajan 142855055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 142955055976SVasanthakumar Thiagarajan 1430c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 143155055976SVasanthakumar Thiagarajan 143255055976SVasanthakumar Thiagarajan return 0; 143355055976SVasanthakumar Thiagarajan } 143455055976SVasanthakumar Thiagarajan 1435bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1436bdcd8170SKalle Valo struct net_device *ndev, 1437bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1438bdcd8170SKalle Valo struct vif_params *params) 1439bdcd8170SKalle Valo { 1440f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1441bdcd8170SKalle Valo 1442bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo switch (type) { 1445bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1446f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1447bdcd8170SKalle Valo break; 1448bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1449f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1450bdcd8170SKalle Valo break; 14516e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1452f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14536e4604c8SJouni Malinen break; 14546b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1455f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14566b5e5d25SJouni Malinen break; 14576b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1458f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14596b5e5d25SJouni Malinen break; 1460bdcd8170SKalle Valo default: 1461bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1462bdcd8170SKalle Valo return -EOPNOTSUPP; 1463bdcd8170SKalle Valo } 1464bdcd8170SKalle Valo 1465551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo return 0; 1468bdcd8170SKalle Valo } 1469bdcd8170SKalle Valo 1470bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1471bdcd8170SKalle Valo struct net_device *dev, 1472bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1473bdcd8170SKalle Valo { 1474bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 147559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1476bdcd8170SKalle Valo int status; 1477bdcd8170SKalle Valo 1478990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1479bdcd8170SKalle Valo return -EIO; 1480bdcd8170SKalle Valo 14813450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14823450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1483bdcd8170SKalle Valo 1484bdcd8170SKalle Valo if (ibss_param->channel) 1485f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1486bdcd8170SKalle Valo 1487bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1488bdcd8170SKalle Valo /* 1489bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1490bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1491bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1492bdcd8170SKalle Valo * updated. 1493bdcd8170SKalle Valo */ 1494bdcd8170SKalle Valo return -EOPNOTSUPP; 1495bdcd8170SKalle Valo } 1496bdcd8170SKalle Valo 14978c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1498bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14998c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15008c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1501bdcd8170SKalle Valo 1502240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1503bdcd8170SKalle Valo 1504240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1505bdcd8170SKalle Valo if (status) 1506bdcd8170SKalle Valo return status; 1507bdcd8170SKalle Valo 1508bdcd8170SKalle Valo if (ibss_param->privacy) { 1509240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1511bdcd8170SKalle Valo } else { 1512240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1513240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1514bdcd8170SKalle Valo } 1515bdcd8170SKalle Valo 1516f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1517bdcd8170SKalle Valo 1518bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1519bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1520bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1521bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1522bdcd8170SKalle Valo __func__, 15233450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15243450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1525f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1526bdcd8170SKalle Valo 1527334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15283450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15293450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15303450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15313450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15323450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1533f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15343ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 153559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1536bdcd8170SKalle Valo 1537bdcd8170SKalle Valo return 0; 1538bdcd8170SKalle Valo } 1539bdcd8170SKalle Valo 1540bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1541bdcd8170SKalle Valo struct net_device *dev) 1542bdcd8170SKalle Valo { 15433450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1544bdcd8170SKalle Valo 1545990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1546bdcd8170SKalle Valo return -EIO; 1547bdcd8170SKalle Valo 1548240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15493450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15503450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1551bdcd8170SKalle Valo 1552bdcd8170SKalle Valo return 0; 1553bdcd8170SKalle Valo } 1554bdcd8170SKalle Valo 1555bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1556bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1557bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1558bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1559bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1560837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15615e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1562bdcd8170SKalle Valo }; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1565bdcd8170SKalle Valo { 1566bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1567bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1568bdcd8170SKalle Valo 36000, 48000, 54000 1569bdcd8170SKalle Valo }; 1570bdcd8170SKalle Valo u8 i; 1571bdcd8170SKalle Valo 1572bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1573bdcd8170SKalle Valo if (rate == legacy[i]) 1574bdcd8170SKalle Valo return true; 1575bdcd8170SKalle Valo 1576bdcd8170SKalle Valo return false; 1577bdcd8170SKalle Valo } 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1580bdcd8170SKalle Valo { 1581bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1582bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1583bdcd8170SKalle Valo }; 1584bdcd8170SKalle Valo u8 i; 1585bdcd8170SKalle Valo 1586bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1587bdcd8170SKalle Valo if (rate == ht20[i]) { 1588bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1589bdcd8170SKalle Valo /* last rate uses sgi */ 1590bdcd8170SKalle Valo *sgi = true; 1591bdcd8170SKalle Valo else 1592bdcd8170SKalle Valo *sgi = false; 1593bdcd8170SKalle Valo 1594bdcd8170SKalle Valo *mcs = i; 1595bdcd8170SKalle Valo return true; 1596bdcd8170SKalle Valo } 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo return false; 1599bdcd8170SKalle Valo } 1600bdcd8170SKalle Valo 1601bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1602bdcd8170SKalle Valo { 1603bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1604bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1605bdcd8170SKalle Valo 150000 1606bdcd8170SKalle Valo }; 1607bdcd8170SKalle Valo u8 i; 1608bdcd8170SKalle Valo 1609bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1610bdcd8170SKalle Valo if (rate == ht40[i]) { 1611bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1612bdcd8170SKalle Valo /* last rate uses sgi */ 1613bdcd8170SKalle Valo *sgi = true; 1614bdcd8170SKalle Valo else 1615bdcd8170SKalle Valo *sgi = false; 1616bdcd8170SKalle Valo 1617bdcd8170SKalle Valo *mcs = i; 1618bdcd8170SKalle Valo return true; 1619bdcd8170SKalle Valo } 1620bdcd8170SKalle Valo } 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo return false; 1623bdcd8170SKalle Valo } 1624bdcd8170SKalle Valo 1625bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1626bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1627bdcd8170SKalle Valo { 1628bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1630bdcd8170SKalle Valo long left; 1631bdcd8170SKalle Valo bool sgi; 1632bdcd8170SKalle Valo s32 rate; 1633bdcd8170SKalle Valo int ret; 1634bdcd8170SKalle Valo u8 mcs; 1635bdcd8170SKalle Valo 16368c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1637bdcd8170SKalle Valo return -ENOENT; 1638bdcd8170SKalle Valo 1639bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1640bdcd8170SKalle Valo return -EBUSY; 1641bdcd8170SKalle Valo 1642b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1643bdcd8170SKalle Valo 1644334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1645bdcd8170SKalle Valo 1646bdcd8170SKalle Valo if (ret != 0) { 1647bdcd8170SKalle Valo up(&ar->sem); 1648bdcd8170SKalle Valo return -EIO; 1649bdcd8170SKalle Valo } 1650bdcd8170SKalle Valo 1651bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1652bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1653b95907a7SVasanthakumar Thiagarajan &vif->flags), 1654bdcd8170SKalle Valo WMI_TIMEOUT); 1655bdcd8170SKalle Valo 1656bdcd8170SKalle Valo up(&ar->sem); 1657bdcd8170SKalle Valo 1658bdcd8170SKalle Valo if (left == 0) 1659bdcd8170SKalle Valo return -ETIMEDOUT; 1660bdcd8170SKalle Valo else if (left < 0) 1661bdcd8170SKalle Valo return left; 1662bdcd8170SKalle Valo 1663b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1664b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1665bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1666b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1667bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1668bdcd8170SKalle Valo } 1669bdcd8170SKalle Valo 1670b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1671b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1672bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1673b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1674bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1675bdcd8170SKalle Valo } 1676bdcd8170SKalle Valo 1677b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1678bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1679bdcd8170SKalle Valo 1680b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1681bdcd8170SKalle Valo 1682bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1683bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1684bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1685bdcd8170SKalle Valo if (sgi) { 1686bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1687bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1688bdcd8170SKalle Valo } else { 1689bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1690bdcd8170SKalle Valo } 1691bdcd8170SKalle Valo 1692bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1693bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1694bdcd8170SKalle Valo if (sgi) { 1695bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1696bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1697bdcd8170SKalle Valo } else { 1698bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1699bdcd8170SKalle Valo } 1700bdcd8170SKalle Valo 1701bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1702bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1703bdcd8170SKalle Valo } else { 17049a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17059a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17069a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1707bdcd8170SKalle Valo return 0; 1708bdcd8170SKalle Valo } 1709bdcd8170SKalle Valo 1710bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1711bdcd8170SKalle Valo 171259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 171359c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1714f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 171532c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 171632c10874SJouni Malinen sinfo->bss_param.flags = 0; 1717cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1718cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 171932c10874SJouni Malinen } 172032c10874SJouni Malinen 1721bdcd8170SKalle Valo return 0; 1722bdcd8170SKalle Valo } 1723bdcd8170SKalle Valo 1724bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1725bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1726bdcd8170SKalle Valo { 1727bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1728334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1729334234b5SVasanthakumar Thiagarajan 1730334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1731bdcd8170SKalle Valo pmksa->pmkid, true); 1732bdcd8170SKalle Valo } 1733bdcd8170SKalle Valo 1734bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1735bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1736bdcd8170SKalle Valo { 1737bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1738334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1739334234b5SVasanthakumar Thiagarajan 1740334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1741bdcd8170SKalle Valo pmksa->pmkid, false); 1742bdcd8170SKalle Valo } 1743bdcd8170SKalle Valo 1744bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1745bdcd8170SKalle Valo { 1746bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 174759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 174859c98449SVasanthakumar Thiagarajan 174959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1750334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1751334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1752bdcd8170SKalle Valo return 0; 1753bdcd8170SKalle Valo } 1754bdcd8170SKalle Valo 1755d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1756d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17576cb3c714SRaja Mani { 1758d91e8eeeSRaja Mani int ret, pos; 1759d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17606cb3c714SRaja Mani u16 i; 17616cb3c714SRaja Mani 1762d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17636cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17646cb3c714SRaja Mani 17656cb3c714SRaja Mani /* 17666cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17676cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17686cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17696cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17706cb3c714SRaja Mani * then equivalent driver specific mask value is 17716cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17726cb3c714SRaja Mani */ 17736cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17746cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17756cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17766cb3c714SRaja Mani mask[pos] = 0xFF; 17776cb3c714SRaja Mani } 17786cb3c714SRaja Mani /* 17796cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17806cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17816cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17826cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17836cb3c714SRaja Mani */ 17846cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17856cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17866cb3c714SRaja Mani wow->patterns[i].pattern_len, 17876cb3c714SRaja Mani 0 /* pattern offset */, 17886cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17896cb3c714SRaja Mani if (ret) 17906cb3c714SRaja Mani return ret; 17916cb3c714SRaja Mani } 17926cb3c714SRaja Mani 1793d91e8eeeSRaja Mani if (wow->disconnect) 1794d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1795d91e8eeeSRaja Mani 1796d91e8eeeSRaja Mani if (wow->magic_pkt) 1797d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1798d91e8eeeSRaja Mani 1799d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1800d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1801d91e8eeeSRaja Mani 1802d91e8eeeSRaja Mani if (wow->eap_identity_req) 1803d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1804d91e8eeeSRaja Mani 1805d91e8eeeSRaja Mani if (wow->four_way_handshake) 1806d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1807d91e8eeeSRaja Mani 1808d91e8eeeSRaja Mani return 0; 1809d91e8eeeSRaja Mani } 1810d91e8eeeSRaja Mani 1811d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1812d91e8eeeSRaja Mani { 1813d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1814d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1815d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1816d91e8eeeSRaja Mani 0x00, 0x08 }; 1817d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1818d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1819d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1820d91e8eeeSRaja Mani 0x00, 0x7f }; 1821d91e8eeeSRaja Mani u8 unicst_offset = 0; 1822d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1823d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1824d91e8eeeSRaja Mani u8 arp_offset = 20; 1825d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1826d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1827d91e8eeeSRaja Mani u8 discvr_offset = 38; 1828d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1829d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1830d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1832d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1833d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1834d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1835d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1836d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1837d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1838d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1839d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1840d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1841d91e8eeeSRaja Mani int ret; 1842d91e8eeeSRaja Mani 1843d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1844d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1845d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1846d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1847d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1848d91e8eeeSRaja Mani if (ret) { 1849d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1850d91e8eeeSRaja Mani return ret; 1851d91e8eeeSRaja Mani } 1852d91e8eeeSRaja Mani 1853d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1854d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1855d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1856d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1857d91e8eeeSRaja Mani arp_pattern, arp_mask); 1858d91e8eeeSRaja Mani if (ret) { 1859d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1860d91e8eeeSRaja Mani return ret; 1861d91e8eeeSRaja Mani } 1862d91e8eeeSRaja Mani 1863d91e8eeeSRaja Mani /* 1864d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1865d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1866d91e8eeeSRaja Mani */ 1867d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1868d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1869d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1870d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1871d91e8eeeSRaja Mani if (ret) { 1872d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1873d91e8eeeSRaja Mani return ret; 1874d91e8eeeSRaja Mani } 1875d91e8eeeSRaja Mani 1876d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1877d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1878d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1879d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1880d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1881d91e8eeeSRaja Mani if (ret) { 1882d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1883d91e8eeeSRaja Mani return ret; 1884d91e8eeeSRaja Mani } 1885d91e8eeeSRaja Mani 1886d91e8eeeSRaja Mani return 0; 1887d91e8eeeSRaja Mani } 1888d91e8eeeSRaja Mani 1889d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1890d91e8eeeSRaja Mani { 1891d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1892d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1893d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1894d91e8eeeSRaja Mani u8 discvr_offset = 38; 1895d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1896d91e8eeeSRaja Mani int ret; 1897d91e8eeeSRaja Mani 1898d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1899d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1900d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1901d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1902d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1903d91e8eeeSRaja Mani mac_mask); 1904d91e8eeeSRaja Mani if (ret) { 1905d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1906d91e8eeeSRaja Mani return ret; 1907d91e8eeeSRaja Mani } 1908d91e8eeeSRaja Mani 1909d91e8eeeSRaja Mani /* 1910d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1911d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1912d91e8eeeSRaja Mani */ 1913d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1914d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1915d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1916d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1917d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1918d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1919d91e8eeeSRaja Mani if (ret) { 1920d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1921d91e8eeeSRaja Mani "pattern\n"); 1922d91e8eeeSRaja Mani return ret; 1923d91e8eeeSRaja Mani } 1924d91e8eeeSRaja Mani } 1925d91e8eeeSRaja Mani 1926d91e8eeeSRaja Mani return 0; 1927d91e8eeeSRaja Mani } 1928d91e8eeeSRaja Mani 1929d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1930d91e8eeeSRaja Mani { 1931d91e8eeeSRaja Mani struct in_device *in_dev; 1932d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1933d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1934d91e8eeeSRaja Mani int ret, left; 1935d91e8eeeSRaja Mani u32 filter = 0; 1936ce0dc0cfSRaja Mani u16 i, bmiss_time; 1937d91e8eeeSRaja Mani u8 index = 0; 1938d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1939d91e8eeeSRaja Mani 1940d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1941d91e8eeeSRaja Mani if (!vif) 1942d91e8eeeSRaja Mani return -EIO; 1943d91e8eeeSRaja Mani 1944d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1945d91e8eeeSRaja Mani return -EIO; 1946d91e8eeeSRaja Mani 1947d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19483c411a43SRaja Mani return -ENOTCONN; 1949d91e8eeeSRaja Mani 1950d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 1951d91e8eeeSRaja Mani return -EINVAL; 1952d91e8eeeSRaja Mani 1953d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 1954d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 1955d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 1956d91e8eeeSRaja Mani WOW_LIST_ID, i); 1957d91e8eeeSRaja Mani 1958d91e8eeeSRaja Mani /* 1959d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 1960d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 1961d91e8eeeSRaja Mani * the user. 1962d91e8eeeSRaja Mani */ 1963d91e8eeeSRaja Mani if (wow) 1964d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 1965d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 1966d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 1967d91e8eeeSRaja Mani else 1968d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 1969d91e8eeeSRaja Mani 1970d91e8eeeSRaja Mani if (ret) 1971d91e8eeeSRaja Mani return ret; 1972d91e8eeeSRaja Mani 1973390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 1974390a8c8fSRaja Mani 1975ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 1976ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 1977ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 1978ce0dc0cfSRaja Mani 0); 1979ce0dc0cfSRaja Mani if (ret) 1980ce0dc0cfSRaja Mani return ret; 1981ce0dc0cfSRaja Mani 1982ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 1983ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 1984ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 1985ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 1986ce0dc0cfSRaja Mani 1987ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 1988ce0dc0cfSRaja Mani bmiss_time, 0); 1989ce0dc0cfSRaja Mani if (ret) 1990ce0dc0cfSRaja Mani return ret; 1991ce0dc0cfSRaja Mani 1992ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 1993ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 1994ce0dc0cfSRaja Mani 0, 0, 0, 0); 1995ce0dc0cfSRaja Mani if (ret) 1996ce0dc0cfSRaja Mani return ret; 1997ce0dc0cfSRaja Mani } 1998ce0dc0cfSRaja Mani 1999390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2000390a8c8fSRaja Mani 2001c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2002c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2003c08631c6SRaja Mani if (!in_dev) 2004c08631c6SRaja Mani goto skip_arp; 2005c08631c6SRaja Mani 2006c08631c6SRaja Mani ifa = in_dev->ifa_list; 2007c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2008c08631c6SRaja Mani 2009c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2010c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2011c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2012c08631c6SRaja Mani ifa = ifa->ifa_next; 2013c08631c6SRaja Mani index++; 2014c08631c6SRaja Mani } 2015c08631c6SRaja Mani 2016c08631c6SRaja Mani if (ifa) { 2017c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2018c08631c6SRaja Mani return -EINVAL; 2019c08631c6SRaja Mani } 2020c08631c6SRaja Mani 2021c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2022c08631c6SRaja Mani if (ret) { 2023c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2024c08631c6SRaja Mani return ret; 2025c08631c6SRaja Mani } 2026c08631c6SRaja Mani 2027c08631c6SRaja Mani skip_arp: 20286cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20296cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20306cb3c714SRaja Mani filter, 20316cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20326cb3c714SRaja Mani if (ret) 20336cb3c714SRaja Mani return ret; 20346cb3c714SRaja Mani 2035081c7a84SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2036081c7a84SRaja Mani 20376cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20386cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 20396cb3c714SRaja Mani if (ret) 20406cb3c714SRaja Mani return ret; 20416cb3c714SRaja Mani 2042081c7a84SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2043081c7a84SRaja Mani test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags), 2044081c7a84SRaja Mani WMI_TIMEOUT); 2045081c7a84SRaja Mani if (left == 0) { 2046081c7a84SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd " 2047081c7a84SRaja Mani "processed event\n"); 2048081c7a84SRaja Mani ret = -ETIMEDOUT; 2049081c7a84SRaja Mani } else if (left < 0) { 2050081c7a84SRaja Mani ath6kl_warn("error while waiting for host sleep cmd " 2051081c7a84SRaja Mani "processed event %d\n", left); 2052081c7a84SRaja Mani ret = left; 2053081c7a84SRaja Mani } 2054081c7a84SRaja Mani 20556cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 20566cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 20576cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 20586cb3c714SRaja Mani if (left == 0) { 20596cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 20606cb3c714SRaja Mani ret = -ETIMEDOUT; 20616cb3c714SRaja Mani } else if (left < 0) { 20626cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 20636cb3c714SRaja Mani ret = left; 20646cb3c714SRaja Mani } 20656cb3c714SRaja Mani } 20666cb3c714SRaja Mani 20676cb3c714SRaja Mani return ret; 20686cb3c714SRaja Mani } 20696cb3c714SRaja Mani 20706cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20716cb3c714SRaja Mani { 20726cb3c714SRaja Mani struct ath6kl_vif *vif; 20736cb3c714SRaja Mani int ret; 20746cb3c714SRaja Mani 20756cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20766cb3c714SRaja Mani if (!vif) 20776cb3c714SRaja Mani return -EIO; 20786cb3c714SRaja Mani 2079390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2080390a8c8fSRaja Mani 20816cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20826cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2083390a8c8fSRaja Mani if (ret) { 2084390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2085390a8c8fSRaja Mani "wow resume: %d\n", ret); 2086390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 20876cb3c714SRaja Mani return ret; 20886cb3c714SRaja Mani } 20896cb3c714SRaja Mani 2090ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2091ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2092ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2093ce0dc0cfSRaja Mani if (ret) 2094ce0dc0cfSRaja Mani return ret; 2095ce0dc0cfSRaja Mani 2096ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2097ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2098ce0dc0cfSRaja Mani if (ret) 2099ce0dc0cfSRaja Mani return ret; 2100ce0dc0cfSRaja Mani 2101ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2102ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2103ce0dc0cfSRaja Mani if (ret) 2104ce0dc0cfSRaja Mani return ret; 2105ce0dc0cfSRaja Mani } 2106ce0dc0cfSRaja Mani 2107390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2108390a8c8fSRaja Mani 2109390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2110390a8c8fSRaja Mani 2111390a8c8fSRaja Mani return 0; 2112390a8c8fSRaja Mani } 2113390a8c8fSRaja Mani 211452d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 21150f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 21160f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 211752d81a68SKalle Valo { 2118390a8c8fSRaja Mani enum ath6kl_state prev_state; 211952d81a68SKalle Valo int ret; 212052d81a68SKalle Valo 212152d81a68SKalle Valo switch (mode) { 2122d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2123d7c44e0bSRaja Mani 2124d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2125d7c44e0bSRaja Mani 2126d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2127d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2128d7c44e0bSRaja Mani 2129390a8c8fSRaja Mani prev_state = ar->state; 2130390a8c8fSRaja Mani 2131d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2132390a8c8fSRaja Mani if (ret) { 2133390a8c8fSRaja Mani ar->state = prev_state; 2134d7c44e0bSRaja Mani return ret; 2135390a8c8fSRaja Mani } 21361e9a905dSRaja Mani 2137d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2138d7c44e0bSRaja Mani break; 2139d7c44e0bSRaja Mani 214052d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2141524441e3SRaja Mani 21427125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2143524441e3SRaja Mani 214452d81a68SKalle Valo /* save the current power mode before enabling power save */ 214552d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 214652d81a68SKalle Valo 214752d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 214852d81a68SKalle Valo if (ret) { 214952d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 215052d81a68SKalle Valo ret); 215152d81a68SKalle Valo } 215252d81a68SKalle Valo 215376a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 215476a9fbe2SKalle Valo 215552d81a68SKalle Valo break; 2156b4b2a0b1SKalle Valo 2157b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2158524441e3SRaja Mani 21597125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2160524441e3SRaja Mani 2161b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2162b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2163b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2164b4b2a0b1SKalle Valo break; 2165b4b2a0b1SKalle Valo } 2166b4b2a0b1SKalle Valo 2167b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2168b4b2a0b1SKalle Valo 2169b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2170b4b2a0b1SKalle Valo if (ret) { 2171b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2172b4b2a0b1SKalle Valo ret); 2173b4b2a0b1SKalle Valo } 2174b4b2a0b1SKalle Valo 2175b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2176b4b2a0b1SKalle Valo 2177b4b2a0b1SKalle Valo break; 2178b4b2a0b1SKalle Valo 217910509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 218010509f90SKalle Valo /* 218110509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 218210509f90SKalle Valo * wow mode and sleeping most of the time. 218310509f90SKalle Valo */ 218410509f90SKalle Valo break; 218510509f90SKalle Valo 2186b4b2a0b1SKalle Valo default: 2187b4b2a0b1SKalle Valo break; 218852d81a68SKalle Valo } 218952d81a68SKalle Valo 219052d81a68SKalle Valo return 0; 219152d81a68SKalle Valo } 2192d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 219352d81a68SKalle Valo 219452d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 219552d81a68SKalle Valo { 219676a9fbe2SKalle Valo int ret; 219776a9fbe2SKalle Valo 219876a9fbe2SKalle Valo switch (ar->state) { 2199d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2200d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2201d7c44e0bSRaja Mani 2202d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2203d7c44e0bSRaja Mani if (ret) { 2204d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2205d7c44e0bSRaja Mani return ret; 2206d7c44e0bSRaja Mani } 2207d7c44e0bSRaja Mani 2208d7c44e0bSRaja Mani break; 2209d7c44e0bSRaja Mani 221076a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 221152d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 221276a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 221376a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 221476a9fbe2SKalle Valo if (ret) { 221576a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 221676a9fbe2SKalle Valo ret); 221776a9fbe2SKalle Valo } 221876a9fbe2SKalle Valo } 221976a9fbe2SKalle Valo 222076a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 222176a9fbe2SKalle Valo 222276a9fbe2SKalle Valo break; 222376a9fbe2SKalle Valo 2224b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2225b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2226b4b2a0b1SKalle Valo 2227b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2228b4b2a0b1SKalle Valo if (ret) { 2229b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2230b4b2a0b1SKalle Valo return ret; 2231b4b2a0b1SKalle Valo } 2232d7c44e0bSRaja Mani break; 2233b4b2a0b1SKalle Valo 223410509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 223510509f90SKalle Valo break; 223610509f90SKalle Valo 223776a9fbe2SKalle Valo default: 223876a9fbe2SKalle Valo break; 223952d81a68SKalle Valo } 224052d81a68SKalle Valo 224152d81a68SKalle Valo return 0; 224252d81a68SKalle Valo } 2243d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 224452d81a68SKalle Valo 2245abcb344bSKalle Valo #ifdef CONFIG_PM 224652d81a68SKalle Valo 224752d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 224852d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2249abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2250abcb344bSKalle Valo { 2251abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2252abcb344bSKalle Valo 22530f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2254abcb344bSKalle Valo } 2255aa6cffc1SChilam Ng 225652d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2257aa6cffc1SChilam Ng { 2258aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2259aa6cffc1SChilam Ng 2260aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2261aa6cffc1SChilam Ng } 2262a918fb3cSRaja Mani 2263a918fb3cSRaja Mani /* 2264a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2265a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2266a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2267a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2268a918fb3cSRaja Mani * 2269a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2270a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2271a918fb3cSRaja Mani * 2272a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2273a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2274a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2275a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2276a918fb3cSRaja Mani * 2277a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2278a918fb3cSRaja Mani */ 2279a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2280a918fb3cSRaja Mani { 2281390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2282390a8c8fSRaja Mani return; 2283390a8c8fSRaja Mani 2284a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2285a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2286a918fb3cSRaja Mani } 2287a918fb3cSRaja Mani 2288a918fb3cSRaja Mani #else 2289a918fb3cSRaja Mani 2290a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2291a918fb3cSRaja Mani { 2292a918fb3cSRaja Mani } 2293abcb344bSKalle Valo #endif 2294abcb344bSKalle Valo 22956a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 22966a7c9badSJouni Malinen struct ieee80211_channel *chan, 22976a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 22986a7c9badSJouni Malinen { 2299e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2300e68f6750SSujith Manoharan 2301e68f6750SSujith Manoharan /* 2302e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2303e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2304e68f6750SSujith Manoharan * 2305e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2306e68f6750SSujith Manoharan */ 2307e68f6750SSujith Manoharan if (!dev) 2308e68f6750SSujith Manoharan return -EBUSY; 2309e68f6750SSujith Manoharan 2310e68f6750SSujith Manoharan vif = netdev_priv(dev); 23116a7c9badSJouni Malinen 2312990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23136a7c9badSJouni Malinen return -EIO; 23146a7c9badSJouni Malinen 23156a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 23166a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2317cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 23186a7c9badSJouni Malinen 23196a7c9badSJouni Malinen return 0; 23206a7c9badSJouni Malinen } 23216a7c9badSJouni Malinen 23228bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 23238bdfbf40SJouni Malinen { 23248bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 23258bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 23268bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 23278bdfbf40SJouni Malinen } 23288bdfbf40SJouni Malinen 2329334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2330334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 23318bdfbf40SJouni Malinen { 2332334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23338bdfbf40SJouni Malinen const u8 *pos; 23348bdfbf40SJouni Malinen u8 *buf = NULL; 23358bdfbf40SJouni Malinen size_t len = 0; 23368bdfbf40SJouni Malinen int ret; 23378bdfbf40SJouni Malinen 23388bdfbf40SJouni Malinen /* 23398bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 23408bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 23418bdfbf40SJouni Malinen */ 23428bdfbf40SJouni Malinen 23438bdfbf40SJouni Malinen if (ies && ies_len) { 23448bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 23458bdfbf40SJouni Malinen if (buf == NULL) 23468bdfbf40SJouni Malinen return -ENOMEM; 23478bdfbf40SJouni Malinen pos = ies; 23488bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 23498bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 23508bdfbf40SJouni Malinen break; 23518bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 23528bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 23538bdfbf40SJouni Malinen len += 2 + pos[1]; 23548bdfbf40SJouni Malinen } 23558bdfbf40SJouni Malinen pos += 2 + pos[1]; 23568bdfbf40SJouni Malinen } 23578bdfbf40SJouni Malinen } 23588bdfbf40SJouni Malinen 2359334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2360334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 23618bdfbf40SJouni Malinen kfree(buf); 23628bdfbf40SJouni Malinen return ret; 23638bdfbf40SJouni Malinen } 23648bdfbf40SJouni Malinen 23658860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 23668860020eSJohannes Berg struct cfg80211_beacon_data *info) 23678860020eSJohannes Berg { 23688860020eSJohannes Berg struct ath6kl *ar = vif->ar; 23698860020eSJohannes Berg int res; 23708860020eSJohannes Berg 237117a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23728860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23738860020eSJohannes Berg WMI_FRAME_BEACON, 23748860020eSJohannes Berg info->beacon_ies, 23758860020eSJohannes Berg info->beacon_ies_len); 23768860020eSJohannes Berg if (res) 23778860020eSJohannes Berg return res; 23788860020eSJohannes Berg 237917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23808860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 23818860020eSJohannes Berg info->proberesp_ies_len); 23828860020eSJohannes Berg if (res) 23838860020eSJohannes Berg return res; 23848860020eSJohannes Berg 238517a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23868860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23878860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 23888860020eSJohannes Berg info->assocresp_ies, 23898860020eSJohannes Berg info->assocresp_ies_len); 23908860020eSJohannes Berg if (res) 23918860020eSJohannes Berg return res; 23928860020eSJohannes Berg 23938860020eSJohannes Berg return 0; 23948860020eSJohannes Berg } 23958860020eSJohannes Berg 23968860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 23978860020eSJohannes Berg struct cfg80211_ap_settings *info) 23986a7c9badSJouni Malinen { 23996a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 24003450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24016a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 240267cd22e4SThomas Pedersen bool hidden = false; 24036a7c9badSJouni Malinen u8 *ies; 24046a7c9badSJouni Malinen int ies_len; 24056a7c9badSJouni Malinen struct wmi_connect_cmd p; 24066a7c9badSJouni Malinen int res; 2407be5abaafSVasanthakumar Thiagarajan int i, ret; 24086a7c9badSJouni Malinen 24098860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 24106a7c9badSJouni Malinen 2411990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24126a7c9badSJouni Malinen return -EIO; 24136a7c9badSJouni Malinen 2414f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 24156a7c9badSJouni Malinen return -EOPNOTSUPP; 24166a7c9badSJouni Malinen 24178860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 24186a7c9badSJouni Malinen 24199a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 24209a5b1318SJouni Malinen 24216a7c9badSJouni Malinen /* TODO: 24226a7c9badSJouni Malinen * info->interval 24236a7c9badSJouni Malinen * info->dtim_period 24246a7c9badSJouni Malinen */ 24256a7c9badSJouni Malinen 24268860020eSJohannes Berg if (info->beacon.head == NULL) 24276a7c9badSJouni Malinen return -EINVAL; 24288860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 24296a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 24308860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 24316a7c9badSJouni Malinen return -EINVAL; 24328860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 24336a7c9badSJouni Malinen 24346a7c9badSJouni Malinen if (info->ssid == NULL) 24356a7c9badSJouni Malinen return -EINVAL; 24363450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 24373450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 24386a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 243967cd22e4SThomas Pedersen hidden = true; 244067cd22e4SThomas Pedersen 244167cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 244267cd22e4SThomas Pedersen if (res) 244367cd22e4SThomas Pedersen return res; 24446a7c9badSJouni Malinen 2445be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2446be5abaafSVasanthakumar Thiagarajan if (ret) 2447be5abaafSVasanthakumar Thiagarajan return ret; 24486a7c9badSJouni Malinen 24496a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 24506a7c9badSJouni Malinen 24516a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 24526a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 24536a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 24546a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24556a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 24566a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24576a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 24586a7c9badSJouni Malinen break; 24596a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 24606a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24616a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 24626a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24636a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 24646a7c9badSJouni Malinen break; 24656a7c9badSJouni Malinen } 24666a7c9badSJouni Malinen } 24676a7c9badSJouni Malinen if (p.auth_mode == 0) 24686a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 24693450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 24706a7c9badSJouni Malinen 24716a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 24726a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 24736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24746a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24756a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 24766a7c9badSJouni Malinen break; 24776a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24786a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 24796a7c9badSJouni Malinen break; 24806a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24816a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 24826a7c9badSJouni Malinen break; 2483b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2484b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2485b8214df1SDai Shuibing break; 24866a7c9badSJouni Malinen } 24876a7c9badSJouni Malinen } 2488229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 24896a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2490240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2491229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2492240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 24936a7c9badSJouni Malinen 24946a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 24956a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24966a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24976a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 24986a7c9badSJouni Malinen break; 24996a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25006a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 25016a7c9badSJouni Malinen break; 25026a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25036a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 25046a7c9badSJouni Malinen break; 2505b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2506b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2507b8214df1SDai Shuibing break; 25086a7c9badSJouni Malinen default: 25096a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 25106a7c9badSJouni Malinen break; 25116a7c9badSJouni Malinen } 2512240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 25136a7c9badSJouni Malinen 25146a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2515f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 25166a7c9badSJouni Malinen 25173450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 25183450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 25193450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2520cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 25216a7c9badSJouni Malinen 2522c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2523c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2524c1762a3fSThirumalai Pachamuthu if (res < 0) 2525c1762a3fSThirumalai Pachamuthu return res; 2526c1762a3fSThirumalai Pachamuthu 25273ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 25283ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 25293ca9d1fcSAarthi Thiruvengadam } else { 25303ca9d1fcSAarthi Thiruvengadam /* 25313ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 25323ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 25333ca9d1fcSAarthi Thiruvengadam */ 25343ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 25353ca9d1fcSAarthi Thiruvengadam } 25363ca9d1fcSAarthi Thiruvengadam 2537334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 25389a5b1318SJouni Malinen if (res < 0) 25399a5b1318SJouni Malinen return res; 25409a5b1318SJouni Malinen 25419a5b1318SJouni Malinen return 0; 25426a7c9badSJouni Malinen } 25436a7c9badSJouni Malinen 25448860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 25458860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 25466a7c9badSJouni Malinen { 25478860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 25488860020eSJohannes Berg 25498860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 25508860020eSJohannes Berg return -EIO; 25518860020eSJohannes Berg 25528860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 25538860020eSJohannes Berg return -EOPNOTSUPP; 25548860020eSJohannes Berg 25558860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 25566a7c9badSJouni Malinen } 25576a7c9badSJouni Malinen 25588860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 25596a7c9badSJouni Malinen { 25606a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 256159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25626a7c9badSJouni Malinen 2563f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 25646a7c9badSJouni Malinen return -EOPNOTSUPP; 256559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 25666a7c9badSJouni Malinen return -ENOTCONN; 25676a7c9badSJouni Malinen 2568334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 256959c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 25706a7c9badSJouni Malinen 25716a7c9badSJouni Malinen return 0; 25726a7c9badSJouni Malinen } 25736a7c9badSJouni Malinen 257433e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 257533e5308dSJouni Malinen 257633e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 257733e5308dSJouni Malinen u8 *mac) 257833e5308dSJouni Malinen { 257933e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 258033e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 258133e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 258233e5308dSJouni Malinen 258333e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 258433e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 258533e5308dSJouni Malinen } 258633e5308dSJouni Malinen 258723875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 258823875136SJouni Malinen u8 *mac, struct station_parameters *params) 258923875136SJouni Malinen { 259023875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2591f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 259223875136SJouni Malinen 2593f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 259423875136SJouni Malinen return -EOPNOTSUPP; 259523875136SJouni Malinen 259623875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 259723875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 259823875136SJouni Malinen return -EOPNOTSUPP; 259923875136SJouni Malinen 260023875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2601334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2602334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2603334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2604334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 260523875136SJouni Malinen } 260623875136SJouni Malinen 260763fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 260863fa1e0cSJouni Malinen struct net_device *dev, 260963fa1e0cSJouni Malinen struct ieee80211_channel *chan, 261063fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 261163fa1e0cSJouni Malinen unsigned int duration, 261263fa1e0cSJouni Malinen u64 *cookie) 261363fa1e0cSJouni Malinen { 261463fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2615334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26161052261eSJouni Malinen u32 id; 261763fa1e0cSJouni Malinen 261863fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 261963fa1e0cSJouni Malinen * return -EBUSY */ 26201052261eSJouni Malinen id = ++vif->last_roc_id; 26211052261eSJouni Malinen if (id == 0) { 26221052261eSJouni Malinen /* Do not use 0 as the cookie value */ 26231052261eSJouni Malinen id = ++vif->last_roc_id; 26241052261eSJouni Malinen } 26251052261eSJouni Malinen *cookie = id; 262663fa1e0cSJouni Malinen 2627334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2628334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 262963fa1e0cSJouni Malinen } 263063fa1e0cSJouni Malinen 263163fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 263263fa1e0cSJouni Malinen struct net_device *dev, 263363fa1e0cSJouni Malinen u64 cookie) 263463fa1e0cSJouni Malinen { 263563fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2636334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 263763fa1e0cSJouni Malinen 26381052261eSJouni Malinen if (cookie != vif->last_roc_id) 263963fa1e0cSJouni Malinen return -ENOENT; 26401052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 264163fa1e0cSJouni Malinen 2642334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 264363fa1e0cSJouni Malinen } 264463fa1e0cSJouni Malinen 2645334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2646334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2647334234b5SVasanthakumar Thiagarajan unsigned int freq) 26488bdfbf40SJouni Malinen { 2649334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26508bdfbf40SJouni Malinen const u8 *pos; 26518bdfbf40SJouni Malinen u8 *p2p; 26528bdfbf40SJouni Malinen int p2p_len; 26538bdfbf40SJouni Malinen int ret; 26548bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 26558bdfbf40SJouni Malinen 26568bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 26578bdfbf40SJouni Malinen 26588bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 26598bdfbf40SJouni Malinen 26608bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 26618bdfbf40SJouni Malinen if (p2p == NULL) 26628bdfbf40SJouni Malinen return -ENOMEM; 26638bdfbf40SJouni Malinen p2p_len = 0; 26648bdfbf40SJouni Malinen 26658bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 26668bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 26678bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 26688bdfbf40SJouni Malinen break; 26698bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 26708bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 26718bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 26728bdfbf40SJouni Malinen } 26738bdfbf40SJouni Malinen pos += 2 + pos[1]; 26748bdfbf40SJouni Malinen } 26758bdfbf40SJouni Malinen 2676334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2677334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 26788bdfbf40SJouni Malinen kfree(p2p); 26798bdfbf40SJouni Malinen return ret; 26808bdfbf40SJouni Malinen } 26818bdfbf40SJouni Malinen 2682d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2683d0ff7383SNaveen Gangadharan u32 id, 2684d0ff7383SNaveen Gangadharan u32 freq, 2685d0ff7383SNaveen Gangadharan u32 wait, 2686d0ff7383SNaveen Gangadharan const u8 *buf, 2687d0ff7383SNaveen Gangadharan size_t len, 2688d0ff7383SNaveen Gangadharan bool *more_data, 2689d0ff7383SNaveen Gangadharan bool no_cck) 2690d0ff7383SNaveen Gangadharan { 2691d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2692d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2693d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2694d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2695d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2696d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2697d0ff7383SNaveen Gangadharan 2698d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2699d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2700d0ff7383SNaveen Gangadharan return false; 2701d0ff7383SNaveen Gangadharan 2702d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2703d0ff7383SNaveen Gangadharan if (!conn) 2704d0ff7383SNaveen Gangadharan return false; 2705d0ff7383SNaveen Gangadharan 2706d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2707d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2708d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2709d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2710d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2711d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2712d0ff7383SNaveen Gangadharan return false; 2713d0ff7383SNaveen Gangadharan 2714d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2715d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2716d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2717d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2718d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2719d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2720d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2721d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2722d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2723d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2724d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2725d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2726d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2727d0ff7383SNaveen Gangadharan 2728d0ff7383SNaveen Gangadharan /* 2729d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2730d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2731d0ff7383SNaveen Gangadharan * STA. 2732d0ff7383SNaveen Gangadharan */ 2733d0ff7383SNaveen Gangadharan if (is_psq_empty) 2734d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2735d0ff7383SNaveen Gangadharan conn->aid, 1); 2736d0ff7383SNaveen Gangadharan return true; 2737d0ff7383SNaveen Gangadharan } 2738d0ff7383SNaveen Gangadharan 2739d0ff7383SNaveen Gangadharan /* 2740d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2741d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2742d0ff7383SNaveen Gangadharan */ 2743d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2744d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2745d0ff7383SNaveen Gangadharan *more_data = true; 2746d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2747d0ff7383SNaveen Gangadharan } 2748d0ff7383SNaveen Gangadharan 2749d0ff7383SNaveen Gangadharan return false; 2750d0ff7383SNaveen Gangadharan } 2751d0ff7383SNaveen Gangadharan 27528a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 27538a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 27548a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 27558a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2756e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2757e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 27588a6c8060SJouni Malinen { 27598a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 276059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27618a6c8060SJouni Malinen u32 id; 27628bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2763d0ff7383SNaveen Gangadharan bool more_data, queued; 27648bdfbf40SJouni Malinen 27658bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27668bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2767f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 27688bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 27698bdfbf40SJouni Malinen /* 27708bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 27718bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 27728bdfbf40SJouni Malinen */ 27738bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2774334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 27758bdfbf40SJouni Malinen chan->center_freq); 27768bdfbf40SJouni Malinen } 27778a6c8060SJouni Malinen 2778cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27798a6c8060SJouni Malinen if (id == 0) { 27808a6c8060SJouni Malinen /* 27818a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 27828a6c8060SJouni Malinen * used for the command. 27838a6c8060SJouni Malinen */ 2784cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27858a6c8060SJouni Malinen } 27868a6c8060SJouni Malinen 27878a6c8060SJouni Malinen *cookie = id; 27883ca9d1fcSAarthi Thiruvengadam 2789d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2790d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2791d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2792d0ff7383SNaveen Gangadharan id, chan->center_freq, 2793d0ff7383SNaveen Gangadharan wait, buf, 2794d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2795d0ff7383SNaveen Gangadharan if (queued) 2796d0ff7383SNaveen Gangadharan return 0; 2797d0ff7383SNaveen Gangadharan } 2798d0ff7383SNaveen Gangadharan 27993ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 28003ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 28013ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 28023ca9d1fcSAarthi Thiruvengadam } 28038a6c8060SJouni Malinen 2804ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2805ae32c30aSJouni Malinen struct net_device *dev, 2806ae32c30aSJouni Malinen u16 frame_type, bool reg) 2807ae32c30aSJouni Malinen { 2808cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2809ae32c30aSJouni Malinen 2810ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2811ae32c30aSJouni Malinen __func__, frame_type, reg); 2812ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2813ae32c30aSJouni Malinen /* 2814ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2815ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2816ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2817ae32c30aSJouni Malinen */ 2818cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2819ae32c30aSJouni Malinen } 2820ae32c30aSJouni Malinen } 2821ae32c30aSJouni Malinen 282210509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 282310509f90SKalle Valo struct net_device *dev, 282410509f90SKalle Valo struct cfg80211_sched_scan_request *request) 282510509f90SKalle Valo { 282610509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 282710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 282810509f90SKalle Valo u16 interval; 282910509f90SKalle Valo int ret; 283010509f90SKalle Valo u8 i; 283110509f90SKalle Valo 283210509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 283310509f90SKalle Valo return -EIO; 283410509f90SKalle Valo 283510509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 283610509f90SKalle Valo return -EBUSY; 283710509f90SKalle Valo 283810509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 283910509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 284010509f90SKalle Valo i, DISABLE_SSID_FLAG, 284110509f90SKalle Valo 0, NULL); 284210509f90SKalle Valo } 284310509f90SKalle Valo 284410509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 284510509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 284610509f90SKalle Valo 284710509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 284810509f90SKalle Valo interval, interval, 284910509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 285010509f90SKalle Valo 285110509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 285210509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 285310509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 285410509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 285510509f90SKalle Valo request->ssids[i].ssid_len, 285610509f90SKalle Valo request->ssids[i].ssid); 285710509f90SKalle Valo } 285810509f90SKalle Valo } 285910509f90SKalle Valo 286010509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 286110509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 286210509f90SKalle Valo WOW_FILTER_SSID, 286310509f90SKalle Valo WOW_HOST_REQ_DELAY); 286410509f90SKalle Valo if (ret) { 286510509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 286610509f90SKalle Valo return ret; 286710509f90SKalle Valo } 286810509f90SKalle Valo 286910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 287010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 287110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 287210509f90SKalle Valo request->ie, request->ie_len); 287310509f90SKalle Valo if (ret) { 287410509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 287510509f90SKalle Valo ret); 287610509f90SKalle Valo return ret; 287710509f90SKalle Valo } 287810509f90SKalle Valo 287910509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 288010509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 288110509f90SKalle Valo if (ret) { 288210509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 288310509f90SKalle Valo ret); 288410509f90SKalle Valo return ret; 288510509f90SKalle Valo } 288610509f90SKalle Valo 288710509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 288810509f90SKalle Valo 288910509f90SKalle Valo return ret; 289010509f90SKalle Valo } 289110509f90SKalle Valo 289210509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 289310509f90SKalle Valo struct net_device *dev) 289410509f90SKalle Valo { 289510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 289610509f90SKalle Valo bool stopped; 289710509f90SKalle Valo 289810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 289910509f90SKalle Valo 290010509f90SKalle Valo if (!stopped) 290110509f90SKalle Valo return -EIO; 290210509f90SKalle Valo 290310509f90SKalle Valo return 0; 290410509f90SKalle Valo } 290510509f90SKalle Valo 2906f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2907f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2908f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2909f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2910f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2911f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2912f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2913f80574aeSJouni Malinen }, 2914ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2915ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2916ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2917ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2918ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2919ba1f6fe3SJouni Malinen }, 2920f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2921f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2922f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2923f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2924f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2925f80574aeSJouni Malinen }, 2926f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2927f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2928f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2929f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2930f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2931f80574aeSJouni Malinen }, 2932f80574aeSJouni Malinen }; 2933f80574aeSJouni Malinen 2934bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 293555055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 293655055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2937bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2938bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2939bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2940bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2941bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2942bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2943bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2944bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2945bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2946bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2947bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2948bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2949bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2950bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2951bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2952bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2953bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2954bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2955003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2956abcb344bSKalle Valo #ifdef CONFIG_PM 295752d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 295852d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2959abcb344bSKalle Valo #endif 29606a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 29618860020eSJohannes Berg .start_ap = ath6kl_start_ap, 29628860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 29638860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 296433e5308dSJouni Malinen .del_station = ath6kl_del_station, 296523875136SJouni Malinen .change_station = ath6kl_change_station, 296663fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 296763fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 29688a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2969ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 297010509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 297110509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2972bdcd8170SKalle Valo }; 2973bdcd8170SKalle Valo 29747125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2975ec4b7f60SKalle Valo { 297610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 297710509f90SKalle Valo 2978ec4b7f60SKalle Valo switch (vif->sme_state) { 2979c97a31b0SKalle Valo case SME_DISCONNECTED: 2980c97a31b0SKalle Valo break; 2981ec4b7f60SKalle Valo case SME_CONNECTING: 2982ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2983ec4b7f60SKalle Valo NULL, 0, 2984ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2985ec4b7f60SKalle Valo GFP_KERNEL); 2986ec4b7f60SKalle Valo break; 2987ec4b7f60SKalle Valo case SME_CONNECTED: 2988ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2989ec4b7f60SKalle Valo break; 2990ec4b7f60SKalle Valo } 2991ec4b7f60SKalle Valo 2992ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2993ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 29947125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2995ec4b7f60SKalle Valo 2996ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 29971f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 29981f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2999ec4b7f60SKalle Valo 3000ec4b7f60SKalle Valo /* disable scanning */ 30017125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 30027125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 30037125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3004ec4b7f60SKalle Valo 3005ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3006ec4b7f60SKalle Valo } 3007ec4b7f60SKalle Valo 30087125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 30097125f01dSKalle Valo { 30107125f01dSKalle Valo struct ath6kl_vif *vif; 30117125f01dSKalle Valo 30127125f01dSKalle Valo vif = ath6kl_vif_first(ar); 30137125f01dSKalle Valo if (!vif) { 30147125f01dSKalle Valo /* save the current power mode before enabling power save */ 30157125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 30167125f01dSKalle Valo 30177125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 30187125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 30197125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 30207125f01dSKalle Valo return; 30217125f01dSKalle Valo } 30227125f01dSKalle Valo 30237125f01dSKalle Valo /* 30247125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 30257125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 30267125f01dSKalle Valo * sleeps. 30277125f01dSKalle Valo */ 30287125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 30297125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 30307125f01dSKalle Valo } 30317125f01dSKalle Valo 3032c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 30338dafb70eSVasanthakumar Thiagarajan { 30347baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 30352132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 30368dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 30378dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 30388dafb70eSVasanthakumar Thiagarajan } 30398dafb70eSVasanthakumar Thiagarajan 3040de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3041108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 304210509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 304310509f90SKalle Valo (unsigned long) vif); 304410509f90SKalle Valo 3045de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3046478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 30478dafb70eSVasanthakumar Thiagarajan 304880abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 304980abaf9bSVasanthakumar Thiagarajan 30508dafb70eSVasanthakumar Thiagarajan return 0; 30518dafb70eSVasanthakumar Thiagarajan } 30528dafb70eSVasanthakumar Thiagarajan 3053c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 30548dafb70eSVasanthakumar Thiagarajan { 305555055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 305680abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 305755055976SVasanthakumar Thiagarajan 30582132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3059108438bcSVasanthakumar Thiagarajan 306055055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 306155055976SVasanthakumar Thiagarajan 306255055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 306355055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 306455055976SVasanthakumar Thiagarajan 306580abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 306680abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 306780abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 306880abaf9bSVasanthakumar Thiagarajan } 306980abaf9bSVasanthakumar Thiagarajan 307027929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 307155055976SVasanthakumar Thiagarajan 307255055976SVasanthakumar Thiagarajan ar->num_vif--; 30738dafb70eSVasanthakumar Thiagarajan } 30748dafb70eSVasanthakumar Thiagarajan 30758dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 307655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 307755055976SVasanthakumar Thiagarajan u8 nw_type) 30788dafb70eSVasanthakumar Thiagarajan { 30798dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3080108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 30818dafb70eSVasanthakumar Thiagarajan 308255055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 30838dafb70eSVasanthakumar Thiagarajan if (!ndev) 30848dafb70eSVasanthakumar Thiagarajan return NULL; 30858dafb70eSVasanthakumar Thiagarajan 3086108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3087108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3088108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3089108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3090108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3091108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3092108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3093108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3094334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3095d0d670abSKalle Valo vif->nw_type = nw_type; 3096d0d670abSKalle Valo vif->next_mode = nw_type; 30978f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3098ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 30998dafb70eSVasanthakumar Thiagarajan 310055055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 310155055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 310255055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 310355055976SVasanthakumar Thiagarajan 0x2; 310455055976SVasanthakumar Thiagarajan 31058dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 31068dafb70eSVasanthakumar Thiagarajan 3107e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 31088dafb70eSVasanthakumar Thiagarajan 3109c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 31108dafb70eSVasanthakumar Thiagarajan goto err; 31118dafb70eSVasanthakumar Thiagarajan 311227929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 31138dafb70eSVasanthakumar Thiagarajan goto err; 31148dafb70eSVasanthakumar Thiagarajan 311555055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 311614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 311759c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 31188dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 311959c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 31208dafb70eSVasanthakumar Thiagarajan 312155055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 312255055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 312355055976SVasanthakumar Thiagarajan 312411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3125990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 312611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3127990bd915SVasanthakumar Thiagarajan 31288dafb70eSVasanthakumar Thiagarajan return ndev; 31298dafb70eSVasanthakumar Thiagarajan 31308dafb70eSVasanthakumar Thiagarajan err: 313127929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 313227929723SVasanthakumar Thiagarajan free_netdev(ndev); 3133bdcd8170SKalle Valo return NULL; 3134bdcd8170SKalle Valo } 3135bdcd8170SKalle Valo 313646d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 313746d33a21SKalle Valo { 313846d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 313946d33a21SKalle Valo int ret; 314046d33a21SKalle Valo 314146d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 314246d33a21SKalle Valo 314346d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 314446d33a21SKalle Valo 314546d33a21SKalle Valo /* set device pointer for wiphy */ 314646d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 314746d33a21SKalle Valo 314846d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 314946d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 315046d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 315146d33a21SKalle Valo if (ar->p2p) { 315246d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 315346d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 315446d33a21SKalle Valo } 315546d33a21SKalle Valo 315646d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 315746d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 315846d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 315946d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 316046d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 316146d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 316246d33a21SKalle Valo 316346d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 316446d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 316546d33a21SKalle Valo 316646d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 316746d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 316846d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 316946d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 317046d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 317146d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 317246d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 317346d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 317446d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 317546d33a21SKalle Valo 317646d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 317746d33a21SKalle Valo 3178f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3179f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3180f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3181f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3182f2afdac7SVasanthakumar Thiagarajan 3183f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3184f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3185f2afdac7SVasanthakumar Thiagarajan 3186f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3187f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3188f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3189f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3190f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3191f2afdac7SVasanthakumar Thiagarajan 319246d33a21SKalle Valo ret = wiphy_register(wiphy); 319346d33a21SKalle Valo if (ret < 0) { 319446d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 319546d33a21SKalle Valo return ret; 319646d33a21SKalle Valo } 319746d33a21SKalle Valo 3198e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3199e5348a1eSVasanthakumar Thiagarajan 320046d33a21SKalle Valo return 0; 320146d33a21SKalle Valo } 320246d33a21SKalle Valo 320346d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3204bdcd8170SKalle Valo { 3205be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3206e5348a1eSVasanthakumar Thiagarajan 3207e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 320845eaa78fSKalle Valo } 320946d33a21SKalle Valo 321045eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 321145eaa78fSKalle Valo { 321245eaa78fSKalle Valo struct ath6kl *ar; 321345eaa78fSKalle Valo struct wiphy *wiphy; 321445eaa78fSKalle Valo 321545eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 321645eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 321745eaa78fSKalle Valo 321845eaa78fSKalle Valo if (!wiphy) { 321945eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 322045eaa78fSKalle Valo return NULL; 322145eaa78fSKalle Valo } 322245eaa78fSKalle Valo 322345eaa78fSKalle Valo ar = wiphy_priv(wiphy); 322445eaa78fSKalle Valo ar->wiphy = wiphy; 322545eaa78fSKalle Valo 322645eaa78fSKalle Valo return ar; 322745eaa78fSKalle Valo } 322845eaa78fSKalle Valo 322945eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 323045eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 323145eaa78fSKalle Valo { 32321d2a4456SVasanthakumar Thiagarajan int i; 32331d2a4456SVasanthakumar Thiagarajan 32341d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 32351d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 32361d2a4456SVasanthakumar Thiagarajan 3237be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3238bdcd8170SKalle Valo } 323945eaa78fSKalle Valo 3240