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 186eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 19c08631c6SRaja Mani #include <linux/inetdevice.h> 20d6a434d6SKalle Valo #include <linux/export.h> 216eb07cafSPaul Gortmaker 22bdcd8170SKalle Valo #include "core.h" 23bdcd8170SKalle Valo #include "cfg80211.h" 24bdcd8170SKalle Valo #include "debug.h" 25abcb344bSKalle Valo #include "hif-ops.h" 26003353b0SKalle Valo #include "testmode.h" 27bdcd8170SKalle Valo 28bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 29bdcd8170SKalle Valo .bitrate = (_rate), \ 30bdcd8170SKalle Valo .flags = (_flags), \ 31bdcd8170SKalle Valo .hw_value = (_rateid), \ 32bdcd8170SKalle Valo } 33bdcd8170SKalle Valo 34bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 35bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 36bdcd8170SKalle Valo .hw_value = (_channel), \ 37bdcd8170SKalle Valo .center_freq = (_freq), \ 38bdcd8170SKalle Valo .flags = (_flags), \ 39bdcd8170SKalle Valo .max_antenna_gain = 0, \ 40bdcd8170SKalle Valo .max_power = 30, \ 41bdcd8170SKalle Valo } 42bdcd8170SKalle Valo 43bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 44bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 45bdcd8170SKalle Valo .hw_value = (_channel), \ 46bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 47bdcd8170SKalle Valo .flags = (_flags), \ 48bdcd8170SKalle Valo .max_antenna_gain = 0, \ 49bdcd8170SKalle Valo .max_power = 30, \ 50bdcd8170SKalle Valo } 51bdcd8170SKalle Valo 52bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 53bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 54bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 55bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 56bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 57bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 58bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 59bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 60bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 61bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 62bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 63bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 64bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 65bdcd8170SKalle Valo }; 66bdcd8170SKalle Valo 67bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 68bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 69bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 70bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 71bdcd8170SKalle Valo 72faaf1929SVasanthakumar Thiagarajan #define ath6kl_g_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 73faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 74faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 75faaf1929SVasanthakumar Thiagarajan 76bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 77bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 78bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 79bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 80bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 81bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 82bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 83bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 84bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 85bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 86bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 87bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 88bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 89bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 90bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 91bdcd8170SKalle Valo }; 92bdcd8170SKalle Valo 93bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 94bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 95bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 96bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 97bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 98bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 99bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 100bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 101bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 102bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 103bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 104bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 105bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 106bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 107bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 108bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 109bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 110bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 111bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 112bdcd8170SKalle Valo CHAN5G(216, 0), 113bdcd8170SKalle Valo }; 114bdcd8170SKalle Valo 115bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 116bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 117bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 118bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 119bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 120faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 121faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 122bdcd8170SKalle Valo }; 123bdcd8170SKalle Valo 124bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 125bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 126bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 127bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 128bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 129faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 131bdcd8170SKalle Valo }; 132bdcd8170SKalle Valo 133837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 134837cb97eSJouni Malinen 13510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 13610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 13710509f90SKalle Valo { 13810509f90SKalle Valo struct ath6kl *ar = vif->ar; 13910509f90SKalle Valo 14010509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14110509f90SKalle Valo return false; 14210509f90SKalle Valo 14310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14410509f90SKalle Valo 14510509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 14610509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 14710509f90SKalle Valo 14810509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 14910509f90SKalle Valo 15010509f90SKalle Valo return true; 15110509f90SKalle Valo } 15210509f90SKalle Valo 15310509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15410509f90SKalle Valo { 15510509f90SKalle Valo struct ath6kl *ar = vif->ar; 15610509f90SKalle Valo bool stopped; 15710509f90SKalle Valo 15810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 15910509f90SKalle Valo 16010509f90SKalle Valo if (!stopped) 16110509f90SKalle Valo return; 16210509f90SKalle Valo 16310509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16410509f90SKalle Valo } 16510509f90SKalle Valo 166240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 167bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 168bdcd8170SKalle Valo { 169bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 170bdcd8170SKalle Valo 171bdcd8170SKalle Valo if (!wpa_version) { 1723450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 173bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 175bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1763450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 177bdcd8170SKalle Valo } else { 178bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 179bdcd8170SKalle Valo return -ENOTSUPP; 180bdcd8170SKalle Valo } 181bdcd8170SKalle Valo 182bdcd8170SKalle Valo return 0; 183bdcd8170SKalle Valo } 184bdcd8170SKalle Valo 185240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 186bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 187bdcd8170SKalle Valo { 188bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 189bdcd8170SKalle Valo 190bdcd8170SKalle Valo switch (auth_type) { 191bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1923450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1953450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 196bdcd8170SKalle Valo break; 197bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1983450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 199bdcd8170SKalle Valo break; 200bdcd8170SKalle Valo 201bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 203bdcd8170SKalle Valo break; 204bdcd8170SKalle Valo 205bdcd8170SKalle Valo default: 2063c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 207bdcd8170SKalle Valo return -ENOTSUPP; 208bdcd8170SKalle Valo } 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo return 0; 211bdcd8170SKalle Valo } 212bdcd8170SKalle Valo 213240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 214bdcd8170SKalle Valo { 2153450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2163450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2173450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 218bdcd8170SKalle Valo 219bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 220bdcd8170SKalle Valo __func__, cipher, ucast); 221bdcd8170SKalle Valo 222bdcd8170SKalle Valo switch (cipher) { 223bdcd8170SKalle Valo case 0: 224bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 225bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 226bdcd8170SKalle Valo *ar_cipher_len = 0; 227bdcd8170SKalle Valo break; 228bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 229bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 230bdcd8170SKalle Valo *ar_cipher_len = 5; 231bdcd8170SKalle Valo break; 232bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 233bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 234bdcd8170SKalle Valo *ar_cipher_len = 13; 235bdcd8170SKalle Valo break; 236bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 237bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 238bdcd8170SKalle Valo *ar_cipher_len = 0; 239bdcd8170SKalle Valo break; 240bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 241bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 242bdcd8170SKalle Valo *ar_cipher_len = 0; 243bdcd8170SKalle Valo break; 2445e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2455e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2465e07021eSDai Shuibing *ar_cipher_len = 0; 2475e07021eSDai Shuibing break; 248bdcd8170SKalle Valo default: 249bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 250bdcd8170SKalle Valo return -ENOTSUPP; 251bdcd8170SKalle Valo } 252bdcd8170SKalle Valo 253bdcd8170SKalle Valo return 0; 254bdcd8170SKalle Valo } 255bdcd8170SKalle Valo 256240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 257bdcd8170SKalle Valo { 258bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 259bdcd8170SKalle Valo 260bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2613450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2623450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2633450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2643450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 265837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2663450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2673450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2683450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 270bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2713450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 272bdcd8170SKalle Valo } 273bdcd8170SKalle Valo } 274bdcd8170SKalle Valo 275990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 276bdcd8170SKalle Valo { 277990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27859c98449SVasanthakumar Thiagarajan 279bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 280bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 281bdcd8170SKalle Valo return false; 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo 28459c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 285bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 286bdcd8170SKalle Valo return false; 287bdcd8170SKalle Valo } 288bdcd8170SKalle Valo 289bdcd8170SKalle Valo return true; 290bdcd8170SKalle Valo } 291bdcd8170SKalle Valo 2926981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2936981ffdcSKevin Fang { 2946981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2956981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2966981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2976981ffdcSKevin Fang } 2986981ffdcSKevin Fang 2996981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3006981ffdcSKevin Fang { 3016981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3026981ffdcSKevin Fang } 3036981ffdcSKevin Fang 30463541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 30563541212SAarthi Thiruvengadam { 30663541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 30763541212SAarthi Thiruvengadam pos[1] >= 4 && 30863541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 30963541212SAarthi Thiruvengadam pos[5] == 0x04); 31063541212SAarthi Thiruvengadam } 31163541212SAarthi Thiruvengadam 312334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3136981ffdcSKevin Fang size_t ies_len) 3146981ffdcSKevin Fang { 315334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3166981ffdcSKevin Fang const u8 *pos; 3176981ffdcSKevin Fang u8 *buf = NULL; 3186981ffdcSKevin Fang size_t len = 0; 3196981ffdcSKevin Fang int ret; 3206981ffdcSKevin Fang 3216981ffdcSKevin Fang /* 32263541212SAarthi Thiruvengadam * Clear previously set flag 32363541212SAarthi Thiruvengadam */ 32463541212SAarthi Thiruvengadam 32563541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 32663541212SAarthi Thiruvengadam 32763541212SAarthi Thiruvengadam /* 3286981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3296981ffdcSKevin Fang */ 3306981ffdcSKevin Fang 3316981ffdcSKevin Fang if (ies && ies_len) { 3326981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3336981ffdcSKevin Fang if (buf == NULL) 3346981ffdcSKevin Fang return -ENOMEM; 3356981ffdcSKevin Fang pos = ies; 3366981ffdcSKevin Fang 3376981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3386981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3396981ffdcSKevin Fang break; 3406981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3416981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3426981ffdcSKevin Fang len += 2 + pos[1]; 3436981ffdcSKevin Fang } 34463541212SAarthi Thiruvengadam 34563541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 34663541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 34763541212SAarthi Thiruvengadam 3486981ffdcSKevin Fang pos += 2 + pos[1]; 3496981ffdcSKevin Fang } 3506981ffdcSKevin Fang } 3516981ffdcSKevin Fang 352334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 353334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3546981ffdcSKevin Fang kfree(buf); 3556981ffdcSKevin Fang return ret; 3566981ffdcSKevin Fang } 3576981ffdcSKevin Fang 35855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 35955055976SVasanthakumar Thiagarajan { 36055055976SVasanthakumar Thiagarajan switch (type) { 36155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36355055976SVasanthakumar Thiagarajan break; 36455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 36555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 36655055976SVasanthakumar Thiagarajan break; 36755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 36855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36955055976SVasanthakumar Thiagarajan break; 37055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37155055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37255055976SVasanthakumar Thiagarajan break; 37355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37455055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37555055976SVasanthakumar Thiagarajan break; 37655055976SVasanthakumar Thiagarajan default: 37755055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 37855055976SVasanthakumar Thiagarajan return -ENOTSUPP; 37955055976SVasanthakumar Thiagarajan } 38055055976SVasanthakumar Thiagarajan 38155055976SVasanthakumar Thiagarajan return 0; 38255055976SVasanthakumar Thiagarajan } 38355055976SVasanthakumar Thiagarajan 38455055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 38555055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38655055976SVasanthakumar Thiagarajan { 38755055976SVasanthakumar Thiagarajan int i; 38855055976SVasanthakumar Thiagarajan 38955055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39055055976SVasanthakumar Thiagarajan return false; 39155055976SVasanthakumar Thiagarajan 39255055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39355055976SVasanthakumar Thiagarajan ar->num_vif)) 39455055976SVasanthakumar Thiagarajan return false; 39555055976SVasanthakumar Thiagarajan 39655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39755055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 39871f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 39955055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40055055976SVasanthakumar Thiagarajan *if_idx = i; 40155055976SVasanthakumar Thiagarajan return true; 40255055976SVasanthakumar Thiagarajan } 40355055976SVasanthakumar Thiagarajan } 40455055976SVasanthakumar Thiagarajan } 40555055976SVasanthakumar Thiagarajan 4063226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4073226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 40871f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4093226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4103226f68aSVasanthakumar Thiagarajan *if_idx = i; 4113226f68aSVasanthakumar Thiagarajan return true; 4123226f68aSVasanthakumar Thiagarajan } 4133226f68aSVasanthakumar Thiagarajan } 4143226f68aSVasanthakumar Thiagarajan } 4153226f68aSVasanthakumar Thiagarajan 41655055976SVasanthakumar Thiagarajan return false; 41755055976SVasanthakumar Thiagarajan } 41855055976SVasanthakumar Thiagarajan 4198c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4208c9bb054SKalle Valo { 4218c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4228c9bb054SKalle Valo } 4238c9bb054SKalle Valo 4248c9bb054SKalle Valo 425bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 426bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 427bdcd8170SKalle Valo { 428bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 42959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 430bdcd8170SKalle Valo int status; 4313ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 432ce0dc0cfSRaja Mani u16 interval; 433bdcd8170SKalle Valo 43410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 43510509f90SKalle Valo 43614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 437bdcd8170SKalle Valo 438990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 439bdcd8170SKalle Valo return -EIO; 440bdcd8170SKalle Valo 441bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 442bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 443bdcd8170SKalle Valo return -EBUSY; 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 447bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 448bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 449bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 450bdcd8170SKalle Valo return -EINVAL; 451bdcd8170SKalle Valo } 452bdcd8170SKalle Valo 453bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 454bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 455bdcd8170SKalle Valo return -ERESTARTSYS; 456bdcd8170SKalle Valo } 457bdcd8170SKalle Valo 458bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 459bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 460bdcd8170SKalle Valo up(&ar->sem); 461bdcd8170SKalle Valo return -EBUSY; 462bdcd8170SKalle Valo } 463bdcd8170SKalle Valo 464bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 465bdcd8170SKalle Valo /* 466bdcd8170SKalle Valo * sleep until the command queue drains 467bdcd8170SKalle Valo */ 468bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4698c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 470bdcd8170SKalle Valo WMI_TIMEOUT); 471bdcd8170SKalle Valo if (signal_pending(current)) { 472bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 473bdcd8170SKalle Valo up(&ar->sem); 474bdcd8170SKalle Valo return -EINTR; 475bdcd8170SKalle Valo } 476bdcd8170SKalle Valo } 477bdcd8170SKalle Valo 478334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 479743b4518SDan Carpenter if (status) { 480743b4518SDan Carpenter up(&ar->sem); 4816981ffdcSKevin Fang return status; 482743b4518SDan Carpenter } 4836e786cb1SJouni Malinen 4846e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 485542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4866981ffdcSKevin Fang 48759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4883450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4893450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 490cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 491334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 492334234b5SVasanthakumar Thiagarajan vif->req_bssid, 493f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 494bdcd8170SKalle Valo 495bdcd8170SKalle Valo up(&ar->sem); 496bdcd8170SKalle Valo if (status) { 497bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 498bdcd8170SKalle Valo return -EIO; 499bdcd8170SKalle Valo } 500bdcd8170SKalle Valo return 0; 5013450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5023450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 503240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo 5063450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5073450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5083450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 509bdcd8170SKalle Valo 510bdcd8170SKalle Valo if (sme->channel) 511f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 512bdcd8170SKalle Valo 5138c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 514bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5158c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 516bdcd8170SKalle Valo 517240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 518bdcd8170SKalle Valo 519240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 520bdcd8170SKalle Valo if (status) { 521bdcd8170SKalle Valo up(&ar->sem); 522bdcd8170SKalle Valo return status; 523bdcd8170SKalle Valo } 524bdcd8170SKalle Valo 525bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 526240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 527bdcd8170SKalle Valo else 528240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 529bdcd8170SKalle Valo 530240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 531bdcd8170SKalle Valo 532bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 533240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 534bdcd8170SKalle Valo 535bdcd8170SKalle Valo if ((sme->key_len) && 5363450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5373450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 538bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 539bdcd8170SKalle Valo 540792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 541bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 542bdcd8170SKalle Valo sme->key_idx); 543bdcd8170SKalle Valo up(&ar->sem); 544bdcd8170SKalle Valo return -ENOENT; 545bdcd8170SKalle Valo } 546bdcd8170SKalle Valo 5476f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 548bdcd8170SKalle Valo key->key_len = sme->key_len; 549bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5503450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5513450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 552bdcd8170SKalle Valo 553334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5543450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 555bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 556bdcd8170SKalle Valo key->key_len, 557f4bb9a6fSJouni Malinen NULL, 0, 558bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 559bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 560bdcd8170SKalle Valo } 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 564240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 565240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 566bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 567bdcd8170SKalle Valo up(&ar->sem); 568bdcd8170SKalle Valo return -EIO; 569bdcd8170SKalle Valo } 570bdcd8170SKalle Valo } 571bdcd8170SKalle Valo 572f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 573bdcd8170SKalle Valo 5743ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5753ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5763ca9d1fcSAarthi Thiruvengadam 577bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 578bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 579bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 580bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 581bdcd8170SKalle Valo __func__, 5823450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5833450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 584f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 585bdcd8170SKalle Valo 586cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 587ce0dc0cfSRaja Mani 588ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 589b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 590b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 591ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 592ce0dc0cfSRaja Mani interval, 593ce0dc0cfSRaja Mani 0); 594ce0dc0cfSRaja Mani if (status) { 595ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 596ce0dc0cfSRaja Mani up(&ar->sem); 597ce0dc0cfSRaja Mani return status; 598ce0dc0cfSRaja Mani } 599ce0dc0cfSRaja Mani } 600ce0dc0cfSRaja Mani 601334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6033450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6043450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6053450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6063450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 607f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6083ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 609bdcd8170SKalle Valo 610bdcd8170SKalle Valo up(&ar->sem); 611bdcd8170SKalle Valo 612bdcd8170SKalle Valo if (status == -EINVAL) { 6133450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6143450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 615bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 616bdcd8170SKalle Valo return -ENOENT; 617bdcd8170SKalle Valo } else if (status) { 618bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 619bdcd8170SKalle Valo return -EIO; 620bdcd8170SKalle Valo } 621bdcd8170SKalle Valo 622bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 623ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 624ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 625de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 626bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 627bdcd8170SKalle Valo } 628bdcd8170SKalle Valo 629bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 63059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo return 0; 633bdcd8170SKalle Valo } 634bdcd8170SKalle Valo 6355e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6365e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6374eab6f4fSRaja Mani enum network_type nw_type, 6384eab6f4fSRaja Mani const u8 *bssid, 63901cac476SJouni Malinen struct ieee80211_channel *chan, 6405e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6415e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 64201cac476SJouni Malinen { 643240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 64401cac476SJouni Malinen struct cfg80211_bss *bss; 6454eab6f4fSRaja Mani u16 cap_mask, cap_val; 64601cac476SJouni Malinen u8 *ie; 64701cac476SJouni Malinen 6484eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6494eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6504eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6514eab6f4fSRaja Mani } else { 6524eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6534eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6544eab6f4fSRaja Mani } 6554eab6f4fSRaja Mani 656be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6574eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6584eab6f4fSRaja Mani cap_mask, cap_val); 65901cac476SJouni Malinen if (bss == NULL) { 66001cac476SJouni Malinen /* 66101cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 66201cac476SJouni Malinen * generate a partial entry until the first BSS info 66301cac476SJouni Malinen * event becomes available. 66401cac476SJouni Malinen * 66501cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 66601cac476SJouni Malinen * IEs from the target. 66701cac476SJouni Malinen */ 6683450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 66901cac476SJouni Malinen if (ie == NULL) 6705e13fd35SVasanthakumar Thiagarajan return NULL; 67101cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6723450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6733450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6743450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 675be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6764eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6773450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 67801cac476SJouni Malinen 0, GFP_KERNEL); 67901cac476SJouni Malinen if (bss) 6804eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6814eab6f4fSRaja Mani "cfg80211\n", bssid); 68201cac476SJouni Malinen kfree(ie); 68301cac476SJouni Malinen } else 6845e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 68501cac476SJouni Malinen 6865e13fd35SVasanthakumar Thiagarajan return bss; 68701cac476SJouni Malinen } 68801cac476SJouni Malinen 689240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 690bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 691bdcd8170SKalle Valo u16 beacon_intvl, 692bdcd8170SKalle Valo enum network_type nw_type, 693bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 694bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 695bdcd8170SKalle Valo { 69601cac476SJouni Malinen struct ieee80211_channel *chan; 697240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6985e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 699bdcd8170SKalle Valo 700bdcd8170SKalle Valo /* capinfo + listen interval */ 701bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 702bdcd8170SKalle Valo 703bdcd8170SKalle Valo /* capinfo + status code + associd */ 704bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 705bdcd8170SKalle Valo 706bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 707bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 708bdcd8170SKalle Valo assoc_resp_ie_offset; 709bdcd8170SKalle Valo 710bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 711bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 712bdcd8170SKalle Valo 71332c10874SJouni Malinen /* 71432c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 71532c10874SJouni Malinen * a Beacon frame from the AP is seen. 71632c10874SJouni Malinen */ 717cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 71859c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 71932c10874SJouni Malinen 720bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 721551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 722bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 723bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 724bdcd8170SKalle Valo return; 725bdcd8170SKalle Valo } 726bdcd8170SKalle Valo } 727bdcd8170SKalle Valo 728bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 729551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 730551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 731bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 732bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 733bdcd8170SKalle Valo return; 734bdcd8170SKalle Valo } 735bdcd8170SKalle Valo } 736bdcd8170SKalle Valo 737be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 738bdcd8170SKalle Valo 7395e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7405e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7415e13fd35SVasanthakumar Thiagarajan if (!bss) { 7424eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 743bdcd8170SKalle Valo return; 744bdcd8170SKalle Valo } 745bdcd8170SKalle Valo 7464eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7474eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7484eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7494eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7505e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 75101cac476SJouni Malinen return; 75201cac476SJouni Malinen } 75301cac476SJouni Malinen 75414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 755bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 75614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 757240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 758bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 759bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 760bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7615e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76214ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 763bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7645e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 765bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 766bdcd8170SKalle Valo } 767bdcd8170SKalle Valo } 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 770bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 771bdcd8170SKalle Valo { 772d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7733450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 774bdcd8170SKalle Valo 775bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 776bdcd8170SKalle Valo reason_code); 777bdcd8170SKalle Valo 77810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 77910509f90SKalle Valo 780990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 781bdcd8170SKalle Valo return -EIO; 782bdcd8170SKalle Valo 783bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 784bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 785bdcd8170SKalle Valo return -EBUSY; 786bdcd8170SKalle Valo } 787bdcd8170SKalle Valo 788bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 789bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 790bdcd8170SKalle Valo return -ERESTARTSYS; 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo 793cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 794240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7953450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7963450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 797bdcd8170SKalle Valo 798bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7998c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 800bdcd8170SKalle Valo 801bdcd8170SKalle Valo up(&ar->sem); 802bdcd8170SKalle Valo 80314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 804170826ddSVasanthakumar Thiagarajan 805bdcd8170SKalle Valo return 0; 806bdcd8170SKalle Valo } 807bdcd8170SKalle Valo 808240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 809bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 810bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 811bdcd8170SKalle Valo { 812240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 81359c98449SVasanthakumar Thiagarajan 81414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 81514ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 81614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 817bdcd8170SKalle Valo } 818bdcd8170SKalle Valo 819f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 820551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 821bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 822bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 823bdcd8170SKalle Valo return; 824bdcd8170SKalle Valo } 825bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 826240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 827bdcd8170SKalle Valo return; 828bdcd8170SKalle Valo } 829bdcd8170SKalle Valo 830f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 831551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 832551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 833bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 834bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 835bdcd8170SKalle Valo return; 836bdcd8170SKalle Valo } 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 8391de547d6SVasanthakumar Thiagarajan /* 8401de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8411de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8421de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8431de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8441de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8451de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8461de547d6SVasanthakumar Thiagarajan */ 847bdcd8170SKalle Valo 8481de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 849334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 850bdcd8170SKalle Valo return; 851bdcd8170SKalle Valo } 852bdcd8170SKalle Valo 85359c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 854bdcd8170SKalle Valo 85514ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 856240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 857bdcd8170SKalle Valo bssid, NULL, 0, 858bdcd8170SKalle Valo NULL, 0, 859bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 860bdcd8170SKalle Valo GFP_KERNEL); 86114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 862240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 863bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 864bdcd8170SKalle Valo } 865bdcd8170SKalle Valo 86614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo 869bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 870bdcd8170SKalle Valo struct cfg80211_scan_request *request) 871bdcd8170SKalle Valo { 872d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 87359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8741276c9efSEdward Lu s8 n_channels = 0; 8751276c9efSEdward Lu u16 *channels = NULL; 876bdcd8170SKalle Valo int ret = 0; 877f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 878bdcd8170SKalle Valo 879990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 880bdcd8170SKalle Valo return -EIO; 881bdcd8170SKalle Valo 88210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 88310509f90SKalle Valo 884bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 88559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8861b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 887240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 88859c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8891b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8901b1e6ee3SJouni Malinen if (ret) { 891bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8921b1e6ee3SJouni Malinen return ret; 893bdcd8170SKalle Valo } 894bdcd8170SKalle Valo } 895bdcd8170SKalle Valo 896bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 897bdcd8170SKalle Valo u8 i; 898bdcd8170SKalle Valo 899bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 900bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 901bdcd8170SKalle Valo 902bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 903334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 904334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 905bdcd8170SKalle Valo request->ssids[i].ssid_len, 906bdcd8170SKalle Valo request->ssids[i].ssid); 907bdcd8170SKalle Valo } 908bdcd8170SKalle Valo 909080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 910334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 911334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 912b84da8c7SJouni Malinen request->ie, request->ie_len); 913b84da8c7SJouni Malinen if (ret) { 914b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 915b84da8c7SJouni Malinen "scan"); 916b84da8c7SJouni Malinen return ret; 917b84da8c7SJouni Malinen } 918b84da8c7SJouni Malinen 91911869befSJouni Malinen /* 92011869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 92111869befSJouni Malinen * channels. If the list is longer than the target supports, do not 92211869befSJouni Malinen * configure the list and instead, scan all available channels. 92311869befSJouni Malinen */ 92411869befSJouni Malinen if (request->n_channels > 0 && 92511869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9261276c9efSEdward Lu u8 i; 9271276c9efSEdward Lu 92811869befSJouni Malinen n_channels = request->n_channels; 9291276c9efSEdward Lu 9301276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9311276c9efSEdward Lu if (channels == NULL) { 9321276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9331276c9efSEdward Lu "scan all channels"); 9341276c9efSEdward Lu n_channels = 0; 9351276c9efSEdward Lu } 9361276c9efSEdward Lu 9371276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9381276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9391276c9efSEdward Lu } 9401276c9efSEdward Lu 94159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 942f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 943f1f92179SVasanthakumar Thiagarajan 9443ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9453ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9463ca9d1fcSAarthi Thiruvengadam /* 9473ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9483ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9493ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9503ca9d1fcSAarthi Thiruvengadam * probe requests 9513ca9d1fcSAarthi Thiruvengadam */ 9523ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9533ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 95413423c31SVasanthakumar Thiagarajan false, 0, 95513423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95613423c31SVasanthakumar Thiagarajan n_channels, channels, 95713423c31SVasanthakumar Thiagarajan request->no_cck, 9583ca9d1fcSAarthi Thiruvengadam request->rates); 9593ca9d1fcSAarthi Thiruvengadam } else { 9603ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9613ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 96213423c31SVasanthakumar Thiagarajan false, 0, 96313423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 96413423c31SVasanthakumar Thiagarajan n_channels, channels); 9653ca9d1fcSAarthi Thiruvengadam } 9661b1e6ee3SJouni Malinen if (ret) 967bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 96811869befSJouni Malinen else 96914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 970bdcd8170SKalle Valo 9711276c9efSEdward Lu kfree(channels); 9721276c9efSEdward Lu 973bdcd8170SKalle Valo return ret; 974bdcd8170SKalle Valo } 975bdcd8170SKalle Valo 9761c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 977bdcd8170SKalle Valo { 978240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9796fd1eaceSKalle Valo int i; 980bdcd8170SKalle Valo 9811c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9821c17d313SKalle Valo aborted ? " aborted" : ""); 983bdcd8170SKalle Valo 98414ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9856fd1eaceSKalle Valo return; 9866fd1eaceSKalle Valo 9871c17d313SKalle Valo if (aborted) 9886fd1eaceSKalle Valo goto out; 989bdcd8170SKalle Valo 99014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 99114ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 992334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 993334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 994bdcd8170SKalle Valo 0, NULL); 995bdcd8170SKalle Valo } 996bdcd8170SKalle Valo } 9976fd1eaceSKalle Valo 9986fd1eaceSKalle Valo out: 999cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 100014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1001bdcd8170SKalle Valo } 1002bdcd8170SKalle Valo 1003bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1004bdcd8170SKalle Valo u8 key_index, bool pairwise, 1005bdcd8170SKalle Valo const u8 *mac_addr, 1006bdcd8170SKalle Valo struct key_params *params) 1007bdcd8170SKalle Valo { 1008d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 100959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1010bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10114a8ce2fdSSujith Manoharan int seq_len; 1012bdcd8170SKalle Valo u8 key_usage; 1013bdcd8170SKalle Valo u8 key_type; 1014bdcd8170SKalle Valo 1015990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1016bdcd8170SKalle Valo return -EIO; 1017bdcd8170SKalle Valo 1018837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1019837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1020837cb97eSJouni Malinen return -EINVAL; 1021240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1022240d2799SVasanthakumar Thiagarajan params->key); 1023837cb97eSJouni Malinen } 1024837cb97eSJouni Malinen 1025792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1026bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1027bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1028bdcd8170SKalle Valo key_index); 1029bdcd8170SKalle Valo return -ENOENT; 1030bdcd8170SKalle Valo } 1031bdcd8170SKalle Valo 10326f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1033bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1034bdcd8170SKalle Valo 1035bdcd8170SKalle Valo if (pairwise) 1036bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1037bdcd8170SKalle Valo else 1038bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1039bdcd8170SKalle Valo 10404a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10415e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10425e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10435e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10445e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10455e07021eSDai Shuibing } 1046bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10475e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1048bdcd8170SKalle Valo return -EINVAL; 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo key->key_len = params->key_len; 1051bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10525e07021eSDai Shuibing key->seq_len = seq_len; 1053bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1054bdcd8170SKalle Valo key->cipher = params->cipher; 1055bdcd8170SKalle Valo 1056bdcd8170SKalle Valo switch (key->cipher) { 1057bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1058bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1059bdcd8170SKalle Valo key_type = WEP_CRYPT; 1060bdcd8170SKalle Valo break; 1061bdcd8170SKalle Valo 1062bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1063bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1064bdcd8170SKalle Valo break; 1065bdcd8170SKalle Valo 1066bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1067bdcd8170SKalle Valo key_type = AES_CRYPT; 1068bdcd8170SKalle Valo break; 10695e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10705e07021eSDai Shuibing key_type = WAPI_CRYPT; 10715e07021eSDai Shuibing break; 1072bdcd8170SKalle Valo 1073bdcd8170SKalle Valo default: 1074bdcd8170SKalle Valo return -ENOTSUPP; 1075bdcd8170SKalle Valo } 1076bdcd8170SKalle Valo 1077ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1078ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1079ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1080de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1081bdcd8170SKalle Valo 1082bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1083bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1084bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1085bdcd8170SKalle Valo key_usage, key->seq_len); 1086bdcd8170SKalle Valo 1087f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10884703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1089cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10909a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10919a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10929a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10939a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10949a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 109559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10969a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10979a5b1318SJouni Malinen "key configuration until AP mode has been " 10989a5b1318SJouni Malinen "started\n"); 10999a5b1318SJouni Malinen /* 11009a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11019a5b1318SJouni Malinen * the connected event is received from the target. 11029a5b1318SJouni Malinen */ 11039a5b1318SJouni Malinen return 0; 11049a5b1318SJouni Malinen } 11059a5b1318SJouni Malinen } 11069a5b1318SJouni Malinen 1107f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 110859c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1109151411e8SJouni Malinen /* 1110151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1111151411e8SJouni Malinen * the AP mode has properly started 1112151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1113151411e8SJouni Malinen */ 1114151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1115151411e8SJouni Malinen "until AP mode has been started\n"); 11166f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11176f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11186f2a73f9SVasanthakumar Thiagarajan key->key_len); 1119151411e8SJouni Malinen return 0; 1120151411e8SJouni Malinen } 1121151411e8SJouni Malinen 11227cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1123bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1124f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1125f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1126bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1127bdcd8170SKalle Valo } 1128bdcd8170SKalle Valo 1129bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1130bdcd8170SKalle Valo u8 key_index, bool pairwise, 1131bdcd8170SKalle Valo const u8 *mac_addr) 1132bdcd8170SKalle Valo { 1133d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11346f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1135bdcd8170SKalle Valo 1136bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1137bdcd8170SKalle Valo 1138990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1139bdcd8170SKalle Valo return -EIO; 1140bdcd8170SKalle Valo 1141792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1142bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1143bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1144bdcd8170SKalle Valo key_index); 1145bdcd8170SKalle Valo return -ENOENT; 1146bdcd8170SKalle Valo } 1147bdcd8170SKalle Valo 11486f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1149bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1150bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1151bdcd8170SKalle Valo return 0; 1152bdcd8170SKalle Valo } 1153bdcd8170SKalle Valo 11546f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1155bdcd8170SKalle Valo 1156334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1157bdcd8170SKalle Valo } 1158bdcd8170SKalle Valo 1159bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1160bdcd8170SKalle Valo u8 key_index, bool pairwise, 1161bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1162bdcd8170SKalle Valo void (*callback) (void *cookie, 1163bdcd8170SKalle Valo struct key_params *)) 1164bdcd8170SKalle Valo { 11656f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1166bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1167bdcd8170SKalle Valo struct key_params params; 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1170bdcd8170SKalle Valo 1171990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1172bdcd8170SKalle Valo return -EIO; 1173bdcd8170SKalle Valo 1174792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1176bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1177bdcd8170SKalle Valo key_index); 1178bdcd8170SKalle Valo return -ENOENT; 1179bdcd8170SKalle Valo } 1180bdcd8170SKalle Valo 11816f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1182bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1183bdcd8170SKalle Valo params.cipher = key->cipher; 1184bdcd8170SKalle Valo params.key_len = key->key_len; 1185bdcd8170SKalle Valo params.seq_len = key->seq_len; 1186bdcd8170SKalle Valo params.seq = key->seq; 1187bdcd8170SKalle Valo params.key = key->key; 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo callback(cookie, ¶ms); 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 1194bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1195bdcd8170SKalle Valo struct net_device *ndev, 1196bdcd8170SKalle Valo u8 key_index, bool unicast, 1197bdcd8170SKalle Valo bool multicast) 1198bdcd8170SKalle Valo { 1199d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 120059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1201bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1202bdcd8170SKalle Valo u8 key_usage; 1203229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1206bdcd8170SKalle Valo 1207990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1208bdcd8170SKalle Valo return -EIO; 1209bdcd8170SKalle Valo 1210792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1211bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1212bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1213bdcd8170SKalle Valo __func__, key_index); 1214bdcd8170SKalle Valo return -ENOENT; 1215bdcd8170SKalle Valo } 1216bdcd8170SKalle Valo 12176f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1218bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1219bdcd8170SKalle Valo __func__, key_index); 1220bdcd8170SKalle Valo return -EINVAL; 1221bdcd8170SKalle Valo } 1222bdcd8170SKalle Valo 12233450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12246f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1225bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12263450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1227bdcd8170SKalle Valo key_usage |= TX_USAGE; 1228229ed6b5SEdward Lu if (unicast) 12293450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1230229ed6b5SEdward Lu if (multicast) 12313450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1232bdcd8170SKalle Valo 1233f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12349a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12359a5b1318SJouni Malinen 1236f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1237334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1238229ed6b5SEdward Lu key_type, key_usage, 1239f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1240f4bb9a6fSJouni Malinen key->key, 1241bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1242bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1243bdcd8170SKalle Valo } 1244bdcd8170SKalle Valo 1245240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1246bdcd8170SKalle Valo bool ismcast) 1247bdcd8170SKalle Valo { 1248bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1249bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1250bdcd8170SKalle Valo 1251240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1252bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1253bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1254bdcd8170SKalle Valo GFP_KERNEL); 1255bdcd8170SKalle Valo } 1256bdcd8170SKalle Valo 1257bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1258bdcd8170SKalle Valo { 1259bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1260990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1261bdcd8170SKalle Valo int ret; 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1264bdcd8170SKalle Valo changed); 1265bdcd8170SKalle Valo 1266990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1267990bd915SVasanthakumar Thiagarajan if (!vif) 1268990bd915SVasanthakumar Thiagarajan return -EIO; 1269990bd915SVasanthakumar Thiagarajan 1270990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1271bdcd8170SKalle Valo return -EIO; 1272bdcd8170SKalle Valo 1273bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1274bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1275bdcd8170SKalle Valo if (ret != 0) { 1276bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1277bdcd8170SKalle Valo return -EIO; 1278bdcd8170SKalle Valo } 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo return 0; 1282bdcd8170SKalle Valo } 1283bdcd8170SKalle Valo 1284bdcd8170SKalle Valo /* 1285bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1286bdcd8170SKalle Valo * data type from 2.6.36 onwards 1287bdcd8170SKalle Valo */ 1288bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1289bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1290b992a285SLuis R. Rodriguez int mbm) 1291bdcd8170SKalle Valo { 1292bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1293990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1294b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1297bdcd8170SKalle Valo type, dbm); 1298bdcd8170SKalle Valo 1299990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1300990bd915SVasanthakumar Thiagarajan if (!vif) 1301990bd915SVasanthakumar Thiagarajan return -EIO; 1302990bd915SVasanthakumar Thiagarajan 1303990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1304bdcd8170SKalle Valo return -EIO; 1305bdcd8170SKalle Valo 1306bdcd8170SKalle Valo switch (type) { 1307bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1308bdcd8170SKalle Valo return 0; 1309bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1310d0d670abSKalle Valo ar->tx_pwr = dbm; 1311bdcd8170SKalle Valo break; 1312bdcd8170SKalle Valo default: 1313bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1314bdcd8170SKalle Valo __func__, type); 1315bdcd8170SKalle Valo return -EOPNOTSUPP; 1316bdcd8170SKalle Valo } 1317bdcd8170SKalle Valo 1318d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1319bdcd8170SKalle Valo 1320bdcd8170SKalle Valo return 0; 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo 1323bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1324bdcd8170SKalle Valo { 1325bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1326990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1327bdcd8170SKalle Valo 1328990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1329990bd915SVasanthakumar Thiagarajan if (!vif) 1330990bd915SVasanthakumar Thiagarajan return -EIO; 1331990bd915SVasanthakumar Thiagarajan 1332990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1333bdcd8170SKalle Valo return -EIO; 1334bdcd8170SKalle Valo 133559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1336bdcd8170SKalle Valo ar->tx_pwr = 0; 1337bdcd8170SKalle Valo 1338990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1339bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1340bdcd8170SKalle Valo return -EIO; 1341bdcd8170SKalle Valo } 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1344bdcd8170SKalle Valo 5 * HZ); 1345bdcd8170SKalle Valo 1346bdcd8170SKalle Valo if (signal_pending(current)) { 1347bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1348bdcd8170SKalle Valo return -EINTR; 1349bdcd8170SKalle Valo } 1350bdcd8170SKalle Valo } 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1353bdcd8170SKalle Valo return 0; 1354bdcd8170SKalle Valo } 1355bdcd8170SKalle Valo 1356bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1357bdcd8170SKalle Valo struct net_device *dev, 1358bdcd8170SKalle Valo bool pmgmt, int timeout) 1359bdcd8170SKalle Valo { 1360bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1361bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1362334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1363bdcd8170SKalle Valo 1364bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1365bdcd8170SKalle Valo __func__, pmgmt, timeout); 1366bdcd8170SKalle Valo 1367990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1368bdcd8170SKalle Valo return -EIO; 1369bdcd8170SKalle Valo 1370bdcd8170SKalle Valo if (pmgmt) { 1371bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1372bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1373bdcd8170SKalle Valo } else { 1374bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1375bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1376bdcd8170SKalle Valo } 1377bdcd8170SKalle Valo 1378334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1379334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1380bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1381bdcd8170SKalle Valo return -EIO; 1382bdcd8170SKalle Valo } 1383bdcd8170SKalle Valo 1384bdcd8170SKalle Valo return 0; 1385bdcd8170SKalle Valo } 1386bdcd8170SKalle Valo 138755055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 138855055976SVasanthakumar Thiagarajan char *name, 138955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 139055055976SVasanthakumar Thiagarajan u32 *flags, 139155055976SVasanthakumar Thiagarajan struct vif_params *params) 139255055976SVasanthakumar Thiagarajan { 139355055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139455055976SVasanthakumar Thiagarajan struct net_device *ndev; 139555055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 139655055976SVasanthakumar Thiagarajan 139771f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 139855055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 139955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140055055976SVasanthakumar Thiagarajan } 140155055976SVasanthakumar Thiagarajan 140255055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 140355055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 140455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140555055976SVasanthakumar Thiagarajan } 140655055976SVasanthakumar Thiagarajan 140755055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 140855055976SVasanthakumar Thiagarajan if (!ndev) 140955055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 141055055976SVasanthakumar Thiagarajan 141155055976SVasanthakumar Thiagarajan ar->num_vif++; 141255055976SVasanthakumar Thiagarajan 141355055976SVasanthakumar Thiagarajan return ndev; 141455055976SVasanthakumar Thiagarajan } 141555055976SVasanthakumar Thiagarajan 141655055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 141755055976SVasanthakumar Thiagarajan struct net_device *ndev) 141855055976SVasanthakumar Thiagarajan { 141955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 142055055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 142155055976SVasanthakumar Thiagarajan 142211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 142355055976SVasanthakumar Thiagarajan list_del(&vif->list); 142411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 142555055976SVasanthakumar Thiagarajan 142655055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 142755055976SVasanthakumar Thiagarajan 1428c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 142955055976SVasanthakumar Thiagarajan 143055055976SVasanthakumar Thiagarajan return 0; 143155055976SVasanthakumar Thiagarajan } 143255055976SVasanthakumar Thiagarajan 1433bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1434bdcd8170SKalle Valo struct net_device *ndev, 1435bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1436bdcd8170SKalle Valo struct vif_params *params) 1437bdcd8170SKalle Valo { 1438f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1441bdcd8170SKalle Valo 1442bdcd8170SKalle Valo switch (type) { 1443bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1444f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1445bdcd8170SKalle Valo break; 1446bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1447f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1448bdcd8170SKalle Valo break; 14496e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1450f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14516e4604c8SJouni Malinen break; 14526b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1453f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14546b5e5d25SJouni Malinen break; 14556b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1456f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14576b5e5d25SJouni Malinen break; 1458bdcd8170SKalle Valo default: 1459bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1460bdcd8170SKalle Valo return -EOPNOTSUPP; 1461bdcd8170SKalle Valo } 1462bdcd8170SKalle Valo 1463551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo return 0; 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1469bdcd8170SKalle Valo struct net_device *dev, 1470bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1471bdcd8170SKalle Valo { 1472bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 147359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1474bdcd8170SKalle Valo int status; 1475bdcd8170SKalle Valo 1476990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1477bdcd8170SKalle Valo return -EIO; 1478bdcd8170SKalle Valo 14793450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14803450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1481bdcd8170SKalle Valo 1482bdcd8170SKalle Valo if (ibss_param->channel) 1483f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1484bdcd8170SKalle Valo 1485bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1486bdcd8170SKalle Valo /* 1487bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1488bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1489bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1490bdcd8170SKalle Valo * updated. 1491bdcd8170SKalle Valo */ 1492bdcd8170SKalle Valo return -EOPNOTSUPP; 1493bdcd8170SKalle Valo } 1494bdcd8170SKalle Valo 14958c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1496bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14978c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14988c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1499bdcd8170SKalle Valo 1500240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1501bdcd8170SKalle Valo 1502240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1503bdcd8170SKalle Valo if (status) 1504bdcd8170SKalle Valo return status; 1505bdcd8170SKalle Valo 1506bdcd8170SKalle Valo if (ibss_param->privacy) { 1507240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1508240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1509bdcd8170SKalle Valo } else { 1510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1511240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1512bdcd8170SKalle Valo } 1513bdcd8170SKalle Valo 1514f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1515bdcd8170SKalle Valo 1516bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1517bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1518bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1519bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1520bdcd8170SKalle Valo __func__, 15213450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15223450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1523f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1524bdcd8170SKalle Valo 1525334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15263450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15273450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15283450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15293450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15303450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1531f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15323ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 153359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1534bdcd8170SKalle Valo 1535bdcd8170SKalle Valo return 0; 1536bdcd8170SKalle Valo } 1537bdcd8170SKalle Valo 1538bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1539bdcd8170SKalle Valo struct net_device *dev) 1540bdcd8170SKalle Valo { 15413450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1542bdcd8170SKalle Valo 1543990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1544bdcd8170SKalle Valo return -EIO; 1545bdcd8170SKalle Valo 1546240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15473450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15483450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo return 0; 1551bdcd8170SKalle Valo } 1552bdcd8170SKalle Valo 1553bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1554bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1555bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1556bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1557bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1558837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15595e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1560bdcd8170SKalle Valo }; 1561bdcd8170SKalle Valo 1562bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1563bdcd8170SKalle Valo { 1564bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1565bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1566bdcd8170SKalle Valo 36000, 48000, 54000 1567bdcd8170SKalle Valo }; 1568bdcd8170SKalle Valo u8 i; 1569bdcd8170SKalle Valo 1570bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1571bdcd8170SKalle Valo if (rate == legacy[i]) 1572bdcd8170SKalle Valo return true; 1573bdcd8170SKalle Valo 1574bdcd8170SKalle Valo return false; 1575bdcd8170SKalle Valo } 1576bdcd8170SKalle Valo 1577bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1578bdcd8170SKalle Valo { 1579bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1580bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1581bdcd8170SKalle Valo }; 1582bdcd8170SKalle Valo u8 i; 1583bdcd8170SKalle Valo 1584bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1585bdcd8170SKalle Valo if (rate == ht20[i]) { 1586bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1587bdcd8170SKalle Valo /* last rate uses sgi */ 1588bdcd8170SKalle Valo *sgi = true; 1589bdcd8170SKalle Valo else 1590bdcd8170SKalle Valo *sgi = false; 1591bdcd8170SKalle Valo 1592bdcd8170SKalle Valo *mcs = i; 1593bdcd8170SKalle Valo return true; 1594bdcd8170SKalle Valo } 1595bdcd8170SKalle Valo } 1596bdcd8170SKalle Valo return false; 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo 1599bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1600bdcd8170SKalle Valo { 1601bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1602bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1603bdcd8170SKalle Valo 150000 1604bdcd8170SKalle Valo }; 1605bdcd8170SKalle Valo u8 i; 1606bdcd8170SKalle Valo 1607bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1608bdcd8170SKalle Valo if (rate == ht40[i]) { 1609bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1610bdcd8170SKalle Valo /* last rate uses sgi */ 1611bdcd8170SKalle Valo *sgi = true; 1612bdcd8170SKalle Valo else 1613bdcd8170SKalle Valo *sgi = false; 1614bdcd8170SKalle Valo 1615bdcd8170SKalle Valo *mcs = i; 1616bdcd8170SKalle Valo return true; 1617bdcd8170SKalle Valo } 1618bdcd8170SKalle Valo } 1619bdcd8170SKalle Valo 1620bdcd8170SKalle Valo return false; 1621bdcd8170SKalle Valo } 1622bdcd8170SKalle Valo 1623bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1624bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1625bdcd8170SKalle Valo { 1626bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1628bdcd8170SKalle Valo long left; 1629bdcd8170SKalle Valo bool sgi; 1630bdcd8170SKalle Valo s32 rate; 1631bdcd8170SKalle Valo int ret; 1632bdcd8170SKalle Valo u8 mcs; 1633bdcd8170SKalle Valo 16348c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1635bdcd8170SKalle Valo return -ENOENT; 1636bdcd8170SKalle Valo 1637bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1638bdcd8170SKalle Valo return -EBUSY; 1639bdcd8170SKalle Valo 1640b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1641bdcd8170SKalle Valo 1642334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1643bdcd8170SKalle Valo 1644bdcd8170SKalle Valo if (ret != 0) { 1645bdcd8170SKalle Valo up(&ar->sem); 1646bdcd8170SKalle Valo return -EIO; 1647bdcd8170SKalle Valo } 1648bdcd8170SKalle Valo 1649bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1650bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1651b95907a7SVasanthakumar Thiagarajan &vif->flags), 1652bdcd8170SKalle Valo WMI_TIMEOUT); 1653bdcd8170SKalle Valo 1654bdcd8170SKalle Valo up(&ar->sem); 1655bdcd8170SKalle Valo 1656bdcd8170SKalle Valo if (left == 0) 1657bdcd8170SKalle Valo return -ETIMEDOUT; 1658bdcd8170SKalle Valo else if (left < 0) 1659bdcd8170SKalle Valo return left; 1660bdcd8170SKalle Valo 1661b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1662b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1663bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1664b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1665bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1666bdcd8170SKalle Valo } 1667bdcd8170SKalle Valo 1668b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1669b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1670bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1671b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1672bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1673bdcd8170SKalle Valo } 1674bdcd8170SKalle Valo 1675b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1676bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1677bdcd8170SKalle Valo 1678b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1679bdcd8170SKalle Valo 1680bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1681bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1682bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1683bdcd8170SKalle Valo if (sgi) { 1684bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1685bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1686bdcd8170SKalle Valo } else { 1687bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1688bdcd8170SKalle Valo } 1689bdcd8170SKalle Valo 1690bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1691bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1692bdcd8170SKalle Valo if (sgi) { 1693bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1694bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1695bdcd8170SKalle Valo } else { 1696bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1697bdcd8170SKalle Valo } 1698bdcd8170SKalle Valo 1699bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1700bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1701bdcd8170SKalle Valo } else { 17029a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17039a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17049a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1705bdcd8170SKalle Valo return 0; 1706bdcd8170SKalle Valo } 1707bdcd8170SKalle Valo 1708bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1709bdcd8170SKalle Valo 171059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 171159c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1712f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 171332c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 171432c10874SJouni Malinen sinfo->bss_param.flags = 0; 1715cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1716cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 171732c10874SJouni Malinen } 171832c10874SJouni Malinen 1719bdcd8170SKalle Valo return 0; 1720bdcd8170SKalle Valo } 1721bdcd8170SKalle Valo 1722bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1723bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1724bdcd8170SKalle Valo { 1725bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1726334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1727334234b5SVasanthakumar Thiagarajan 1728334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1729bdcd8170SKalle Valo pmksa->pmkid, true); 1730bdcd8170SKalle Valo } 1731bdcd8170SKalle Valo 1732bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1733bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1734bdcd8170SKalle Valo { 1735bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1736334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1737334234b5SVasanthakumar Thiagarajan 1738334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1739bdcd8170SKalle Valo pmksa->pmkid, false); 1740bdcd8170SKalle Valo } 1741bdcd8170SKalle Valo 1742bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1743bdcd8170SKalle Valo { 1744bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 174559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 174659c98449SVasanthakumar Thiagarajan 174759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1748334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1749334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1750bdcd8170SKalle Valo return 0; 1751bdcd8170SKalle Valo } 1752bdcd8170SKalle Valo 1753d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1754d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17556cb3c714SRaja Mani { 1756d91e8eeeSRaja Mani int ret, pos; 1757d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17586cb3c714SRaja Mani u16 i; 17596cb3c714SRaja Mani 1760d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17616cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17626cb3c714SRaja Mani 17636cb3c714SRaja Mani /* 17646cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17656cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17666cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17676cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17686cb3c714SRaja Mani * then equivalent driver specific mask value is 17696cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17706cb3c714SRaja Mani */ 17716cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17726cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17736cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17746cb3c714SRaja Mani mask[pos] = 0xFF; 17756cb3c714SRaja Mani } 17766cb3c714SRaja Mani /* 17776cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17786cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17796cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17806cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17816cb3c714SRaja Mani */ 17826cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17836cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17846cb3c714SRaja Mani wow->patterns[i].pattern_len, 17856cb3c714SRaja Mani 0 /* pattern offset */, 17866cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17876cb3c714SRaja Mani if (ret) 17886cb3c714SRaja Mani return ret; 17896cb3c714SRaja Mani } 17906cb3c714SRaja Mani 1791d91e8eeeSRaja Mani if (wow->disconnect) 1792d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1793d91e8eeeSRaja Mani 1794d91e8eeeSRaja Mani if (wow->magic_pkt) 1795d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1796d91e8eeeSRaja Mani 1797d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1798d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1799d91e8eeeSRaja Mani 1800d91e8eeeSRaja Mani if (wow->eap_identity_req) 1801d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1802d91e8eeeSRaja Mani 1803d91e8eeeSRaja Mani if (wow->four_way_handshake) 1804d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1805d91e8eeeSRaja Mani 1806d91e8eeeSRaja Mani return 0; 1807d91e8eeeSRaja Mani } 1808d91e8eeeSRaja Mani 1809d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1810d91e8eeeSRaja Mani { 1811d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1812d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1813d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1814d91e8eeeSRaja Mani 0x00, 0x08 }; 1815d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1816d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1817d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1818d91e8eeeSRaja Mani 0x00, 0x7f }; 1819d91e8eeeSRaja Mani u8 unicst_offset = 0; 1820d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1821d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1822d91e8eeeSRaja Mani u8 arp_offset = 20; 1823d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1824d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1825d91e8eeeSRaja Mani u8 discvr_offset = 38; 1826d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1827d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1828d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1829d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1830d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1832d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1833d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1834d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1835d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1836d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1837d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1838d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1839d91e8eeeSRaja Mani int ret; 1840d91e8eeeSRaja Mani 1841d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1842d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1843d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1844d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1845d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1846d91e8eeeSRaja Mani if (ret) { 1847d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1848d91e8eeeSRaja Mani return ret; 1849d91e8eeeSRaja Mani } 1850d91e8eeeSRaja Mani 1851d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1852d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1853d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1854d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1855d91e8eeeSRaja Mani arp_pattern, arp_mask); 1856d91e8eeeSRaja Mani if (ret) { 1857d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1858d91e8eeeSRaja Mani return ret; 1859d91e8eeeSRaja Mani } 1860d91e8eeeSRaja Mani 1861d91e8eeeSRaja Mani /* 1862d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1863d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1864d91e8eeeSRaja Mani */ 1865d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1866d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1867d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1868d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1869d91e8eeeSRaja Mani if (ret) { 1870d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1871d91e8eeeSRaja Mani return ret; 1872d91e8eeeSRaja Mani } 1873d91e8eeeSRaja Mani 1874d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1875d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1876d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1877d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1878d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1879d91e8eeeSRaja Mani if (ret) { 1880d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1881d91e8eeeSRaja Mani return ret; 1882d91e8eeeSRaja Mani } 1883d91e8eeeSRaja Mani 1884d91e8eeeSRaja Mani return 0; 1885d91e8eeeSRaja Mani } 1886d91e8eeeSRaja Mani 1887d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1888d91e8eeeSRaja Mani { 1889d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1890d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1891d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1892d91e8eeeSRaja Mani u8 discvr_offset = 38; 1893d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1894d91e8eeeSRaja Mani int ret; 1895d91e8eeeSRaja Mani 1896d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1897d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1898d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1899d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1900d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1901d91e8eeeSRaja Mani mac_mask); 1902d91e8eeeSRaja Mani if (ret) { 1903d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1904d91e8eeeSRaja Mani return ret; 1905d91e8eeeSRaja Mani } 1906d91e8eeeSRaja Mani 1907d91e8eeeSRaja Mani /* 1908d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1909d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1910d91e8eeeSRaja Mani */ 1911d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1912d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1913d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1914d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1915d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1916d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1917d91e8eeeSRaja Mani if (ret) { 1918d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1919d91e8eeeSRaja Mani "pattern\n"); 1920d91e8eeeSRaja Mani return ret; 1921d91e8eeeSRaja Mani } 1922d91e8eeeSRaja Mani } 1923d91e8eeeSRaja Mani 1924d91e8eeeSRaja Mani return 0; 1925d91e8eeeSRaja Mani } 1926d91e8eeeSRaja Mani 1927055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 1928055bde49SRaja Mani { 1929055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1930055bde49SRaja Mani } 1931055bde49SRaja Mani 1932055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 1933055bde49SRaja Mani { 1934055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 1935055bde49SRaja Mani } 1936055bde49SRaja Mani 1937055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 1938055bde49SRaja Mani { 1939055bde49SRaja Mani int ret, left; 1940055bde49SRaja Mani 1941055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1942055bde49SRaja Mani 1943055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 1944055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 1945055bde49SRaja Mani if (ret) 1946055bde49SRaja Mani return ret; 1947055bde49SRaja Mani 1948055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1949055bde49SRaja Mani is_hsleep_mode_procsed(vif), 1950055bde49SRaja Mani WMI_TIMEOUT); 1951055bde49SRaja Mani if (left == 0) { 1952055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 1953055bde49SRaja Mani ret = -ETIMEDOUT; 1954055bde49SRaja Mani } else if (left < 0) { 1955055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 1956055bde49SRaja Mani left); 1957055bde49SRaja Mani ret = left; 1958055bde49SRaja Mani } 1959055bde49SRaja Mani 1960055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 1961055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1962055bde49SRaja Mani is_ctrl_ep_empty(ar), 1963055bde49SRaja Mani WMI_TIMEOUT); 1964055bde49SRaja Mani if (left == 0) { 1965055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 1966055bde49SRaja Mani ret = -ETIMEDOUT; 1967055bde49SRaja Mani } else if (left < 0) { 1968055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 1969055bde49SRaja Mani ret = left; 1970055bde49SRaja Mani } 1971055bde49SRaja Mani } 1972055bde49SRaja Mani 1973055bde49SRaja Mani return ret; 1974055bde49SRaja Mani } 1975055bde49SRaja Mani 1976d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1977d91e8eeeSRaja Mani { 1978d91e8eeeSRaja Mani struct in_device *in_dev; 1979d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1980d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1981055bde49SRaja Mani int ret; 1982d91e8eeeSRaja Mani u32 filter = 0; 1983ce0dc0cfSRaja Mani u16 i, bmiss_time; 1984d91e8eeeSRaja Mani u8 index = 0; 1985d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1986d91e8eeeSRaja Mani 1987d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1988d91e8eeeSRaja Mani if (!vif) 1989d91e8eeeSRaja Mani return -EIO; 1990d91e8eeeSRaja Mani 1991d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1992d91e8eeeSRaja Mani return -EIO; 1993d91e8eeeSRaja Mani 1994d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19953c411a43SRaja Mani return -ENOTCONN; 1996d91e8eeeSRaja Mani 1997d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 1998d91e8eeeSRaja Mani return -EINVAL; 1999d91e8eeeSRaja Mani 2000d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2001d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2002d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2003d91e8eeeSRaja Mani WOW_LIST_ID, i); 2004d91e8eeeSRaja Mani 2005d91e8eeeSRaja Mani /* 2006d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2007d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2008d91e8eeeSRaja Mani * the user. 2009d91e8eeeSRaja Mani */ 2010d91e8eeeSRaja Mani if (wow) 2011d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2012d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2013d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2014d91e8eeeSRaja Mani else 2015d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2016d91e8eeeSRaja Mani 2017d91e8eeeSRaja Mani if (ret) 2018d91e8eeeSRaja Mani return ret; 2019d91e8eeeSRaja Mani 2020390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2021390a8c8fSRaja Mani 2022ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2023ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2024ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2025ce0dc0cfSRaja Mani 0); 2026ce0dc0cfSRaja Mani if (ret) 2027ce0dc0cfSRaja Mani return ret; 2028ce0dc0cfSRaja Mani 2029ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2030ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2031ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2032ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2033ce0dc0cfSRaja Mani 2034ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2035ce0dc0cfSRaja Mani bmiss_time, 0); 2036ce0dc0cfSRaja Mani if (ret) 2037ce0dc0cfSRaja Mani return ret; 2038ce0dc0cfSRaja Mani 2039ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2040ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2041ce0dc0cfSRaja Mani 0, 0, 0, 0); 2042ce0dc0cfSRaja Mani if (ret) 2043ce0dc0cfSRaja Mani return ret; 2044ce0dc0cfSRaja Mani } 2045ce0dc0cfSRaja Mani 2046390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2047390a8c8fSRaja Mani 2048c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2049c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2050c08631c6SRaja Mani if (!in_dev) 2051c08631c6SRaja Mani goto skip_arp; 2052c08631c6SRaja Mani 2053c08631c6SRaja Mani ifa = in_dev->ifa_list; 2054c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2055c08631c6SRaja Mani 2056c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2057c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2058c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2059c08631c6SRaja Mani ifa = ifa->ifa_next; 2060c08631c6SRaja Mani index++; 2061c08631c6SRaja Mani } 2062c08631c6SRaja Mani 2063c08631c6SRaja Mani if (ifa) { 2064c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2065c08631c6SRaja Mani return -EINVAL; 2066c08631c6SRaja Mani } 2067c08631c6SRaja Mani 2068c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2069c08631c6SRaja Mani if (ret) { 2070c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2071c08631c6SRaja Mani return ret; 2072c08631c6SRaja Mani } 2073c08631c6SRaja Mani 2074c08631c6SRaja Mani skip_arp: 20756cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20766cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20776cb3c714SRaja Mani filter, 20786cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20796cb3c714SRaja Mani if (ret) 20806cb3c714SRaja Mani return ret; 20816cb3c714SRaja Mani 2082055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 20836cb3c714SRaja Mani if (ret) 20846cb3c714SRaja Mani return ret; 20856cb3c714SRaja Mani 2086055bde49SRaja Mani return 0; 20876cb3c714SRaja Mani } 20886cb3c714SRaja Mani 20896cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20906cb3c714SRaja Mani { 20916cb3c714SRaja Mani struct ath6kl_vif *vif; 20926cb3c714SRaja Mani int ret; 20936cb3c714SRaja Mani 20946cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20956cb3c714SRaja Mani if (!vif) 20966cb3c714SRaja Mani return -EIO; 20976cb3c714SRaja Mani 2098390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2099390a8c8fSRaja Mani 21006cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21016cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2102390a8c8fSRaja Mani if (ret) { 2103390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2104390a8c8fSRaja Mani "wow resume: %d\n", ret); 2105390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21066cb3c714SRaja Mani return ret; 21076cb3c714SRaja Mani } 21086cb3c714SRaja Mani 2109ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2110ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2111ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2112ce0dc0cfSRaja Mani if (ret) 2113ce0dc0cfSRaja Mani return ret; 2114ce0dc0cfSRaja Mani 2115ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2116ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2117ce0dc0cfSRaja Mani if (ret) 2118ce0dc0cfSRaja Mani return ret; 2119ce0dc0cfSRaja Mani 2120ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2121ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2122ce0dc0cfSRaja Mani if (ret) 2123ce0dc0cfSRaja Mani return ret; 2124ce0dc0cfSRaja Mani } 2125ce0dc0cfSRaja Mani 2126390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2127390a8c8fSRaja Mani 2128390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2129390a8c8fSRaja Mani 2130390a8c8fSRaja Mani return 0; 2131390a8c8fSRaja Mani } 2132390a8c8fSRaja Mani 213340abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 213440abc2deSRaja Mani { 213540abc2deSRaja Mani struct ath6kl_vif *vif; 213640abc2deSRaja Mani int ret; 213740abc2deSRaja Mani 213840abc2deSRaja Mani vif = ath6kl_vif_first(ar); 213940abc2deSRaja Mani if (!vif) 214040abc2deSRaja Mani return -EIO; 214140abc2deSRaja Mani 214240abc2deSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 214340abc2deSRaja Mani return -EIO; 214440abc2deSRaja Mani 214540abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 214640abc2deSRaja Mani 214740abc2deSRaja Mani /* Save the current power mode before enabling power save */ 214840abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 214940abc2deSRaja Mani 215040abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 215140abc2deSRaja Mani if (ret) 215240abc2deSRaja Mani return ret; 215340abc2deSRaja Mani 215440abc2deSRaja Mani /* Disable WOW mode */ 215540abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 215640abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 215740abc2deSRaja Mani 0, 0); 215840abc2deSRaja Mani if (ret) 215940abc2deSRaja Mani return ret; 216040abc2deSRaja Mani 216140abc2deSRaja Mani /* Flush all non control pkts in TX path */ 216240abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 216340abc2deSRaja Mani 216440abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 216540abc2deSRaja Mani if (ret) 216640abc2deSRaja Mani return ret; 216740abc2deSRaja Mani 216840abc2deSRaja Mani return 0; 216940abc2deSRaja Mani } 217040abc2deSRaja Mani 217140abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 217240abc2deSRaja Mani { 217340abc2deSRaja Mani struct ath6kl_vif *vif; 217440abc2deSRaja Mani int ret; 217540abc2deSRaja Mani 217640abc2deSRaja Mani vif = ath6kl_vif_first(ar); 217740abc2deSRaja Mani 217840abc2deSRaja Mani if (!vif) 217940abc2deSRaja Mani return -EIO; 218040abc2deSRaja Mani 218140abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 218240abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 218340abc2deSRaja Mani ar->wmi->saved_pwr_mode); 218440abc2deSRaja Mani if (ret) 218540abc2deSRaja Mani return ret; 218640abc2deSRaja Mani } 218740abc2deSRaja Mani 218840abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 218940abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 219040abc2deSRaja Mani if (ret) 219140abc2deSRaja Mani return ret; 219240abc2deSRaja Mani 219340abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 219440abc2deSRaja Mani 219540abc2deSRaja Mani /* Reset scan parameter to default values */ 219640abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 219740abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 219840abc2deSRaja Mani if (ret) 219940abc2deSRaja Mani return ret; 220040abc2deSRaja Mani 220140abc2deSRaja Mani return 0; 220240abc2deSRaja Mani } 220340abc2deSRaja Mani 220452d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22050f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22060f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 220752d81a68SKalle Valo { 2208390a8c8fSRaja Mani enum ath6kl_state prev_state; 220952d81a68SKalle Valo int ret; 221052d81a68SKalle Valo 221152d81a68SKalle Valo switch (mode) { 2212d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2213d7c44e0bSRaja Mani 2214d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2215d7c44e0bSRaja Mani 2216d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2217d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2218d7c44e0bSRaja Mani 2219390a8c8fSRaja Mani prev_state = ar->state; 2220390a8c8fSRaja Mani 2221d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2222390a8c8fSRaja Mani if (ret) { 2223390a8c8fSRaja Mani ar->state = prev_state; 2224d7c44e0bSRaja Mani return ret; 2225390a8c8fSRaja Mani } 22261e9a905dSRaja Mani 2227d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2228d7c44e0bSRaja Mani break; 2229d7c44e0bSRaja Mani 223052d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2231524441e3SRaja Mani 223240abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2233524441e3SRaja Mani 223440abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 223552d81a68SKalle Valo if (ret) { 223640abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 223740abc2deSRaja Mani return ret; 223852d81a68SKalle Valo } 223952d81a68SKalle Valo 224076a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 224176a9fbe2SKalle Valo 224252d81a68SKalle Valo break; 2243b4b2a0b1SKalle Valo 2244b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2245524441e3SRaja Mani 22467125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2247524441e3SRaja Mani 2248b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2249b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2250b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2251b4b2a0b1SKalle Valo break; 2252b4b2a0b1SKalle Valo } 2253b4b2a0b1SKalle Valo 2254b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2255b4b2a0b1SKalle Valo 2256b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2257b4b2a0b1SKalle Valo if (ret) { 2258b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2259b4b2a0b1SKalle Valo ret); 2260b4b2a0b1SKalle Valo } 2261b4b2a0b1SKalle Valo 2262b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2263b4b2a0b1SKalle Valo 2264b4b2a0b1SKalle Valo break; 2265b4b2a0b1SKalle Valo 226610509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 226710509f90SKalle Valo /* 226810509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 226910509f90SKalle Valo * wow mode and sleeping most of the time. 227010509f90SKalle Valo */ 227110509f90SKalle Valo break; 227210509f90SKalle Valo 2273b4b2a0b1SKalle Valo default: 2274b4b2a0b1SKalle Valo break; 227552d81a68SKalle Valo } 227652d81a68SKalle Valo 227752d81a68SKalle Valo return 0; 227852d81a68SKalle Valo } 2279d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 228052d81a68SKalle Valo 228152d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 228252d81a68SKalle Valo { 228376a9fbe2SKalle Valo int ret; 228476a9fbe2SKalle Valo 228576a9fbe2SKalle Valo switch (ar->state) { 2286d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2287d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2288d7c44e0bSRaja Mani 2289d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2290d7c44e0bSRaja Mani if (ret) { 2291d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2292d7c44e0bSRaja Mani return ret; 2293d7c44e0bSRaja Mani } 2294d7c44e0bSRaja Mani 2295d7c44e0bSRaja Mani break; 2296d7c44e0bSRaja Mani 229776a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 229840abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 229940abc2deSRaja Mani 230040abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 230176a9fbe2SKalle Valo if (ret) { 230240abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 230340abc2deSRaja Mani return ret; 230476a9fbe2SKalle Valo } 230576a9fbe2SKalle Valo break; 230676a9fbe2SKalle Valo 2307b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2308b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2309b4b2a0b1SKalle Valo 2310b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2311b4b2a0b1SKalle Valo if (ret) { 2312b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2313b4b2a0b1SKalle Valo return ret; 2314b4b2a0b1SKalle Valo } 2315d7c44e0bSRaja Mani break; 2316b4b2a0b1SKalle Valo 231710509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 231810509f90SKalle Valo break; 231910509f90SKalle Valo 232076a9fbe2SKalle Valo default: 232176a9fbe2SKalle Valo break; 232252d81a68SKalle Valo } 232352d81a68SKalle Valo 232452d81a68SKalle Valo return 0; 232552d81a68SKalle Valo } 2326d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 232752d81a68SKalle Valo 2328abcb344bSKalle Valo #ifdef CONFIG_PM 232952d81a68SKalle Valo 233052d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 233152d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2332abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2333abcb344bSKalle Valo { 2334abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2335abcb344bSKalle Valo 23360f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2337abcb344bSKalle Valo } 2338aa6cffc1SChilam Ng 233952d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2340aa6cffc1SChilam Ng { 2341aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2342aa6cffc1SChilam Ng 2343aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2344aa6cffc1SChilam Ng } 2345a918fb3cSRaja Mani 2346a918fb3cSRaja Mani /* 2347a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2348a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2349a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2350a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2351a918fb3cSRaja Mani * 2352a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2353a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2354a918fb3cSRaja Mani * 2355a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2356a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2357a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2358a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2359a918fb3cSRaja Mani * 2360a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2361a918fb3cSRaja Mani */ 2362a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2363a918fb3cSRaja Mani { 2364390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2365390a8c8fSRaja Mani return; 2366390a8c8fSRaja Mani 2367a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2368a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2369a918fb3cSRaja Mani } 2370a918fb3cSRaja Mani 2371a918fb3cSRaja Mani #else 2372a918fb3cSRaja Mani 2373a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2374a918fb3cSRaja Mani { 2375a918fb3cSRaja Mani } 2376abcb344bSKalle Valo #endif 2377abcb344bSKalle Valo 23786a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 23796a7c9badSJouni Malinen struct ieee80211_channel *chan, 23806a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 23816a7c9badSJouni Malinen { 2382e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2383e68f6750SSujith Manoharan 2384e68f6750SSujith Manoharan /* 2385e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2386e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2387e68f6750SSujith Manoharan * 2388e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2389e68f6750SSujith Manoharan */ 2390e68f6750SSujith Manoharan if (!dev) 2391e68f6750SSujith Manoharan return -EBUSY; 2392e68f6750SSujith Manoharan 2393e68f6750SSujith Manoharan vif = netdev_priv(dev); 23946a7c9badSJouni Malinen 2395990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23966a7c9badSJouni Malinen return -EIO; 23976a7c9badSJouni Malinen 23986a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 23996a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2400cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 24016a7c9badSJouni Malinen 24026a7c9badSJouni Malinen return 0; 24036a7c9badSJouni Malinen } 24046a7c9badSJouni Malinen 24058bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 24068bdfbf40SJouni Malinen { 24078bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 24088bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 24098bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 24108bdfbf40SJouni Malinen } 24118bdfbf40SJouni Malinen 2412334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2413334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 24148bdfbf40SJouni Malinen { 2415334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24168bdfbf40SJouni Malinen const u8 *pos; 24178bdfbf40SJouni Malinen u8 *buf = NULL; 24188bdfbf40SJouni Malinen size_t len = 0; 24198bdfbf40SJouni Malinen int ret; 24208bdfbf40SJouni Malinen 24218bdfbf40SJouni Malinen /* 24228bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 24238bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 24248bdfbf40SJouni Malinen */ 24258bdfbf40SJouni Malinen 24268bdfbf40SJouni Malinen if (ies && ies_len) { 24278bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 24288bdfbf40SJouni Malinen if (buf == NULL) 24298bdfbf40SJouni Malinen return -ENOMEM; 24308bdfbf40SJouni Malinen pos = ies; 24318bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 24328bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 24338bdfbf40SJouni Malinen break; 24348bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 24358bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 24368bdfbf40SJouni Malinen len += 2 + pos[1]; 24378bdfbf40SJouni Malinen } 24388bdfbf40SJouni Malinen pos += 2 + pos[1]; 24398bdfbf40SJouni Malinen } 24408bdfbf40SJouni Malinen } 24418bdfbf40SJouni Malinen 2442334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2443334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 24448bdfbf40SJouni Malinen kfree(buf); 24458bdfbf40SJouni Malinen return ret; 24468bdfbf40SJouni Malinen } 24478bdfbf40SJouni Malinen 24488860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 24498860020eSJohannes Berg struct cfg80211_beacon_data *info) 24508860020eSJohannes Berg { 24518860020eSJohannes Berg struct ath6kl *ar = vif->ar; 24528860020eSJohannes Berg int res; 24538860020eSJohannes Berg 245417a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24558860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24568860020eSJohannes Berg WMI_FRAME_BEACON, 24578860020eSJohannes Berg info->beacon_ies, 24588860020eSJohannes Berg info->beacon_ies_len); 24598860020eSJohannes Berg if (res) 24608860020eSJohannes Berg return res; 24618860020eSJohannes Berg 246217a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24638860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 24648860020eSJohannes Berg info->proberesp_ies_len); 24658860020eSJohannes Berg if (res) 24668860020eSJohannes Berg return res; 24678860020eSJohannes Berg 246817a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24698860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24708860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 24718860020eSJohannes Berg info->assocresp_ies, 24728860020eSJohannes Berg info->assocresp_ies_len); 24738860020eSJohannes Berg if (res) 24748860020eSJohannes Berg return res; 24758860020eSJohannes Berg 24768860020eSJohannes Berg return 0; 24778860020eSJohannes Berg } 24788860020eSJohannes Berg 24798860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 24808860020eSJohannes Berg struct cfg80211_ap_settings *info) 24816a7c9badSJouni Malinen { 24826a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 24833450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24846a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 248567cd22e4SThomas Pedersen bool hidden = false; 24866a7c9badSJouni Malinen u8 *ies; 24876a7c9badSJouni Malinen int ies_len; 24886a7c9badSJouni Malinen struct wmi_connect_cmd p; 24896a7c9badSJouni Malinen int res; 2490be5abaafSVasanthakumar Thiagarajan int i, ret; 24916a7c9badSJouni Malinen 24928860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 24936a7c9badSJouni Malinen 2494990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24956a7c9badSJouni Malinen return -EIO; 24966a7c9badSJouni Malinen 2497f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 24986a7c9badSJouni Malinen return -EOPNOTSUPP; 24996a7c9badSJouni Malinen 25008860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 25016a7c9badSJouni Malinen 25029a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 25039a5b1318SJouni Malinen 25046a7c9badSJouni Malinen /* TODO: 25056a7c9badSJouni Malinen * info->interval 25066a7c9badSJouni Malinen * info->dtim_period 25076a7c9badSJouni Malinen */ 25086a7c9badSJouni Malinen 25098860020eSJohannes Berg if (info->beacon.head == NULL) 25106a7c9badSJouni Malinen return -EINVAL; 25118860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 25126a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 25138860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 25146a7c9badSJouni Malinen return -EINVAL; 25158860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 25166a7c9badSJouni Malinen 25176a7c9badSJouni Malinen if (info->ssid == NULL) 25186a7c9badSJouni Malinen return -EINVAL; 25193450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 25203450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 25216a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 252267cd22e4SThomas Pedersen hidden = true; 252367cd22e4SThomas Pedersen 252467cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 252567cd22e4SThomas Pedersen if (res) 252667cd22e4SThomas Pedersen return res; 25276a7c9badSJouni Malinen 2528be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2529be5abaafSVasanthakumar Thiagarajan if (ret) 2530be5abaafSVasanthakumar Thiagarajan return ret; 25316a7c9badSJouni Malinen 25326a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 25336a7c9badSJouni Malinen 25346a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 25356a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 25366a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 25376a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25386a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 25396a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25406a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 25416a7c9badSJouni Malinen break; 25426a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 25436a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25446a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 25456a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25466a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 25476a7c9badSJouni Malinen break; 25486a7c9badSJouni Malinen } 25496a7c9badSJouni Malinen } 25506a7c9badSJouni Malinen if (p.auth_mode == 0) 25516a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 25523450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 25536a7c9badSJouni Malinen 25546a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 25556a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 25566a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25576a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25586a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 25596a7c9badSJouni Malinen break; 25606a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25616a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 25626a7c9badSJouni Malinen break; 25636a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25646a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 25656a7c9badSJouni Malinen break; 2566b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2567b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2568b8214df1SDai Shuibing break; 25696a7c9badSJouni Malinen } 25706a7c9badSJouni Malinen } 2571229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 25726a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2573240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2574229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2575240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 25766a7c9badSJouni Malinen 25776a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 25786a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25796a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25806a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 25816a7c9badSJouni Malinen break; 25826a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25836a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 25846a7c9badSJouni Malinen break; 25856a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25866a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 25876a7c9badSJouni Malinen break; 2588b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2589b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2590b8214df1SDai Shuibing break; 25916a7c9badSJouni Malinen default: 25926a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 25936a7c9badSJouni Malinen break; 25946a7c9badSJouni Malinen } 2595240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 25966a7c9badSJouni Malinen 25976a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2598f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 25996a7c9badSJouni Malinen 26003450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 26013450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 26023450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2603cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 26046a7c9badSJouni Malinen 2605c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2606c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2607c1762a3fSThirumalai Pachamuthu if (res < 0) 2608c1762a3fSThirumalai Pachamuthu return res; 2609c1762a3fSThirumalai Pachamuthu 26103ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 26113ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 26123ca9d1fcSAarthi Thiruvengadam } else { 26133ca9d1fcSAarthi Thiruvengadam /* 26143ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 26153ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 26163ca9d1fcSAarthi Thiruvengadam */ 26173ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 26183ca9d1fcSAarthi Thiruvengadam } 26193ca9d1fcSAarthi Thiruvengadam 262003bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 262103bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 262203bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 262303bdeb0dSVasanthakumar Thiagarajan if (res < 0) 262403bdeb0dSVasanthakumar Thiagarajan return res; 262503bdeb0dSVasanthakumar Thiagarajan } 262603bdeb0dSVasanthakumar Thiagarajan 2627334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 26289a5b1318SJouni Malinen if (res < 0) 26299a5b1318SJouni Malinen return res; 26309a5b1318SJouni Malinen 26319a5b1318SJouni Malinen return 0; 26326a7c9badSJouni Malinen } 26336a7c9badSJouni Malinen 26348860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 26358860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 26366a7c9badSJouni Malinen { 26378860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 26388860020eSJohannes Berg 26398860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 26408860020eSJohannes Berg return -EIO; 26418860020eSJohannes Berg 26428860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 26438860020eSJohannes Berg return -EOPNOTSUPP; 26448860020eSJohannes Berg 26458860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 26466a7c9badSJouni Malinen } 26476a7c9badSJouni Malinen 26488860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 26496a7c9badSJouni Malinen { 26506a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 265159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26526a7c9badSJouni Malinen 2653f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 26546a7c9badSJouni Malinen return -EOPNOTSUPP; 265559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 26566a7c9badSJouni Malinen return -ENOTCONN; 26576a7c9badSJouni Malinen 2658334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 265959c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 26606a7c9badSJouni Malinen 26616a7c9badSJouni Malinen return 0; 26626a7c9badSJouni Malinen } 26636a7c9badSJouni Malinen 266433e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 266533e5308dSJouni Malinen 266633e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 266733e5308dSJouni Malinen u8 *mac) 266833e5308dSJouni Malinen { 266933e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 267033e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 267133e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 267233e5308dSJouni Malinen 267333e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 267433e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 267533e5308dSJouni Malinen } 267633e5308dSJouni Malinen 267723875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 267823875136SJouni Malinen u8 *mac, struct station_parameters *params) 267923875136SJouni Malinen { 268023875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2681f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 268223875136SJouni Malinen 2683f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 268423875136SJouni Malinen return -EOPNOTSUPP; 268523875136SJouni Malinen 268623875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 268723875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 268823875136SJouni Malinen return -EOPNOTSUPP; 268923875136SJouni Malinen 269023875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2691334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2692334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2693334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2694334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 269523875136SJouni Malinen } 269623875136SJouni Malinen 269763fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 269863fa1e0cSJouni Malinen struct net_device *dev, 269963fa1e0cSJouni Malinen struct ieee80211_channel *chan, 270063fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 270163fa1e0cSJouni Malinen unsigned int duration, 270263fa1e0cSJouni Malinen u64 *cookie) 270363fa1e0cSJouni Malinen { 270463fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2705334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27061052261eSJouni Malinen u32 id; 270763fa1e0cSJouni Malinen 270863fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 270963fa1e0cSJouni Malinen * return -EBUSY */ 27101052261eSJouni Malinen id = ++vif->last_roc_id; 27111052261eSJouni Malinen if (id == 0) { 27121052261eSJouni Malinen /* Do not use 0 as the cookie value */ 27131052261eSJouni Malinen id = ++vif->last_roc_id; 27141052261eSJouni Malinen } 27151052261eSJouni Malinen *cookie = id; 271663fa1e0cSJouni Malinen 2717334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2718334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 271963fa1e0cSJouni Malinen } 272063fa1e0cSJouni Malinen 272163fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 272263fa1e0cSJouni Malinen struct net_device *dev, 272363fa1e0cSJouni Malinen u64 cookie) 272463fa1e0cSJouni Malinen { 272563fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2726334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 272763fa1e0cSJouni Malinen 27281052261eSJouni Malinen if (cookie != vif->last_roc_id) 272963fa1e0cSJouni Malinen return -ENOENT; 27301052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 273163fa1e0cSJouni Malinen 2732334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 273363fa1e0cSJouni Malinen } 273463fa1e0cSJouni Malinen 2735334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2736334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2737334234b5SVasanthakumar Thiagarajan unsigned int freq) 27388bdfbf40SJouni Malinen { 2739334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27408bdfbf40SJouni Malinen const u8 *pos; 27418bdfbf40SJouni Malinen u8 *p2p; 27428bdfbf40SJouni Malinen int p2p_len; 27438bdfbf40SJouni Malinen int ret; 27448bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 27458bdfbf40SJouni Malinen 27468bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27478bdfbf40SJouni Malinen 27488bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 27498bdfbf40SJouni Malinen 27508bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 27518bdfbf40SJouni Malinen if (p2p == NULL) 27528bdfbf40SJouni Malinen return -ENOMEM; 27538bdfbf40SJouni Malinen p2p_len = 0; 27548bdfbf40SJouni Malinen 27558bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 27568bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 27578bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 27588bdfbf40SJouni Malinen break; 27598bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 27608bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 27618bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 27628bdfbf40SJouni Malinen } 27638bdfbf40SJouni Malinen pos += 2 + pos[1]; 27648bdfbf40SJouni Malinen } 27658bdfbf40SJouni Malinen 2766334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2767334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 27688bdfbf40SJouni Malinen kfree(p2p); 27698bdfbf40SJouni Malinen return ret; 27708bdfbf40SJouni Malinen } 27718bdfbf40SJouni Malinen 2772d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2773d0ff7383SNaveen Gangadharan u32 id, 2774d0ff7383SNaveen Gangadharan u32 freq, 2775d0ff7383SNaveen Gangadharan u32 wait, 2776d0ff7383SNaveen Gangadharan const u8 *buf, 2777d0ff7383SNaveen Gangadharan size_t len, 2778d0ff7383SNaveen Gangadharan bool *more_data, 2779d0ff7383SNaveen Gangadharan bool no_cck) 2780d0ff7383SNaveen Gangadharan { 2781d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2782d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2783d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2784d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2785d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2786d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2787d0ff7383SNaveen Gangadharan 2788d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2789d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2790d0ff7383SNaveen Gangadharan return false; 2791d0ff7383SNaveen Gangadharan 2792d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2793d0ff7383SNaveen Gangadharan if (!conn) 2794d0ff7383SNaveen Gangadharan return false; 2795d0ff7383SNaveen Gangadharan 2796d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2797d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2798d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2799d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2800d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2801d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2802d0ff7383SNaveen Gangadharan return false; 2803d0ff7383SNaveen Gangadharan 2804d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2805d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2806d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2807d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2808d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2809d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2810d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2811d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2812d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2813d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2814d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2815d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2816d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2817d0ff7383SNaveen Gangadharan 2818d0ff7383SNaveen Gangadharan /* 2819d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2820d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2821d0ff7383SNaveen Gangadharan * STA. 2822d0ff7383SNaveen Gangadharan */ 2823d0ff7383SNaveen Gangadharan if (is_psq_empty) 2824d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2825d0ff7383SNaveen Gangadharan conn->aid, 1); 2826d0ff7383SNaveen Gangadharan return true; 2827d0ff7383SNaveen Gangadharan } 2828d0ff7383SNaveen Gangadharan 2829d0ff7383SNaveen Gangadharan /* 2830d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2831d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2832d0ff7383SNaveen Gangadharan */ 2833d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2834d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2835d0ff7383SNaveen Gangadharan *more_data = true; 2836d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2837d0ff7383SNaveen Gangadharan } 2838d0ff7383SNaveen Gangadharan 2839d0ff7383SNaveen Gangadharan return false; 2840d0ff7383SNaveen Gangadharan } 2841d0ff7383SNaveen Gangadharan 2842c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 2843c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 2844c86e4f44SAarthi Thiruvengadam { 2845c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 2846c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 2847c86e4f44SAarthi Thiruvengadam 2848c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 2849c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 2850c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 2851c86e4f44SAarthi Thiruvengadam return true; 2852c86e4f44SAarthi Thiruvengadam } 2853c86e4f44SAarthi Thiruvengadam 2854c86e4f44SAarthi Thiruvengadam return false; 2855c86e4f44SAarthi Thiruvengadam } 2856c86e4f44SAarthi Thiruvengadam 28578a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 28588a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 28598a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 28608a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2861e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2862e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 28638a6c8060SJouni Malinen { 28648a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 286559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28668a6c8060SJouni Malinen u32 id; 28678bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2868d0ff7383SNaveen Gangadharan bool more_data, queued; 28698bdfbf40SJouni Malinen 28708bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 2871c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 2872c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 2873c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 28748bdfbf40SJouni Malinen /* 2875c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 28768bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 28778bdfbf40SJouni Malinen */ 28788bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2879334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 28808bdfbf40SJouni Malinen chan->center_freq); 28818bdfbf40SJouni Malinen } 28828a6c8060SJouni Malinen 2883cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 28848a6c8060SJouni Malinen if (id == 0) { 28858a6c8060SJouni Malinen /* 28868a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 28878a6c8060SJouni Malinen * used for the command. 28888a6c8060SJouni Malinen */ 2889cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 28908a6c8060SJouni Malinen } 28918a6c8060SJouni Malinen 28928a6c8060SJouni Malinen *cookie = id; 28933ca9d1fcSAarthi Thiruvengadam 2894d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2895d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2896d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2897d0ff7383SNaveen Gangadharan id, chan->center_freq, 2898d0ff7383SNaveen Gangadharan wait, buf, 2899d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2900d0ff7383SNaveen Gangadharan if (queued) 2901d0ff7383SNaveen Gangadharan return 0; 2902d0ff7383SNaveen Gangadharan } 2903d0ff7383SNaveen Gangadharan 29043ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 29053ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 29063ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 29073ca9d1fcSAarthi Thiruvengadam } 29088a6c8060SJouni Malinen 2909ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2910ae32c30aSJouni Malinen struct net_device *dev, 2911ae32c30aSJouni Malinen u16 frame_type, bool reg) 2912ae32c30aSJouni Malinen { 2913cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2914ae32c30aSJouni Malinen 2915ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2916ae32c30aSJouni Malinen __func__, frame_type, reg); 2917ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2918ae32c30aSJouni Malinen /* 2919ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2920ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2921ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2922ae32c30aSJouni Malinen */ 2923cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2924ae32c30aSJouni Malinen } 2925ae32c30aSJouni Malinen } 2926ae32c30aSJouni Malinen 292710509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 292810509f90SKalle Valo struct net_device *dev, 292910509f90SKalle Valo struct cfg80211_sched_scan_request *request) 293010509f90SKalle Valo { 293110509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 293210509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 293310509f90SKalle Valo u16 interval; 293410509f90SKalle Valo int ret; 293510509f90SKalle Valo u8 i; 293610509f90SKalle Valo 293710509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 293810509f90SKalle Valo return -EIO; 293910509f90SKalle Valo 294010509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 294110509f90SKalle Valo return -EBUSY; 294210509f90SKalle Valo 2943b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2944b4d13d3bSKalle Valo 294510509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 294610509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 294710509f90SKalle Valo i, DISABLE_SSID_FLAG, 294810509f90SKalle Valo 0, NULL); 294910509f90SKalle Valo } 295010509f90SKalle Valo 295110509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 295210509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 295310509f90SKalle Valo 295410509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 295510509f90SKalle Valo interval, interval, 295610509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 295710509f90SKalle Valo 295810509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 295910509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 296010509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 296110509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 296210509f90SKalle Valo request->ssids[i].ssid_len, 296310509f90SKalle Valo request->ssids[i].ssid); 296410509f90SKalle Valo } 296510509f90SKalle Valo } 296610509f90SKalle Valo 296710509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 296810509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 296910509f90SKalle Valo WOW_FILTER_SSID, 297010509f90SKalle Valo WOW_HOST_REQ_DELAY); 297110509f90SKalle Valo if (ret) { 297210509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 297310509f90SKalle Valo return ret; 297410509f90SKalle Valo } 297510509f90SKalle Valo 297610509f90SKalle Valo /* this also clears IE in fw if it's not set */ 297710509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 297810509f90SKalle Valo WMI_FRAME_PROBE_REQ, 297910509f90SKalle Valo request->ie, request->ie_len); 298010509f90SKalle Valo if (ret) { 298110509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 298210509f90SKalle Valo ret); 298310509f90SKalle Valo return ret; 298410509f90SKalle Valo } 298510509f90SKalle Valo 298610509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 298710509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 298810509f90SKalle Valo if (ret) { 298910509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 299010509f90SKalle Valo ret); 299110509f90SKalle Valo return ret; 299210509f90SKalle Valo } 299310509f90SKalle Valo 299410509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 299510509f90SKalle Valo 299610509f90SKalle Valo return ret; 299710509f90SKalle Valo } 299810509f90SKalle Valo 299910509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 300010509f90SKalle Valo struct net_device *dev) 300110509f90SKalle Valo { 300210509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 300310509f90SKalle Valo bool stopped; 300410509f90SKalle Valo 300510509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 300610509f90SKalle Valo 300710509f90SKalle Valo if (!stopped) 300810509f90SKalle Valo return -EIO; 300910509f90SKalle Valo 301010509f90SKalle Valo return 0; 301110509f90SKalle Valo } 301210509f90SKalle Valo 3013f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3014f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3015f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3016f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3017f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3018f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3019f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3020f80574aeSJouni Malinen }, 3021ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3022ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3023ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3024ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3025ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3026ba1f6fe3SJouni Malinen }, 3027f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3028f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3029f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3030f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3031f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3032f80574aeSJouni Malinen }, 3033f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3034f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3035f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3036f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3037f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3038f80574aeSJouni Malinen }, 3039f80574aeSJouni Malinen }; 3040f80574aeSJouni Malinen 3041bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 304255055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 304355055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3044bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3045bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3046bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3047bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3048bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3049bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3050bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3051bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3052bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3053bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3054bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3055bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3056bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3057bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3058bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3059bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3060bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3061bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3062003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3063abcb344bSKalle Valo #ifdef CONFIG_PM 306452d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 306552d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3066abcb344bSKalle Valo #endif 30676a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 30688860020eSJohannes Berg .start_ap = ath6kl_start_ap, 30698860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 30708860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 307133e5308dSJouni Malinen .del_station = ath6kl_del_station, 307223875136SJouni Malinen .change_station = ath6kl_change_station, 307363fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 307463fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 30758a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3076ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 307710509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 307810509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3079bdcd8170SKalle Valo }; 3080bdcd8170SKalle Valo 30817125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3082ec4b7f60SKalle Valo { 308310509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 308410509f90SKalle Valo 3085ec4b7f60SKalle Valo switch (vif->sme_state) { 3086c97a31b0SKalle Valo case SME_DISCONNECTED: 3087c97a31b0SKalle Valo break; 3088ec4b7f60SKalle Valo case SME_CONNECTING: 3089ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3090ec4b7f60SKalle Valo NULL, 0, 3091ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3092ec4b7f60SKalle Valo GFP_KERNEL); 3093ec4b7f60SKalle Valo break; 3094ec4b7f60SKalle Valo case SME_CONNECTED: 3095ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3096ec4b7f60SKalle Valo break; 3097ec4b7f60SKalle Valo } 3098ec4b7f60SKalle Valo 3099ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3100ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 31017125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3102ec4b7f60SKalle Valo 3103ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 31041f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 31051f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3106ec4b7f60SKalle Valo 3107ec4b7f60SKalle Valo /* disable scanning */ 31087125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 31097125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 31107125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3111ec4b7f60SKalle Valo 3112ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3113ec4b7f60SKalle Valo } 3114ec4b7f60SKalle Valo 31157125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 31167125f01dSKalle Valo { 31177125f01dSKalle Valo struct ath6kl_vif *vif; 31187125f01dSKalle Valo 31197125f01dSKalle Valo vif = ath6kl_vif_first(ar); 31207125f01dSKalle Valo if (!vif) { 31217125f01dSKalle Valo /* save the current power mode before enabling power save */ 31227125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 31237125f01dSKalle Valo 31247125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 31257125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 31267125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 31277125f01dSKalle Valo return; 31287125f01dSKalle Valo } 31297125f01dSKalle Valo 31307125f01dSKalle Valo /* 31317125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 31327125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 31337125f01dSKalle Valo * sleeps. 31347125f01dSKalle Valo */ 31357125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 31367125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 31377125f01dSKalle Valo } 31387125f01dSKalle Valo 3139c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 31408dafb70eSVasanthakumar Thiagarajan { 31417baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 31422132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 31438dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 31448dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 31458dafb70eSVasanthakumar Thiagarajan } 31468dafb70eSVasanthakumar Thiagarajan 3147de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3148108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 314910509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 315010509f90SKalle Valo (unsigned long) vif); 315110509f90SKalle Valo 3152de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3153478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 31548dafb70eSVasanthakumar Thiagarajan 315580abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 315680abaf9bSVasanthakumar Thiagarajan 31578dafb70eSVasanthakumar Thiagarajan return 0; 31588dafb70eSVasanthakumar Thiagarajan } 31598dafb70eSVasanthakumar Thiagarajan 3160c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 31618dafb70eSVasanthakumar Thiagarajan { 316255055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 316380abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 316455055976SVasanthakumar Thiagarajan 31652132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3166108438bcSVasanthakumar Thiagarajan 316755055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 316855055976SVasanthakumar Thiagarajan 316955055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 317055055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 317155055976SVasanthakumar Thiagarajan 317280abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 317380abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 317480abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 317580abaf9bSVasanthakumar Thiagarajan } 317680abaf9bSVasanthakumar Thiagarajan 317727929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 317855055976SVasanthakumar Thiagarajan 317955055976SVasanthakumar Thiagarajan ar->num_vif--; 31808dafb70eSVasanthakumar Thiagarajan } 31818dafb70eSVasanthakumar Thiagarajan 31828dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 318355055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 318455055976SVasanthakumar Thiagarajan u8 nw_type) 31858dafb70eSVasanthakumar Thiagarajan { 31868dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3187108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 31888dafb70eSVasanthakumar Thiagarajan 318955055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 31908dafb70eSVasanthakumar Thiagarajan if (!ndev) 31918dafb70eSVasanthakumar Thiagarajan return NULL; 31928dafb70eSVasanthakumar Thiagarajan 3193108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3194108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3195108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3196108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3197108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3198108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3199108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3200108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3201334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3202d0d670abSKalle Valo vif->nw_type = nw_type; 3203d0d670abSKalle Valo vif->next_mode = nw_type; 32048f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3205ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 32068dafb70eSVasanthakumar Thiagarajan 320755055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 320855055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 320955055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 321055055976SVasanthakumar Thiagarajan 0x2; 321155055976SVasanthakumar Thiagarajan 32128dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 32138dafb70eSVasanthakumar Thiagarajan 3214e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 32158dafb70eSVasanthakumar Thiagarajan 3216c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 32178dafb70eSVasanthakumar Thiagarajan goto err; 32188dafb70eSVasanthakumar Thiagarajan 321927929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 32208dafb70eSVasanthakumar Thiagarajan goto err; 32218dafb70eSVasanthakumar Thiagarajan 322255055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 322314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 322459c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 32258dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 322659c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 32278dafb70eSVasanthakumar Thiagarajan 322855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 322955055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 323055055976SVasanthakumar Thiagarajan 323111f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3232990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 323311f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3234990bd915SVasanthakumar Thiagarajan 32358dafb70eSVasanthakumar Thiagarajan return ndev; 32368dafb70eSVasanthakumar Thiagarajan 32378dafb70eSVasanthakumar Thiagarajan err: 323827929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 323927929723SVasanthakumar Thiagarajan free_netdev(ndev); 3240bdcd8170SKalle Valo return NULL; 3241bdcd8170SKalle Valo } 3242bdcd8170SKalle Valo 324346d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 324446d33a21SKalle Valo { 324546d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 324646d33a21SKalle Valo int ret; 324746d33a21SKalle Valo 324846d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 324946d33a21SKalle Valo 325046d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 325146d33a21SKalle Valo 325246d33a21SKalle Valo /* set device pointer for wiphy */ 325346d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 325446d33a21SKalle Valo 325546d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 325646d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 325746d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 325846d33a21SKalle Valo if (ar->p2p) { 325946d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 326046d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 326146d33a21SKalle Valo } 326246d33a21SKalle Valo 326346d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 326446d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 326546d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 326646d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 326746d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 326846d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 326946d33a21SKalle Valo 327046d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 327146d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 327246d33a21SKalle Valo 327346d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 327446d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 327546d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 327646d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 327746d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 327846d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 327946d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 328046d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 328146d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 328246d33a21SKalle Valo 328346d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 328446d33a21SKalle Valo 3285f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3286f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3287f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3288f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3289f2afdac7SVasanthakumar Thiagarajan 3290f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3291f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3292f2afdac7SVasanthakumar Thiagarajan 329303bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 329403bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 329503bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 329603bdeb0dSVasanthakumar Thiagarajan 3297f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3298f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3299f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3300f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3301f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3302f2afdac7SVasanthakumar Thiagarajan 330346d33a21SKalle Valo ret = wiphy_register(wiphy); 330446d33a21SKalle Valo if (ret < 0) { 330546d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 330646d33a21SKalle Valo return ret; 330746d33a21SKalle Valo } 330846d33a21SKalle Valo 3309e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3310e5348a1eSVasanthakumar Thiagarajan 331146d33a21SKalle Valo return 0; 331246d33a21SKalle Valo } 331346d33a21SKalle Valo 331446d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3315bdcd8170SKalle Valo { 3316be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3317e5348a1eSVasanthakumar Thiagarajan 3318e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 331945eaa78fSKalle Valo } 332046d33a21SKalle Valo 332145eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 332245eaa78fSKalle Valo { 332345eaa78fSKalle Valo struct ath6kl *ar; 332445eaa78fSKalle Valo struct wiphy *wiphy; 332545eaa78fSKalle Valo 332645eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 332745eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 332845eaa78fSKalle Valo 332945eaa78fSKalle Valo if (!wiphy) { 333045eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 333145eaa78fSKalle Valo return NULL; 333245eaa78fSKalle Valo } 333345eaa78fSKalle Valo 333445eaa78fSKalle Valo ar = wiphy_priv(wiphy); 333545eaa78fSKalle Valo ar->wiphy = wiphy; 333645eaa78fSKalle Valo 333745eaa78fSKalle Valo return ar; 333845eaa78fSKalle Valo } 333945eaa78fSKalle Valo 334045eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 334145eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 334245eaa78fSKalle Valo { 33431d2a4456SVasanthakumar Thiagarajan int i; 33441d2a4456SVasanthakumar Thiagarajan 33451d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 33461d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 33471d2a4456SVasanthakumar Thiagarajan 3348be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3349bdcd8170SKalle Valo } 335045eaa78fSKalle Valo 3351