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 9445b35dff0SRaja Mani vif->scan_req = request; 9455b35dff0SRaja Mani 9463ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9473ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9483ca9d1fcSAarthi Thiruvengadam /* 9493ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9503ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9513ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9523ca9d1fcSAarthi Thiruvengadam * probe requests 9533ca9d1fcSAarthi Thiruvengadam */ 9543ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9553ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 95613423c31SVasanthakumar Thiagarajan false, 0, 95713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95813423c31SVasanthakumar Thiagarajan n_channels, channels, 95913423c31SVasanthakumar Thiagarajan request->no_cck, 9603ca9d1fcSAarthi Thiruvengadam request->rates); 9613ca9d1fcSAarthi Thiruvengadam } else { 9623ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9633ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 96413423c31SVasanthakumar Thiagarajan false, 0, 96513423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 96613423c31SVasanthakumar Thiagarajan n_channels, channels); 9673ca9d1fcSAarthi Thiruvengadam } 9685b35dff0SRaja Mani if (ret) { 969bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 9705b35dff0SRaja Mani vif->scan_req = NULL; 9715b35dff0SRaja Mani } 972bdcd8170SKalle Valo 9731276c9efSEdward Lu kfree(channels); 9741276c9efSEdward Lu 975bdcd8170SKalle Valo return ret; 976bdcd8170SKalle Valo } 977bdcd8170SKalle Valo 9781c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 979bdcd8170SKalle Valo { 980240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9816fd1eaceSKalle Valo int i; 982bdcd8170SKalle Valo 9831c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9841c17d313SKalle Valo aborted ? " aborted" : ""); 985bdcd8170SKalle Valo 98614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9876fd1eaceSKalle Valo return; 9886fd1eaceSKalle Valo 9891c17d313SKalle Valo if (aborted) 9906fd1eaceSKalle Valo goto out; 991bdcd8170SKalle Valo 99214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 99314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 994334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 995334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 996bdcd8170SKalle Valo 0, NULL); 997bdcd8170SKalle Valo } 998bdcd8170SKalle Valo } 9996fd1eaceSKalle Valo 10006fd1eaceSKalle Valo out: 1001cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 100214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1003bdcd8170SKalle Valo } 1004bdcd8170SKalle Valo 1005bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1006bdcd8170SKalle Valo u8 key_index, bool pairwise, 1007bdcd8170SKalle Valo const u8 *mac_addr, 1008bdcd8170SKalle Valo struct key_params *params) 1009bdcd8170SKalle Valo { 1010d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 101159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1012bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10134a8ce2fdSSujith Manoharan int seq_len; 1014bdcd8170SKalle Valo u8 key_usage; 1015bdcd8170SKalle Valo u8 key_type; 1016bdcd8170SKalle Valo 1017990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1018bdcd8170SKalle Valo return -EIO; 1019bdcd8170SKalle Valo 1020837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1021837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1022837cb97eSJouni Malinen return -EINVAL; 1023240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1024240d2799SVasanthakumar Thiagarajan params->key); 1025837cb97eSJouni Malinen } 1026837cb97eSJouni Malinen 1027792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1028bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1029bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1030bdcd8170SKalle Valo key_index); 1031bdcd8170SKalle Valo return -ENOENT; 1032bdcd8170SKalle Valo } 1033bdcd8170SKalle Valo 10346f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1035bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1036bdcd8170SKalle Valo 1037bdcd8170SKalle Valo if (pairwise) 1038bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1039bdcd8170SKalle Valo else 1040bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1041bdcd8170SKalle Valo 10424a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10435e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10445e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10455e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10465e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10475e07021eSDai Shuibing } 1048bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10495e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1050bdcd8170SKalle Valo return -EINVAL; 1051bdcd8170SKalle Valo 1052bdcd8170SKalle Valo key->key_len = params->key_len; 1053bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10545e07021eSDai Shuibing key->seq_len = seq_len; 1055bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1056bdcd8170SKalle Valo key->cipher = params->cipher; 1057bdcd8170SKalle Valo 1058bdcd8170SKalle Valo switch (key->cipher) { 1059bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1060bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1061bdcd8170SKalle Valo key_type = WEP_CRYPT; 1062bdcd8170SKalle Valo break; 1063bdcd8170SKalle Valo 1064bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1065bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1066bdcd8170SKalle Valo break; 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1069bdcd8170SKalle Valo key_type = AES_CRYPT; 1070bdcd8170SKalle Valo break; 10715e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10725e07021eSDai Shuibing key_type = WAPI_CRYPT; 10735e07021eSDai Shuibing break; 1074bdcd8170SKalle Valo 1075bdcd8170SKalle Valo default: 1076bdcd8170SKalle Valo return -ENOTSUPP; 1077bdcd8170SKalle Valo } 1078bdcd8170SKalle Valo 1079ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1080ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1081ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1082de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1083bdcd8170SKalle Valo 1084bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1085bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1086bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1087bdcd8170SKalle Valo key_usage, key->seq_len); 1088bdcd8170SKalle Valo 1089f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10904703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1091cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10929a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10939a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10949a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10959a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10969a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 109759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10989a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10999a5b1318SJouni Malinen "key configuration until AP mode has been " 11009a5b1318SJouni Malinen "started\n"); 11019a5b1318SJouni Malinen /* 11029a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11039a5b1318SJouni Malinen * the connected event is received from the target. 11049a5b1318SJouni Malinen */ 11059a5b1318SJouni Malinen return 0; 11069a5b1318SJouni Malinen } 11079a5b1318SJouni Malinen } 11089a5b1318SJouni Malinen 1109f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 111059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1111151411e8SJouni Malinen /* 1112151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1113151411e8SJouni Malinen * the AP mode has properly started 1114151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1115151411e8SJouni Malinen */ 1116151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1117151411e8SJouni Malinen "until AP mode has been started\n"); 11186f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11196f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11206f2a73f9SVasanthakumar Thiagarajan key->key_len); 1121151411e8SJouni Malinen return 0; 1122151411e8SJouni Malinen } 1123151411e8SJouni Malinen 11247cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1125bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1126f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1127f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1128bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1129bdcd8170SKalle Valo } 1130bdcd8170SKalle Valo 1131bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1132bdcd8170SKalle Valo u8 key_index, bool pairwise, 1133bdcd8170SKalle Valo const u8 *mac_addr) 1134bdcd8170SKalle Valo { 1135d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11366f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1137bdcd8170SKalle Valo 1138bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1139bdcd8170SKalle Valo 1140990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1141bdcd8170SKalle Valo return -EIO; 1142bdcd8170SKalle Valo 1143792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1145bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1146bdcd8170SKalle Valo key_index); 1147bdcd8170SKalle Valo return -ENOENT; 1148bdcd8170SKalle Valo } 1149bdcd8170SKalle Valo 11506f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1151bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1152bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1153bdcd8170SKalle Valo return 0; 1154bdcd8170SKalle Valo } 1155bdcd8170SKalle Valo 11566f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1157bdcd8170SKalle Valo 1158334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1159bdcd8170SKalle Valo } 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1162bdcd8170SKalle Valo u8 key_index, bool pairwise, 1163bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1164bdcd8170SKalle Valo void (*callback) (void *cookie, 1165bdcd8170SKalle Valo struct key_params *)) 1166bdcd8170SKalle Valo { 11676f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1168bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1169bdcd8170SKalle Valo struct key_params params; 1170bdcd8170SKalle Valo 1171bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1172bdcd8170SKalle Valo 1173990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1174bdcd8170SKalle Valo return -EIO; 1175bdcd8170SKalle Valo 1176792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1177bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1178bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1179bdcd8170SKalle Valo key_index); 1180bdcd8170SKalle Valo return -ENOENT; 1181bdcd8170SKalle Valo } 1182bdcd8170SKalle Valo 11836f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1184bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1185bdcd8170SKalle Valo params.cipher = key->cipher; 1186bdcd8170SKalle Valo params.key_len = key->key_len; 1187bdcd8170SKalle Valo params.seq_len = key->seq_len; 1188bdcd8170SKalle Valo params.seq = key->seq; 1189bdcd8170SKalle Valo params.key = key->key; 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo callback(cookie, ¶ms); 1192bdcd8170SKalle Valo 1193bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1194bdcd8170SKalle Valo } 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1197bdcd8170SKalle Valo struct net_device *ndev, 1198bdcd8170SKalle Valo u8 key_index, bool unicast, 1199bdcd8170SKalle Valo bool multicast) 1200bdcd8170SKalle Valo { 1201d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 120259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1203bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1204bdcd8170SKalle Valo u8 key_usage; 1205229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1206bdcd8170SKalle Valo 1207bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1208bdcd8170SKalle Valo 1209990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1210bdcd8170SKalle Valo return -EIO; 1211bdcd8170SKalle Valo 1212792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1213bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1214bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1215bdcd8170SKalle Valo __func__, key_index); 1216bdcd8170SKalle Valo return -ENOENT; 1217bdcd8170SKalle Valo } 1218bdcd8170SKalle Valo 12196f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1221bdcd8170SKalle Valo __func__, key_index); 1222bdcd8170SKalle Valo return -EINVAL; 1223bdcd8170SKalle Valo } 1224bdcd8170SKalle Valo 12253450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12266f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1227bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12283450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1229bdcd8170SKalle Valo key_usage |= TX_USAGE; 1230229ed6b5SEdward Lu if (unicast) 12313450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1232229ed6b5SEdward Lu if (multicast) 12333450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1234bdcd8170SKalle Valo 1235f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12369a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12379a5b1318SJouni Malinen 1238f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1239334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1240229ed6b5SEdward Lu key_type, key_usage, 1241f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1242f4bb9a6fSJouni Malinen key->key, 1243bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1244bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1245bdcd8170SKalle Valo } 1246bdcd8170SKalle Valo 1247240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1248bdcd8170SKalle Valo bool ismcast) 1249bdcd8170SKalle Valo { 1250bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1251bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1252bdcd8170SKalle Valo 1253240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1254bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1255bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1256bdcd8170SKalle Valo GFP_KERNEL); 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo 1259bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1260bdcd8170SKalle Valo { 1261bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1262990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1263bdcd8170SKalle Valo int ret; 1264bdcd8170SKalle Valo 1265bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1266bdcd8170SKalle Valo changed); 1267bdcd8170SKalle Valo 1268990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1269990bd915SVasanthakumar Thiagarajan if (!vif) 1270990bd915SVasanthakumar Thiagarajan return -EIO; 1271990bd915SVasanthakumar Thiagarajan 1272990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1273bdcd8170SKalle Valo return -EIO; 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1276bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1277bdcd8170SKalle Valo if (ret != 0) { 1278bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1279bdcd8170SKalle Valo return -EIO; 1280bdcd8170SKalle Valo } 1281bdcd8170SKalle Valo } 1282bdcd8170SKalle Valo 1283bdcd8170SKalle Valo return 0; 1284bdcd8170SKalle Valo } 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo /* 1287bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1288bdcd8170SKalle Valo * data type from 2.6.36 onwards 1289bdcd8170SKalle Valo */ 1290bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1291bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1292b992a285SLuis R. Rodriguez int mbm) 1293bdcd8170SKalle Valo { 1294bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1295990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1296b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1297bdcd8170SKalle Valo 1298bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1299bdcd8170SKalle Valo type, dbm); 1300bdcd8170SKalle Valo 1301990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1302990bd915SVasanthakumar Thiagarajan if (!vif) 1303990bd915SVasanthakumar Thiagarajan return -EIO; 1304990bd915SVasanthakumar Thiagarajan 1305990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1306bdcd8170SKalle Valo return -EIO; 1307bdcd8170SKalle Valo 1308bdcd8170SKalle Valo switch (type) { 1309bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1310bdcd8170SKalle Valo return 0; 1311bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1312d0d670abSKalle Valo ar->tx_pwr = dbm; 1313bdcd8170SKalle Valo break; 1314bdcd8170SKalle Valo default: 1315bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1316bdcd8170SKalle Valo __func__, type); 1317bdcd8170SKalle Valo return -EOPNOTSUPP; 1318bdcd8170SKalle Valo } 1319bdcd8170SKalle Valo 1320d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo return 0; 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1326bdcd8170SKalle Valo { 1327bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1328990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1329bdcd8170SKalle Valo 1330990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1331990bd915SVasanthakumar Thiagarajan if (!vif) 1332990bd915SVasanthakumar Thiagarajan return -EIO; 1333990bd915SVasanthakumar Thiagarajan 1334990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1335bdcd8170SKalle Valo return -EIO; 1336bdcd8170SKalle Valo 133759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1338bdcd8170SKalle Valo ar->tx_pwr = 0; 1339bdcd8170SKalle Valo 1340990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1341bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1342bdcd8170SKalle Valo return -EIO; 1343bdcd8170SKalle Valo } 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1346bdcd8170SKalle Valo 5 * HZ); 1347bdcd8170SKalle Valo 1348bdcd8170SKalle Valo if (signal_pending(current)) { 1349bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1350bdcd8170SKalle Valo return -EINTR; 1351bdcd8170SKalle Valo } 1352bdcd8170SKalle Valo } 1353bdcd8170SKalle Valo 1354bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1355bdcd8170SKalle Valo return 0; 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1359bdcd8170SKalle Valo struct net_device *dev, 1360bdcd8170SKalle Valo bool pmgmt, int timeout) 1361bdcd8170SKalle Valo { 1362bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1363bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1364334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1365bdcd8170SKalle Valo 1366bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1367bdcd8170SKalle Valo __func__, pmgmt, timeout); 1368bdcd8170SKalle Valo 1369990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1370bdcd8170SKalle Valo return -EIO; 1371bdcd8170SKalle Valo 1372bdcd8170SKalle Valo if (pmgmt) { 1373bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1374bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1375bdcd8170SKalle Valo } else { 1376bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1377bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1378bdcd8170SKalle Valo } 1379bdcd8170SKalle Valo 1380334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1381334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1382bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo } 1385bdcd8170SKalle Valo 1386bdcd8170SKalle Valo return 0; 1387bdcd8170SKalle Valo } 1388bdcd8170SKalle Valo 138955055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 139055055976SVasanthakumar Thiagarajan char *name, 139155055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 139255055976SVasanthakumar Thiagarajan u32 *flags, 139355055976SVasanthakumar Thiagarajan struct vif_params *params) 139455055976SVasanthakumar Thiagarajan { 139555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139655055976SVasanthakumar Thiagarajan struct net_device *ndev; 139755055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 139855055976SVasanthakumar Thiagarajan 139971f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 140055055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 140155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140255055976SVasanthakumar Thiagarajan } 140355055976SVasanthakumar Thiagarajan 140455055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 140555055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 140655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140755055976SVasanthakumar Thiagarajan } 140855055976SVasanthakumar Thiagarajan 140955055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 141055055976SVasanthakumar Thiagarajan if (!ndev) 141155055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 141255055976SVasanthakumar Thiagarajan 141355055976SVasanthakumar Thiagarajan ar->num_vif++; 141455055976SVasanthakumar Thiagarajan 141555055976SVasanthakumar Thiagarajan return ndev; 141655055976SVasanthakumar Thiagarajan } 141755055976SVasanthakumar Thiagarajan 141855055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 141955055976SVasanthakumar Thiagarajan struct net_device *ndev) 142055055976SVasanthakumar Thiagarajan { 142155055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 142255055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 142355055976SVasanthakumar Thiagarajan 142411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 142555055976SVasanthakumar Thiagarajan list_del(&vif->list); 142611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 142755055976SVasanthakumar Thiagarajan 142855055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 142955055976SVasanthakumar Thiagarajan 1430c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 143155055976SVasanthakumar Thiagarajan 143255055976SVasanthakumar Thiagarajan return 0; 143355055976SVasanthakumar Thiagarajan } 143455055976SVasanthakumar Thiagarajan 1435bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1436bdcd8170SKalle Valo struct net_device *ndev, 1437bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1438bdcd8170SKalle Valo struct vif_params *params) 1439bdcd8170SKalle Valo { 1440f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1441bdcd8170SKalle Valo 1442bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo switch (type) { 1445bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1446f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1447bdcd8170SKalle Valo break; 1448bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1449f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1450bdcd8170SKalle Valo break; 14516e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1452f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14536e4604c8SJouni Malinen break; 14546b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1455f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14566b5e5d25SJouni Malinen break; 14576b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1458f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14596b5e5d25SJouni Malinen break; 1460bdcd8170SKalle Valo default: 1461bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1462bdcd8170SKalle Valo return -EOPNOTSUPP; 1463bdcd8170SKalle Valo } 1464bdcd8170SKalle Valo 1465551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo return 0; 1468bdcd8170SKalle Valo } 1469bdcd8170SKalle Valo 1470bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1471bdcd8170SKalle Valo struct net_device *dev, 1472bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1473bdcd8170SKalle Valo { 1474bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 147559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1476bdcd8170SKalle Valo int status; 1477bdcd8170SKalle Valo 1478990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1479bdcd8170SKalle Valo return -EIO; 1480bdcd8170SKalle Valo 14813450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14823450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1483bdcd8170SKalle Valo 1484bdcd8170SKalle Valo if (ibss_param->channel) 1485f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1486bdcd8170SKalle Valo 1487bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1488bdcd8170SKalle Valo /* 1489bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1490bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1491bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1492bdcd8170SKalle Valo * updated. 1493bdcd8170SKalle Valo */ 1494bdcd8170SKalle Valo return -EOPNOTSUPP; 1495bdcd8170SKalle Valo } 1496bdcd8170SKalle Valo 14978c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1498bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14998c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 15008c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1501bdcd8170SKalle Valo 1502240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1503bdcd8170SKalle Valo 1504240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1505bdcd8170SKalle Valo if (status) 1506bdcd8170SKalle Valo return status; 1507bdcd8170SKalle Valo 1508bdcd8170SKalle Valo if (ibss_param->privacy) { 1509240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1511bdcd8170SKalle Valo } else { 1512240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1513240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1514bdcd8170SKalle Valo } 1515bdcd8170SKalle Valo 1516f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1517bdcd8170SKalle Valo 1518bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1519bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1520bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1521bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1522bdcd8170SKalle Valo __func__, 15233450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15243450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1525f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1526bdcd8170SKalle Valo 1527334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15283450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15293450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15303450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15313450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15323450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1533f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15343ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 153559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1536bdcd8170SKalle Valo 1537bdcd8170SKalle Valo return 0; 1538bdcd8170SKalle Valo } 1539bdcd8170SKalle Valo 1540bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1541bdcd8170SKalle Valo struct net_device *dev) 1542bdcd8170SKalle Valo { 15433450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1544bdcd8170SKalle Valo 1545990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1546bdcd8170SKalle Valo return -EIO; 1547bdcd8170SKalle Valo 1548240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15493450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15503450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1551bdcd8170SKalle Valo 1552bdcd8170SKalle Valo return 0; 1553bdcd8170SKalle Valo } 1554bdcd8170SKalle Valo 1555bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1556bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1557bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1558bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1559bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1560837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15615e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1562bdcd8170SKalle Valo }; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1565bdcd8170SKalle Valo { 1566bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1567bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1568bdcd8170SKalle Valo 36000, 48000, 54000 1569bdcd8170SKalle Valo }; 1570bdcd8170SKalle Valo u8 i; 1571bdcd8170SKalle Valo 1572bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1573bdcd8170SKalle Valo if (rate == legacy[i]) 1574bdcd8170SKalle Valo return true; 1575bdcd8170SKalle Valo 1576bdcd8170SKalle Valo return false; 1577bdcd8170SKalle Valo } 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1580bdcd8170SKalle Valo { 1581bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1582bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1583bdcd8170SKalle Valo }; 1584bdcd8170SKalle Valo u8 i; 1585bdcd8170SKalle Valo 1586bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1587bdcd8170SKalle Valo if (rate == ht20[i]) { 1588bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1589bdcd8170SKalle Valo /* last rate uses sgi */ 1590bdcd8170SKalle Valo *sgi = true; 1591bdcd8170SKalle Valo else 1592bdcd8170SKalle Valo *sgi = false; 1593bdcd8170SKalle Valo 1594bdcd8170SKalle Valo *mcs = i; 1595bdcd8170SKalle Valo return true; 1596bdcd8170SKalle Valo } 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo return false; 1599bdcd8170SKalle Valo } 1600bdcd8170SKalle Valo 1601bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1602bdcd8170SKalle Valo { 1603bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1604bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1605bdcd8170SKalle Valo 150000 1606bdcd8170SKalle Valo }; 1607bdcd8170SKalle Valo u8 i; 1608bdcd8170SKalle Valo 1609bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1610bdcd8170SKalle Valo if (rate == ht40[i]) { 1611bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1612bdcd8170SKalle Valo /* last rate uses sgi */ 1613bdcd8170SKalle Valo *sgi = true; 1614bdcd8170SKalle Valo else 1615bdcd8170SKalle Valo *sgi = false; 1616bdcd8170SKalle Valo 1617bdcd8170SKalle Valo *mcs = i; 1618bdcd8170SKalle Valo return true; 1619bdcd8170SKalle Valo } 1620bdcd8170SKalle Valo } 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo return false; 1623bdcd8170SKalle Valo } 1624bdcd8170SKalle Valo 1625bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1626bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1627bdcd8170SKalle Valo { 1628bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1630bdcd8170SKalle Valo long left; 1631bdcd8170SKalle Valo bool sgi; 1632bdcd8170SKalle Valo s32 rate; 1633bdcd8170SKalle Valo int ret; 1634bdcd8170SKalle Valo u8 mcs; 1635bdcd8170SKalle Valo 16368c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1637bdcd8170SKalle Valo return -ENOENT; 1638bdcd8170SKalle Valo 1639bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1640bdcd8170SKalle Valo return -EBUSY; 1641bdcd8170SKalle Valo 1642b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1643bdcd8170SKalle Valo 1644334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1645bdcd8170SKalle Valo 1646bdcd8170SKalle Valo if (ret != 0) { 1647bdcd8170SKalle Valo up(&ar->sem); 1648bdcd8170SKalle Valo return -EIO; 1649bdcd8170SKalle Valo } 1650bdcd8170SKalle Valo 1651bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1652bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1653b95907a7SVasanthakumar Thiagarajan &vif->flags), 1654bdcd8170SKalle Valo WMI_TIMEOUT); 1655bdcd8170SKalle Valo 1656bdcd8170SKalle Valo up(&ar->sem); 1657bdcd8170SKalle Valo 1658bdcd8170SKalle Valo if (left == 0) 1659bdcd8170SKalle Valo return -ETIMEDOUT; 1660bdcd8170SKalle Valo else if (left < 0) 1661bdcd8170SKalle Valo return left; 1662bdcd8170SKalle Valo 1663b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1664b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1665bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1666b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1667bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1668bdcd8170SKalle Valo } 1669bdcd8170SKalle Valo 1670b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1671b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1672bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1673b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1674bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1675bdcd8170SKalle Valo } 1676bdcd8170SKalle Valo 1677b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1678bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1679bdcd8170SKalle Valo 1680b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1681bdcd8170SKalle Valo 1682bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1683bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1684bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1685bdcd8170SKalle Valo if (sgi) { 1686bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1687bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1688bdcd8170SKalle Valo } else { 1689bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1690bdcd8170SKalle Valo } 1691bdcd8170SKalle Valo 1692bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1693bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1694bdcd8170SKalle Valo if (sgi) { 1695bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1696bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1697bdcd8170SKalle Valo } else { 1698bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1699bdcd8170SKalle Valo } 1700bdcd8170SKalle Valo 1701bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1702bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1703bdcd8170SKalle Valo } else { 17049a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17059a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17069a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1707bdcd8170SKalle Valo return 0; 1708bdcd8170SKalle Valo } 1709bdcd8170SKalle Valo 1710bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1711bdcd8170SKalle Valo 171259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 171359c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1714f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 171532c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 171632c10874SJouni Malinen sinfo->bss_param.flags = 0; 1717cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1718cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 171932c10874SJouni Malinen } 172032c10874SJouni Malinen 1721bdcd8170SKalle Valo return 0; 1722bdcd8170SKalle Valo } 1723bdcd8170SKalle Valo 1724bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1725bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1726bdcd8170SKalle Valo { 1727bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1728334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1729334234b5SVasanthakumar Thiagarajan 1730334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1731bdcd8170SKalle Valo pmksa->pmkid, true); 1732bdcd8170SKalle Valo } 1733bdcd8170SKalle Valo 1734bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1735bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1736bdcd8170SKalle Valo { 1737bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1738334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1739334234b5SVasanthakumar Thiagarajan 1740334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1741bdcd8170SKalle Valo pmksa->pmkid, false); 1742bdcd8170SKalle Valo } 1743bdcd8170SKalle Valo 1744bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1745bdcd8170SKalle Valo { 1746bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 174759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 174859c98449SVasanthakumar Thiagarajan 174959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1750334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1751334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1752bdcd8170SKalle Valo return 0; 1753bdcd8170SKalle Valo } 1754bdcd8170SKalle Valo 1755d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1756d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17576cb3c714SRaja Mani { 1758d91e8eeeSRaja Mani int ret, pos; 1759d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17606cb3c714SRaja Mani u16 i; 17616cb3c714SRaja Mani 1762d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17636cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17646cb3c714SRaja Mani 17656cb3c714SRaja Mani /* 17666cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17676cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17686cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17696cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17706cb3c714SRaja Mani * then equivalent driver specific mask value is 17716cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17726cb3c714SRaja Mani */ 17736cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17746cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17756cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17766cb3c714SRaja Mani mask[pos] = 0xFF; 17776cb3c714SRaja Mani } 17786cb3c714SRaja Mani /* 17796cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17806cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17816cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17826cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17836cb3c714SRaja Mani */ 17846cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17856cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17866cb3c714SRaja Mani wow->patterns[i].pattern_len, 17876cb3c714SRaja Mani 0 /* pattern offset */, 17886cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17896cb3c714SRaja Mani if (ret) 17906cb3c714SRaja Mani return ret; 17916cb3c714SRaja Mani } 17926cb3c714SRaja Mani 1793d91e8eeeSRaja Mani if (wow->disconnect) 1794d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1795d91e8eeeSRaja Mani 1796d91e8eeeSRaja Mani if (wow->magic_pkt) 1797d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1798d91e8eeeSRaja Mani 1799d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1800d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1801d91e8eeeSRaja Mani 1802d91e8eeeSRaja Mani if (wow->eap_identity_req) 1803d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1804d91e8eeeSRaja Mani 1805d91e8eeeSRaja Mani if (wow->four_way_handshake) 1806d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1807d91e8eeeSRaja Mani 1808d91e8eeeSRaja Mani return 0; 1809d91e8eeeSRaja Mani } 1810d91e8eeeSRaja Mani 1811d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1812d91e8eeeSRaja Mani { 1813d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1814d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1815d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1816d91e8eeeSRaja Mani 0x00, 0x08 }; 1817d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1818d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1819d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1820d91e8eeeSRaja Mani 0x00, 0x7f }; 1821d91e8eeeSRaja Mani u8 unicst_offset = 0; 1822d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1823d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1824d91e8eeeSRaja Mani u8 arp_offset = 20; 1825d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1826d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1827d91e8eeeSRaja Mani u8 discvr_offset = 38; 1828d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1829d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1830d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1832d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1833d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1834d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1835d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1836d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1837d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1838d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1839d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1840d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1841d91e8eeeSRaja Mani int ret; 1842d91e8eeeSRaja Mani 1843d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1844d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1845d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1846d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1847d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1848d91e8eeeSRaja Mani if (ret) { 1849d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1850d91e8eeeSRaja Mani return ret; 1851d91e8eeeSRaja Mani } 1852d91e8eeeSRaja Mani 1853d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1854d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1855d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1856d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1857d91e8eeeSRaja Mani arp_pattern, arp_mask); 1858d91e8eeeSRaja Mani if (ret) { 1859d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1860d91e8eeeSRaja Mani return ret; 1861d91e8eeeSRaja Mani } 1862d91e8eeeSRaja Mani 1863d91e8eeeSRaja Mani /* 1864d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1865d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1866d91e8eeeSRaja Mani */ 1867d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1868d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1869d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1870d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1871d91e8eeeSRaja Mani if (ret) { 1872d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1873d91e8eeeSRaja Mani return ret; 1874d91e8eeeSRaja Mani } 1875d91e8eeeSRaja Mani 1876d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1877d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1878d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1879d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1880d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1881d91e8eeeSRaja Mani if (ret) { 1882d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1883d91e8eeeSRaja Mani return ret; 1884d91e8eeeSRaja Mani } 1885d91e8eeeSRaja Mani 1886d91e8eeeSRaja Mani return 0; 1887d91e8eeeSRaja Mani } 1888d91e8eeeSRaja Mani 1889d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1890d91e8eeeSRaja Mani { 1891d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1892d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1893d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1894d91e8eeeSRaja Mani u8 discvr_offset = 38; 1895d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1896d91e8eeeSRaja Mani int ret; 1897d91e8eeeSRaja Mani 1898d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1899d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1900d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1901d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1902d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1903d91e8eeeSRaja Mani mac_mask); 1904d91e8eeeSRaja Mani if (ret) { 1905d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1906d91e8eeeSRaja Mani return ret; 1907d91e8eeeSRaja Mani } 1908d91e8eeeSRaja Mani 1909d91e8eeeSRaja Mani /* 1910d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1911d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1912d91e8eeeSRaja Mani */ 1913d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1914d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1915d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1916d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1917d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1918d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1919d91e8eeeSRaja Mani if (ret) { 1920d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1921d91e8eeeSRaja Mani "pattern\n"); 1922d91e8eeeSRaja Mani return ret; 1923d91e8eeeSRaja Mani } 1924d91e8eeeSRaja Mani } 1925d91e8eeeSRaja Mani 1926d91e8eeeSRaja Mani return 0; 1927d91e8eeeSRaja Mani } 1928d91e8eeeSRaja Mani 1929055bde49SRaja Mani static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 1930055bde49SRaja Mani { 1931055bde49SRaja Mani return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1932055bde49SRaja Mani } 1933055bde49SRaja Mani 1934055bde49SRaja Mani static bool is_ctrl_ep_empty(struct ath6kl *ar) 1935055bde49SRaja Mani { 1936055bde49SRaja Mani return !ar->tx_pending[ar->ctrl_ep]; 1937055bde49SRaja Mani } 1938055bde49SRaja Mani 1939055bde49SRaja Mani static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 1940055bde49SRaja Mani { 1941055bde49SRaja Mani int ret, left; 1942055bde49SRaja Mani 1943055bde49SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1944055bde49SRaja Mani 1945055bde49SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 1946055bde49SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 1947055bde49SRaja Mani if (ret) 1948055bde49SRaja Mani return ret; 1949055bde49SRaja Mani 1950055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1951055bde49SRaja Mani is_hsleep_mode_procsed(vif), 1952055bde49SRaja Mani WMI_TIMEOUT); 1953055bde49SRaja Mani if (left == 0) { 1954055bde49SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 1955055bde49SRaja Mani ret = -ETIMEDOUT; 1956055bde49SRaja Mani } else if (left < 0) { 1957055bde49SRaja Mani ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 1958055bde49SRaja Mani left); 1959055bde49SRaja Mani ret = left; 1960055bde49SRaja Mani } 1961055bde49SRaja Mani 1962055bde49SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 1963055bde49SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1964055bde49SRaja Mani is_ctrl_ep_empty(ar), 1965055bde49SRaja Mani WMI_TIMEOUT); 1966055bde49SRaja Mani if (left == 0) { 1967055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 1968055bde49SRaja Mani ret = -ETIMEDOUT; 1969055bde49SRaja Mani } else if (left < 0) { 1970055bde49SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 1971055bde49SRaja Mani ret = left; 1972055bde49SRaja Mani } 1973055bde49SRaja Mani } 1974055bde49SRaja Mani 1975055bde49SRaja Mani return ret; 1976055bde49SRaja Mani } 1977055bde49SRaja Mani 1978d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1979d91e8eeeSRaja Mani { 1980d91e8eeeSRaja Mani struct in_device *in_dev; 1981d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1982d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1983055bde49SRaja Mani int ret; 1984d91e8eeeSRaja Mani u32 filter = 0; 1985ce0dc0cfSRaja Mani u16 i, bmiss_time; 1986d91e8eeeSRaja Mani u8 index = 0; 1987d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1988d91e8eeeSRaja Mani 1989d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1990d91e8eeeSRaja Mani if (!vif) 1991d91e8eeeSRaja Mani return -EIO; 1992d91e8eeeSRaja Mani 1993d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1994d91e8eeeSRaja Mani return -EIO; 1995d91e8eeeSRaja Mani 1996d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19973c411a43SRaja Mani return -ENOTCONN; 1998d91e8eeeSRaja Mani 1999d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2000d91e8eeeSRaja Mani return -EINVAL; 2001d91e8eeeSRaja Mani 2002d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 2003d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2004d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2005d91e8eeeSRaja Mani WOW_LIST_ID, i); 2006d91e8eeeSRaja Mani 2007d91e8eeeSRaja Mani /* 2008d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 2009d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 2010d91e8eeeSRaja Mani * the user. 2011d91e8eeeSRaja Mani */ 2012d91e8eeeSRaja Mani if (wow) 2013d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2014d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 2015d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 2016d91e8eeeSRaja Mani else 2017d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 2018d91e8eeeSRaja Mani 2019d91e8eeeSRaja Mani if (ret) 2020d91e8eeeSRaja Mani return ret; 2021d91e8eeeSRaja Mani 2022390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 2023390a8c8fSRaja Mani 2024ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2025ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2026ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 2027ce0dc0cfSRaja Mani 0); 2028ce0dc0cfSRaja Mani if (ret) 2029ce0dc0cfSRaja Mani return ret; 2030ce0dc0cfSRaja Mani 2031ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 2032ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2033ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2034ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 2035ce0dc0cfSRaja Mani 2036ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2037ce0dc0cfSRaja Mani bmiss_time, 0); 2038ce0dc0cfSRaja Mani if (ret) 2039ce0dc0cfSRaja Mani return ret; 2040ce0dc0cfSRaja Mani 2041ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2042ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2043ce0dc0cfSRaja Mani 0, 0, 0, 0); 2044ce0dc0cfSRaja Mani if (ret) 2045ce0dc0cfSRaja Mani return ret; 2046ce0dc0cfSRaja Mani } 2047ce0dc0cfSRaja Mani 2048390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 2049390a8c8fSRaja Mani 2050c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2051c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2052c08631c6SRaja Mani if (!in_dev) 2053c08631c6SRaja Mani goto skip_arp; 2054c08631c6SRaja Mani 2055c08631c6SRaja Mani ifa = in_dev->ifa_list; 2056c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2057c08631c6SRaja Mani 2058c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2059c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2060c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2061c08631c6SRaja Mani ifa = ifa->ifa_next; 2062c08631c6SRaja Mani index++; 2063c08631c6SRaja Mani } 2064c08631c6SRaja Mani 2065c08631c6SRaja Mani if (ifa) { 2066c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2067c08631c6SRaja Mani return -EINVAL; 2068c08631c6SRaja Mani } 2069c08631c6SRaja Mani 2070c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2071c08631c6SRaja Mani if (ret) { 2072c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2073c08631c6SRaja Mani return ret; 2074c08631c6SRaja Mani } 2075c08631c6SRaja Mani 2076c08631c6SRaja Mani skip_arp: 20776cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20786cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20796cb3c714SRaja Mani filter, 20806cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20816cb3c714SRaja Mani if (ret) 20826cb3c714SRaja Mani return ret; 20836cb3c714SRaja Mani 2084055bde49SRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 20856cb3c714SRaja Mani if (ret) 20866cb3c714SRaja Mani return ret; 20876cb3c714SRaja Mani 2088055bde49SRaja Mani return 0; 20896cb3c714SRaja Mani } 20906cb3c714SRaja Mani 20916cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20926cb3c714SRaja Mani { 20936cb3c714SRaja Mani struct ath6kl_vif *vif; 20946cb3c714SRaja Mani int ret; 20956cb3c714SRaja Mani 20966cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20976cb3c714SRaja Mani if (!vif) 20986cb3c714SRaja Mani return -EIO; 20996cb3c714SRaja Mani 2100390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2101390a8c8fSRaja Mani 21026cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 21036cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2104390a8c8fSRaja Mani if (ret) { 2105390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2106390a8c8fSRaja Mani "wow resume: %d\n", ret); 2107390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 21086cb3c714SRaja Mani return ret; 21096cb3c714SRaja Mani } 21106cb3c714SRaja Mani 2111ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2112ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2113ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2114ce0dc0cfSRaja Mani if (ret) 2115ce0dc0cfSRaja Mani return ret; 2116ce0dc0cfSRaja Mani 2117ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2118ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2119ce0dc0cfSRaja Mani if (ret) 2120ce0dc0cfSRaja Mani return ret; 2121ce0dc0cfSRaja Mani 2122ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2123ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2124ce0dc0cfSRaja Mani if (ret) 2125ce0dc0cfSRaja Mani return ret; 2126ce0dc0cfSRaja Mani } 2127ce0dc0cfSRaja Mani 2128390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2129390a8c8fSRaja Mani 2130390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2131390a8c8fSRaja Mani 2132390a8c8fSRaja Mani return 0; 2133390a8c8fSRaja Mani } 2134390a8c8fSRaja Mani 213540abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 213640abc2deSRaja Mani { 213740abc2deSRaja Mani struct ath6kl_vif *vif; 213840abc2deSRaja Mani int ret; 213940abc2deSRaja Mani 214040abc2deSRaja Mani vif = ath6kl_vif_first(ar); 214140abc2deSRaja Mani if (!vif) 214240abc2deSRaja Mani return -EIO; 214340abc2deSRaja Mani 214440abc2deSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 214540abc2deSRaja Mani return -EIO; 214640abc2deSRaja Mani 214740abc2deSRaja Mani ath6kl_cfg80211_stop_all(ar); 214840abc2deSRaja Mani 214940abc2deSRaja Mani /* Save the current power mode before enabling power save */ 215040abc2deSRaja Mani ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 215140abc2deSRaja Mani 215240abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 215340abc2deSRaja Mani if (ret) 215440abc2deSRaja Mani return ret; 215540abc2deSRaja Mani 215640abc2deSRaja Mani /* Disable WOW mode */ 215740abc2deSRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 215840abc2deSRaja Mani ATH6KL_WOW_MODE_DISABLE, 215940abc2deSRaja Mani 0, 0); 216040abc2deSRaja Mani if (ret) 216140abc2deSRaja Mani return ret; 216240abc2deSRaja Mani 216340abc2deSRaja Mani /* Flush all non control pkts in TX path */ 216440abc2deSRaja Mani ath6kl_tx_data_cleanup(ar); 216540abc2deSRaja Mani 216640abc2deSRaja Mani ret = ath6kl_cfg80211_host_sleep(ar, vif); 216740abc2deSRaja Mani if (ret) 216840abc2deSRaja Mani return ret; 216940abc2deSRaja Mani 217040abc2deSRaja Mani return 0; 217140abc2deSRaja Mani } 217240abc2deSRaja Mani 217340abc2deSRaja Mani static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 217440abc2deSRaja Mani { 217540abc2deSRaja Mani struct ath6kl_vif *vif; 217640abc2deSRaja Mani int ret; 217740abc2deSRaja Mani 217840abc2deSRaja Mani vif = ath6kl_vif_first(ar); 217940abc2deSRaja Mani 218040abc2deSRaja Mani if (!vif) 218140abc2deSRaja Mani return -EIO; 218240abc2deSRaja Mani 218340abc2deSRaja Mani if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 218440abc2deSRaja Mani ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 218540abc2deSRaja Mani ar->wmi->saved_pwr_mode); 218640abc2deSRaja Mani if (ret) 218740abc2deSRaja Mani return ret; 218840abc2deSRaja Mani } 218940abc2deSRaja Mani 219040abc2deSRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 219140abc2deSRaja Mani ATH6KL_HOST_MODE_AWAKE); 219240abc2deSRaja Mani if (ret) 219340abc2deSRaja Mani return ret; 219440abc2deSRaja Mani 219540abc2deSRaja Mani ar->state = ATH6KL_STATE_ON; 219640abc2deSRaja Mani 219740abc2deSRaja Mani /* Reset scan parameter to default values */ 219840abc2deSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 219940abc2deSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 220040abc2deSRaja Mani if (ret) 220140abc2deSRaja Mani return ret; 220240abc2deSRaja Mani 220340abc2deSRaja Mani return 0; 220440abc2deSRaja Mani } 220540abc2deSRaja Mani 220652d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 22070f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 22080f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 220952d81a68SKalle Valo { 2210390a8c8fSRaja Mani enum ath6kl_state prev_state; 221152d81a68SKalle Valo int ret; 221252d81a68SKalle Valo 221352d81a68SKalle Valo switch (mode) { 2214d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2215d7c44e0bSRaja Mani 2216d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2217d7c44e0bSRaja Mani 2218d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2219d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2220d7c44e0bSRaja Mani 2221390a8c8fSRaja Mani prev_state = ar->state; 2222390a8c8fSRaja Mani 2223d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2224390a8c8fSRaja Mani if (ret) { 2225390a8c8fSRaja Mani ar->state = prev_state; 2226d7c44e0bSRaja Mani return ret; 2227390a8c8fSRaja Mani } 22281e9a905dSRaja Mani 2229d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2230d7c44e0bSRaja Mani break; 2231d7c44e0bSRaja Mani 223252d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2233524441e3SRaja Mani 223440abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2235524441e3SRaja Mani 223640abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_suspend(ar); 223752d81a68SKalle Valo if (ret) { 223840abc2deSRaja Mani ath6kl_err("deepsleep suspend failed: %d\n", ret); 223940abc2deSRaja Mani return ret; 224052d81a68SKalle Valo } 224152d81a68SKalle Valo 224276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 224376a9fbe2SKalle Valo 224452d81a68SKalle Valo break; 2245b4b2a0b1SKalle Valo 2246b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2247524441e3SRaja Mani 22487125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2249524441e3SRaja Mani 2250b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2251b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2252b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2253b4b2a0b1SKalle Valo break; 2254b4b2a0b1SKalle Valo } 2255b4b2a0b1SKalle Valo 2256b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2257b4b2a0b1SKalle Valo 2258b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2259b4b2a0b1SKalle Valo if (ret) { 2260b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2261b4b2a0b1SKalle Valo ret); 2262b4b2a0b1SKalle Valo } 2263b4b2a0b1SKalle Valo 2264b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2265b4b2a0b1SKalle Valo 2266b4b2a0b1SKalle Valo break; 2267b4b2a0b1SKalle Valo 226810509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 226910509f90SKalle Valo /* 227010509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 227110509f90SKalle Valo * wow mode and sleeping most of the time. 227210509f90SKalle Valo */ 227310509f90SKalle Valo break; 227410509f90SKalle Valo 2275b4b2a0b1SKalle Valo default: 2276b4b2a0b1SKalle Valo break; 227752d81a68SKalle Valo } 227852d81a68SKalle Valo 227952d81a68SKalle Valo return 0; 228052d81a68SKalle Valo } 2281d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 228252d81a68SKalle Valo 228352d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 228452d81a68SKalle Valo { 228576a9fbe2SKalle Valo int ret; 228676a9fbe2SKalle Valo 228776a9fbe2SKalle Valo switch (ar->state) { 2288d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2289d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2290d7c44e0bSRaja Mani 2291d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2292d7c44e0bSRaja Mani if (ret) { 2293d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2294d7c44e0bSRaja Mani return ret; 2295d7c44e0bSRaja Mani } 2296d7c44e0bSRaja Mani 2297d7c44e0bSRaja Mani break; 2298d7c44e0bSRaja Mani 229976a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 230040abc2deSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 230140abc2deSRaja Mani 230240abc2deSRaja Mani ret = ath6kl_cfg80211_deepsleep_resume(ar); 230376a9fbe2SKalle Valo if (ret) { 230440abc2deSRaja Mani ath6kl_warn("deep sleep resume failed: %d\n", ret); 230540abc2deSRaja Mani return ret; 230676a9fbe2SKalle Valo } 230776a9fbe2SKalle Valo break; 230876a9fbe2SKalle Valo 2309b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2310b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2311b4b2a0b1SKalle Valo 2312b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2313b4b2a0b1SKalle Valo if (ret) { 2314b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2315b4b2a0b1SKalle Valo return ret; 2316b4b2a0b1SKalle Valo } 2317d7c44e0bSRaja Mani break; 2318b4b2a0b1SKalle Valo 231910509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 232010509f90SKalle Valo break; 232110509f90SKalle Valo 232276a9fbe2SKalle Valo default: 232376a9fbe2SKalle Valo break; 232452d81a68SKalle Valo } 232552d81a68SKalle Valo 232652d81a68SKalle Valo return 0; 232752d81a68SKalle Valo } 2328d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 232952d81a68SKalle Valo 2330abcb344bSKalle Valo #ifdef CONFIG_PM 233152d81a68SKalle Valo 233252d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 233352d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2334abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2335abcb344bSKalle Valo { 2336abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2337abcb344bSKalle Valo 23380f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2339abcb344bSKalle Valo } 2340aa6cffc1SChilam Ng 234152d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2342aa6cffc1SChilam Ng { 2343aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2344aa6cffc1SChilam Ng 2345aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2346aa6cffc1SChilam Ng } 2347a918fb3cSRaja Mani 2348a918fb3cSRaja Mani /* 2349a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2350a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2351a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2352a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2353a918fb3cSRaja Mani * 2354a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2355a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2356a918fb3cSRaja Mani * 2357a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2358a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2359a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2360a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2361a918fb3cSRaja Mani * 2362a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2363a918fb3cSRaja Mani */ 2364a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2365a918fb3cSRaja Mani { 2366390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2367390a8c8fSRaja Mani return; 2368390a8c8fSRaja Mani 2369a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2370a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2371a918fb3cSRaja Mani } 2372a918fb3cSRaja Mani 2373a918fb3cSRaja Mani #else 2374a918fb3cSRaja Mani 2375a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2376a918fb3cSRaja Mani { 2377a918fb3cSRaja Mani } 2378abcb344bSKalle Valo #endif 2379abcb344bSKalle Valo 23806a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 23816a7c9badSJouni Malinen struct ieee80211_channel *chan, 23826a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 23836a7c9badSJouni Malinen { 2384e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2385e68f6750SSujith Manoharan 2386e68f6750SSujith Manoharan /* 2387e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2388e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2389e68f6750SSujith Manoharan * 2390e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2391e68f6750SSujith Manoharan */ 2392e68f6750SSujith Manoharan if (!dev) 2393e68f6750SSujith Manoharan return -EBUSY; 2394e68f6750SSujith Manoharan 2395e68f6750SSujith Manoharan vif = netdev_priv(dev); 23966a7c9badSJouni Malinen 2397990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23986a7c9badSJouni Malinen return -EIO; 23996a7c9badSJouni Malinen 24006a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 24016a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2402cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 24036a7c9badSJouni Malinen 24046a7c9badSJouni Malinen return 0; 24056a7c9badSJouni Malinen } 24066a7c9badSJouni Malinen 24078bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 24088bdfbf40SJouni Malinen { 24098bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 24108bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 24118bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 24128bdfbf40SJouni Malinen } 24138bdfbf40SJouni Malinen 2414334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2415334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 24168bdfbf40SJouni Malinen { 2417334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24188bdfbf40SJouni Malinen const u8 *pos; 24198bdfbf40SJouni Malinen u8 *buf = NULL; 24208bdfbf40SJouni Malinen size_t len = 0; 24218bdfbf40SJouni Malinen int ret; 24228bdfbf40SJouni Malinen 24238bdfbf40SJouni Malinen /* 24248bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 24258bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 24268bdfbf40SJouni Malinen */ 24278bdfbf40SJouni Malinen 24288bdfbf40SJouni Malinen if (ies && ies_len) { 24298bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 24308bdfbf40SJouni Malinen if (buf == NULL) 24318bdfbf40SJouni Malinen return -ENOMEM; 24328bdfbf40SJouni Malinen pos = ies; 24338bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 24348bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 24358bdfbf40SJouni Malinen break; 24368bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 24378bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 24388bdfbf40SJouni Malinen len += 2 + pos[1]; 24398bdfbf40SJouni Malinen } 24408bdfbf40SJouni Malinen pos += 2 + pos[1]; 24418bdfbf40SJouni Malinen } 24428bdfbf40SJouni Malinen } 24438bdfbf40SJouni Malinen 2444334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2445334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 24468bdfbf40SJouni Malinen kfree(buf); 24478bdfbf40SJouni Malinen return ret; 24488bdfbf40SJouni Malinen } 24498bdfbf40SJouni Malinen 24508860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 24518860020eSJohannes Berg struct cfg80211_beacon_data *info) 24528860020eSJohannes Berg { 24538860020eSJohannes Berg struct ath6kl *ar = vif->ar; 24548860020eSJohannes Berg int res; 24558860020eSJohannes Berg 245617a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24578860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24588860020eSJohannes Berg WMI_FRAME_BEACON, 24598860020eSJohannes Berg info->beacon_ies, 24608860020eSJohannes Berg info->beacon_ies_len); 24618860020eSJohannes Berg if (res) 24628860020eSJohannes Berg return res; 24638860020eSJohannes Berg 246417a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24658860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 24668860020eSJohannes Berg info->proberesp_ies_len); 24678860020eSJohannes Berg if (res) 24688860020eSJohannes Berg return res; 24698860020eSJohannes Berg 247017a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 24718860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 24728860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 24738860020eSJohannes Berg info->assocresp_ies, 24748860020eSJohannes Berg info->assocresp_ies_len); 24758860020eSJohannes Berg if (res) 24768860020eSJohannes Berg return res; 24778860020eSJohannes Berg 24788860020eSJohannes Berg return 0; 24798860020eSJohannes Berg } 24808860020eSJohannes Berg 24818860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 24828860020eSJohannes Berg struct cfg80211_ap_settings *info) 24836a7c9badSJouni Malinen { 24846a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 24853450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24866a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 248767cd22e4SThomas Pedersen bool hidden = false; 24886a7c9badSJouni Malinen u8 *ies; 24896a7c9badSJouni Malinen int ies_len; 24906a7c9badSJouni Malinen struct wmi_connect_cmd p; 24916a7c9badSJouni Malinen int res; 2492be5abaafSVasanthakumar Thiagarajan int i, ret; 24936a7c9badSJouni Malinen 24948860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 24956a7c9badSJouni Malinen 2496990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24976a7c9badSJouni Malinen return -EIO; 24986a7c9badSJouni Malinen 2499f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 25006a7c9badSJouni Malinen return -EOPNOTSUPP; 25016a7c9badSJouni Malinen 25028860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 25036a7c9badSJouni Malinen 25049a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 25059a5b1318SJouni Malinen 25066a7c9badSJouni Malinen /* TODO: 25076a7c9badSJouni Malinen * info->interval 25086a7c9badSJouni Malinen * info->dtim_period 25096a7c9badSJouni Malinen */ 25106a7c9badSJouni Malinen 25118860020eSJohannes Berg if (info->beacon.head == NULL) 25126a7c9badSJouni Malinen return -EINVAL; 25138860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 25146a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 25158860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 25166a7c9badSJouni Malinen return -EINVAL; 25178860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 25186a7c9badSJouni Malinen 25196a7c9badSJouni Malinen if (info->ssid == NULL) 25206a7c9badSJouni Malinen return -EINVAL; 25213450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 25223450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 25236a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 252467cd22e4SThomas Pedersen hidden = true; 252567cd22e4SThomas Pedersen 252667cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 252767cd22e4SThomas Pedersen if (res) 252867cd22e4SThomas Pedersen return res; 25296a7c9badSJouni Malinen 2530be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2531be5abaafSVasanthakumar Thiagarajan if (ret) 2532be5abaafSVasanthakumar Thiagarajan return ret; 25336a7c9badSJouni Malinen 25346a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 25356a7c9badSJouni Malinen 25366a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 25376a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 25386a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 25396a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25406a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 25416a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25426a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 25436a7c9badSJouni Malinen break; 25446a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 25456a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 25466a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 25476a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 25486a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 25496a7c9badSJouni Malinen break; 25506a7c9badSJouni Malinen } 25516a7c9badSJouni Malinen } 25526a7c9badSJouni Malinen if (p.auth_mode == 0) 25536a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 25543450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 25556a7c9badSJouni Malinen 25566a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 25576a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 25586a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25596a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25606a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 25616a7c9badSJouni Malinen break; 25626a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25636a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 25646a7c9badSJouni Malinen break; 25656a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25666a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 25676a7c9badSJouni Malinen break; 2568b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2569b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2570b8214df1SDai Shuibing break; 25716a7c9badSJouni Malinen } 25726a7c9badSJouni Malinen } 2573229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 25746a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2575240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2576229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2577240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 25786a7c9badSJouni Malinen 25796a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 25806a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 25816a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 25826a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 25836a7c9badSJouni Malinen break; 25846a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 25856a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 25866a7c9badSJouni Malinen break; 25876a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25886a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 25896a7c9badSJouni Malinen break; 2590b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2591b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2592b8214df1SDai Shuibing break; 25936a7c9badSJouni Malinen default: 25946a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 25956a7c9badSJouni Malinen break; 25966a7c9badSJouni Malinen } 2597240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 25986a7c9badSJouni Malinen 25996a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2600f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 26016a7c9badSJouni Malinen 26023450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 26033450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 26043450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2605cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 26066a7c9badSJouni Malinen 2607c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2608c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2609c1762a3fSThirumalai Pachamuthu if (res < 0) 2610c1762a3fSThirumalai Pachamuthu return res; 2611c1762a3fSThirumalai Pachamuthu 26123ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 26133ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 26143ca9d1fcSAarthi Thiruvengadam } else { 26153ca9d1fcSAarthi Thiruvengadam /* 26163ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 26173ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 26183ca9d1fcSAarthi Thiruvengadam */ 26193ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 26203ca9d1fcSAarthi Thiruvengadam } 26213ca9d1fcSAarthi Thiruvengadam 262203bdeb0dSVasanthakumar Thiagarajan if (info->inactivity_timeout) { 262303bdeb0dSVasanthakumar Thiagarajan res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 262403bdeb0dSVasanthakumar Thiagarajan info->inactivity_timeout); 262503bdeb0dSVasanthakumar Thiagarajan if (res < 0) 262603bdeb0dSVasanthakumar Thiagarajan return res; 262703bdeb0dSVasanthakumar Thiagarajan } 262803bdeb0dSVasanthakumar Thiagarajan 2629334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 26309a5b1318SJouni Malinen if (res < 0) 26319a5b1318SJouni Malinen return res; 26329a5b1318SJouni Malinen 26339a5b1318SJouni Malinen return 0; 26346a7c9badSJouni Malinen } 26356a7c9badSJouni Malinen 26368860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 26378860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 26386a7c9badSJouni Malinen { 26398860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 26408860020eSJohannes Berg 26418860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 26428860020eSJohannes Berg return -EIO; 26438860020eSJohannes Berg 26448860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 26458860020eSJohannes Berg return -EOPNOTSUPP; 26468860020eSJohannes Berg 26478860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 26486a7c9badSJouni Malinen } 26496a7c9badSJouni Malinen 26508860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 26516a7c9badSJouni Malinen { 26526a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 265359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26546a7c9badSJouni Malinen 2655f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 26566a7c9badSJouni Malinen return -EOPNOTSUPP; 265759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 26586a7c9badSJouni Malinen return -ENOTCONN; 26596a7c9badSJouni Malinen 2660334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 266159c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 26626a7c9badSJouni Malinen 26636a7c9badSJouni Malinen return 0; 26646a7c9badSJouni Malinen } 26656a7c9badSJouni Malinen 266633e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 266733e5308dSJouni Malinen 266833e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 266933e5308dSJouni Malinen u8 *mac) 267033e5308dSJouni Malinen { 267133e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 267233e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 267333e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 267433e5308dSJouni Malinen 267533e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 267633e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 267733e5308dSJouni Malinen } 267833e5308dSJouni Malinen 267923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 268023875136SJouni Malinen u8 *mac, struct station_parameters *params) 268123875136SJouni Malinen { 268223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2683f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 268423875136SJouni Malinen 2685f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 268623875136SJouni Malinen return -EOPNOTSUPP; 268723875136SJouni Malinen 268823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 268923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 269023875136SJouni Malinen return -EOPNOTSUPP; 269123875136SJouni Malinen 269223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2693334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2694334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2695334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2696334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 269723875136SJouni Malinen } 269823875136SJouni Malinen 269963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 270063fa1e0cSJouni Malinen struct net_device *dev, 270163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 270263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 270363fa1e0cSJouni Malinen unsigned int duration, 270463fa1e0cSJouni Malinen u64 *cookie) 270563fa1e0cSJouni Malinen { 270663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2707334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27081052261eSJouni Malinen u32 id; 270963fa1e0cSJouni Malinen 271063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 271163fa1e0cSJouni Malinen * return -EBUSY */ 27121052261eSJouni Malinen id = ++vif->last_roc_id; 27131052261eSJouni Malinen if (id == 0) { 27141052261eSJouni Malinen /* Do not use 0 as the cookie value */ 27151052261eSJouni Malinen id = ++vif->last_roc_id; 27161052261eSJouni Malinen } 27171052261eSJouni Malinen *cookie = id; 271863fa1e0cSJouni Malinen 2719334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2720334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 272163fa1e0cSJouni Malinen } 272263fa1e0cSJouni Malinen 272363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 272463fa1e0cSJouni Malinen struct net_device *dev, 272563fa1e0cSJouni Malinen u64 cookie) 272663fa1e0cSJouni Malinen { 272763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2728334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 272963fa1e0cSJouni Malinen 27301052261eSJouni Malinen if (cookie != vif->last_roc_id) 273163fa1e0cSJouni Malinen return -ENOENT; 27321052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 273363fa1e0cSJouni Malinen 2734334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 273563fa1e0cSJouni Malinen } 273663fa1e0cSJouni Malinen 2737334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2738334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2739334234b5SVasanthakumar Thiagarajan unsigned int freq) 27408bdfbf40SJouni Malinen { 2741334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27428bdfbf40SJouni Malinen const u8 *pos; 27438bdfbf40SJouni Malinen u8 *p2p; 27448bdfbf40SJouni Malinen int p2p_len; 27458bdfbf40SJouni Malinen int ret; 27468bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 27478bdfbf40SJouni Malinen 27488bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27498bdfbf40SJouni Malinen 27508bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 27518bdfbf40SJouni Malinen 27528bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 27538bdfbf40SJouni Malinen if (p2p == NULL) 27548bdfbf40SJouni Malinen return -ENOMEM; 27558bdfbf40SJouni Malinen p2p_len = 0; 27568bdfbf40SJouni Malinen 27578bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 27588bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 27598bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 27608bdfbf40SJouni Malinen break; 27618bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 27628bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 27638bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 27648bdfbf40SJouni Malinen } 27658bdfbf40SJouni Malinen pos += 2 + pos[1]; 27668bdfbf40SJouni Malinen } 27678bdfbf40SJouni Malinen 2768334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2769334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 27708bdfbf40SJouni Malinen kfree(p2p); 27718bdfbf40SJouni Malinen return ret; 27728bdfbf40SJouni Malinen } 27738bdfbf40SJouni Malinen 2774d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2775d0ff7383SNaveen Gangadharan u32 id, 2776d0ff7383SNaveen Gangadharan u32 freq, 2777d0ff7383SNaveen Gangadharan u32 wait, 2778d0ff7383SNaveen Gangadharan const u8 *buf, 2779d0ff7383SNaveen Gangadharan size_t len, 2780d0ff7383SNaveen Gangadharan bool *more_data, 2781d0ff7383SNaveen Gangadharan bool no_cck) 2782d0ff7383SNaveen Gangadharan { 2783d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2784d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2785d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2786d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2787d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2788d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2789d0ff7383SNaveen Gangadharan 2790d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2791d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2792d0ff7383SNaveen Gangadharan return false; 2793d0ff7383SNaveen Gangadharan 2794d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2795d0ff7383SNaveen Gangadharan if (!conn) 2796d0ff7383SNaveen Gangadharan return false; 2797d0ff7383SNaveen Gangadharan 2798d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2799d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2800d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2801d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2802d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2803d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2804d0ff7383SNaveen Gangadharan return false; 2805d0ff7383SNaveen Gangadharan 2806d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2807d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2808d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2809d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2810d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2811d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2812d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2813d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2814d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2815d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2816d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2817d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2818d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2819d0ff7383SNaveen Gangadharan 2820d0ff7383SNaveen Gangadharan /* 2821d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2822d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2823d0ff7383SNaveen Gangadharan * STA. 2824d0ff7383SNaveen Gangadharan */ 2825d0ff7383SNaveen Gangadharan if (is_psq_empty) 2826d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2827d0ff7383SNaveen Gangadharan conn->aid, 1); 2828d0ff7383SNaveen Gangadharan return true; 2829d0ff7383SNaveen Gangadharan } 2830d0ff7383SNaveen Gangadharan 2831d0ff7383SNaveen Gangadharan /* 2832d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2833d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2834d0ff7383SNaveen Gangadharan */ 2835d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2836d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2837d0ff7383SNaveen Gangadharan *more_data = true; 2838d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2839d0ff7383SNaveen Gangadharan } 2840d0ff7383SNaveen Gangadharan 2841d0ff7383SNaveen Gangadharan return false; 2842d0ff7383SNaveen Gangadharan } 2843d0ff7383SNaveen Gangadharan 2844c86e4f44SAarthi Thiruvengadam /* Check if SSID length is greater than DIRECT- */ 2845c86e4f44SAarthi Thiruvengadam static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 2846c86e4f44SAarthi Thiruvengadam { 2847c86e4f44SAarthi Thiruvengadam const struct ieee80211_mgmt *mgmt; 2848c86e4f44SAarthi Thiruvengadam mgmt = (const struct ieee80211_mgmt *) buf; 2849c86e4f44SAarthi Thiruvengadam 2850c86e4f44SAarthi Thiruvengadam /* variable[1] contains the SSID tag length */ 2851c86e4f44SAarthi Thiruvengadam if (buf + len >= &mgmt->u.probe_resp.variable[1] && 2852c86e4f44SAarthi Thiruvengadam (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 2853c86e4f44SAarthi Thiruvengadam return true; 2854c86e4f44SAarthi Thiruvengadam } 2855c86e4f44SAarthi Thiruvengadam 2856c86e4f44SAarthi Thiruvengadam return false; 2857c86e4f44SAarthi Thiruvengadam } 2858c86e4f44SAarthi Thiruvengadam 28598a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 28608a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 28618a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 28628a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2863e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2864e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 28658a6c8060SJouni Malinen { 28668a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 286759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 28688a6c8060SJouni Malinen u32 id; 28698bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2870d0ff7383SNaveen Gangadharan bool more_data, queued; 28718bdfbf40SJouni Malinen 28728bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 2873c86e4f44SAarthi Thiruvengadam if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 2874c86e4f44SAarthi Thiruvengadam ieee80211_is_probe_resp(mgmt->frame_control) && 2875c86e4f44SAarthi Thiruvengadam ath6kl_is_p2p_go_ssid(buf, len)) { 28768bdfbf40SJouni Malinen /* 2877c86e4f44SAarthi Thiruvengadam * Send Probe Response frame in GO mode using a separate WMI 28788bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 28798bdfbf40SJouni Malinen */ 28808bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2881334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 28828bdfbf40SJouni Malinen chan->center_freq); 28838bdfbf40SJouni Malinen } 28848a6c8060SJouni Malinen 2885cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 28868a6c8060SJouni Malinen if (id == 0) { 28878a6c8060SJouni Malinen /* 28888a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 28898a6c8060SJouni Malinen * used for the command. 28908a6c8060SJouni Malinen */ 2891cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 28928a6c8060SJouni Malinen } 28938a6c8060SJouni Malinen 28948a6c8060SJouni Malinen *cookie = id; 28953ca9d1fcSAarthi Thiruvengadam 2896d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2897d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2898d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2899d0ff7383SNaveen Gangadharan id, chan->center_freq, 2900d0ff7383SNaveen Gangadharan wait, buf, 2901d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2902d0ff7383SNaveen Gangadharan if (queued) 2903d0ff7383SNaveen Gangadharan return 0; 2904d0ff7383SNaveen Gangadharan } 2905d0ff7383SNaveen Gangadharan 29063ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 29073ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 29083ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 29093ca9d1fcSAarthi Thiruvengadam } 29108a6c8060SJouni Malinen 2911ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2912ae32c30aSJouni Malinen struct net_device *dev, 2913ae32c30aSJouni Malinen u16 frame_type, bool reg) 2914ae32c30aSJouni Malinen { 2915cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2916ae32c30aSJouni Malinen 2917ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2918ae32c30aSJouni Malinen __func__, frame_type, reg); 2919ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2920ae32c30aSJouni Malinen /* 2921ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2922ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2923ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2924ae32c30aSJouni Malinen */ 2925cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2926ae32c30aSJouni Malinen } 2927ae32c30aSJouni Malinen } 2928ae32c30aSJouni Malinen 292910509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 293010509f90SKalle Valo struct net_device *dev, 293110509f90SKalle Valo struct cfg80211_sched_scan_request *request) 293210509f90SKalle Valo { 293310509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 293410509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 293510509f90SKalle Valo u16 interval; 293610509f90SKalle Valo int ret; 293710509f90SKalle Valo u8 i; 293810509f90SKalle Valo 293910509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 294010509f90SKalle Valo return -EIO; 294110509f90SKalle Valo 294210509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 294310509f90SKalle Valo return -EBUSY; 294410509f90SKalle Valo 2945b4d13d3bSKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2946b4d13d3bSKalle Valo 294710509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 294810509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 294910509f90SKalle Valo i, DISABLE_SSID_FLAG, 295010509f90SKalle Valo 0, NULL); 295110509f90SKalle Valo } 295210509f90SKalle Valo 295310509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 295410509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 295510509f90SKalle Valo 295610509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 295710509f90SKalle Valo interval, interval, 295810509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 295910509f90SKalle Valo 296010509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 296110509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 296210509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 296310509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 296410509f90SKalle Valo request->ssids[i].ssid_len, 296510509f90SKalle Valo request->ssids[i].ssid); 296610509f90SKalle Valo } 296710509f90SKalle Valo } 296810509f90SKalle Valo 296910509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 297010509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 297110509f90SKalle Valo WOW_FILTER_SSID, 297210509f90SKalle Valo WOW_HOST_REQ_DELAY); 297310509f90SKalle Valo if (ret) { 297410509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 297510509f90SKalle Valo return ret; 297610509f90SKalle Valo } 297710509f90SKalle Valo 297810509f90SKalle Valo /* this also clears IE in fw if it's not set */ 297910509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 298010509f90SKalle Valo WMI_FRAME_PROBE_REQ, 298110509f90SKalle Valo request->ie, request->ie_len); 298210509f90SKalle Valo if (ret) { 298310509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 298410509f90SKalle Valo ret); 298510509f90SKalle Valo return ret; 298610509f90SKalle Valo } 298710509f90SKalle Valo 298810509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 298910509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 299010509f90SKalle Valo if (ret) { 299110509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 299210509f90SKalle Valo ret); 299310509f90SKalle Valo return ret; 299410509f90SKalle Valo } 299510509f90SKalle Valo 299610509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 299710509f90SKalle Valo 299810509f90SKalle Valo return ret; 299910509f90SKalle Valo } 300010509f90SKalle Valo 300110509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 300210509f90SKalle Valo struct net_device *dev) 300310509f90SKalle Valo { 300410509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 300510509f90SKalle Valo bool stopped; 300610509f90SKalle Valo 300710509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 300810509f90SKalle Valo 300910509f90SKalle Valo if (!stopped) 301010509f90SKalle Valo return -EIO; 301110509f90SKalle Valo 301210509f90SKalle Valo return 0; 301310509f90SKalle Valo } 301410509f90SKalle Valo 3015f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 3016f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3017f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 3018f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3019f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3020f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3021f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3022f80574aeSJouni Malinen }, 3023ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 3024ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3025ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3026ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3027ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3028ba1f6fe3SJouni Malinen }, 3029f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 3030f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3031f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3032f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3033f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3034f80574aeSJouni Malinen }, 3035f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 3036f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3037f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3038f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3039f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3040f80574aeSJouni Malinen }, 3041f80574aeSJouni Malinen }; 3042f80574aeSJouni Malinen 3043bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 304455055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 304555055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 3046bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 3047bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 3048bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 3049bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 3050bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 3051bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 3052bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 3053bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 3054bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3055bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 3056bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 3057bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3058bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 3059bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 3060bdcd8170SKalle Valo .get_station = ath6kl_get_station, 3061bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 3062bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 3063bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 3064003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3065abcb344bSKalle Valo #ifdef CONFIG_PM 306652d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 306752d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 3068abcb344bSKalle Valo #endif 30696a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 30708860020eSJohannes Berg .start_ap = ath6kl_start_ap, 30718860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 30728860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 307333e5308dSJouni Malinen .del_station = ath6kl_del_station, 307423875136SJouni Malinen .change_station = ath6kl_change_station, 307563fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 307663fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 30778a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 3078ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 307910509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 308010509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3081bdcd8170SKalle Valo }; 3082bdcd8170SKalle Valo 30837125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3084ec4b7f60SKalle Valo { 308510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 308610509f90SKalle Valo 3087ec4b7f60SKalle Valo switch (vif->sme_state) { 3088c97a31b0SKalle Valo case SME_DISCONNECTED: 3089c97a31b0SKalle Valo break; 3090ec4b7f60SKalle Valo case SME_CONNECTING: 3091ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3092ec4b7f60SKalle Valo NULL, 0, 3093ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 3094ec4b7f60SKalle Valo GFP_KERNEL); 3095ec4b7f60SKalle Valo break; 3096ec4b7f60SKalle Valo case SME_CONNECTED: 3097ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3098ec4b7f60SKalle Valo break; 3099ec4b7f60SKalle Valo } 3100ec4b7f60SKalle Valo 3101ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 3102ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 31037125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3104ec4b7f60SKalle Valo 3105ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 31061f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 31071f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 3108ec4b7f60SKalle Valo 3109ec4b7f60SKalle Valo /* disable scanning */ 31107125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 31117125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 31127125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3113ec4b7f60SKalle Valo 3114ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3115ec4b7f60SKalle Valo } 3116ec4b7f60SKalle Valo 31177125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 31187125f01dSKalle Valo { 31197125f01dSKalle Valo struct ath6kl_vif *vif; 31207125f01dSKalle Valo 31217125f01dSKalle Valo vif = ath6kl_vif_first(ar); 31227125f01dSKalle Valo if (!vif) { 31237125f01dSKalle Valo /* save the current power mode before enabling power save */ 31247125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 31257125f01dSKalle Valo 31267125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 31277125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 31287125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 31297125f01dSKalle Valo return; 31307125f01dSKalle Valo } 31317125f01dSKalle Valo 31327125f01dSKalle Valo /* 31337125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 31347125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 31357125f01dSKalle Valo * sleeps. 31367125f01dSKalle Valo */ 31377125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 31387125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 31397125f01dSKalle Valo } 31407125f01dSKalle Valo 3141c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 31428dafb70eSVasanthakumar Thiagarajan { 31437baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 31442132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 31458dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 31468dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 31478dafb70eSVasanthakumar Thiagarajan } 31488dafb70eSVasanthakumar Thiagarajan 3149de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3150108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 315110509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 315210509f90SKalle Valo (unsigned long) vif); 315310509f90SKalle Valo 3154de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3155478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 31568dafb70eSVasanthakumar Thiagarajan 315780abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 315880abaf9bSVasanthakumar Thiagarajan 31598dafb70eSVasanthakumar Thiagarajan return 0; 31608dafb70eSVasanthakumar Thiagarajan } 31618dafb70eSVasanthakumar Thiagarajan 3162c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 31638dafb70eSVasanthakumar Thiagarajan { 316455055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 316580abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 316655055976SVasanthakumar Thiagarajan 31672132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3168108438bcSVasanthakumar Thiagarajan 316955055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 317055055976SVasanthakumar Thiagarajan 317155055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 317255055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 317355055976SVasanthakumar Thiagarajan 317480abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 317580abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 317680abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 317780abaf9bSVasanthakumar Thiagarajan } 317880abaf9bSVasanthakumar Thiagarajan 317927929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 318055055976SVasanthakumar Thiagarajan 318155055976SVasanthakumar Thiagarajan ar->num_vif--; 31828dafb70eSVasanthakumar Thiagarajan } 31838dafb70eSVasanthakumar Thiagarajan 31848dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 318555055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 318655055976SVasanthakumar Thiagarajan u8 nw_type) 31878dafb70eSVasanthakumar Thiagarajan { 31888dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3189108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 31908dafb70eSVasanthakumar Thiagarajan 319155055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 31928dafb70eSVasanthakumar Thiagarajan if (!ndev) 31938dafb70eSVasanthakumar Thiagarajan return NULL; 31948dafb70eSVasanthakumar Thiagarajan 3195108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3196108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3197108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3198108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3199108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3200108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3201108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3202108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3203334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3204d0d670abSKalle Valo vif->nw_type = nw_type; 3205d0d670abSKalle Valo vif->next_mode = nw_type; 32068f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3207ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 32088dafb70eSVasanthakumar Thiagarajan 320955055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 321055055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 321155055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 321255055976SVasanthakumar Thiagarajan 0x2; 321355055976SVasanthakumar Thiagarajan 32148dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 32158dafb70eSVasanthakumar Thiagarajan 3216e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 32178dafb70eSVasanthakumar Thiagarajan 3218c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 32198dafb70eSVasanthakumar Thiagarajan goto err; 32208dafb70eSVasanthakumar Thiagarajan 322127929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 32228dafb70eSVasanthakumar Thiagarajan goto err; 32238dafb70eSVasanthakumar Thiagarajan 322455055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 322514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 322659c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 32278dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 322859c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 32298dafb70eSVasanthakumar Thiagarajan 323055055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 323155055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 323255055976SVasanthakumar Thiagarajan 323311f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3234990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 323511f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3236990bd915SVasanthakumar Thiagarajan 32378dafb70eSVasanthakumar Thiagarajan return ndev; 32388dafb70eSVasanthakumar Thiagarajan 32398dafb70eSVasanthakumar Thiagarajan err: 324027929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 324127929723SVasanthakumar Thiagarajan free_netdev(ndev); 3242bdcd8170SKalle Valo return NULL; 3243bdcd8170SKalle Valo } 3244bdcd8170SKalle Valo 324546d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 324646d33a21SKalle Valo { 324746d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 324846d33a21SKalle Valo int ret; 324946d33a21SKalle Valo 325046d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 325146d33a21SKalle Valo 325246d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 325346d33a21SKalle Valo 325446d33a21SKalle Valo /* set device pointer for wiphy */ 325546d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 325646d33a21SKalle Valo 325746d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 325846d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 325946d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 326046d33a21SKalle Valo if (ar->p2p) { 326146d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 326246d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 326346d33a21SKalle Valo } 326446d33a21SKalle Valo 326546d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 326646d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 326746d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 326846d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 326946d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 327046d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 327146d33a21SKalle Valo 327246d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 327346d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 327446d33a21SKalle Valo 327546d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 327646d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 327746d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 327846d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 327946d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 328046d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 328146d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 328246d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 328346d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 328446d33a21SKalle Valo 328546d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 328646d33a21SKalle Valo 3287f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3288f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3289f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3290f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3291f2afdac7SVasanthakumar Thiagarajan 3292f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3293f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3294f2afdac7SVasanthakumar Thiagarajan 329503bdeb0dSVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 329603bdeb0dSVasanthakumar Thiagarajan ar->fw_capabilities)) 329703bdeb0dSVasanthakumar Thiagarajan ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 329803bdeb0dSVasanthakumar Thiagarajan 3299f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3300f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3301f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3302f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3303f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3304f2afdac7SVasanthakumar Thiagarajan 330546d33a21SKalle Valo ret = wiphy_register(wiphy); 330646d33a21SKalle Valo if (ret < 0) { 330746d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 330846d33a21SKalle Valo return ret; 330946d33a21SKalle Valo } 331046d33a21SKalle Valo 3311e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3312e5348a1eSVasanthakumar Thiagarajan 331346d33a21SKalle Valo return 0; 331446d33a21SKalle Valo } 331546d33a21SKalle Valo 331646d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3317bdcd8170SKalle Valo { 3318be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3319e5348a1eSVasanthakumar Thiagarajan 3320e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 332145eaa78fSKalle Valo } 332246d33a21SKalle Valo 332345eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 332445eaa78fSKalle Valo { 332545eaa78fSKalle Valo struct ath6kl *ar; 332645eaa78fSKalle Valo struct wiphy *wiphy; 332745eaa78fSKalle Valo 332845eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 332945eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 333045eaa78fSKalle Valo 333145eaa78fSKalle Valo if (!wiphy) { 333245eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 333345eaa78fSKalle Valo return NULL; 333445eaa78fSKalle Valo } 333545eaa78fSKalle Valo 333645eaa78fSKalle Valo ar = wiphy_priv(wiphy); 333745eaa78fSKalle Valo ar->wiphy = wiphy; 333845eaa78fSKalle Valo 333945eaa78fSKalle Valo return ar; 334045eaa78fSKalle Valo } 334145eaa78fSKalle Valo 334245eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 334345eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 334445eaa78fSKalle Valo { 33451d2a4456SVasanthakumar Thiagarajan int i; 33461d2a4456SVasanthakumar Thiagarajan 33471d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 33481d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 33491d2a4456SVasanthakumar Thiagarajan 3350be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3351bdcd8170SKalle Valo } 335245eaa78fSKalle Valo 3353