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 419bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 420bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 421bdcd8170SKalle Valo { 422bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 42359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 424bdcd8170SKalle Valo int status; 4253ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 426bdcd8170SKalle Valo 42710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 42810509f90SKalle Valo 42914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 430bdcd8170SKalle Valo 431990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 432bdcd8170SKalle Valo return -EIO; 433bdcd8170SKalle Valo 434bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 435bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 436bdcd8170SKalle Valo return -EBUSY; 437bdcd8170SKalle Valo } 438bdcd8170SKalle Valo 439bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 440bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 441bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 442bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 443bdcd8170SKalle Valo return -EINVAL; 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 447bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 448bdcd8170SKalle Valo return -ERESTARTSYS; 449bdcd8170SKalle Valo } 450bdcd8170SKalle Valo 451bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 452bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 453bdcd8170SKalle Valo up(&ar->sem); 454bdcd8170SKalle Valo return -EBUSY; 455bdcd8170SKalle Valo } 456bdcd8170SKalle Valo 457bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 458bdcd8170SKalle Valo /* 459bdcd8170SKalle Valo * sleep until the command queue drains 460bdcd8170SKalle Valo */ 461bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 462bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 463bdcd8170SKalle Valo WMI_TIMEOUT); 464bdcd8170SKalle Valo if (signal_pending(current)) { 465bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 466bdcd8170SKalle Valo up(&ar->sem); 467bdcd8170SKalle Valo return -EINTR; 468bdcd8170SKalle Valo } 469bdcd8170SKalle Valo } 470bdcd8170SKalle Valo 471334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 472743b4518SDan Carpenter if (status) { 473743b4518SDan Carpenter up(&ar->sem); 4746981ffdcSKevin Fang return status; 475743b4518SDan Carpenter } 4766e786cb1SJouni Malinen 4776e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 478542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4796981ffdcSKevin Fang 48059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4813450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4823450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 483cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 484334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 485334234b5SVasanthakumar Thiagarajan vif->req_bssid, 486f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 487bdcd8170SKalle Valo 488bdcd8170SKalle Valo up(&ar->sem); 489bdcd8170SKalle Valo if (status) { 490bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 491bdcd8170SKalle Valo return -EIO; 492bdcd8170SKalle Valo } 493bdcd8170SKalle Valo return 0; 4943450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4953450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 496240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 497bdcd8170SKalle Valo } 498bdcd8170SKalle Valo 4993450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5003450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5013450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 502bdcd8170SKalle Valo 503bdcd8170SKalle Valo if (sme->channel) 504f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 505bdcd8170SKalle Valo 5068c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 507bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5088c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 509bdcd8170SKalle Valo 510240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 511bdcd8170SKalle Valo 512240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 513bdcd8170SKalle Valo if (status) { 514bdcd8170SKalle Valo up(&ar->sem); 515bdcd8170SKalle Valo return status; 516bdcd8170SKalle Valo } 517bdcd8170SKalle Valo 518bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 519240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 520bdcd8170SKalle Valo else 521240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 522bdcd8170SKalle Valo 523240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 524bdcd8170SKalle Valo 525bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 526240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 527bdcd8170SKalle Valo 528bdcd8170SKalle Valo if ((sme->key_len) && 5293450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5303450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 531bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 532bdcd8170SKalle Valo 533792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 534bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 535bdcd8170SKalle Valo sme->key_idx); 536bdcd8170SKalle Valo up(&ar->sem); 537bdcd8170SKalle Valo return -ENOENT; 538bdcd8170SKalle Valo } 539bdcd8170SKalle Valo 5406f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 541bdcd8170SKalle Valo key->key_len = sme->key_len; 542bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5433450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5443450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 545bdcd8170SKalle Valo 546334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5473450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 548bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 549bdcd8170SKalle Valo key->key_len, 550f4bb9a6fSJouni Malinen NULL, 0, 551bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 552bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 553bdcd8170SKalle Valo } 554bdcd8170SKalle Valo 555bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 55659c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 557240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 558240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 559bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 560bdcd8170SKalle Valo up(&ar->sem); 561bdcd8170SKalle Valo return -EIO; 562bdcd8170SKalle Valo } 563bdcd8170SKalle Valo } 564bdcd8170SKalle Valo 565f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 566bdcd8170SKalle Valo 5673ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5683ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5693ca9d1fcSAarthi Thiruvengadam 570bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 571bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 572bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 573bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 574bdcd8170SKalle Valo __func__, 5753450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5763450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 577f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 578bdcd8170SKalle Valo 579cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 580334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5813450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5823450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5833450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5843450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5853450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 586f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 5873ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 588bdcd8170SKalle Valo 589bdcd8170SKalle Valo up(&ar->sem); 590bdcd8170SKalle Valo 591bdcd8170SKalle Valo if (status == -EINVAL) { 5923450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5933450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 594bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 595bdcd8170SKalle Valo return -ENOENT; 596bdcd8170SKalle Valo } else if (status) { 597bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 598bdcd8170SKalle Valo return -EIO; 599bdcd8170SKalle Valo } 600bdcd8170SKalle Valo 601bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 6023450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 6033450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 604de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 605bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 606bdcd8170SKalle Valo } 607bdcd8170SKalle Valo 608bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 60959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 610bdcd8170SKalle Valo 611bdcd8170SKalle Valo return 0; 612bdcd8170SKalle Valo } 613bdcd8170SKalle Valo 6145e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6155e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6164eab6f4fSRaja Mani enum network_type nw_type, 6174eab6f4fSRaja Mani const u8 *bssid, 61801cac476SJouni Malinen struct ieee80211_channel *chan, 6195e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6205e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 62101cac476SJouni Malinen { 622240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 62301cac476SJouni Malinen struct cfg80211_bss *bss; 6244eab6f4fSRaja Mani u16 cap_mask, cap_val; 62501cac476SJouni Malinen u8 *ie; 62601cac476SJouni Malinen 6274eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6284eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6294eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6304eab6f4fSRaja Mani } else { 6314eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6324eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6334eab6f4fSRaja Mani } 6344eab6f4fSRaja Mani 635be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6364eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6374eab6f4fSRaja Mani cap_mask, cap_val); 63801cac476SJouni Malinen if (bss == NULL) { 63901cac476SJouni Malinen /* 64001cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 64101cac476SJouni Malinen * generate a partial entry until the first BSS info 64201cac476SJouni Malinen * event becomes available. 64301cac476SJouni Malinen * 64401cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 64501cac476SJouni Malinen * IEs from the target. 64601cac476SJouni Malinen */ 6473450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 64801cac476SJouni Malinen if (ie == NULL) 6495e13fd35SVasanthakumar Thiagarajan return NULL; 65001cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6513450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6523450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6533450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 654be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6554eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6563450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 65701cac476SJouni Malinen 0, GFP_KERNEL); 65801cac476SJouni Malinen if (bss) 6594eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6604eab6f4fSRaja Mani "cfg80211\n", bssid); 66101cac476SJouni Malinen kfree(ie); 66201cac476SJouni Malinen } else 6635e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 66401cac476SJouni Malinen 6655e13fd35SVasanthakumar Thiagarajan return bss; 66601cac476SJouni Malinen } 66701cac476SJouni Malinen 668240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 669bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 670bdcd8170SKalle Valo u16 beacon_intvl, 671bdcd8170SKalle Valo enum network_type nw_type, 672bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 673bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 674bdcd8170SKalle Valo { 67501cac476SJouni Malinen struct ieee80211_channel *chan; 676240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6775e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo /* capinfo + listen interval */ 680bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 681bdcd8170SKalle Valo 682bdcd8170SKalle Valo /* capinfo + status code + associd */ 683bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 684bdcd8170SKalle Valo 685bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 686bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 687bdcd8170SKalle Valo assoc_resp_ie_offset; 688bdcd8170SKalle Valo 689bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 690bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 691bdcd8170SKalle Valo 69232c10874SJouni Malinen /* 69332c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 69432c10874SJouni Malinen * a Beacon frame from the AP is seen. 69532c10874SJouni Malinen */ 696cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 69759c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 69832c10874SJouni Malinen 699bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 700551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 701bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 702bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 703bdcd8170SKalle Valo return; 704bdcd8170SKalle Valo } 705bdcd8170SKalle Valo } 706bdcd8170SKalle Valo 707bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 708551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 709551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 710bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 711bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 712bdcd8170SKalle Valo return; 713bdcd8170SKalle Valo } 714bdcd8170SKalle Valo } 715bdcd8170SKalle Valo 716be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 717bdcd8170SKalle Valo 7185e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7195e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7205e13fd35SVasanthakumar Thiagarajan if (!bss) { 7214eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 722bdcd8170SKalle Valo return; 723bdcd8170SKalle Valo } 724bdcd8170SKalle Valo 7254eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7264eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7274eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7284eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7295e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 73001cac476SJouni Malinen return; 73101cac476SJouni Malinen } 73201cac476SJouni Malinen 73314ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 734bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 73514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 736240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 737bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 738bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 739bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7405e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 74114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 742bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7435e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 744bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 745bdcd8170SKalle Valo } 746bdcd8170SKalle Valo } 747bdcd8170SKalle Valo 748bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 749bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 750bdcd8170SKalle Valo { 751d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7523450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 753bdcd8170SKalle Valo 754bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 755bdcd8170SKalle Valo reason_code); 756bdcd8170SKalle Valo 75710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 75810509f90SKalle Valo 759990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 760bdcd8170SKalle Valo return -EIO; 761bdcd8170SKalle Valo 762bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 763bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 764bdcd8170SKalle Valo return -EBUSY; 765bdcd8170SKalle Valo } 766bdcd8170SKalle Valo 767bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 768bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 769bdcd8170SKalle Valo return -ERESTARTSYS; 770bdcd8170SKalle Valo } 771bdcd8170SKalle Valo 772cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 773240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7743450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7753450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 776bdcd8170SKalle Valo 777bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7788c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 779bdcd8170SKalle Valo 780bdcd8170SKalle Valo up(&ar->sem); 781bdcd8170SKalle Valo 78214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 783170826ddSVasanthakumar Thiagarajan 784bdcd8170SKalle Valo return 0; 785bdcd8170SKalle Valo } 786bdcd8170SKalle Valo 787240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 788bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 789bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 790bdcd8170SKalle Valo { 791240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 79259c98449SVasanthakumar Thiagarajan 79314ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 79414ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 79514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 796bdcd8170SKalle Valo } 797bdcd8170SKalle Valo 798f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 799551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 800bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 801bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 802bdcd8170SKalle Valo return; 803bdcd8170SKalle Valo } 804bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 805240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 806bdcd8170SKalle Valo return; 807bdcd8170SKalle Valo } 808bdcd8170SKalle Valo 809f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 810551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 811551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 812bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 813bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 814bdcd8170SKalle Valo return; 815bdcd8170SKalle Valo } 816bdcd8170SKalle Valo } 817bdcd8170SKalle Valo 8181de547d6SVasanthakumar Thiagarajan /* 8191de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8201de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8211de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8221de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8231de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8241de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8251de547d6SVasanthakumar Thiagarajan */ 826bdcd8170SKalle Valo 8271de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 828334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 829bdcd8170SKalle Valo return; 830bdcd8170SKalle Valo } 831bdcd8170SKalle Valo 83259c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 833bdcd8170SKalle Valo 83414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 835240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 836bdcd8170SKalle Valo bssid, NULL, 0, 837bdcd8170SKalle Valo NULL, 0, 838bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 839bdcd8170SKalle Valo GFP_KERNEL); 84014ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 841240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 842bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 843bdcd8170SKalle Valo } 844bdcd8170SKalle Valo 84514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 846bdcd8170SKalle Valo } 847bdcd8170SKalle Valo 848bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 849bdcd8170SKalle Valo struct cfg80211_scan_request *request) 850bdcd8170SKalle Valo { 851d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 85259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8531276c9efSEdward Lu s8 n_channels = 0; 8541276c9efSEdward Lu u16 *channels = NULL; 855bdcd8170SKalle Valo int ret = 0; 856f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 857bdcd8170SKalle Valo 858990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 859bdcd8170SKalle Valo return -EIO; 860bdcd8170SKalle Valo 86110509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 86210509f90SKalle Valo 863bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 86459c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8651b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 866240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 86759c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8681b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8691b1e6ee3SJouni Malinen if (ret) { 870bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8711b1e6ee3SJouni Malinen return ret; 872bdcd8170SKalle Valo } 873bdcd8170SKalle Valo } 874bdcd8170SKalle Valo 875bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 876bdcd8170SKalle Valo u8 i; 877bdcd8170SKalle Valo 878bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 879bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 880bdcd8170SKalle Valo 881bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 882334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 883334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 884bdcd8170SKalle Valo request->ssids[i].ssid_len, 885bdcd8170SKalle Valo request->ssids[i].ssid); 886bdcd8170SKalle Valo } 887bdcd8170SKalle Valo 888080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 889334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 890334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 891b84da8c7SJouni Malinen request->ie, request->ie_len); 892b84da8c7SJouni Malinen if (ret) { 893b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 894b84da8c7SJouni Malinen "scan"); 895b84da8c7SJouni Malinen return ret; 896b84da8c7SJouni Malinen } 897b84da8c7SJouni Malinen 89811869befSJouni Malinen /* 89911869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 90011869befSJouni Malinen * channels. If the list is longer than the target supports, do not 90111869befSJouni Malinen * configure the list and instead, scan all available channels. 90211869befSJouni Malinen */ 90311869befSJouni Malinen if (request->n_channels > 0 && 90411869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9051276c9efSEdward Lu u8 i; 9061276c9efSEdward Lu 90711869befSJouni Malinen n_channels = request->n_channels; 9081276c9efSEdward Lu 9091276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9101276c9efSEdward Lu if (channels == NULL) { 9111276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9121276c9efSEdward Lu "scan all channels"); 9131276c9efSEdward Lu n_channels = 0; 9141276c9efSEdward Lu } 9151276c9efSEdward Lu 9161276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9171276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9181276c9efSEdward Lu } 9191276c9efSEdward Lu 92059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 921f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 922f1f92179SVasanthakumar Thiagarajan 9233ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9243ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9253ca9d1fcSAarthi Thiruvengadam /* 9263ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9273ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9283ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9293ca9d1fcSAarthi Thiruvengadam * probe requests 9303ca9d1fcSAarthi Thiruvengadam */ 9313ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9323ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 93313423c31SVasanthakumar Thiagarajan false, 0, 93413423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 93513423c31SVasanthakumar Thiagarajan n_channels, channels, 93613423c31SVasanthakumar Thiagarajan request->no_cck, 9373ca9d1fcSAarthi Thiruvengadam request->rates); 9383ca9d1fcSAarthi Thiruvengadam } else { 9393ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9403ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 94113423c31SVasanthakumar Thiagarajan false, 0, 94213423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 94313423c31SVasanthakumar Thiagarajan n_channels, channels); 9443ca9d1fcSAarthi Thiruvengadam } 9451b1e6ee3SJouni Malinen if (ret) 946bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 94711869befSJouni Malinen else 94814ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 949bdcd8170SKalle Valo 9501276c9efSEdward Lu kfree(channels); 9511276c9efSEdward Lu 952bdcd8170SKalle Valo return ret; 953bdcd8170SKalle Valo } 954bdcd8170SKalle Valo 9551c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 956bdcd8170SKalle Valo { 957240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9586fd1eaceSKalle Valo int i; 959bdcd8170SKalle Valo 9601c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9611c17d313SKalle Valo aborted ? " aborted" : ""); 962bdcd8170SKalle Valo 96314ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9646fd1eaceSKalle Valo return; 9656fd1eaceSKalle Valo 9661c17d313SKalle Valo if (aborted) 9676fd1eaceSKalle Valo goto out; 968bdcd8170SKalle Valo 96914ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 97014ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 971334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 972334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 973bdcd8170SKalle Valo 0, NULL); 974bdcd8170SKalle Valo } 975bdcd8170SKalle Valo } 9766fd1eaceSKalle Valo 9776fd1eaceSKalle Valo out: 978cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 97914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 980bdcd8170SKalle Valo } 981bdcd8170SKalle Valo 982bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 983bdcd8170SKalle Valo u8 key_index, bool pairwise, 984bdcd8170SKalle Valo const u8 *mac_addr, 985bdcd8170SKalle Valo struct key_params *params) 986bdcd8170SKalle Valo { 987d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 98859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 989bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 9904a8ce2fdSSujith Manoharan int seq_len; 991bdcd8170SKalle Valo u8 key_usage; 992bdcd8170SKalle Valo u8 key_type; 993bdcd8170SKalle Valo 994990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 995bdcd8170SKalle Valo return -EIO; 996bdcd8170SKalle Valo 997837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 998837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 999837cb97eSJouni Malinen return -EINVAL; 1000240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1001240d2799SVasanthakumar Thiagarajan params->key); 1002837cb97eSJouni Malinen } 1003837cb97eSJouni Malinen 1004792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1005bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1006bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1007bdcd8170SKalle Valo key_index); 1008bdcd8170SKalle Valo return -ENOENT; 1009bdcd8170SKalle Valo } 1010bdcd8170SKalle Valo 10116f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1012bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1013bdcd8170SKalle Valo 1014bdcd8170SKalle Valo if (pairwise) 1015bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1016bdcd8170SKalle Valo else 1017bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1018bdcd8170SKalle Valo 10194a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10205e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10215e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10225e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10235e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10245e07021eSDai Shuibing } 1025bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10265e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1027bdcd8170SKalle Valo return -EINVAL; 1028bdcd8170SKalle Valo 1029bdcd8170SKalle Valo key->key_len = params->key_len; 1030bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10315e07021eSDai Shuibing key->seq_len = seq_len; 1032bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1033bdcd8170SKalle Valo key->cipher = params->cipher; 1034bdcd8170SKalle Valo 1035bdcd8170SKalle Valo switch (key->cipher) { 1036bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1037bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1038bdcd8170SKalle Valo key_type = WEP_CRYPT; 1039bdcd8170SKalle Valo break; 1040bdcd8170SKalle Valo 1041bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1042bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1043bdcd8170SKalle Valo break; 1044bdcd8170SKalle Valo 1045bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1046bdcd8170SKalle Valo key_type = AES_CRYPT; 1047bdcd8170SKalle Valo break; 10485e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10495e07021eSDai Shuibing key_type = WAPI_CRYPT; 10505e07021eSDai Shuibing break; 1051bdcd8170SKalle Valo 1052bdcd8170SKalle Valo default: 1053bdcd8170SKalle Valo return -ENOTSUPP; 1054bdcd8170SKalle Valo } 1055bdcd8170SKalle Valo 10563450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10573450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1058bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1059de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1060bdcd8170SKalle Valo 1061bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1062bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1063bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1064bdcd8170SKalle Valo key_usage, key->seq_len); 1065bdcd8170SKalle Valo 1066f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10674703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1068cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10699a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10709a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10719a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10729a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10739a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 107459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10759a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10769a5b1318SJouni Malinen "key configuration until AP mode has been " 10779a5b1318SJouni Malinen "started\n"); 10789a5b1318SJouni Malinen /* 10799a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10809a5b1318SJouni Malinen * the connected event is received from the target. 10819a5b1318SJouni Malinen */ 10829a5b1318SJouni Malinen return 0; 10839a5b1318SJouni Malinen } 10849a5b1318SJouni Malinen } 10859a5b1318SJouni Malinen 1086f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 108759c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1088151411e8SJouni Malinen /* 1089151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1090151411e8SJouni Malinen * the AP mode has properly started 1091151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1092151411e8SJouni Malinen */ 1093151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1094151411e8SJouni Malinen "until AP mode has been started\n"); 10956f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10966f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10976f2a73f9SVasanthakumar Thiagarajan key->key_len); 1098151411e8SJouni Malinen return 0; 1099151411e8SJouni Malinen } 1100151411e8SJouni Malinen 11017cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1102bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1103f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1104f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1105bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1106bdcd8170SKalle Valo } 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1109bdcd8170SKalle Valo u8 key_index, bool pairwise, 1110bdcd8170SKalle Valo const u8 *mac_addr) 1111bdcd8170SKalle Valo { 1112d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11136f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1114bdcd8170SKalle Valo 1115bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1116bdcd8170SKalle Valo 1117990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1118bdcd8170SKalle Valo return -EIO; 1119bdcd8170SKalle Valo 1120792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1121bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1122bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1123bdcd8170SKalle Valo key_index); 1124bdcd8170SKalle Valo return -ENOENT; 1125bdcd8170SKalle Valo } 1126bdcd8170SKalle Valo 11276f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1128bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1129bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1130bdcd8170SKalle Valo return 0; 1131bdcd8170SKalle Valo } 1132bdcd8170SKalle Valo 11336f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1134bdcd8170SKalle Valo 1135334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1136bdcd8170SKalle Valo } 1137bdcd8170SKalle Valo 1138bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1139bdcd8170SKalle Valo u8 key_index, bool pairwise, 1140bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1141bdcd8170SKalle Valo void (*callback) (void *cookie, 1142bdcd8170SKalle Valo struct key_params *)) 1143bdcd8170SKalle Valo { 11446f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1145bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1146bdcd8170SKalle Valo struct key_params params; 1147bdcd8170SKalle Valo 1148bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1149bdcd8170SKalle Valo 1150990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1151bdcd8170SKalle Valo return -EIO; 1152bdcd8170SKalle Valo 1153792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1154bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1155bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1156bdcd8170SKalle Valo key_index); 1157bdcd8170SKalle Valo return -ENOENT; 1158bdcd8170SKalle Valo } 1159bdcd8170SKalle Valo 11606f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1161bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1162bdcd8170SKalle Valo params.cipher = key->cipher; 1163bdcd8170SKalle Valo params.key_len = key->key_len; 1164bdcd8170SKalle Valo params.seq_len = key->seq_len; 1165bdcd8170SKalle Valo params.seq = key->seq; 1166bdcd8170SKalle Valo params.key = key->key; 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo callback(cookie, ¶ms); 1169bdcd8170SKalle Valo 1170bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1171bdcd8170SKalle Valo } 1172bdcd8170SKalle Valo 1173bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1174bdcd8170SKalle Valo struct net_device *ndev, 1175bdcd8170SKalle Valo u8 key_index, bool unicast, 1176bdcd8170SKalle Valo bool multicast) 1177bdcd8170SKalle Valo { 1178d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 117959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1180bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1181bdcd8170SKalle Valo u8 key_usage; 1182229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1185bdcd8170SKalle Valo 1186990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1187bdcd8170SKalle Valo return -EIO; 1188bdcd8170SKalle Valo 1189792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1191bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1192bdcd8170SKalle Valo __func__, key_index); 1193bdcd8170SKalle Valo return -ENOENT; 1194bdcd8170SKalle Valo } 1195bdcd8170SKalle Valo 11966f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1197bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1198bdcd8170SKalle Valo __func__, key_index); 1199bdcd8170SKalle Valo return -EINVAL; 1200bdcd8170SKalle Valo } 1201bdcd8170SKalle Valo 12023450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12036f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1204bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12053450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1206bdcd8170SKalle Valo key_usage |= TX_USAGE; 1207229ed6b5SEdward Lu if (unicast) 12083450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1209229ed6b5SEdward Lu if (multicast) 12103450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1211bdcd8170SKalle Valo 1212f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12139a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12149a5b1318SJouni Malinen 1215f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1216334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1217229ed6b5SEdward Lu key_type, key_usage, 1218f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1219f4bb9a6fSJouni Malinen key->key, 1220bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1221bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1222bdcd8170SKalle Valo } 1223bdcd8170SKalle Valo 1224240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1225bdcd8170SKalle Valo bool ismcast) 1226bdcd8170SKalle Valo { 1227bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1228bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1229bdcd8170SKalle Valo 1230240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1231bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1232bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1233bdcd8170SKalle Valo GFP_KERNEL); 1234bdcd8170SKalle Valo } 1235bdcd8170SKalle Valo 1236bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1237bdcd8170SKalle Valo { 1238bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1239990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1240bdcd8170SKalle Valo int ret; 1241bdcd8170SKalle Valo 1242bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1243bdcd8170SKalle Valo changed); 1244bdcd8170SKalle Valo 1245990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1246990bd915SVasanthakumar Thiagarajan if (!vif) 1247990bd915SVasanthakumar Thiagarajan return -EIO; 1248990bd915SVasanthakumar Thiagarajan 1249990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1250bdcd8170SKalle Valo return -EIO; 1251bdcd8170SKalle Valo 1252bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1253bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1254bdcd8170SKalle Valo if (ret != 0) { 1255bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1256bdcd8170SKalle Valo return -EIO; 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo } 1259bdcd8170SKalle Valo 1260bdcd8170SKalle Valo return 0; 1261bdcd8170SKalle Valo } 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo /* 1264bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1265bdcd8170SKalle Valo * data type from 2.6.36 onwards 1266bdcd8170SKalle Valo */ 1267bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1268bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1269b992a285SLuis R. Rodriguez int mbm) 1270bdcd8170SKalle Valo { 1271bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1272990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1273bdcd8170SKalle Valo u8 ath6kl_dbm; 1274b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1275bdcd8170SKalle Valo 1276bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1277bdcd8170SKalle Valo type, dbm); 1278bdcd8170SKalle Valo 1279990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1280990bd915SVasanthakumar Thiagarajan if (!vif) 1281990bd915SVasanthakumar Thiagarajan return -EIO; 1282990bd915SVasanthakumar Thiagarajan 1283990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1284bdcd8170SKalle Valo return -EIO; 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo switch (type) { 1287bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1288bdcd8170SKalle Valo return 0; 1289bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1290bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1291bdcd8170SKalle Valo break; 1292bdcd8170SKalle Valo default: 1293bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1294bdcd8170SKalle Valo __func__, type); 1295bdcd8170SKalle Valo return -EOPNOTSUPP; 1296bdcd8170SKalle Valo } 1297bdcd8170SKalle Valo 1298990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1299bdcd8170SKalle Valo 1300bdcd8170SKalle Valo return 0; 1301bdcd8170SKalle Valo } 1302bdcd8170SKalle Valo 1303bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1304bdcd8170SKalle Valo { 1305bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1306990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1307bdcd8170SKalle Valo 1308990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1309990bd915SVasanthakumar Thiagarajan if (!vif) 1310990bd915SVasanthakumar Thiagarajan return -EIO; 1311990bd915SVasanthakumar Thiagarajan 1312990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1313bdcd8170SKalle Valo return -EIO; 1314bdcd8170SKalle Valo 131559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1316bdcd8170SKalle Valo ar->tx_pwr = 0; 1317bdcd8170SKalle Valo 1318990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1319bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1320bdcd8170SKalle Valo return -EIO; 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo 1323bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1324bdcd8170SKalle Valo 5 * HZ); 1325bdcd8170SKalle Valo 1326bdcd8170SKalle Valo if (signal_pending(current)) { 1327bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1328bdcd8170SKalle Valo return -EINTR; 1329bdcd8170SKalle Valo } 1330bdcd8170SKalle Valo } 1331bdcd8170SKalle Valo 1332bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1333bdcd8170SKalle Valo return 0; 1334bdcd8170SKalle Valo } 1335bdcd8170SKalle Valo 1336bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1337bdcd8170SKalle Valo struct net_device *dev, 1338bdcd8170SKalle Valo bool pmgmt, int timeout) 1339bdcd8170SKalle Valo { 1340bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1341bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1342334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1343bdcd8170SKalle Valo 1344bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1345bdcd8170SKalle Valo __func__, pmgmt, timeout); 1346bdcd8170SKalle Valo 1347990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1348bdcd8170SKalle Valo return -EIO; 1349bdcd8170SKalle Valo 1350bdcd8170SKalle Valo if (pmgmt) { 1351bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1352bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1353bdcd8170SKalle Valo } else { 1354bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1355bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1359334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1360bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1361bdcd8170SKalle Valo return -EIO; 1362bdcd8170SKalle Valo } 1363bdcd8170SKalle Valo 1364bdcd8170SKalle Valo return 0; 1365bdcd8170SKalle Valo } 1366bdcd8170SKalle Valo 136755055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 136855055976SVasanthakumar Thiagarajan char *name, 136955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 137055055976SVasanthakumar Thiagarajan u32 *flags, 137155055976SVasanthakumar Thiagarajan struct vif_params *params) 137255055976SVasanthakumar Thiagarajan { 137355055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 137455055976SVasanthakumar Thiagarajan struct net_device *ndev; 137555055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 137655055976SVasanthakumar Thiagarajan 137771f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 137855055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 137955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 138055055976SVasanthakumar Thiagarajan } 138155055976SVasanthakumar Thiagarajan 138255055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 138355055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 138455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 138555055976SVasanthakumar Thiagarajan } 138655055976SVasanthakumar Thiagarajan 138755055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 138855055976SVasanthakumar Thiagarajan if (!ndev) 138955055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 139055055976SVasanthakumar Thiagarajan 139155055976SVasanthakumar Thiagarajan ar->num_vif++; 139255055976SVasanthakumar Thiagarajan 139355055976SVasanthakumar Thiagarajan return ndev; 139455055976SVasanthakumar Thiagarajan } 139555055976SVasanthakumar Thiagarajan 139655055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 139755055976SVasanthakumar Thiagarajan struct net_device *ndev) 139855055976SVasanthakumar Thiagarajan { 139955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 140055055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 140155055976SVasanthakumar Thiagarajan 140211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 140355055976SVasanthakumar Thiagarajan list_del(&vif->list); 140411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 140555055976SVasanthakumar Thiagarajan 140655055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 140755055976SVasanthakumar Thiagarajan 1408c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 140955055976SVasanthakumar Thiagarajan 141055055976SVasanthakumar Thiagarajan return 0; 141155055976SVasanthakumar Thiagarajan } 141255055976SVasanthakumar Thiagarajan 1413bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1414bdcd8170SKalle Valo struct net_device *ndev, 1415bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1416bdcd8170SKalle Valo struct vif_params *params) 1417bdcd8170SKalle Valo { 1418f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1419bdcd8170SKalle Valo 1420bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1421bdcd8170SKalle Valo 1422bdcd8170SKalle Valo switch (type) { 1423bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1424f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1425bdcd8170SKalle Valo break; 1426bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1427f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1428bdcd8170SKalle Valo break; 14296e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1430f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14316e4604c8SJouni Malinen break; 14326b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1433f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14346b5e5d25SJouni Malinen break; 14356b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1436f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14376b5e5d25SJouni Malinen break; 1438bdcd8170SKalle Valo default: 1439bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1440bdcd8170SKalle Valo return -EOPNOTSUPP; 1441bdcd8170SKalle Valo } 1442bdcd8170SKalle Valo 1443551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1444bdcd8170SKalle Valo 1445bdcd8170SKalle Valo return 0; 1446bdcd8170SKalle Valo } 1447bdcd8170SKalle Valo 1448bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1449bdcd8170SKalle Valo struct net_device *dev, 1450bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1451bdcd8170SKalle Valo { 1452bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 145359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1454bdcd8170SKalle Valo int status; 1455bdcd8170SKalle Valo 1456990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1457bdcd8170SKalle Valo return -EIO; 1458bdcd8170SKalle Valo 14593450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14603450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1461bdcd8170SKalle Valo 1462bdcd8170SKalle Valo if (ibss_param->channel) 1463f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1466bdcd8170SKalle Valo /* 1467bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1468bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1469bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1470bdcd8170SKalle Valo * updated. 1471bdcd8170SKalle Valo */ 1472bdcd8170SKalle Valo return -EOPNOTSUPP; 1473bdcd8170SKalle Valo } 1474bdcd8170SKalle Valo 14758c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1476bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14778c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14788c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1479bdcd8170SKalle Valo 1480240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1481bdcd8170SKalle Valo 1482240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1483bdcd8170SKalle Valo if (status) 1484bdcd8170SKalle Valo return status; 1485bdcd8170SKalle Valo 1486bdcd8170SKalle Valo if (ibss_param->privacy) { 1487240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1488240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1489bdcd8170SKalle Valo } else { 1490240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1491240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1492bdcd8170SKalle Valo } 1493bdcd8170SKalle Valo 1494f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1495bdcd8170SKalle Valo 1496bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1497bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1498bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1499bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1500bdcd8170SKalle Valo __func__, 15013450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15023450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1503f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1504bdcd8170SKalle Valo 1505334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15063450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15073450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15083450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15093450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15103450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1511f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15123ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 151359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1514bdcd8170SKalle Valo 1515bdcd8170SKalle Valo return 0; 1516bdcd8170SKalle Valo } 1517bdcd8170SKalle Valo 1518bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1519bdcd8170SKalle Valo struct net_device *dev) 1520bdcd8170SKalle Valo { 15213450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1522bdcd8170SKalle Valo 1523990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1524bdcd8170SKalle Valo return -EIO; 1525bdcd8170SKalle Valo 1526240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15273450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15283450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1529bdcd8170SKalle Valo 1530bdcd8170SKalle Valo return 0; 1531bdcd8170SKalle Valo } 1532bdcd8170SKalle Valo 1533bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1534bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1535bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1536bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1537bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1538837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15395e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1540bdcd8170SKalle Valo }; 1541bdcd8170SKalle Valo 1542bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1543bdcd8170SKalle Valo { 1544bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1545bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1546bdcd8170SKalle Valo 36000, 48000, 54000 1547bdcd8170SKalle Valo }; 1548bdcd8170SKalle Valo u8 i; 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1551bdcd8170SKalle Valo if (rate == legacy[i]) 1552bdcd8170SKalle Valo return true; 1553bdcd8170SKalle Valo 1554bdcd8170SKalle Valo return false; 1555bdcd8170SKalle Valo } 1556bdcd8170SKalle Valo 1557bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1558bdcd8170SKalle Valo { 1559bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1560bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1561bdcd8170SKalle Valo }; 1562bdcd8170SKalle Valo u8 i; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1565bdcd8170SKalle Valo if (rate == ht20[i]) { 1566bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1567bdcd8170SKalle Valo /* last rate uses sgi */ 1568bdcd8170SKalle Valo *sgi = true; 1569bdcd8170SKalle Valo else 1570bdcd8170SKalle Valo *sgi = false; 1571bdcd8170SKalle Valo 1572bdcd8170SKalle Valo *mcs = i; 1573bdcd8170SKalle Valo return true; 1574bdcd8170SKalle Valo } 1575bdcd8170SKalle Valo } 1576bdcd8170SKalle Valo return false; 1577bdcd8170SKalle Valo } 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1580bdcd8170SKalle Valo { 1581bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1582bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1583bdcd8170SKalle Valo 150000 1584bdcd8170SKalle Valo }; 1585bdcd8170SKalle Valo u8 i; 1586bdcd8170SKalle Valo 1587bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1588bdcd8170SKalle Valo if (rate == ht40[i]) { 1589bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1590bdcd8170SKalle Valo /* last rate uses sgi */ 1591bdcd8170SKalle Valo *sgi = true; 1592bdcd8170SKalle Valo else 1593bdcd8170SKalle Valo *sgi = false; 1594bdcd8170SKalle Valo 1595bdcd8170SKalle Valo *mcs = i; 1596bdcd8170SKalle Valo return true; 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo } 1599bdcd8170SKalle Valo 1600bdcd8170SKalle Valo return false; 1601bdcd8170SKalle Valo } 1602bdcd8170SKalle Valo 1603bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1604bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1605bdcd8170SKalle Valo { 1606bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 160759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1608bdcd8170SKalle Valo long left; 1609bdcd8170SKalle Valo bool sgi; 1610bdcd8170SKalle Valo s32 rate; 1611bdcd8170SKalle Valo int ret; 1612bdcd8170SKalle Valo u8 mcs; 1613bdcd8170SKalle Valo 16148c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1615bdcd8170SKalle Valo return -ENOENT; 1616bdcd8170SKalle Valo 1617bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1618bdcd8170SKalle Valo return -EBUSY; 1619bdcd8170SKalle Valo 1620b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1621bdcd8170SKalle Valo 1622334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1623bdcd8170SKalle Valo 1624bdcd8170SKalle Valo if (ret != 0) { 1625bdcd8170SKalle Valo up(&ar->sem); 1626bdcd8170SKalle Valo return -EIO; 1627bdcd8170SKalle Valo } 1628bdcd8170SKalle Valo 1629bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1630bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1631b95907a7SVasanthakumar Thiagarajan &vif->flags), 1632bdcd8170SKalle Valo WMI_TIMEOUT); 1633bdcd8170SKalle Valo 1634bdcd8170SKalle Valo up(&ar->sem); 1635bdcd8170SKalle Valo 1636bdcd8170SKalle Valo if (left == 0) 1637bdcd8170SKalle Valo return -ETIMEDOUT; 1638bdcd8170SKalle Valo else if (left < 0) 1639bdcd8170SKalle Valo return left; 1640bdcd8170SKalle Valo 1641b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1642b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1643bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1644b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1645bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1646bdcd8170SKalle Valo } 1647bdcd8170SKalle Valo 1648b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1649b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1650bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1651b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1652bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1653bdcd8170SKalle Valo } 1654bdcd8170SKalle Valo 1655b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1656bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1657bdcd8170SKalle Valo 1658b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1659bdcd8170SKalle Valo 1660bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1661bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1662bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1663bdcd8170SKalle Valo if (sgi) { 1664bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1665bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1666bdcd8170SKalle Valo } else { 1667bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1668bdcd8170SKalle Valo } 1669bdcd8170SKalle Valo 1670bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1671bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1672bdcd8170SKalle Valo if (sgi) { 1673bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1674bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1675bdcd8170SKalle Valo } else { 1676bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1677bdcd8170SKalle Valo } 1678bdcd8170SKalle Valo 1679bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1680bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1681bdcd8170SKalle Valo } else { 16829a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16839a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16849a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1685bdcd8170SKalle Valo return 0; 1686bdcd8170SKalle Valo } 1687bdcd8170SKalle Valo 1688bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1689bdcd8170SKalle Valo 169059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 169159c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1692f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 169332c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 169432c10874SJouni Malinen sinfo->bss_param.flags = 0; 1695cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1696cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 169732c10874SJouni Malinen } 169832c10874SJouni Malinen 1699bdcd8170SKalle Valo return 0; 1700bdcd8170SKalle Valo } 1701bdcd8170SKalle Valo 1702bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1703bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1704bdcd8170SKalle Valo { 1705bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1706334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1707334234b5SVasanthakumar Thiagarajan 1708334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1709bdcd8170SKalle Valo pmksa->pmkid, true); 1710bdcd8170SKalle Valo } 1711bdcd8170SKalle Valo 1712bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1713bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1714bdcd8170SKalle Valo { 1715bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1716334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1717334234b5SVasanthakumar Thiagarajan 1718334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1719bdcd8170SKalle Valo pmksa->pmkid, false); 1720bdcd8170SKalle Valo } 1721bdcd8170SKalle Valo 1722bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1723bdcd8170SKalle Valo { 1724bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 172559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 172659c98449SVasanthakumar Thiagarajan 172759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1728334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1729334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1730bdcd8170SKalle Valo return 0; 1731bdcd8170SKalle Valo } 1732bdcd8170SKalle Valo 1733d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1734d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17356cb3c714SRaja Mani { 1736d91e8eeeSRaja Mani int ret, pos; 1737d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17386cb3c714SRaja Mani u16 i; 17396cb3c714SRaja Mani 1740d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17416cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17426cb3c714SRaja Mani 17436cb3c714SRaja Mani /* 17446cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17456cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17466cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17476cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17486cb3c714SRaja Mani * then equivalent driver specific mask value is 17496cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17506cb3c714SRaja Mani */ 17516cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17526cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17536cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17546cb3c714SRaja Mani mask[pos] = 0xFF; 17556cb3c714SRaja Mani } 17566cb3c714SRaja Mani /* 17576cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17586cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17596cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17606cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17616cb3c714SRaja Mani */ 17626cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17636cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17646cb3c714SRaja Mani wow->patterns[i].pattern_len, 17656cb3c714SRaja Mani 0 /* pattern offset */, 17666cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17676cb3c714SRaja Mani if (ret) 17686cb3c714SRaja Mani return ret; 17696cb3c714SRaja Mani } 17706cb3c714SRaja Mani 1771d91e8eeeSRaja Mani if (wow->disconnect) 1772d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1773d91e8eeeSRaja Mani 1774d91e8eeeSRaja Mani if (wow->magic_pkt) 1775d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1776d91e8eeeSRaja Mani 1777d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1778d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1779d91e8eeeSRaja Mani 1780d91e8eeeSRaja Mani if (wow->eap_identity_req) 1781d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1782d91e8eeeSRaja Mani 1783d91e8eeeSRaja Mani if (wow->four_way_handshake) 1784d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1785d91e8eeeSRaja Mani 1786d91e8eeeSRaja Mani return 0; 1787d91e8eeeSRaja Mani } 1788d91e8eeeSRaja Mani 1789d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1790d91e8eeeSRaja Mani { 1791d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1792d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1793d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1794d91e8eeeSRaja Mani 0x00, 0x08 }; 1795d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1796d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1797d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1798d91e8eeeSRaja Mani 0x00, 0x7f }; 1799d91e8eeeSRaja Mani u8 unicst_offset = 0; 1800d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1801d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1802d91e8eeeSRaja Mani u8 arp_offset = 20; 1803d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1804d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1805d91e8eeeSRaja Mani u8 discvr_offset = 38; 1806d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1807d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1808d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1809d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1810d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1811d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1812d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1813d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1814d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1815d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1816d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1817d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1818d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1819d91e8eeeSRaja Mani int ret; 1820d91e8eeeSRaja Mani 1821d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1822d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1823d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1824d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1825d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1826d91e8eeeSRaja Mani if (ret) { 1827d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1828d91e8eeeSRaja Mani return ret; 1829d91e8eeeSRaja Mani } 1830d91e8eeeSRaja Mani 1831d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1832d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1833d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1834d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1835d91e8eeeSRaja Mani arp_pattern, arp_mask); 1836d91e8eeeSRaja Mani if (ret) { 1837d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1838d91e8eeeSRaja Mani return ret; 1839d91e8eeeSRaja Mani } 1840d91e8eeeSRaja Mani 1841d91e8eeeSRaja Mani /* 1842d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1843d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1844d91e8eeeSRaja Mani */ 1845d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1846d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1847d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1848d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1849d91e8eeeSRaja Mani if (ret) { 1850d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1851d91e8eeeSRaja Mani return ret; 1852d91e8eeeSRaja Mani } 1853d91e8eeeSRaja Mani 1854d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1855d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1856d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1857d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1858d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1859d91e8eeeSRaja Mani if (ret) { 1860d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1861d91e8eeeSRaja Mani return ret; 1862d91e8eeeSRaja Mani } 1863d91e8eeeSRaja Mani 1864d91e8eeeSRaja Mani return 0; 1865d91e8eeeSRaja Mani } 1866d91e8eeeSRaja Mani 1867d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1868d91e8eeeSRaja Mani { 1869d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1870d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1871d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1872d91e8eeeSRaja Mani u8 discvr_offset = 38; 1873d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1874d91e8eeeSRaja Mani int ret; 1875d91e8eeeSRaja Mani 1876d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1877d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1878d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1879d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1880d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1881d91e8eeeSRaja Mani mac_mask); 1882d91e8eeeSRaja Mani if (ret) { 1883d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1884d91e8eeeSRaja Mani return ret; 1885d91e8eeeSRaja Mani } 1886d91e8eeeSRaja Mani 1887d91e8eeeSRaja Mani /* 1888d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1889d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1890d91e8eeeSRaja Mani */ 1891d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1892d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1893d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1894d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1895d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1896d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1897d91e8eeeSRaja Mani if (ret) { 1898d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1899d91e8eeeSRaja Mani "pattern\n"); 1900d91e8eeeSRaja Mani return ret; 1901d91e8eeeSRaja Mani } 1902d91e8eeeSRaja Mani } 1903d91e8eeeSRaja Mani 1904d91e8eeeSRaja Mani return 0; 1905d91e8eeeSRaja Mani } 1906d91e8eeeSRaja Mani 1907d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1908d91e8eeeSRaja Mani { 1909d91e8eeeSRaja Mani struct in_device *in_dev; 1910d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1911d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1912d91e8eeeSRaja Mani int ret, left; 1913d91e8eeeSRaja Mani u32 filter = 0; 1914d91e8eeeSRaja Mani u16 i; 1915d91e8eeeSRaja Mani u8 index = 0; 1916d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1917d91e8eeeSRaja Mani 1918d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1919d91e8eeeSRaja Mani if (!vif) 1920d91e8eeeSRaja Mani return -EIO; 1921d91e8eeeSRaja Mani 1922d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1923d91e8eeeSRaja Mani return -EIO; 1924d91e8eeeSRaja Mani 1925d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19263c411a43SRaja Mani return -ENOTCONN; 1927d91e8eeeSRaja Mani 1928d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 1929d91e8eeeSRaja Mani return -EINVAL; 1930d91e8eeeSRaja Mani 1931d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 1932d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 1933d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 1934d91e8eeeSRaja Mani WOW_LIST_ID, i); 1935d91e8eeeSRaja Mani 1936d91e8eeeSRaja Mani /* 1937d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 1938d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 1939d91e8eeeSRaja Mani * the user. 1940d91e8eeeSRaja Mani */ 1941d91e8eeeSRaja Mani if (wow) 1942d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 1943d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 1944d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 1945d91e8eeeSRaja Mani else 1946d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 1947d91e8eeeSRaja Mani 1948d91e8eeeSRaja Mani if (ret) 1949d91e8eeeSRaja Mani return ret; 1950d91e8eeeSRaja Mani 1951390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 1952390a8c8fSRaja Mani 1953390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 1954390a8c8fSRaja Mani 1955c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1956c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1957c08631c6SRaja Mani if (!in_dev) 1958c08631c6SRaja Mani goto skip_arp; 1959c08631c6SRaja Mani 1960c08631c6SRaja Mani ifa = in_dev->ifa_list; 1961c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 1962c08631c6SRaja Mani 1963c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 1964c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 1965c08631c6SRaja Mani ips[index] = ifa->ifa_local; 1966c08631c6SRaja Mani ifa = ifa->ifa_next; 1967c08631c6SRaja Mani index++; 1968c08631c6SRaja Mani } 1969c08631c6SRaja Mani 1970c08631c6SRaja Mani if (ifa) { 1971c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 1972c08631c6SRaja Mani return -EINVAL; 1973c08631c6SRaja Mani } 1974c08631c6SRaja Mani 1975c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 1976c08631c6SRaja Mani if (ret) { 1977c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 1978c08631c6SRaja Mani return ret; 1979c08631c6SRaja Mani } 1980c08631c6SRaja Mani 1981c08631c6SRaja Mani skip_arp: 19826cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 19836cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 19846cb3c714SRaja Mani filter, 19856cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 19866cb3c714SRaja Mani if (ret) 19876cb3c714SRaja Mani return ret; 19886cb3c714SRaja Mani 1989081c7a84SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 1990081c7a84SRaja Mani 19916cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 19926cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 19936cb3c714SRaja Mani if (ret) 19946cb3c714SRaja Mani return ret; 19956cb3c714SRaja Mani 1996081c7a84SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 1997081c7a84SRaja Mani test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags), 1998081c7a84SRaja Mani WMI_TIMEOUT); 1999081c7a84SRaja Mani if (left == 0) { 2000081c7a84SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd " 2001081c7a84SRaja Mani "processed event\n"); 2002081c7a84SRaja Mani ret = -ETIMEDOUT; 2003081c7a84SRaja Mani } else if (left < 0) { 2004081c7a84SRaja Mani ath6kl_warn("error while waiting for host sleep cmd " 2005081c7a84SRaja Mani "processed event %d\n", left); 2006081c7a84SRaja Mani ret = left; 2007081c7a84SRaja Mani } 2008081c7a84SRaja Mani 20096cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 20106cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 20116cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 20126cb3c714SRaja Mani if (left == 0) { 20136cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 20146cb3c714SRaja Mani ret = -ETIMEDOUT; 20156cb3c714SRaja Mani } else if (left < 0) { 20166cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 20176cb3c714SRaja Mani ret = left; 20186cb3c714SRaja Mani } 20196cb3c714SRaja Mani } 20206cb3c714SRaja Mani 20216cb3c714SRaja Mani return ret; 20226cb3c714SRaja Mani } 20236cb3c714SRaja Mani 20246cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20256cb3c714SRaja Mani { 20266cb3c714SRaja Mani struct ath6kl_vif *vif; 20276cb3c714SRaja Mani int ret; 20286cb3c714SRaja Mani 20296cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20306cb3c714SRaja Mani if (!vif) 20316cb3c714SRaja Mani return -EIO; 20326cb3c714SRaja Mani 2033390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2034390a8c8fSRaja Mani 20356cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20366cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2037390a8c8fSRaja Mani if (ret) { 2038390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2039390a8c8fSRaja Mani "wow resume: %d\n", ret); 2040390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 20416cb3c714SRaja Mani return ret; 20426cb3c714SRaja Mani } 20436cb3c714SRaja Mani 2044390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2045390a8c8fSRaja Mani 2046390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2047390a8c8fSRaja Mani 2048390a8c8fSRaja Mani return 0; 2049390a8c8fSRaja Mani } 2050390a8c8fSRaja Mani 205152d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 20520f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 20530f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 205452d81a68SKalle Valo { 2055390a8c8fSRaja Mani enum ath6kl_state prev_state; 205652d81a68SKalle Valo int ret; 205752d81a68SKalle Valo 205852d81a68SKalle Valo switch (mode) { 2059d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2060d7c44e0bSRaja Mani 2061d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2062d7c44e0bSRaja Mani 2063d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2064d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2065d7c44e0bSRaja Mani 2066390a8c8fSRaja Mani prev_state = ar->state; 2067390a8c8fSRaja Mani 2068d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2069390a8c8fSRaja Mani if (ret) { 2070390a8c8fSRaja Mani ar->state = prev_state; 2071d7c44e0bSRaja Mani return ret; 2072390a8c8fSRaja Mani } 20731e9a905dSRaja Mani 2074d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2075d7c44e0bSRaja Mani break; 2076d7c44e0bSRaja Mani 207752d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2078524441e3SRaja Mani 20797125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2080524441e3SRaja Mani 208152d81a68SKalle Valo /* save the current power mode before enabling power save */ 208252d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 208352d81a68SKalle Valo 208452d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 208552d81a68SKalle Valo if (ret) { 208652d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 208752d81a68SKalle Valo ret); 208852d81a68SKalle Valo } 208952d81a68SKalle Valo 209076a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 209176a9fbe2SKalle Valo 209252d81a68SKalle Valo break; 2093b4b2a0b1SKalle Valo 2094b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2095524441e3SRaja Mani 20967125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2097524441e3SRaja Mani 2098b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2099b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2100b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2101b4b2a0b1SKalle Valo break; 2102b4b2a0b1SKalle Valo } 2103b4b2a0b1SKalle Valo 2104b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2105b4b2a0b1SKalle Valo 2106b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2107b4b2a0b1SKalle Valo if (ret) { 2108b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2109b4b2a0b1SKalle Valo ret); 2110b4b2a0b1SKalle Valo } 2111b4b2a0b1SKalle Valo 2112b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2113b4b2a0b1SKalle Valo 2114b4b2a0b1SKalle Valo break; 2115b4b2a0b1SKalle Valo 211610509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 211710509f90SKalle Valo /* 211810509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 211910509f90SKalle Valo * wow mode and sleeping most of the time. 212010509f90SKalle Valo */ 212110509f90SKalle Valo break; 212210509f90SKalle Valo 2123b4b2a0b1SKalle Valo default: 2124b4b2a0b1SKalle Valo break; 212552d81a68SKalle Valo } 212652d81a68SKalle Valo 212752d81a68SKalle Valo return 0; 212852d81a68SKalle Valo } 2129d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 213052d81a68SKalle Valo 213152d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 213252d81a68SKalle Valo { 213376a9fbe2SKalle Valo int ret; 213476a9fbe2SKalle Valo 213576a9fbe2SKalle Valo switch (ar->state) { 2136d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2137d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2138d7c44e0bSRaja Mani 2139d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2140d7c44e0bSRaja Mani if (ret) { 2141d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2142d7c44e0bSRaja Mani return ret; 2143d7c44e0bSRaja Mani } 2144d7c44e0bSRaja Mani 2145d7c44e0bSRaja Mani break; 2146d7c44e0bSRaja Mani 214776a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 214852d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 214976a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 215076a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 215176a9fbe2SKalle Valo if (ret) { 215276a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 215376a9fbe2SKalle Valo ret); 215476a9fbe2SKalle Valo } 215576a9fbe2SKalle Valo } 215676a9fbe2SKalle Valo 215776a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 215876a9fbe2SKalle Valo 215976a9fbe2SKalle Valo break; 216076a9fbe2SKalle Valo 2161b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2162b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2163b4b2a0b1SKalle Valo 2164b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2165b4b2a0b1SKalle Valo if (ret) { 2166b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2167b4b2a0b1SKalle Valo return ret; 2168b4b2a0b1SKalle Valo } 2169d7c44e0bSRaja Mani break; 2170b4b2a0b1SKalle Valo 217110509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 217210509f90SKalle Valo break; 217310509f90SKalle Valo 217476a9fbe2SKalle Valo default: 217576a9fbe2SKalle Valo break; 217652d81a68SKalle Valo } 217752d81a68SKalle Valo 217852d81a68SKalle Valo return 0; 217952d81a68SKalle Valo } 2180d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 218152d81a68SKalle Valo 2182abcb344bSKalle Valo #ifdef CONFIG_PM 218352d81a68SKalle Valo 218452d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 218552d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2186abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2187abcb344bSKalle Valo { 2188abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2189abcb344bSKalle Valo 21900f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2191abcb344bSKalle Valo } 2192aa6cffc1SChilam Ng 219352d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2194aa6cffc1SChilam Ng { 2195aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2196aa6cffc1SChilam Ng 2197aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2198aa6cffc1SChilam Ng } 2199a918fb3cSRaja Mani 2200a918fb3cSRaja Mani /* 2201a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2202a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2203a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2204a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2205a918fb3cSRaja Mani * 2206a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2207a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2208a918fb3cSRaja Mani * 2209a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2210a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2211a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2212a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2213a918fb3cSRaja Mani * 2214a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2215a918fb3cSRaja Mani */ 2216a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2217a918fb3cSRaja Mani { 2218390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2219390a8c8fSRaja Mani return; 2220390a8c8fSRaja Mani 2221a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2222a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2223a918fb3cSRaja Mani } 2224a918fb3cSRaja Mani 2225a918fb3cSRaja Mani #else 2226a918fb3cSRaja Mani 2227a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2228a918fb3cSRaja Mani { 2229a918fb3cSRaja Mani } 2230abcb344bSKalle Valo #endif 2231abcb344bSKalle Valo 22326a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 22336a7c9badSJouni Malinen struct ieee80211_channel *chan, 22346a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 22356a7c9badSJouni Malinen { 2236e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2237e68f6750SSujith Manoharan 2238e68f6750SSujith Manoharan /* 2239e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2240e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2241e68f6750SSujith Manoharan * 2242e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2243e68f6750SSujith Manoharan */ 2244e68f6750SSujith Manoharan if (!dev) 2245e68f6750SSujith Manoharan return -EBUSY; 2246e68f6750SSujith Manoharan 2247e68f6750SSujith Manoharan vif = netdev_priv(dev); 22486a7c9badSJouni Malinen 2249990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 22506a7c9badSJouni Malinen return -EIO; 22516a7c9badSJouni Malinen 22526a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 22536a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2254cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 22556a7c9badSJouni Malinen 22566a7c9badSJouni Malinen return 0; 22576a7c9badSJouni Malinen } 22586a7c9badSJouni Malinen 22598bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 22608bdfbf40SJouni Malinen { 22618bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 22628bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 22638bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 22648bdfbf40SJouni Malinen } 22658bdfbf40SJouni Malinen 2266334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2267334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 22688bdfbf40SJouni Malinen { 2269334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 22708bdfbf40SJouni Malinen const u8 *pos; 22718bdfbf40SJouni Malinen u8 *buf = NULL; 22728bdfbf40SJouni Malinen size_t len = 0; 22738bdfbf40SJouni Malinen int ret; 22748bdfbf40SJouni Malinen 22758bdfbf40SJouni Malinen /* 22768bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 22778bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 22788bdfbf40SJouni Malinen */ 22798bdfbf40SJouni Malinen 22808bdfbf40SJouni Malinen if (ies && ies_len) { 22818bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 22828bdfbf40SJouni Malinen if (buf == NULL) 22838bdfbf40SJouni Malinen return -ENOMEM; 22848bdfbf40SJouni Malinen pos = ies; 22858bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 22868bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 22878bdfbf40SJouni Malinen break; 22888bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 22898bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 22908bdfbf40SJouni Malinen len += 2 + pos[1]; 22918bdfbf40SJouni Malinen } 22928bdfbf40SJouni Malinen pos += 2 + pos[1]; 22938bdfbf40SJouni Malinen } 22948bdfbf40SJouni Malinen } 22958bdfbf40SJouni Malinen 2296334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2297334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 22988bdfbf40SJouni Malinen kfree(buf); 22998bdfbf40SJouni Malinen return ret; 23008bdfbf40SJouni Malinen } 23018bdfbf40SJouni Malinen 23028860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 23038860020eSJohannes Berg struct cfg80211_beacon_data *info) 23048860020eSJohannes Berg { 23058860020eSJohannes Berg struct ath6kl *ar = vif->ar; 23068860020eSJohannes Berg int res; 23078860020eSJohannes Berg 23088860020eSJohannes Berg if (info->beacon_ies) { 23098860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23108860020eSJohannes Berg WMI_FRAME_BEACON, 23118860020eSJohannes Berg info->beacon_ies, 23128860020eSJohannes Berg info->beacon_ies_len); 23138860020eSJohannes Berg if (res) 23148860020eSJohannes Berg return res; 23158860020eSJohannes Berg } 23168860020eSJohannes Berg 23178860020eSJohannes Berg if (info->proberesp_ies) { 23188860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 23198860020eSJohannes Berg info->proberesp_ies_len); 23208860020eSJohannes Berg if (res) 23218860020eSJohannes Berg return res; 23228860020eSJohannes Berg } 23238860020eSJohannes Berg 23248860020eSJohannes Berg if (info->assocresp_ies) { 23258860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23268860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 23278860020eSJohannes Berg info->assocresp_ies, 23288860020eSJohannes Berg info->assocresp_ies_len); 23298860020eSJohannes Berg if (res) 23308860020eSJohannes Berg return res; 23318860020eSJohannes Berg } 23328860020eSJohannes Berg 23338860020eSJohannes Berg return 0; 23348860020eSJohannes Berg } 23358860020eSJohannes Berg 23368860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 23378860020eSJohannes Berg struct cfg80211_ap_settings *info) 23386a7c9badSJouni Malinen { 23396a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 23403450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23416a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 234267cd22e4SThomas Pedersen bool hidden = false; 23436a7c9badSJouni Malinen u8 *ies; 23446a7c9badSJouni Malinen int ies_len; 23456a7c9badSJouni Malinen struct wmi_connect_cmd p; 23466a7c9badSJouni Malinen int res; 2347be5abaafSVasanthakumar Thiagarajan int i, ret; 23486a7c9badSJouni Malinen 23498860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 23506a7c9badSJouni Malinen 2351990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23526a7c9badSJouni Malinen return -EIO; 23536a7c9badSJouni Malinen 2354f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 23556a7c9badSJouni Malinen return -EOPNOTSUPP; 23566a7c9badSJouni Malinen 23578860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 23586a7c9badSJouni Malinen 23599a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 23609a5b1318SJouni Malinen 23616a7c9badSJouni Malinen /* TODO: 23626a7c9badSJouni Malinen * info->interval 23636a7c9badSJouni Malinen * info->dtim_period 23646a7c9badSJouni Malinen */ 23656a7c9badSJouni Malinen 23668860020eSJohannes Berg if (info->beacon.head == NULL) 23676a7c9badSJouni Malinen return -EINVAL; 23688860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 23696a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 23708860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 23716a7c9badSJouni Malinen return -EINVAL; 23728860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 23736a7c9badSJouni Malinen 23746a7c9badSJouni Malinen if (info->ssid == NULL) 23756a7c9badSJouni Malinen return -EINVAL; 23763450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 23773450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 23786a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 237967cd22e4SThomas Pedersen hidden = true; 238067cd22e4SThomas Pedersen 238167cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 238267cd22e4SThomas Pedersen if (res) 238367cd22e4SThomas Pedersen return res; 23846a7c9badSJouni Malinen 2385be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2386be5abaafSVasanthakumar Thiagarajan if (ret) 2387be5abaafSVasanthakumar Thiagarajan return ret; 23886a7c9badSJouni Malinen 23896a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 23906a7c9badSJouni Malinen 23916a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 23926a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 23936a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 23946a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 23956a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 23966a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 23976a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 23986a7c9badSJouni Malinen break; 23996a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 24006a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24016a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 24026a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24036a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 24046a7c9badSJouni Malinen break; 24056a7c9badSJouni Malinen } 24066a7c9badSJouni Malinen } 24076a7c9badSJouni Malinen if (p.auth_mode == 0) 24086a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 24093450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 24106a7c9badSJouni Malinen 24116a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 24126a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 24136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24146a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24156a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 24166a7c9badSJouni Malinen break; 24176a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24186a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 24196a7c9badSJouni Malinen break; 24206a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24216a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 24226a7c9badSJouni Malinen break; 2423b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2424b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2425b8214df1SDai Shuibing break; 24266a7c9badSJouni Malinen } 24276a7c9badSJouni Malinen } 2428229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 24296a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2430240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2431229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2432240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 24336a7c9badSJouni Malinen 24346a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 24356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24376a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 24386a7c9badSJouni Malinen break; 24396a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24406a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 24416a7c9badSJouni Malinen break; 24426a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24436a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 24446a7c9badSJouni Malinen break; 2445b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2446b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2447b8214df1SDai Shuibing break; 24486a7c9badSJouni Malinen default: 24496a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 24506a7c9badSJouni Malinen break; 24516a7c9badSJouni Malinen } 2452240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 24536a7c9badSJouni Malinen 24546a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2455f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 24566a7c9badSJouni Malinen 24573450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 24583450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 24593450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2460cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 24616a7c9badSJouni Malinen 2462c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2463c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2464c1762a3fSThirumalai Pachamuthu if (res < 0) 2465c1762a3fSThirumalai Pachamuthu return res; 2466c1762a3fSThirumalai Pachamuthu 24673ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 24683ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 24693ca9d1fcSAarthi Thiruvengadam } else { 24703ca9d1fcSAarthi Thiruvengadam /* 24713ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 24723ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 24733ca9d1fcSAarthi Thiruvengadam */ 24743ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 24753ca9d1fcSAarthi Thiruvengadam } 24763ca9d1fcSAarthi Thiruvengadam 2477334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 24789a5b1318SJouni Malinen if (res < 0) 24799a5b1318SJouni Malinen return res; 24809a5b1318SJouni Malinen 24819a5b1318SJouni Malinen return 0; 24826a7c9badSJouni Malinen } 24836a7c9badSJouni Malinen 24848860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 24858860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 24866a7c9badSJouni Malinen { 24878860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 24888860020eSJohannes Berg 24898860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 24908860020eSJohannes Berg return -EIO; 24918860020eSJohannes Berg 24928860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 24938860020eSJohannes Berg return -EOPNOTSUPP; 24948860020eSJohannes Berg 24958860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 24966a7c9badSJouni Malinen } 24976a7c9badSJouni Malinen 24988860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 24996a7c9badSJouni Malinen { 25006a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 250159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25026a7c9badSJouni Malinen 2503f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 25046a7c9badSJouni Malinen return -EOPNOTSUPP; 250559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 25066a7c9badSJouni Malinen return -ENOTCONN; 25076a7c9badSJouni Malinen 2508334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 250959c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 25106a7c9badSJouni Malinen 25116a7c9badSJouni Malinen return 0; 25126a7c9badSJouni Malinen } 25136a7c9badSJouni Malinen 251433e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 251533e5308dSJouni Malinen 251633e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 251733e5308dSJouni Malinen u8 *mac) 251833e5308dSJouni Malinen { 251933e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 252033e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 252133e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 252233e5308dSJouni Malinen 252333e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 252433e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 252533e5308dSJouni Malinen } 252633e5308dSJouni Malinen 252723875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 252823875136SJouni Malinen u8 *mac, struct station_parameters *params) 252923875136SJouni Malinen { 253023875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2531f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 253223875136SJouni Malinen 2533f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 253423875136SJouni Malinen return -EOPNOTSUPP; 253523875136SJouni Malinen 253623875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 253723875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 253823875136SJouni Malinen return -EOPNOTSUPP; 253923875136SJouni Malinen 254023875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2541334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2542334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2543334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2544334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 254523875136SJouni Malinen } 254623875136SJouni Malinen 254763fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 254863fa1e0cSJouni Malinen struct net_device *dev, 254963fa1e0cSJouni Malinen struct ieee80211_channel *chan, 255063fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 255163fa1e0cSJouni Malinen unsigned int duration, 255263fa1e0cSJouni Malinen u64 *cookie) 255363fa1e0cSJouni Malinen { 255463fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2555334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25561052261eSJouni Malinen u32 id; 255763fa1e0cSJouni Malinen 255863fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 255963fa1e0cSJouni Malinen * return -EBUSY */ 25601052261eSJouni Malinen id = ++vif->last_roc_id; 25611052261eSJouni Malinen if (id == 0) { 25621052261eSJouni Malinen /* Do not use 0 as the cookie value */ 25631052261eSJouni Malinen id = ++vif->last_roc_id; 25641052261eSJouni Malinen } 25651052261eSJouni Malinen *cookie = id; 256663fa1e0cSJouni Malinen 2567334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2568334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 256963fa1e0cSJouni Malinen } 257063fa1e0cSJouni Malinen 257163fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 257263fa1e0cSJouni Malinen struct net_device *dev, 257363fa1e0cSJouni Malinen u64 cookie) 257463fa1e0cSJouni Malinen { 257563fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2576334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 257763fa1e0cSJouni Malinen 25781052261eSJouni Malinen if (cookie != vif->last_roc_id) 257963fa1e0cSJouni Malinen return -ENOENT; 25801052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 258163fa1e0cSJouni Malinen 2582334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 258363fa1e0cSJouni Malinen } 258463fa1e0cSJouni Malinen 2585334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2586334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2587334234b5SVasanthakumar Thiagarajan unsigned int freq) 25888bdfbf40SJouni Malinen { 2589334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 25908bdfbf40SJouni Malinen const u8 *pos; 25918bdfbf40SJouni Malinen u8 *p2p; 25928bdfbf40SJouni Malinen int p2p_len; 25938bdfbf40SJouni Malinen int ret; 25948bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 25958bdfbf40SJouni Malinen 25968bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 25978bdfbf40SJouni Malinen 25988bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 25998bdfbf40SJouni Malinen 26008bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 26018bdfbf40SJouni Malinen if (p2p == NULL) 26028bdfbf40SJouni Malinen return -ENOMEM; 26038bdfbf40SJouni Malinen p2p_len = 0; 26048bdfbf40SJouni Malinen 26058bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 26068bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 26078bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 26088bdfbf40SJouni Malinen break; 26098bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 26108bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 26118bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 26128bdfbf40SJouni Malinen } 26138bdfbf40SJouni Malinen pos += 2 + pos[1]; 26148bdfbf40SJouni Malinen } 26158bdfbf40SJouni Malinen 2616334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2617334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 26188bdfbf40SJouni Malinen kfree(p2p); 26198bdfbf40SJouni Malinen return ret; 26208bdfbf40SJouni Malinen } 26218bdfbf40SJouni Malinen 2622d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2623d0ff7383SNaveen Gangadharan u32 id, 2624d0ff7383SNaveen Gangadharan u32 freq, 2625d0ff7383SNaveen Gangadharan u32 wait, 2626d0ff7383SNaveen Gangadharan const u8 *buf, 2627d0ff7383SNaveen Gangadharan size_t len, 2628d0ff7383SNaveen Gangadharan bool *more_data, 2629d0ff7383SNaveen Gangadharan bool no_cck) 2630d0ff7383SNaveen Gangadharan { 2631d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2632d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2633d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2634d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2635d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2636d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2637d0ff7383SNaveen Gangadharan 2638d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2639d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2640d0ff7383SNaveen Gangadharan return false; 2641d0ff7383SNaveen Gangadharan 2642d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2643d0ff7383SNaveen Gangadharan if (!conn) 2644d0ff7383SNaveen Gangadharan return false; 2645d0ff7383SNaveen Gangadharan 2646d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2647d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2648d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2649d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2650d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2651d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2652d0ff7383SNaveen Gangadharan return false; 2653d0ff7383SNaveen Gangadharan 2654d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2655d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2656d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2657d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2658d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2659d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2660d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2661d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2662d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2663d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2664d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2665d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2666d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2667d0ff7383SNaveen Gangadharan 2668d0ff7383SNaveen Gangadharan /* 2669d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2670d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2671d0ff7383SNaveen Gangadharan * STA. 2672d0ff7383SNaveen Gangadharan */ 2673d0ff7383SNaveen Gangadharan if (is_psq_empty) 2674d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2675d0ff7383SNaveen Gangadharan conn->aid, 1); 2676d0ff7383SNaveen Gangadharan return true; 2677d0ff7383SNaveen Gangadharan } 2678d0ff7383SNaveen Gangadharan 2679d0ff7383SNaveen Gangadharan /* 2680d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2681d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2682d0ff7383SNaveen Gangadharan */ 2683d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2684d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2685d0ff7383SNaveen Gangadharan *more_data = true; 2686d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2687d0ff7383SNaveen Gangadharan } 2688d0ff7383SNaveen Gangadharan 2689d0ff7383SNaveen Gangadharan return false; 2690d0ff7383SNaveen Gangadharan } 2691d0ff7383SNaveen Gangadharan 26928a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 26938a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 26948a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 26958a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2696e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2697e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 26988a6c8060SJouni Malinen { 26998a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 270059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27018a6c8060SJouni Malinen u32 id; 27028bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2703d0ff7383SNaveen Gangadharan bool more_data, queued; 27048bdfbf40SJouni Malinen 27058bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27068bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2707f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 27088bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 27098bdfbf40SJouni Malinen /* 27108bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 27118bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 27128bdfbf40SJouni Malinen */ 27138bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2714334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 27158bdfbf40SJouni Malinen chan->center_freq); 27168bdfbf40SJouni Malinen } 27178a6c8060SJouni Malinen 2718cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27198a6c8060SJouni Malinen if (id == 0) { 27208a6c8060SJouni Malinen /* 27218a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 27228a6c8060SJouni Malinen * used for the command. 27238a6c8060SJouni Malinen */ 2724cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27258a6c8060SJouni Malinen } 27268a6c8060SJouni Malinen 27278a6c8060SJouni Malinen *cookie = id; 27283ca9d1fcSAarthi Thiruvengadam 2729d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2730d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2731d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2732d0ff7383SNaveen Gangadharan id, chan->center_freq, 2733d0ff7383SNaveen Gangadharan wait, buf, 2734d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2735d0ff7383SNaveen Gangadharan if (queued) 2736d0ff7383SNaveen Gangadharan return 0; 2737d0ff7383SNaveen Gangadharan } 2738d0ff7383SNaveen Gangadharan 27393ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 27403ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 27413ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 27423ca9d1fcSAarthi Thiruvengadam } 27438a6c8060SJouni Malinen 2744ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2745ae32c30aSJouni Malinen struct net_device *dev, 2746ae32c30aSJouni Malinen u16 frame_type, bool reg) 2747ae32c30aSJouni Malinen { 2748cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2749ae32c30aSJouni Malinen 2750ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2751ae32c30aSJouni Malinen __func__, frame_type, reg); 2752ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2753ae32c30aSJouni Malinen /* 2754ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2755ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2756ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2757ae32c30aSJouni Malinen */ 2758cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2759ae32c30aSJouni Malinen } 2760ae32c30aSJouni Malinen } 2761ae32c30aSJouni Malinen 276210509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 276310509f90SKalle Valo struct net_device *dev, 276410509f90SKalle Valo struct cfg80211_sched_scan_request *request) 276510509f90SKalle Valo { 276610509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 276710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 276810509f90SKalle Valo u16 interval; 276910509f90SKalle Valo int ret; 277010509f90SKalle Valo u8 i; 277110509f90SKalle Valo 277210509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 277310509f90SKalle Valo return -EIO; 277410509f90SKalle Valo 277510509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 277610509f90SKalle Valo return -EBUSY; 277710509f90SKalle Valo 277810509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 277910509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 278010509f90SKalle Valo i, DISABLE_SSID_FLAG, 278110509f90SKalle Valo 0, NULL); 278210509f90SKalle Valo } 278310509f90SKalle Valo 278410509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 278510509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 278610509f90SKalle Valo 278710509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 278810509f90SKalle Valo interval, interval, 278910509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 279010509f90SKalle Valo 279110509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 279210509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 279310509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 279410509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 279510509f90SKalle Valo request->ssids[i].ssid_len, 279610509f90SKalle Valo request->ssids[i].ssid); 279710509f90SKalle Valo } 279810509f90SKalle Valo } 279910509f90SKalle Valo 280010509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 280110509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 280210509f90SKalle Valo WOW_FILTER_SSID, 280310509f90SKalle Valo WOW_HOST_REQ_DELAY); 280410509f90SKalle Valo if (ret) { 280510509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 280610509f90SKalle Valo return ret; 280710509f90SKalle Valo } 280810509f90SKalle Valo 280910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 281010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 281110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 281210509f90SKalle Valo request->ie, request->ie_len); 281310509f90SKalle Valo if (ret) { 281410509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 281510509f90SKalle Valo ret); 281610509f90SKalle Valo return ret; 281710509f90SKalle Valo } 281810509f90SKalle Valo 281910509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 282010509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 282110509f90SKalle Valo if (ret) { 282210509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 282310509f90SKalle Valo ret); 282410509f90SKalle Valo return ret; 282510509f90SKalle Valo } 282610509f90SKalle Valo 282710509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 282810509f90SKalle Valo 282910509f90SKalle Valo return ret; 283010509f90SKalle Valo } 283110509f90SKalle Valo 283210509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 283310509f90SKalle Valo struct net_device *dev) 283410509f90SKalle Valo { 283510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 283610509f90SKalle Valo bool stopped; 283710509f90SKalle Valo 283810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 283910509f90SKalle Valo 284010509f90SKalle Valo if (!stopped) 284110509f90SKalle Valo return -EIO; 284210509f90SKalle Valo 284310509f90SKalle Valo return 0; 284410509f90SKalle Valo } 284510509f90SKalle Valo 2846f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2847f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2848f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2849f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2850f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2851f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2852f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2853f80574aeSJouni Malinen }, 2854ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2855ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2856ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2857ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2858ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2859ba1f6fe3SJouni Malinen }, 2860f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2861f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2862f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2863f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2864f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2865f80574aeSJouni Malinen }, 2866f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2867f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2868f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2869f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2870f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2871f80574aeSJouni Malinen }, 2872f80574aeSJouni Malinen }; 2873f80574aeSJouni Malinen 2874bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 287555055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 287655055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2877bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2878bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2879bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2880bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2881bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2882bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2883bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2884bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2885bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2886bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2887bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2888bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2889bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2890bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2891bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2892bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2893bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2894bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2895003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2896abcb344bSKalle Valo #ifdef CONFIG_PM 289752d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 289852d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2899abcb344bSKalle Valo #endif 29006a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 29018860020eSJohannes Berg .start_ap = ath6kl_start_ap, 29028860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 29038860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 290433e5308dSJouni Malinen .del_station = ath6kl_del_station, 290523875136SJouni Malinen .change_station = ath6kl_change_station, 290663fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 290763fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 29088a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2909ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 291010509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 291110509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2912bdcd8170SKalle Valo }; 2913bdcd8170SKalle Valo 29147125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2915ec4b7f60SKalle Valo { 291610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 291710509f90SKalle Valo 2918ec4b7f60SKalle Valo switch (vif->sme_state) { 2919c97a31b0SKalle Valo case SME_DISCONNECTED: 2920c97a31b0SKalle Valo break; 2921ec4b7f60SKalle Valo case SME_CONNECTING: 2922ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2923ec4b7f60SKalle Valo NULL, 0, 2924ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2925ec4b7f60SKalle Valo GFP_KERNEL); 2926ec4b7f60SKalle Valo break; 2927ec4b7f60SKalle Valo case SME_CONNECTED: 2928ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2929ec4b7f60SKalle Valo break; 2930ec4b7f60SKalle Valo } 2931ec4b7f60SKalle Valo 2932ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2933ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 29347125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2935ec4b7f60SKalle Valo 2936ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 29371f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 29381f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2939ec4b7f60SKalle Valo 2940ec4b7f60SKalle Valo /* disable scanning */ 29417125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 29427125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 29437125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 2944ec4b7f60SKalle Valo 2945ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2946ec4b7f60SKalle Valo } 2947ec4b7f60SKalle Valo 29487125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 29497125f01dSKalle Valo { 29507125f01dSKalle Valo struct ath6kl_vif *vif; 29517125f01dSKalle Valo 29527125f01dSKalle Valo vif = ath6kl_vif_first(ar); 29537125f01dSKalle Valo if (!vif) { 29547125f01dSKalle Valo /* save the current power mode before enabling power save */ 29557125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 29567125f01dSKalle Valo 29577125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 29587125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 29597125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 29607125f01dSKalle Valo return; 29617125f01dSKalle Valo } 29627125f01dSKalle Valo 29637125f01dSKalle Valo /* 29647125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 29657125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 29667125f01dSKalle Valo * sleeps. 29677125f01dSKalle Valo */ 29687125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 29697125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 29707125f01dSKalle Valo } 29717125f01dSKalle Valo 2972c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 29738dafb70eSVasanthakumar Thiagarajan { 29747baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 29752132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 29768dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 29778dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 29788dafb70eSVasanthakumar Thiagarajan } 29798dafb70eSVasanthakumar Thiagarajan 2980de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2981108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 298210509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 298310509f90SKalle Valo (unsigned long) vif); 298410509f90SKalle Valo 2985de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2986478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 29878dafb70eSVasanthakumar Thiagarajan 298880abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 298980abaf9bSVasanthakumar Thiagarajan 29908dafb70eSVasanthakumar Thiagarajan return 0; 29918dafb70eSVasanthakumar Thiagarajan } 29928dafb70eSVasanthakumar Thiagarajan 2993c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 29948dafb70eSVasanthakumar Thiagarajan { 299555055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 299680abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 299755055976SVasanthakumar Thiagarajan 29982132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2999108438bcSVasanthakumar Thiagarajan 300055055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 300155055976SVasanthakumar Thiagarajan 300255055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 300355055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 300455055976SVasanthakumar Thiagarajan 300580abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 300680abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 300780abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 300880abaf9bSVasanthakumar Thiagarajan } 300980abaf9bSVasanthakumar Thiagarajan 301027929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 301155055976SVasanthakumar Thiagarajan 301255055976SVasanthakumar Thiagarajan ar->num_vif--; 30138dafb70eSVasanthakumar Thiagarajan } 30148dafb70eSVasanthakumar Thiagarajan 30158dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 301655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 301755055976SVasanthakumar Thiagarajan u8 nw_type) 30188dafb70eSVasanthakumar Thiagarajan { 30198dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3020108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 30218dafb70eSVasanthakumar Thiagarajan 302255055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 30238dafb70eSVasanthakumar Thiagarajan if (!ndev) 30248dafb70eSVasanthakumar Thiagarajan return NULL; 30258dafb70eSVasanthakumar Thiagarajan 3026108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3027108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3028108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3029108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3030108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3031108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3032108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3033108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3034334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 303555055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 30368dafb70eSVasanthakumar Thiagarajan 303755055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 303855055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 303955055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 304055055976SVasanthakumar Thiagarajan 0x2; 304155055976SVasanthakumar Thiagarajan 30428dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 30438dafb70eSVasanthakumar Thiagarajan 3044e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 30458dafb70eSVasanthakumar Thiagarajan 3046c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 30478dafb70eSVasanthakumar Thiagarajan goto err; 30488dafb70eSVasanthakumar Thiagarajan 304927929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 30508dafb70eSVasanthakumar Thiagarajan goto err; 30518dafb70eSVasanthakumar Thiagarajan 305255055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 305314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 305459c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 30558dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 305659c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 30578dafb70eSVasanthakumar Thiagarajan 305855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 305955055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 306055055976SVasanthakumar Thiagarajan 306111f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3062990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 306311f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3064990bd915SVasanthakumar Thiagarajan 30658dafb70eSVasanthakumar Thiagarajan return ndev; 30668dafb70eSVasanthakumar Thiagarajan 30678dafb70eSVasanthakumar Thiagarajan err: 306827929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 306927929723SVasanthakumar Thiagarajan free_netdev(ndev); 3070bdcd8170SKalle Valo return NULL; 3071bdcd8170SKalle Valo } 3072bdcd8170SKalle Valo 307346d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 307446d33a21SKalle Valo { 307546d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 307646d33a21SKalle Valo int ret; 307746d33a21SKalle Valo 307846d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 307946d33a21SKalle Valo 308046d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 308146d33a21SKalle Valo 308246d33a21SKalle Valo /* set device pointer for wiphy */ 308346d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 308446d33a21SKalle Valo 308546d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 308646d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 308746d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 308846d33a21SKalle Valo if (ar->p2p) { 308946d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 309046d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 309146d33a21SKalle Valo } 309246d33a21SKalle Valo 309346d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 309446d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 309546d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 309646d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 309746d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 309846d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 309946d33a21SKalle Valo 310046d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 310146d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 310246d33a21SKalle Valo 310346d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 310446d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 310546d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 310646d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 310746d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 310846d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 310946d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 311046d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 311146d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 311246d33a21SKalle Valo 311346d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 311446d33a21SKalle Valo 3115f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3116f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3117f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3118f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3119f2afdac7SVasanthakumar Thiagarajan 3120f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3121f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3122f2afdac7SVasanthakumar Thiagarajan 3123f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3124f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3125f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3126f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3127f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3128f2afdac7SVasanthakumar Thiagarajan 312946d33a21SKalle Valo ret = wiphy_register(wiphy); 313046d33a21SKalle Valo if (ret < 0) { 313146d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 313246d33a21SKalle Valo return ret; 313346d33a21SKalle Valo } 313446d33a21SKalle Valo 3135e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3136e5348a1eSVasanthakumar Thiagarajan 313746d33a21SKalle Valo return 0; 313846d33a21SKalle Valo } 313946d33a21SKalle Valo 314046d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3141bdcd8170SKalle Valo { 3142be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3143e5348a1eSVasanthakumar Thiagarajan 3144e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 314545eaa78fSKalle Valo } 314646d33a21SKalle Valo 314745eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 314845eaa78fSKalle Valo { 314945eaa78fSKalle Valo struct ath6kl *ar; 315045eaa78fSKalle Valo struct wiphy *wiphy; 315145eaa78fSKalle Valo 315245eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 315345eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 315445eaa78fSKalle Valo 315545eaa78fSKalle Valo if (!wiphy) { 315645eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 315745eaa78fSKalle Valo return NULL; 315845eaa78fSKalle Valo } 315945eaa78fSKalle Valo 316045eaa78fSKalle Valo ar = wiphy_priv(wiphy); 316145eaa78fSKalle Valo ar->wiphy = wiphy; 316245eaa78fSKalle Valo 316345eaa78fSKalle Valo return ar; 316445eaa78fSKalle Valo } 316545eaa78fSKalle Valo 316645eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 316745eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 316845eaa78fSKalle Valo { 31691d2a4456SVasanthakumar Thiagarajan int i; 31701d2a4456SVasanthakumar Thiagarajan 31711d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 31721d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 31731d2a4456SVasanthakumar Thiagarajan 3174be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3175bdcd8170SKalle Valo } 317645eaa78fSKalle Valo 3177