1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 3bdcd8170SKalle Valo * 4bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 5bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 6bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 7bdcd8170SKalle Valo * 8bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15bdcd8170SKalle Valo */ 16bdcd8170SKalle Valo 17bdcd8170SKalle Valo #include "core.h" 18bdcd8170SKalle Valo #include "cfg80211.h" 19bdcd8170SKalle Valo #include "debug.h" 20abcb344bSKalle Valo #include "hif-ops.h" 21003353b0SKalle Valo #include "testmode.h" 22bdcd8170SKalle Valo 236bbc7c35SJouni Malinen static unsigned int ath6kl_p2p; 243226f68aSVasanthakumar Thiagarajan static unsigned int multi_norm_if_support; 256bbc7c35SJouni Malinen 266bbc7c35SJouni Malinen module_param(ath6kl_p2p, uint, 0644); 273226f68aSVasanthakumar Thiagarajan module_param(multi_norm_if_support, uint, 0644); 286bbc7c35SJouni Malinen 29bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 30bdcd8170SKalle Valo .bitrate = (_rate), \ 31bdcd8170SKalle Valo .flags = (_flags), \ 32bdcd8170SKalle Valo .hw_value = (_rateid), \ 33bdcd8170SKalle Valo } 34bdcd8170SKalle Valo 35bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 36bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 37bdcd8170SKalle Valo .hw_value = (_channel), \ 38bdcd8170SKalle Valo .center_freq = (_freq), \ 39bdcd8170SKalle Valo .flags = (_flags), \ 40bdcd8170SKalle Valo .max_antenna_gain = 0, \ 41bdcd8170SKalle Valo .max_power = 30, \ 42bdcd8170SKalle Valo } 43bdcd8170SKalle Valo 44bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 45bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 46bdcd8170SKalle Valo .hw_value = (_channel), \ 47bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 48bdcd8170SKalle Valo .flags = (_flags), \ 49bdcd8170SKalle Valo .max_antenna_gain = 0, \ 50bdcd8170SKalle Valo .max_power = 30, \ 51bdcd8170SKalle Valo } 52bdcd8170SKalle Valo 53bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 54bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 55bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 56bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 57bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 58bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 59bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 60bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 61bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 62bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 63bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 64bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 65bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 66bdcd8170SKalle Valo }; 67bdcd8170SKalle Valo 68bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 69bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 70bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 71bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 72bdcd8170SKalle Valo 73bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 74bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 75bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 76bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 77bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 78bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 79bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 80bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 81bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 82bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 83bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 84bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 85bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 86bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 87bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 88bdcd8170SKalle Valo }; 89bdcd8170SKalle Valo 90bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 91bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 92bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 93bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 94bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 95bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 96bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 97bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 98bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 99bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 100bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 101bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 102bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 103bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 104bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 105bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 106bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 107bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 108bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 109bdcd8170SKalle Valo CHAN5G(216, 0), 110bdcd8170SKalle Valo }; 111bdcd8170SKalle Valo 112bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 113bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 114bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 115bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 116bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 117bdcd8170SKalle Valo }; 118bdcd8170SKalle Valo 119bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 120bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 121bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 122bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 123bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 124bdcd8170SKalle Valo }; 125bdcd8170SKalle Valo 126837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 127837cb97eSJouni Malinen 128240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 129bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 130bdcd8170SKalle Valo { 131bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 132bdcd8170SKalle Valo 133bdcd8170SKalle Valo if (!wpa_version) { 1343450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 135bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1363450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 137bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1383450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 139bdcd8170SKalle Valo } else { 140bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 141bdcd8170SKalle Valo return -ENOTSUPP; 142bdcd8170SKalle Valo } 143bdcd8170SKalle Valo 144bdcd8170SKalle Valo return 0; 145bdcd8170SKalle Valo } 146bdcd8170SKalle Valo 147240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 148bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 149bdcd8170SKalle Valo { 150bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 151bdcd8170SKalle Valo 152bdcd8170SKalle Valo switch (auth_type) { 153bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1543450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 155bdcd8170SKalle Valo break; 156bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1573450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 158bdcd8170SKalle Valo break; 159bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1603450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 161bdcd8170SKalle Valo break; 162bdcd8170SKalle Valo 163bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 1643450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 165bdcd8170SKalle Valo break; 166bdcd8170SKalle Valo 167bdcd8170SKalle Valo default: 168bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 169bdcd8170SKalle Valo return -ENOTSUPP; 170bdcd8170SKalle Valo } 171bdcd8170SKalle Valo 172bdcd8170SKalle Valo return 0; 173bdcd8170SKalle Valo } 174bdcd8170SKalle Valo 175240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 176bdcd8170SKalle Valo { 1773450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 1783450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 1793450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 180bdcd8170SKalle Valo 181bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 182bdcd8170SKalle Valo __func__, cipher, ucast); 183bdcd8170SKalle Valo 184bdcd8170SKalle Valo switch (cipher) { 185bdcd8170SKalle Valo case 0: 186bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 187bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 188bdcd8170SKalle Valo *ar_cipher_len = 0; 189bdcd8170SKalle Valo break; 190bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 191bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 192bdcd8170SKalle Valo *ar_cipher_len = 5; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 195bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 196bdcd8170SKalle Valo *ar_cipher_len = 13; 197bdcd8170SKalle Valo break; 198bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 199bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 200bdcd8170SKalle Valo *ar_cipher_len = 0; 201bdcd8170SKalle Valo break; 202bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 203bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 204bdcd8170SKalle Valo *ar_cipher_len = 0; 205bdcd8170SKalle Valo break; 206bdcd8170SKalle Valo default: 207bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 208bdcd8170SKalle Valo return -ENOTSUPP; 209bdcd8170SKalle Valo } 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo return 0; 212bdcd8170SKalle Valo } 213bdcd8170SKalle Valo 214240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 215bdcd8170SKalle Valo { 216bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 217bdcd8170SKalle Valo 218bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2193450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2203450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2213450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2223450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 223837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2243450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2253450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2263450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2273450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 228bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2293450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 230bdcd8170SKalle Valo } 231bdcd8170SKalle Valo } 232bdcd8170SKalle Valo 233990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 234bdcd8170SKalle Valo { 235990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23659c98449SVasanthakumar Thiagarajan 237bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 238bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 239bdcd8170SKalle Valo return false; 240bdcd8170SKalle Valo } 241bdcd8170SKalle Valo 24259c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 243bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 244bdcd8170SKalle Valo return false; 245bdcd8170SKalle Valo } 246bdcd8170SKalle Valo 247bdcd8170SKalle Valo return true; 248bdcd8170SKalle Valo } 249bdcd8170SKalle Valo 2506981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2516981ffdcSKevin Fang { 2526981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2536981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2546981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2556981ffdcSKevin Fang } 2566981ffdcSKevin Fang 2576981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2586981ffdcSKevin Fang { 2596981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2606981ffdcSKevin Fang } 2616981ffdcSKevin Fang 262334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 2636981ffdcSKevin Fang size_t ies_len) 2646981ffdcSKevin Fang { 265334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2666981ffdcSKevin Fang const u8 *pos; 2676981ffdcSKevin Fang u8 *buf = NULL; 2686981ffdcSKevin Fang size_t len = 0; 2696981ffdcSKevin Fang int ret; 2706981ffdcSKevin Fang 2716981ffdcSKevin Fang /* 2726981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2736981ffdcSKevin Fang */ 2746981ffdcSKevin Fang 2756981ffdcSKevin Fang if (ies && ies_len) { 2766981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2776981ffdcSKevin Fang if (buf == NULL) 2786981ffdcSKevin Fang return -ENOMEM; 2796981ffdcSKevin Fang pos = ies; 2806981ffdcSKevin Fang 2816981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 2826981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 2836981ffdcSKevin Fang break; 2846981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 2856981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 2866981ffdcSKevin Fang len += 2 + pos[1]; 2876981ffdcSKevin Fang } 2886981ffdcSKevin Fang pos += 2 + pos[1]; 2896981ffdcSKevin Fang } 2906981ffdcSKevin Fang } 2916981ffdcSKevin Fang 292334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 293334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 2946981ffdcSKevin Fang kfree(buf); 2956981ffdcSKevin Fang return ret; 2966981ffdcSKevin Fang } 2976981ffdcSKevin Fang 29855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 29955055976SVasanthakumar Thiagarajan { 30055055976SVasanthakumar Thiagarajan switch (type) { 30155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 30255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 30355055976SVasanthakumar Thiagarajan break; 30455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 30555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 30655055976SVasanthakumar Thiagarajan break; 30755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 30855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 30955055976SVasanthakumar Thiagarajan break; 31055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 31155055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 31255055976SVasanthakumar Thiagarajan break; 31355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 31455055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 31555055976SVasanthakumar Thiagarajan break; 31655055976SVasanthakumar Thiagarajan default: 31755055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 31855055976SVasanthakumar Thiagarajan return -ENOTSUPP; 31955055976SVasanthakumar Thiagarajan } 32055055976SVasanthakumar Thiagarajan 32155055976SVasanthakumar Thiagarajan return 0; 32255055976SVasanthakumar Thiagarajan } 32355055976SVasanthakumar Thiagarajan 32455055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 32555055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 32655055976SVasanthakumar Thiagarajan { 32755055976SVasanthakumar Thiagarajan int i; 32855055976SVasanthakumar Thiagarajan 32955055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 33055055976SVasanthakumar Thiagarajan return false; 33155055976SVasanthakumar Thiagarajan 33255055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 33355055976SVasanthakumar Thiagarajan ar->num_vif)) 33455055976SVasanthakumar Thiagarajan return false; 33555055976SVasanthakumar Thiagarajan 33655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 33755055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 33855055976SVasanthakumar Thiagarajan for (i = 0; i < MAX_NUM_VIF; i++) { 33955055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 34055055976SVasanthakumar Thiagarajan *if_idx = i; 34155055976SVasanthakumar Thiagarajan return true; 34255055976SVasanthakumar Thiagarajan } 34355055976SVasanthakumar Thiagarajan } 34455055976SVasanthakumar Thiagarajan } 34555055976SVasanthakumar Thiagarajan 3463226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 3473226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 3483226f68aSVasanthakumar Thiagarajan for (i = ar->max_norm_iface; i < MAX_NUM_VIF; i++) { 3493226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 3503226f68aSVasanthakumar Thiagarajan *if_idx = i; 3513226f68aSVasanthakumar Thiagarajan return true; 3523226f68aSVasanthakumar Thiagarajan } 3533226f68aSVasanthakumar Thiagarajan } 3543226f68aSVasanthakumar Thiagarajan } 3553226f68aSVasanthakumar Thiagarajan 35655055976SVasanthakumar Thiagarajan return false; 35755055976SVasanthakumar Thiagarajan } 35855055976SVasanthakumar Thiagarajan 359bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 360bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 361bdcd8170SKalle Valo { 362bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 36359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 364bdcd8170SKalle Valo int status; 365bdcd8170SKalle Valo 36614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 367bdcd8170SKalle Valo 368990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 369bdcd8170SKalle Valo return -EIO; 370bdcd8170SKalle Valo 371bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 372bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 373bdcd8170SKalle Valo return -EBUSY; 374bdcd8170SKalle Valo } 375bdcd8170SKalle Valo 376bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 377bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 378bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 379bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 380bdcd8170SKalle Valo return -EINVAL; 381bdcd8170SKalle Valo } 382bdcd8170SKalle Valo 383bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 384bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 385bdcd8170SKalle Valo return -ERESTARTSYS; 386bdcd8170SKalle Valo } 387bdcd8170SKalle Valo 388bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 389bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 390bdcd8170SKalle Valo up(&ar->sem); 391bdcd8170SKalle Valo return -EBUSY; 392bdcd8170SKalle Valo } 393bdcd8170SKalle Valo 394bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 395bdcd8170SKalle Valo /* 396bdcd8170SKalle Valo * sleep until the command queue drains 397bdcd8170SKalle Valo */ 398bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 399bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 400bdcd8170SKalle Valo WMI_TIMEOUT); 401bdcd8170SKalle Valo if (signal_pending(current)) { 402bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 403bdcd8170SKalle Valo up(&ar->sem); 404bdcd8170SKalle Valo return -EINTR; 405bdcd8170SKalle Valo } 406bdcd8170SKalle Valo } 407bdcd8170SKalle Valo 4086981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 409334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 4106981ffdcSKevin Fang if (status) 4116981ffdcSKevin Fang return status; 4126981ffdcSKevin Fang } 4136981ffdcSKevin Fang 41459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4153450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4163450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 417cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 418334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 419334234b5SVasanthakumar Thiagarajan vif->req_bssid, 420f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 421bdcd8170SKalle Valo 422bdcd8170SKalle Valo up(&ar->sem); 423bdcd8170SKalle Valo if (status) { 424bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 425bdcd8170SKalle Valo return -EIO; 426bdcd8170SKalle Valo } 427bdcd8170SKalle Valo return 0; 4283450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4293450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 430240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 431bdcd8170SKalle Valo } 432bdcd8170SKalle Valo 4333450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4343450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4353450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 436bdcd8170SKalle Valo 437bdcd8170SKalle Valo if (sme->channel) 438f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 439bdcd8170SKalle Valo 4408c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 441bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 4428c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 443bdcd8170SKalle Valo 444240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 445bdcd8170SKalle Valo 446240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 447bdcd8170SKalle Valo if (status) { 448bdcd8170SKalle Valo up(&ar->sem); 449bdcd8170SKalle Valo return status; 450bdcd8170SKalle Valo } 451bdcd8170SKalle Valo 452bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 453240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 454bdcd8170SKalle Valo else 455240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 456bdcd8170SKalle Valo 457240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 458bdcd8170SKalle Valo 459bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 460240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 461bdcd8170SKalle Valo 462bdcd8170SKalle Valo if ((sme->key_len) && 4633450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 4643450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 465bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 466bdcd8170SKalle Valo 467bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 468bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 469bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 470bdcd8170SKalle Valo sme->key_idx); 471bdcd8170SKalle Valo up(&ar->sem); 472bdcd8170SKalle Valo return -ENOENT; 473bdcd8170SKalle Valo } 474bdcd8170SKalle Valo 4756f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 476bdcd8170SKalle Valo key->key_len = sme->key_len; 477bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 4783450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 4793450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 480bdcd8170SKalle Valo 481334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 4823450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 483bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 484bdcd8170SKalle Valo key->key_len, 485bdcd8170SKalle Valo NULL, 486bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 487bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 488bdcd8170SKalle Valo } 489bdcd8170SKalle Valo 490bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 49159c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 492240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 493240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 494bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 495bdcd8170SKalle Valo up(&ar->sem); 496bdcd8170SKalle Valo return -EIO; 497bdcd8170SKalle Valo } 498bdcd8170SKalle Valo } 499bdcd8170SKalle Valo 500f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 501bdcd8170SKalle Valo 502bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 503bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 504bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 505bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 506bdcd8170SKalle Valo __func__, 5073450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5083450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 509f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 510bdcd8170SKalle Valo 511cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 512334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5133450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5143450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5153450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5163450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5173450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 518f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 519bdcd8170SKalle Valo ar->connect_ctrl_flags); 520bdcd8170SKalle Valo 521bdcd8170SKalle Valo up(&ar->sem); 522bdcd8170SKalle Valo 523bdcd8170SKalle Valo if (status == -EINVAL) { 5243450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5253450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 526bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 527bdcd8170SKalle Valo return -ENOENT; 528bdcd8170SKalle Valo } else if (status) { 529bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 530bdcd8170SKalle Valo return -EIO; 531bdcd8170SKalle Valo } 532bdcd8170SKalle Valo 533bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5343450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5353450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 536de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 537bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 538bdcd8170SKalle Valo } 539bdcd8170SKalle Valo 540bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 54159c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 542bdcd8170SKalle Valo 543bdcd8170SKalle Valo return 0; 544bdcd8170SKalle Valo } 545bdcd8170SKalle Valo 546240d2799SVasanthakumar Thiagarajan static int ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, const u8 *bssid, 54701cac476SJouni Malinen struct ieee80211_channel *chan, 54801cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 54901cac476SJouni Malinen { 550240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 55101cac476SJouni Malinen struct cfg80211_bss *bss; 55201cac476SJouni Malinen u8 *ie; 55301cac476SJouni Malinen 554be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 5553450334fSVasanthakumar Thiagarajan vif->ssid, vif->ssid_len, WLAN_CAPABILITY_ESS, 55601cac476SJouni Malinen WLAN_CAPABILITY_ESS); 55701cac476SJouni Malinen if (bss == NULL) { 55801cac476SJouni Malinen /* 55901cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 56001cac476SJouni Malinen * generate a partial entry until the first BSS info 56101cac476SJouni Malinen * event becomes available. 56201cac476SJouni Malinen * 56301cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 56401cac476SJouni Malinen * IEs from the target. 56501cac476SJouni Malinen */ 5663450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 56701cac476SJouni Malinen if (ie == NULL) 56801cac476SJouni Malinen return -ENOMEM; 56901cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 5703450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 5713450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 5723450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 573be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 57401cac476SJouni Malinen bssid, 0, WLAN_CAPABILITY_ESS, 100, 5753450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 57601cac476SJouni Malinen 0, GFP_KERNEL); 57701cac476SJouni Malinen if (bss) 57801cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for " 57901cac476SJouni Malinen "%pM prior to indicating connect/roamed " 58001cac476SJouni Malinen "event\n", bssid); 58101cac476SJouni Malinen kfree(ie); 58201cac476SJouni Malinen } else 58301cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 58401cac476SJouni Malinen "entry\n"); 58501cac476SJouni Malinen 58601cac476SJouni Malinen if (bss == NULL) 58701cac476SJouni Malinen return -ENOMEM; 58801cac476SJouni Malinen 58901cac476SJouni Malinen cfg80211_put_bss(bss); 59001cac476SJouni Malinen 59101cac476SJouni Malinen return 0; 59201cac476SJouni Malinen } 59301cac476SJouni Malinen 594240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 595bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 596bdcd8170SKalle Valo u16 beacon_intvl, 597bdcd8170SKalle Valo enum network_type nw_type, 598bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 599bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 600bdcd8170SKalle Valo { 60101cac476SJouni Malinen struct ieee80211_channel *chan; 602240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 603bdcd8170SKalle Valo 604bdcd8170SKalle Valo /* capinfo + listen interval */ 605bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 606bdcd8170SKalle Valo 607bdcd8170SKalle Valo /* capinfo + status code + associd */ 608bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 609bdcd8170SKalle Valo 610bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 611bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 612bdcd8170SKalle Valo assoc_resp_ie_offset; 613bdcd8170SKalle Valo 614bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 615bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 616bdcd8170SKalle Valo 61732c10874SJouni Malinen /* 61832c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 61932c10874SJouni Malinen * a Beacon frame from the AP is seen. 62032c10874SJouni Malinen */ 621cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 62259c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 62332c10874SJouni Malinen 624bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 625bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 626bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 627bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 628bdcd8170SKalle Valo return; 629bdcd8170SKalle Valo } 630bdcd8170SKalle Valo } 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 6336b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 6346b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 635bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 636bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 637bdcd8170SKalle Valo return; 638bdcd8170SKalle Valo } 639bdcd8170SKalle Valo } 640bdcd8170SKalle Valo 641be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 642bdcd8170SKalle Valo 643bdcd8170SKalle Valo 644bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 645240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 646bdcd8170SKalle Valo return; 647bdcd8170SKalle Valo } 648bdcd8170SKalle Valo 649240d2799SVasanthakumar Thiagarajan if (ath6kl_add_bss_if_needed(vif, bssid, chan, assoc_info, 65001cac476SJouni Malinen beacon_ie_len) < 0) { 65101cac476SJouni Malinen ath6kl_err("could not add cfg80211 bss entry for " 65201cac476SJouni Malinen "connect/roamed notification\n"); 65301cac476SJouni Malinen return; 65401cac476SJouni Malinen } 65501cac476SJouni Malinen 65614ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 657bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 65814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 659240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 660bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 661bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 662bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 66314ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 664bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 665240d2799SVasanthakumar Thiagarajan cfg80211_roamed(vif->ndev, chan, bssid, 666bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 667bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 668bdcd8170SKalle Valo } 669bdcd8170SKalle Valo } 670bdcd8170SKalle Valo 671bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 672bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 673bdcd8170SKalle Valo { 674bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 6753450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 676bdcd8170SKalle Valo 677bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 678bdcd8170SKalle Valo reason_code); 679bdcd8170SKalle Valo 680990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 681bdcd8170SKalle Valo return -EIO; 682bdcd8170SKalle Valo 683bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 684bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 685bdcd8170SKalle Valo return -EBUSY; 686bdcd8170SKalle Valo } 687bdcd8170SKalle Valo 688bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 689bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 690bdcd8170SKalle Valo return -ERESTARTSYS; 691bdcd8170SKalle Valo } 692bdcd8170SKalle Valo 693cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 694240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 6953450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6963450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 697bdcd8170SKalle Valo 698bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 6998c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 700bdcd8170SKalle Valo 701bdcd8170SKalle Valo up(&ar->sem); 702bdcd8170SKalle Valo 70314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 704170826ddSVasanthakumar Thiagarajan 705bdcd8170SKalle Valo return 0; 706bdcd8170SKalle Valo } 707bdcd8170SKalle Valo 708240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 709bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 710bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 711bdcd8170SKalle Valo { 712240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 71359c98449SVasanthakumar Thiagarajan 71414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 71514ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 71614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 717bdcd8170SKalle Valo } 718bdcd8170SKalle Valo 719f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 720bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 721bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 722bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 723bdcd8170SKalle Valo return; 724bdcd8170SKalle Valo } 725bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 726240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 727bdcd8170SKalle Valo return; 728bdcd8170SKalle Valo } 729bdcd8170SKalle Valo 730f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 7316b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 7326b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 733bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 734bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 735bdcd8170SKalle Valo return; 736bdcd8170SKalle Valo } 737bdcd8170SKalle Valo } 738bdcd8170SKalle Valo 7391de547d6SVasanthakumar Thiagarajan /* 7401de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 7411de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 7421de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 7431de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 7441de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 7451de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 7461de547d6SVasanthakumar Thiagarajan */ 747bdcd8170SKalle Valo 7481de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 749334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 750bdcd8170SKalle Valo return; 751bdcd8170SKalle Valo } 752bdcd8170SKalle Valo 75359c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 754bdcd8170SKalle Valo 75514ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 756240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 757bdcd8170SKalle Valo bssid, NULL, 0, 758bdcd8170SKalle Valo NULL, 0, 759bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 760bdcd8170SKalle Valo GFP_KERNEL); 76114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 762240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 763bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 764bdcd8170SKalle Valo } 765bdcd8170SKalle Valo 76614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 767bdcd8170SKalle Valo } 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 770bdcd8170SKalle Valo struct cfg80211_scan_request *request) 771bdcd8170SKalle Valo { 772bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 77359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 7741276c9efSEdward Lu s8 n_channels = 0; 7751276c9efSEdward Lu u16 *channels = NULL; 776bdcd8170SKalle Valo int ret = 0; 777f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 778bdcd8170SKalle Valo 779990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 780bdcd8170SKalle Valo return -EIO; 781bdcd8170SKalle Valo 782bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 78359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 7841b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 785240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 78659c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 7871b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 7881b1e6ee3SJouni Malinen if (ret) { 789bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 7901b1e6ee3SJouni Malinen return ret; 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo } 793bdcd8170SKalle Valo 794bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 795bdcd8170SKalle Valo u8 i; 796bdcd8170SKalle Valo 797bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 798bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 799bdcd8170SKalle Valo 800bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 801334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 802334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 803bdcd8170SKalle Valo request->ssids[i].ssid_len, 804bdcd8170SKalle Valo request->ssids[i].ssid); 805bdcd8170SKalle Valo } 806bdcd8170SKalle Valo 807b84da8c7SJouni Malinen if (request->ie) { 808334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 809334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 810b84da8c7SJouni Malinen request->ie, request->ie_len); 811b84da8c7SJouni Malinen if (ret) { 812b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 813b84da8c7SJouni Malinen "scan"); 814b84da8c7SJouni Malinen return ret; 815b84da8c7SJouni Malinen } 816b84da8c7SJouni Malinen } 817b84da8c7SJouni Malinen 81811869befSJouni Malinen /* 81911869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 82011869befSJouni Malinen * channels. If the list is longer than the target supports, do not 82111869befSJouni Malinen * configure the list and instead, scan all available channels. 82211869befSJouni Malinen */ 82311869befSJouni Malinen if (request->n_channels > 0 && 82411869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 8251276c9efSEdward Lu u8 i; 8261276c9efSEdward Lu 82711869befSJouni Malinen n_channels = request->n_channels; 8281276c9efSEdward Lu 8291276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 8301276c9efSEdward Lu if (channels == NULL) { 8311276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 8321276c9efSEdward Lu "scan all channels"); 8331276c9efSEdward Lu n_channels = 0; 8341276c9efSEdward Lu } 8351276c9efSEdward Lu 8361276c9efSEdward Lu for (i = 0; i < n_channels; i++) 8371276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 8381276c9efSEdward Lu } 8391276c9efSEdward Lu 84059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 841f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 842f1f92179SVasanthakumar Thiagarajan 843334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, WMI_LONG_SCAN, 844334234b5SVasanthakumar Thiagarajan force_fg_scan, false, 0, 0, n_channels, 845334234b5SVasanthakumar Thiagarajan channels); 8461b1e6ee3SJouni Malinen if (ret) 847bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 84811869befSJouni Malinen else 84914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 850bdcd8170SKalle Valo 8511276c9efSEdward Lu kfree(channels); 8521276c9efSEdward Lu 853bdcd8170SKalle Valo return ret; 854bdcd8170SKalle Valo } 855bdcd8170SKalle Valo 856240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, int status) 857bdcd8170SKalle Valo { 858240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 8596fd1eaceSKalle Valo int i; 860bdcd8170SKalle Valo 861bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 862bdcd8170SKalle Valo 86314ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 8646fd1eaceSKalle Valo return; 8656fd1eaceSKalle Valo 8666fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 86714ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 8686fd1eaceSKalle Valo goto out; 8696fd1eaceSKalle Valo } 8706fd1eaceSKalle Valo 87114ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, false); 872bdcd8170SKalle Valo 87314ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 87414ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 875334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 876334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 877bdcd8170SKalle Valo 0, NULL); 878bdcd8170SKalle Valo } 879bdcd8170SKalle Valo } 8806fd1eaceSKalle Valo 8816fd1eaceSKalle Valo out: 88214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 883bdcd8170SKalle Valo } 884bdcd8170SKalle Valo 885bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 886bdcd8170SKalle Valo u8 key_index, bool pairwise, 887bdcd8170SKalle Valo const u8 *mac_addr, 888bdcd8170SKalle Valo struct key_params *params) 889bdcd8170SKalle Valo { 890bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 89159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 892bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 893bdcd8170SKalle Valo u8 key_usage; 894bdcd8170SKalle Valo u8 key_type; 895bdcd8170SKalle Valo int status = 0; 896bdcd8170SKalle Valo 897990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 898bdcd8170SKalle Valo return -EIO; 899bdcd8170SKalle Valo 900837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 901837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 902837cb97eSJouni Malinen return -EINVAL; 903240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 904240d2799SVasanthakumar Thiagarajan params->key); 905837cb97eSJouni Malinen } 906837cb97eSJouni Malinen 907bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 908bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 909bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 910bdcd8170SKalle Valo key_index); 911bdcd8170SKalle Valo return -ENOENT; 912bdcd8170SKalle Valo } 913bdcd8170SKalle Valo 9146f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 915bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 916bdcd8170SKalle Valo 917bdcd8170SKalle Valo if (pairwise) 918bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 919bdcd8170SKalle Valo else 920bdcd8170SKalle Valo key_usage = GROUP_USAGE; 921bdcd8170SKalle Valo 922bdcd8170SKalle Valo if (params) { 923bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 924bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 925bdcd8170SKalle Valo return -EINVAL; 926bdcd8170SKalle Valo 927bdcd8170SKalle Valo key->key_len = params->key_len; 928bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 929bdcd8170SKalle Valo key->seq_len = params->seq_len; 930bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 931bdcd8170SKalle Valo key->cipher = params->cipher; 932bdcd8170SKalle Valo } 933bdcd8170SKalle Valo 934bdcd8170SKalle Valo switch (key->cipher) { 935bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 936bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 937bdcd8170SKalle Valo key_type = WEP_CRYPT; 938bdcd8170SKalle Valo break; 939bdcd8170SKalle Valo 940bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 941bdcd8170SKalle Valo key_type = TKIP_CRYPT; 942bdcd8170SKalle Valo break; 943bdcd8170SKalle Valo 944bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 945bdcd8170SKalle Valo key_type = AES_CRYPT; 946bdcd8170SKalle Valo break; 947bdcd8170SKalle Valo 948bdcd8170SKalle Valo default: 949bdcd8170SKalle Valo return -ENOTSUPP; 950bdcd8170SKalle Valo } 951bdcd8170SKalle Valo 9523450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 9533450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 954bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 955de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 956bdcd8170SKalle Valo 957bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 958bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 959bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 960bdcd8170SKalle Valo key_usage, key->seq_len); 961bdcd8170SKalle Valo 9623450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 9639a5b1318SJouni Malinen 964f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 9659a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 9669a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 9679a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 9689a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 9699a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 9709a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 97159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 9729a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9739a5b1318SJouni Malinen "key configuration until AP mode has been " 9749a5b1318SJouni Malinen "started\n"); 9759a5b1318SJouni Malinen /* 9769a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9779a5b1318SJouni Malinen * the connected event is received from the target. 9789a5b1318SJouni Malinen */ 9799a5b1318SJouni Malinen return 0; 9809a5b1318SJouni Malinen } 9819a5b1318SJouni Malinen } 9829a5b1318SJouni Malinen 983f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 98459c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 985151411e8SJouni Malinen /* 986151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 987151411e8SJouni Malinen * the AP mode has properly started 988151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 989151411e8SJouni Malinen */ 990151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 991151411e8SJouni Malinen "until AP mode has been started\n"); 9926f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 9936f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 9946f2a73f9SVasanthakumar Thiagarajan key->key_len); 995151411e8SJouni Malinen return 0; 996151411e8SJouni Malinen } 997151411e8SJouni Malinen 998334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 999334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1000bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1001bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 1002bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1003bdcd8170SKalle Valo 1004bdcd8170SKalle Valo if (status) 1005bdcd8170SKalle Valo return -EIO; 1006bdcd8170SKalle Valo 1007bdcd8170SKalle Valo return 0; 1008bdcd8170SKalle Valo } 1009bdcd8170SKalle Valo 1010bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1011bdcd8170SKalle Valo u8 key_index, bool pairwise, 1012bdcd8170SKalle Valo const u8 *mac_addr) 1013bdcd8170SKalle Valo { 1014bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 10156f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1016bdcd8170SKalle Valo 1017bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1018bdcd8170SKalle Valo 1019990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1020bdcd8170SKalle Valo return -EIO; 1021bdcd8170SKalle Valo 1022bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1023bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1024bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1025bdcd8170SKalle Valo key_index); 1026bdcd8170SKalle Valo return -ENOENT; 1027bdcd8170SKalle Valo } 1028bdcd8170SKalle Valo 10296f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1030bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1031bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1032bdcd8170SKalle Valo return 0; 1033bdcd8170SKalle Valo } 1034bdcd8170SKalle Valo 10356f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1036bdcd8170SKalle Valo 1037334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1038bdcd8170SKalle Valo } 1039bdcd8170SKalle Valo 1040bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1041bdcd8170SKalle Valo u8 key_index, bool pairwise, 1042bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1043bdcd8170SKalle Valo void (*callback) (void *cookie, 1044bdcd8170SKalle Valo struct key_params *)) 1045bdcd8170SKalle Valo { 10466f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1047bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1048bdcd8170SKalle Valo struct key_params params; 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1051bdcd8170SKalle Valo 1052990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1053bdcd8170SKalle Valo return -EIO; 1054bdcd8170SKalle Valo 1055bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1056bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1057bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1058bdcd8170SKalle Valo key_index); 1059bdcd8170SKalle Valo return -ENOENT; 1060bdcd8170SKalle Valo } 1061bdcd8170SKalle Valo 10626f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1063bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1064bdcd8170SKalle Valo params.cipher = key->cipher; 1065bdcd8170SKalle Valo params.key_len = key->key_len; 1066bdcd8170SKalle Valo params.seq_len = key->seq_len; 1067bdcd8170SKalle Valo params.seq = key->seq; 1068bdcd8170SKalle Valo params.key = key->key; 1069bdcd8170SKalle Valo 1070bdcd8170SKalle Valo callback(cookie, ¶ms); 1071bdcd8170SKalle Valo 1072bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1073bdcd8170SKalle Valo } 1074bdcd8170SKalle Valo 1075bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1076bdcd8170SKalle Valo struct net_device *ndev, 1077bdcd8170SKalle Valo u8 key_index, bool unicast, 1078bdcd8170SKalle Valo bool multicast) 1079bdcd8170SKalle Valo { 1080bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 108159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1082bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1083bdcd8170SKalle Valo int status = 0; 1084bdcd8170SKalle Valo u8 key_usage; 1085229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1086bdcd8170SKalle Valo 1087bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1088bdcd8170SKalle Valo 1089990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1090bdcd8170SKalle Valo return -EIO; 1091bdcd8170SKalle Valo 1092bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1093bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1094bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1095bdcd8170SKalle Valo __func__, key_index); 1096bdcd8170SKalle Valo return -ENOENT; 1097bdcd8170SKalle Valo } 1098bdcd8170SKalle Valo 10996f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1100bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1101bdcd8170SKalle Valo __func__, key_index); 1102bdcd8170SKalle Valo return -EINVAL; 1103bdcd8170SKalle Valo } 1104bdcd8170SKalle Valo 11053450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11066f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1107bdcd8170SKalle Valo key_usage = GROUP_USAGE; 11083450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1109bdcd8170SKalle Valo key_usage |= TX_USAGE; 1110229ed6b5SEdward Lu if (unicast) 11113450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1112229ed6b5SEdward Lu if (multicast) 11133450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1114bdcd8170SKalle Valo 1115f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 11169a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 11179a5b1318SJouni Malinen 1118334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1119334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1120229ed6b5SEdward Lu key_type, key_usage, 1121bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1122bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1123bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1124bdcd8170SKalle Valo if (status) 1125bdcd8170SKalle Valo return -EIO; 1126bdcd8170SKalle Valo 1127bdcd8170SKalle Valo return 0; 1128bdcd8170SKalle Valo } 1129bdcd8170SKalle Valo 1130240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1131bdcd8170SKalle Valo bool ismcast) 1132bdcd8170SKalle Valo { 1133bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1134bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1135bdcd8170SKalle Valo 1136240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1137bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1138bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1139bdcd8170SKalle Valo GFP_KERNEL); 1140bdcd8170SKalle Valo } 1141bdcd8170SKalle Valo 1142bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1143bdcd8170SKalle Valo { 1144bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1145990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1146bdcd8170SKalle Valo int ret; 1147bdcd8170SKalle Valo 1148bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1149bdcd8170SKalle Valo changed); 1150bdcd8170SKalle Valo 1151990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1152990bd915SVasanthakumar Thiagarajan if (!vif) 1153990bd915SVasanthakumar Thiagarajan return -EIO; 1154990bd915SVasanthakumar Thiagarajan 1155990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1156bdcd8170SKalle Valo return -EIO; 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1159bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1160bdcd8170SKalle Valo if (ret != 0) { 1161bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1162bdcd8170SKalle Valo return -EIO; 1163bdcd8170SKalle Valo } 1164bdcd8170SKalle Valo } 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo return 0; 1167bdcd8170SKalle Valo } 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo /* 1170bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1171bdcd8170SKalle Valo * data type from 2.6.36 onwards 1172bdcd8170SKalle Valo */ 1173bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1174bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1175bdcd8170SKalle Valo int dbm) 1176bdcd8170SKalle Valo { 1177bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1178990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1179bdcd8170SKalle Valo u8 ath6kl_dbm; 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1182bdcd8170SKalle Valo type, dbm); 1183bdcd8170SKalle Valo 1184990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1185990bd915SVasanthakumar Thiagarajan if (!vif) 1186990bd915SVasanthakumar Thiagarajan return -EIO; 1187990bd915SVasanthakumar Thiagarajan 1188990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1189bdcd8170SKalle Valo return -EIO; 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo switch (type) { 1192bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1193bdcd8170SKalle Valo return 0; 1194bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1195bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1196bdcd8170SKalle Valo break; 1197bdcd8170SKalle Valo default: 1198bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1199bdcd8170SKalle Valo __func__, type); 1200bdcd8170SKalle Valo return -EOPNOTSUPP; 1201bdcd8170SKalle Valo } 1202bdcd8170SKalle Valo 1203990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo return 0; 1206bdcd8170SKalle Valo } 1207bdcd8170SKalle Valo 1208bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1209bdcd8170SKalle Valo { 1210bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1211990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1212bdcd8170SKalle Valo 1213990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1214990bd915SVasanthakumar Thiagarajan if (!vif) 1215990bd915SVasanthakumar Thiagarajan return -EIO; 1216990bd915SVasanthakumar Thiagarajan 1217990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1218bdcd8170SKalle Valo return -EIO; 1219bdcd8170SKalle Valo 122059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1221bdcd8170SKalle Valo ar->tx_pwr = 0; 1222bdcd8170SKalle Valo 1223990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1224bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1225bdcd8170SKalle Valo return -EIO; 1226bdcd8170SKalle Valo } 1227bdcd8170SKalle Valo 1228bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1229bdcd8170SKalle Valo 5 * HZ); 1230bdcd8170SKalle Valo 1231bdcd8170SKalle Valo if (signal_pending(current)) { 1232bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1233bdcd8170SKalle Valo return -EINTR; 1234bdcd8170SKalle Valo } 1235bdcd8170SKalle Valo } 1236bdcd8170SKalle Valo 1237bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1238bdcd8170SKalle Valo return 0; 1239bdcd8170SKalle Valo } 1240bdcd8170SKalle Valo 1241bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1242bdcd8170SKalle Valo struct net_device *dev, 1243bdcd8170SKalle Valo bool pmgmt, int timeout) 1244bdcd8170SKalle Valo { 1245bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1246bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1247334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1248bdcd8170SKalle Valo 1249bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1250bdcd8170SKalle Valo __func__, pmgmt, timeout); 1251bdcd8170SKalle Valo 1252990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1253bdcd8170SKalle Valo return -EIO; 1254bdcd8170SKalle Valo 1255bdcd8170SKalle Valo if (pmgmt) { 1256bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1257bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1258bdcd8170SKalle Valo } else { 1259bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1260bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1261bdcd8170SKalle Valo } 1262bdcd8170SKalle Valo 1263334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1264334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1265bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1266bdcd8170SKalle Valo return -EIO; 1267bdcd8170SKalle Valo } 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo return 0; 1270bdcd8170SKalle Valo } 1271bdcd8170SKalle Valo 127255055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 127355055976SVasanthakumar Thiagarajan char *name, 127455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 127555055976SVasanthakumar Thiagarajan u32 *flags, 127655055976SVasanthakumar Thiagarajan struct vif_params *params) 127755055976SVasanthakumar Thiagarajan { 127855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 127955055976SVasanthakumar Thiagarajan struct net_device *ndev; 128055055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 128155055976SVasanthakumar Thiagarajan 128255055976SVasanthakumar Thiagarajan if (ar->num_vif == MAX_NUM_VIF) { 128355055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 128455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 128555055976SVasanthakumar Thiagarajan } 128655055976SVasanthakumar Thiagarajan 128755055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 128855055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 128955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 129055055976SVasanthakumar Thiagarajan } 129155055976SVasanthakumar Thiagarajan 129255055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 129355055976SVasanthakumar Thiagarajan if (!ndev) 129455055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 129555055976SVasanthakumar Thiagarajan 129655055976SVasanthakumar Thiagarajan ar->num_vif++; 129755055976SVasanthakumar Thiagarajan 129855055976SVasanthakumar Thiagarajan return ndev; 129955055976SVasanthakumar Thiagarajan } 130055055976SVasanthakumar Thiagarajan 130155055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 130255055976SVasanthakumar Thiagarajan struct net_device *ndev) 130355055976SVasanthakumar Thiagarajan { 130455055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 130555055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 130655055976SVasanthakumar Thiagarajan 130755055976SVasanthakumar Thiagarajan spin_lock(&ar->list_lock); 130855055976SVasanthakumar Thiagarajan list_del(&vif->list); 130955055976SVasanthakumar Thiagarajan spin_unlock(&ar->list_lock); 131055055976SVasanthakumar Thiagarajan 131155055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 131255055976SVasanthakumar Thiagarajan 131355055976SVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 131455055976SVasanthakumar Thiagarajan 131555055976SVasanthakumar Thiagarajan return 0; 131655055976SVasanthakumar Thiagarajan } 131755055976SVasanthakumar Thiagarajan 1318bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1319bdcd8170SKalle Valo struct net_device *ndev, 1320bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1321bdcd8170SKalle Valo struct vif_params *params) 1322bdcd8170SKalle Valo { 1323bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1324bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1325f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1326bdcd8170SKalle Valo 1327bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1328bdcd8170SKalle Valo 1329990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1330bdcd8170SKalle Valo return -EIO; 1331bdcd8170SKalle Valo 1332bdcd8170SKalle Valo switch (type) { 1333bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1334f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1335bdcd8170SKalle Valo break; 1336bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1337f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1338bdcd8170SKalle Valo break; 13396e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1340f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13416e4604c8SJouni Malinen break; 13426b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1343f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 13446b5e5d25SJouni Malinen break; 13456b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1346f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13476b5e5d25SJouni Malinen break; 1348bdcd8170SKalle Valo default: 1349bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1350bdcd8170SKalle Valo return -EOPNOTSUPP; 1351bdcd8170SKalle Valo } 1352bdcd8170SKalle Valo 1353bdcd8170SKalle Valo wdev->iftype = type; 1354bdcd8170SKalle Valo 1355bdcd8170SKalle Valo return 0; 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1359bdcd8170SKalle Valo struct net_device *dev, 1360bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1361bdcd8170SKalle Valo { 1362bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 136359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1364bdcd8170SKalle Valo int status; 1365bdcd8170SKalle Valo 1366990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1367bdcd8170SKalle Valo return -EIO; 1368bdcd8170SKalle Valo 13693450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 13703450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1371bdcd8170SKalle Valo 1372bdcd8170SKalle Valo if (ibss_param->channel) 1373f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1374bdcd8170SKalle Valo 1375bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1376bdcd8170SKalle Valo /* 1377bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1378bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1379bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1380bdcd8170SKalle Valo * updated. 1381bdcd8170SKalle Valo */ 1382bdcd8170SKalle Valo return -EOPNOTSUPP; 1383bdcd8170SKalle Valo } 1384bdcd8170SKalle Valo 13858c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1386bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 13878c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 13888c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1389bdcd8170SKalle Valo 1390240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1391bdcd8170SKalle Valo 1392240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1393bdcd8170SKalle Valo if (status) 1394bdcd8170SKalle Valo return status; 1395bdcd8170SKalle Valo 1396bdcd8170SKalle Valo if (ibss_param->privacy) { 1397240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1398240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1399bdcd8170SKalle Valo } else { 1400240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1401240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1402bdcd8170SKalle Valo } 1403bdcd8170SKalle Valo 1404f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1405bdcd8170SKalle Valo 1406bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1407bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1408bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1409bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1410bdcd8170SKalle Valo __func__, 14113450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14123450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1413f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1414bdcd8170SKalle Valo 1415334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 14163450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 14173450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 14183450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 14193450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 14203450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1421f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 1422bdcd8170SKalle Valo ar->connect_ctrl_flags); 142359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1424bdcd8170SKalle Valo 1425bdcd8170SKalle Valo return 0; 1426bdcd8170SKalle Valo } 1427bdcd8170SKalle Valo 1428bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1429bdcd8170SKalle Valo struct net_device *dev) 1430bdcd8170SKalle Valo { 14313450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1432bdcd8170SKalle Valo 1433990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1434bdcd8170SKalle Valo return -EIO; 1435bdcd8170SKalle Valo 1436240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 14373450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 14383450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo return 0; 1441bdcd8170SKalle Valo } 1442bdcd8170SKalle Valo 1443bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1444bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1445bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1446bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1447bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1448837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1449bdcd8170SKalle Valo }; 1450bdcd8170SKalle Valo 1451bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1452bdcd8170SKalle Valo { 1453bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1454bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1455bdcd8170SKalle Valo 36000, 48000, 54000 1456bdcd8170SKalle Valo }; 1457bdcd8170SKalle Valo u8 i; 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1460bdcd8170SKalle Valo if (rate == legacy[i]) 1461bdcd8170SKalle Valo return true; 1462bdcd8170SKalle Valo 1463bdcd8170SKalle Valo return false; 1464bdcd8170SKalle Valo } 1465bdcd8170SKalle Valo 1466bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1467bdcd8170SKalle Valo { 1468bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1469bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1470bdcd8170SKalle Valo }; 1471bdcd8170SKalle Valo u8 i; 1472bdcd8170SKalle Valo 1473bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1474bdcd8170SKalle Valo if (rate == ht20[i]) { 1475bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1476bdcd8170SKalle Valo /* last rate uses sgi */ 1477bdcd8170SKalle Valo *sgi = true; 1478bdcd8170SKalle Valo else 1479bdcd8170SKalle Valo *sgi = false; 1480bdcd8170SKalle Valo 1481bdcd8170SKalle Valo *mcs = i; 1482bdcd8170SKalle Valo return true; 1483bdcd8170SKalle Valo } 1484bdcd8170SKalle Valo } 1485bdcd8170SKalle Valo return false; 1486bdcd8170SKalle Valo } 1487bdcd8170SKalle Valo 1488bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1489bdcd8170SKalle Valo { 1490bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1491bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1492bdcd8170SKalle Valo 150000 1493bdcd8170SKalle Valo }; 1494bdcd8170SKalle Valo u8 i; 1495bdcd8170SKalle Valo 1496bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1497bdcd8170SKalle Valo if (rate == ht40[i]) { 1498bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1499bdcd8170SKalle Valo /* last rate uses sgi */ 1500bdcd8170SKalle Valo *sgi = true; 1501bdcd8170SKalle Valo else 1502bdcd8170SKalle Valo *sgi = false; 1503bdcd8170SKalle Valo 1504bdcd8170SKalle Valo *mcs = i; 1505bdcd8170SKalle Valo return true; 1506bdcd8170SKalle Valo } 1507bdcd8170SKalle Valo } 1508bdcd8170SKalle Valo 1509bdcd8170SKalle Valo return false; 1510bdcd8170SKalle Valo } 1511bdcd8170SKalle Valo 1512bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1513bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1514bdcd8170SKalle Valo { 1515bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 151659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1517bdcd8170SKalle Valo long left; 1518bdcd8170SKalle Valo bool sgi; 1519bdcd8170SKalle Valo s32 rate; 1520bdcd8170SKalle Valo int ret; 1521bdcd8170SKalle Valo u8 mcs; 1522bdcd8170SKalle Valo 15238c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1524bdcd8170SKalle Valo return -ENOENT; 1525bdcd8170SKalle Valo 1526bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1527bdcd8170SKalle Valo return -EBUSY; 1528bdcd8170SKalle Valo 1529b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1530bdcd8170SKalle Valo 1531334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1532bdcd8170SKalle Valo 1533bdcd8170SKalle Valo if (ret != 0) { 1534bdcd8170SKalle Valo up(&ar->sem); 1535bdcd8170SKalle Valo return -EIO; 1536bdcd8170SKalle Valo } 1537bdcd8170SKalle Valo 1538bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1539bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1540b95907a7SVasanthakumar Thiagarajan &vif->flags), 1541bdcd8170SKalle Valo WMI_TIMEOUT); 1542bdcd8170SKalle Valo 1543bdcd8170SKalle Valo up(&ar->sem); 1544bdcd8170SKalle Valo 1545bdcd8170SKalle Valo if (left == 0) 1546bdcd8170SKalle Valo return -ETIMEDOUT; 1547bdcd8170SKalle Valo else if (left < 0) 1548bdcd8170SKalle Valo return left; 1549bdcd8170SKalle Valo 1550b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1551b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1552bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1553b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1554bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1555bdcd8170SKalle Valo } 1556bdcd8170SKalle Valo 1557b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1558b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1559bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1560b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1561bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1562bdcd8170SKalle Valo } 1563bdcd8170SKalle Valo 1564b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1565bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1566bdcd8170SKalle Valo 1567b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1568bdcd8170SKalle Valo 1569bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1570bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1571bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1572bdcd8170SKalle Valo if (sgi) { 1573bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1574bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1575bdcd8170SKalle Valo } else { 1576bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1577bdcd8170SKalle Valo } 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1580bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1581bdcd8170SKalle Valo if (sgi) { 1582bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1583bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1584bdcd8170SKalle Valo } else { 1585bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1586bdcd8170SKalle Valo } 1587bdcd8170SKalle Valo 1588bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1589bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1590bdcd8170SKalle Valo } else { 15919a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 15929a730834SKalle Valo "invalid rate from stats: %d\n", rate); 15939a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1594bdcd8170SKalle Valo return 0; 1595bdcd8170SKalle Valo } 1596bdcd8170SKalle Valo 1597bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1598bdcd8170SKalle Valo 159959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 160059c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1601f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 160232c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 160332c10874SJouni Malinen sinfo->bss_param.flags = 0; 1604cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1605cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 160632c10874SJouni Malinen } 160732c10874SJouni Malinen 1608bdcd8170SKalle Valo return 0; 1609bdcd8170SKalle Valo } 1610bdcd8170SKalle Valo 1611bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1612bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1613bdcd8170SKalle Valo { 1614bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1615334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1616334234b5SVasanthakumar Thiagarajan 1617334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1618bdcd8170SKalle Valo pmksa->pmkid, true); 1619bdcd8170SKalle Valo } 1620bdcd8170SKalle Valo 1621bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1622bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1623bdcd8170SKalle Valo { 1624bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1625334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1626334234b5SVasanthakumar Thiagarajan 1627334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1628bdcd8170SKalle Valo pmksa->pmkid, false); 1629bdcd8170SKalle Valo } 1630bdcd8170SKalle Valo 1631bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1632bdcd8170SKalle Valo { 1633bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 163459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 163559c98449SVasanthakumar Thiagarajan 163659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1637334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1638334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1639bdcd8170SKalle Valo return 0; 1640bdcd8170SKalle Valo } 1641bdcd8170SKalle Valo 1642abcb344bSKalle Valo #ifdef CONFIG_PM 1643abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1644abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1645abcb344bSKalle Valo { 1646abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1647abcb344bSKalle Valo 1648abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1649abcb344bSKalle Valo } 1650aa6cffc1SChilam Ng 1651aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1652aa6cffc1SChilam Ng { 1653aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1654aa6cffc1SChilam Ng 1655aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1656aa6cffc1SChilam Ng } 1657abcb344bSKalle Valo #endif 1658abcb344bSKalle Valo 16596a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 16606a7c9badSJouni Malinen struct ieee80211_channel *chan, 16616a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 16626a7c9badSJouni Malinen { 1663cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 16646a7c9badSJouni Malinen 1665990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 16666a7c9badSJouni Malinen return -EIO; 16676a7c9badSJouni Malinen 16686a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 16696a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 1670cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 16716a7c9badSJouni Malinen 16726a7c9badSJouni Malinen return 0; 16736a7c9badSJouni Malinen } 16746a7c9badSJouni Malinen 16758bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 16768bdfbf40SJouni Malinen { 16778bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 16788bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 16798bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 16808bdfbf40SJouni Malinen } 16818bdfbf40SJouni Malinen 1682334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 1683334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 16848bdfbf40SJouni Malinen { 1685334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 16868bdfbf40SJouni Malinen const u8 *pos; 16878bdfbf40SJouni Malinen u8 *buf = NULL; 16888bdfbf40SJouni Malinen size_t len = 0; 16898bdfbf40SJouni Malinen int ret; 16908bdfbf40SJouni Malinen 16918bdfbf40SJouni Malinen /* 16928bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 16938bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 16948bdfbf40SJouni Malinen */ 16958bdfbf40SJouni Malinen 16968bdfbf40SJouni Malinen if (ies && ies_len) { 16978bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 16988bdfbf40SJouni Malinen if (buf == NULL) 16998bdfbf40SJouni Malinen return -ENOMEM; 17008bdfbf40SJouni Malinen pos = ies; 17018bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 17028bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 17038bdfbf40SJouni Malinen break; 17048bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 17058bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 17068bdfbf40SJouni Malinen len += 2 + pos[1]; 17078bdfbf40SJouni Malinen } 17088bdfbf40SJouni Malinen pos += 2 + pos[1]; 17098bdfbf40SJouni Malinen } 17108bdfbf40SJouni Malinen } 17118bdfbf40SJouni Malinen 1712334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1713334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 17148bdfbf40SJouni Malinen kfree(buf); 17158bdfbf40SJouni Malinen return ret; 17168bdfbf40SJouni Malinen } 17178bdfbf40SJouni Malinen 17186a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 17196a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 17206a7c9badSJouni Malinen { 17216a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 17223450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17236a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 17246a7c9badSJouni Malinen u8 *ies; 17256a7c9badSJouni Malinen int ies_len; 17266a7c9badSJouni Malinen struct wmi_connect_cmd p; 17276a7c9badSJouni Malinen int res; 17286a7c9badSJouni Malinen int i; 17296a7c9badSJouni Malinen 17306a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 17316a7c9badSJouni Malinen 1732990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 17336a7c9badSJouni Malinen return -EIO; 17346a7c9badSJouni Malinen 1735f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 17366a7c9badSJouni Malinen return -EOPNOTSUPP; 17376a7c9badSJouni Malinen 17386a7c9badSJouni Malinen if (info->beacon_ies) { 1739334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1740334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 17416a7c9badSJouni Malinen info->beacon_ies, 17426a7c9badSJouni Malinen info->beacon_ies_len); 17436a7c9badSJouni Malinen if (res) 17446a7c9badSJouni Malinen return res; 17456a7c9badSJouni Malinen } 17466a7c9badSJouni Malinen if (info->proberesp_ies) { 1747334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 17486a7c9badSJouni Malinen info->proberesp_ies_len); 17496a7c9badSJouni Malinen if (res) 17506a7c9badSJouni Malinen return res; 17516a7c9badSJouni Malinen } 17526a7c9badSJouni Malinen if (info->assocresp_ies) { 1753334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1754334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 17556a7c9badSJouni Malinen info->assocresp_ies, 17566a7c9badSJouni Malinen info->assocresp_ies_len); 17576a7c9badSJouni Malinen if (res) 17586a7c9badSJouni Malinen return res; 17596a7c9badSJouni Malinen } 17606a7c9badSJouni Malinen 17616a7c9badSJouni Malinen if (!add) 17626a7c9badSJouni Malinen return 0; 17636a7c9badSJouni Malinen 17649a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 17659a5b1318SJouni Malinen 17666a7c9badSJouni Malinen /* TODO: 17676a7c9badSJouni Malinen * info->interval 17686a7c9badSJouni Malinen * info->dtim_period 17696a7c9badSJouni Malinen */ 17706a7c9badSJouni Malinen 17716a7c9badSJouni Malinen if (info->head == NULL) 17726a7c9badSJouni Malinen return -EINVAL; 17736a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 17746a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 17756a7c9badSJouni Malinen if (ies > info->head + info->head_len) 17766a7c9badSJouni Malinen return -EINVAL; 17776a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 17786a7c9badSJouni Malinen 17796a7c9badSJouni Malinen if (info->ssid == NULL) 17806a7c9badSJouni Malinen return -EINVAL; 17813450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 17823450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 17836a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 17846a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 17856a7c9badSJouni Malinen 17863450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 17876a7c9badSJouni Malinen 17886a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 17896a7c9badSJouni Malinen 17906a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 17916a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 17926a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 17936a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 17946a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 17956a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 17966a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 17976a7c9badSJouni Malinen break; 17986a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 17996a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 18006a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 18016a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 18026a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 18036a7c9badSJouni Malinen break; 18046a7c9badSJouni Malinen } 18056a7c9badSJouni Malinen } 18066a7c9badSJouni Malinen if (p.auth_mode == 0) 18076a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 18083450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 18096a7c9badSJouni Malinen 18106a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 18116a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 18126a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 18136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 18146a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 18156a7c9badSJouni Malinen break; 18166a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 18176a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 18186a7c9badSJouni Malinen break; 18196a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 18206a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 18216a7c9badSJouni Malinen break; 18226a7c9badSJouni Malinen } 18236a7c9badSJouni Malinen } 1824229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 18256a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1826240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1827229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1828240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 18296a7c9badSJouni Malinen 18306a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 18316a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 18326a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 18336a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 18346a7c9badSJouni Malinen break; 18356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 18366a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 18376a7c9badSJouni Malinen break; 18386a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 18396a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 18406a7c9badSJouni Malinen break; 18416a7c9badSJouni Malinen default: 18426a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 18436a7c9badSJouni Malinen break; 18446a7c9badSJouni Malinen } 1845240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 18466a7c9badSJouni Malinen 18476a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 1848f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 18496a7c9badSJouni Malinen 18503450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 18513450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 18523450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 1853cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 18546a7c9badSJouni Malinen 1855334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 18569a5b1318SJouni Malinen if (res < 0) 18579a5b1318SJouni Malinen return res; 18589a5b1318SJouni Malinen 18599a5b1318SJouni Malinen return 0; 18606a7c9badSJouni Malinen } 18616a7c9badSJouni Malinen 18626a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 18636a7c9badSJouni Malinen struct beacon_parameters *info) 18646a7c9badSJouni Malinen { 18656a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 18666a7c9badSJouni Malinen } 18676a7c9badSJouni Malinen 18686a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 18696a7c9badSJouni Malinen struct beacon_parameters *info) 18706a7c9badSJouni Malinen { 18716a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 18726a7c9badSJouni Malinen } 18736a7c9badSJouni Malinen 18746a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 18756a7c9badSJouni Malinen { 18766a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 187759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18786a7c9badSJouni Malinen 1879f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 18806a7c9badSJouni Malinen return -EOPNOTSUPP; 188159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 18826a7c9badSJouni Malinen return -ENOTCONN; 18836a7c9badSJouni Malinen 1884334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 188559c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 18866a7c9badSJouni Malinen 18876a7c9badSJouni Malinen return 0; 18886a7c9badSJouni Malinen } 18896a7c9badSJouni Malinen 189023875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 189123875136SJouni Malinen u8 *mac, struct station_parameters *params) 189223875136SJouni Malinen { 189323875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1894f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 189523875136SJouni Malinen 1896f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 189723875136SJouni Malinen return -EOPNOTSUPP; 189823875136SJouni Malinen 189923875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 190023875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 190123875136SJouni Malinen return -EOPNOTSUPP; 190223875136SJouni Malinen 190323875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 1904334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 1905334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 1906334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 1907334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 190823875136SJouni Malinen } 190923875136SJouni Malinen 191063fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 191163fa1e0cSJouni Malinen struct net_device *dev, 191263fa1e0cSJouni Malinen struct ieee80211_channel *chan, 191363fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 191463fa1e0cSJouni Malinen unsigned int duration, 191563fa1e0cSJouni Malinen u64 *cookie) 191663fa1e0cSJouni Malinen { 191763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1918334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 191963fa1e0cSJouni Malinen 192063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 192163fa1e0cSJouni Malinen * return -EBUSY */ 192263fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 192363fa1e0cSJouni Malinen 1924334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 1925334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 192663fa1e0cSJouni Malinen } 192763fa1e0cSJouni Malinen 192863fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 192963fa1e0cSJouni Malinen struct net_device *dev, 193063fa1e0cSJouni Malinen u64 cookie) 193163fa1e0cSJouni Malinen { 193263fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1933334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 193463fa1e0cSJouni Malinen 193563fa1e0cSJouni Malinen if (cookie != 1) 193663fa1e0cSJouni Malinen return -ENOENT; 193763fa1e0cSJouni Malinen 1938334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 193963fa1e0cSJouni Malinen } 194063fa1e0cSJouni Malinen 1941334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 1942334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 1943334234b5SVasanthakumar Thiagarajan unsigned int freq) 19448bdfbf40SJouni Malinen { 1945334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 19468bdfbf40SJouni Malinen const u8 *pos; 19478bdfbf40SJouni Malinen u8 *p2p; 19488bdfbf40SJouni Malinen int p2p_len; 19498bdfbf40SJouni Malinen int ret; 19508bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 19518bdfbf40SJouni Malinen 19528bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 19538bdfbf40SJouni Malinen 19548bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 19558bdfbf40SJouni Malinen 19568bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 19578bdfbf40SJouni Malinen if (p2p == NULL) 19588bdfbf40SJouni Malinen return -ENOMEM; 19598bdfbf40SJouni Malinen p2p_len = 0; 19608bdfbf40SJouni Malinen 19618bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 19628bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 19638bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 19648bdfbf40SJouni Malinen break; 19658bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 19668bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 19678bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 19688bdfbf40SJouni Malinen } 19698bdfbf40SJouni Malinen pos += 2 + pos[1]; 19708bdfbf40SJouni Malinen } 19718bdfbf40SJouni Malinen 1972334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 1973334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 19748bdfbf40SJouni Malinen kfree(p2p); 19758bdfbf40SJouni Malinen return ret; 19768bdfbf40SJouni Malinen } 19778bdfbf40SJouni Malinen 19788a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 19798a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 19808a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 19818a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1982e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1983e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 19848a6c8060SJouni Malinen { 19858a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 198659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 19878a6c8060SJouni Malinen u32 id; 19888bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 19898bdfbf40SJouni Malinen 19908bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 19918bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 1992f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 19938bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 19948bdfbf40SJouni Malinen /* 19958bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 19968bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 19978bdfbf40SJouni Malinen */ 19988bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 1999334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 20008bdfbf40SJouni Malinen chan->center_freq); 20018bdfbf40SJouni Malinen } 20028a6c8060SJouni Malinen 2003cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 20048a6c8060SJouni Malinen if (id == 0) { 20058a6c8060SJouni Malinen /* 20068a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 20078a6c8060SJouni Malinen * used for the command. 20088a6c8060SJouni Malinen */ 2009cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 20108a6c8060SJouni Malinen } 20118a6c8060SJouni Malinen 20128a6c8060SJouni Malinen *cookie = id; 2013334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2014334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 20158a6c8060SJouni Malinen buf, len); 20168a6c8060SJouni Malinen } 20178a6c8060SJouni Malinen 2018ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2019ae32c30aSJouni Malinen struct net_device *dev, 2020ae32c30aSJouni Malinen u16 frame_type, bool reg) 2021ae32c30aSJouni Malinen { 2022cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2023ae32c30aSJouni Malinen 2024ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2025ae32c30aSJouni Malinen __func__, frame_type, reg); 2026ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2027ae32c30aSJouni Malinen /* 2028ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2029ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2030ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2031ae32c30aSJouni Malinen */ 2032cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2033ae32c30aSJouni Malinen } 2034ae32c30aSJouni Malinen } 2035ae32c30aSJouni Malinen 2036f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2037f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2038f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2039f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2040f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2041f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2042f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2043f80574aeSJouni Malinen }, 2044f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2045f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2046f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2047f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2048f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2049f80574aeSJouni Malinen }, 2050f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2051f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2052f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2053f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2054f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2055f80574aeSJouni Malinen }, 2056f80574aeSJouni Malinen }; 2057f80574aeSJouni Malinen 2058bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 205955055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 206055055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2061bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2062bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2063bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2064bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2065bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2066bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2067bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2068bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2069bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2070bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2071bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2072bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2073bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2074bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2075bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2076bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2077bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2078bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2079003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2080abcb344bSKalle Valo #ifdef CONFIG_PM 2081abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 2082aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 2083abcb344bSKalle Valo #endif 20846a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 20856a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 20866a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 20876a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 208823875136SJouni Malinen .change_station = ath6kl_change_station, 208963fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 209063fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 20918a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2092ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 2093bdcd8170SKalle Valo }; 2094bdcd8170SKalle Valo 20958dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 2096bdcd8170SKalle Valo { 20976bbc7c35SJouni Malinen struct ath6kl *ar; 2098be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 20998dafb70eSVasanthakumar Thiagarajan u8 ctr; 2100bdcd8170SKalle Valo 2101bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 2102be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 21038dafb70eSVasanthakumar Thiagarajan 2104be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 2105bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 2106bdcd8170SKalle Valo return NULL; 2107bdcd8170SKalle Valo } 2108bdcd8170SKalle Valo 2109be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 21103226f68aSVasanthakumar Thiagarajan if (!multi_norm_if_support) 21116bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 2112be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 21138dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 21148dafb70eSVasanthakumar Thiagarajan 21153226f68aSVasanthakumar Thiagarajan if (multi_norm_if_support) 21163226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 2; 21173226f68aSVasanthakumar Thiagarajan else 21183226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 21193226f68aSVasanthakumar Thiagarajan 21203226f68aSVasanthakumar Thiagarajan /* FIXME: Remove this once the multivif support is enabled */ 21213226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 21223226f68aSVasanthakumar Thiagarajan 21238dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 21248dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 2125990bd915SVasanthakumar Thiagarajan spin_lock_init(&ar->list_lock); 21268dafb70eSVasanthakumar Thiagarajan 21278dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 21288dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 21298dafb70eSVasanthakumar Thiagarajan 21308dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 2131990bd915SVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->vif_list); 21328dafb70eSVasanthakumar Thiagarajan 21338dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 21348dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 21358dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 21368dafb70eSVasanthakumar Thiagarajan 21378dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 21388dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 21398dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 21408dafb70eSVasanthakumar Thiagarajan 21418dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 21428dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 21438dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 21448dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 21458dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 21468dafb70eSVasanthakumar Thiagarajan 21478dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 21488dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 21498dafb70eSVasanthakumar Thiagarajan 21508dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 21518dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 21528dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 21538dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 21548dafb70eSVasanthakumar Thiagarajan } 21558dafb70eSVasanthakumar Thiagarajan 21568dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 21578dafb70eSVasanthakumar Thiagarajan 21588dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 21598dafb70eSVasanthakumar Thiagarajan 21608dafb70eSVasanthakumar Thiagarajan return ar; 21618dafb70eSVasanthakumar Thiagarajan } 21628dafb70eSVasanthakumar Thiagarajan 21638dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 21648dafb70eSVasanthakumar Thiagarajan { 21658dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 21668dafb70eSVasanthakumar Thiagarajan int ret; 21676bbc7c35SJouni Malinen 2168be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2169f80574aeSJouni Malinen 2170be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 217163fa1e0cSJouni Malinen 2172bdcd8170SKalle Valo /* set device pointer for wiphy */ 21738dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2174bdcd8170SKalle Valo 2175be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 21768dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 21778dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 21786bbc7c35SJouni Malinen if (ar->p2p) { 2179be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 21806bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 21816bbc7c35SJouni Malinen } 21828dafb70eSVasanthakumar Thiagarajan 2183bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2184be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2185be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2186be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2187be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2188be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2189bdcd8170SKalle Valo 2190be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2191be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2192bdcd8170SKalle Valo 2193be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2194bdcd8170SKalle Valo if (ret < 0) { 2195bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 21968dafb70eSVasanthakumar Thiagarajan return ret; 21978dafb70eSVasanthakumar Thiagarajan } 21988dafb70eSVasanthakumar Thiagarajan 21998dafb70eSVasanthakumar Thiagarajan return 0; 22008dafb70eSVasanthakumar Thiagarajan } 22018dafb70eSVasanthakumar Thiagarajan 2202108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 22038dafb70eSVasanthakumar Thiagarajan { 22042132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 22052132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 22068dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 22078dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 22088dafb70eSVasanthakumar Thiagarajan } 22098dafb70eSVasanthakumar Thiagarajan 2210de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2211108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 2212de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2213478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 22148dafb70eSVasanthakumar Thiagarajan 22158dafb70eSVasanthakumar Thiagarajan return 0; 22168dafb70eSVasanthakumar Thiagarajan } 22178dafb70eSVasanthakumar Thiagarajan 2218108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 22198dafb70eSVasanthakumar Thiagarajan { 222055055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 222155055976SVasanthakumar Thiagarajan 22222132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2223108438bcSVasanthakumar Thiagarajan 222455055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 222555055976SVasanthakumar Thiagarajan 222655055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 222755055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 222855055976SVasanthakumar Thiagarajan 222927929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 223055055976SVasanthakumar Thiagarajan 223155055976SVasanthakumar Thiagarajan ar->num_vif--; 22328dafb70eSVasanthakumar Thiagarajan } 22338dafb70eSVasanthakumar Thiagarajan 22348dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 223555055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 223655055976SVasanthakumar Thiagarajan u8 nw_type) 22378dafb70eSVasanthakumar Thiagarajan { 22388dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2239108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 22408dafb70eSVasanthakumar Thiagarajan 224155055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 22428dafb70eSVasanthakumar Thiagarajan if (!ndev) 22438dafb70eSVasanthakumar Thiagarajan return NULL; 22448dafb70eSVasanthakumar Thiagarajan 2245108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2246108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2247108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2248108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2249108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2250108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2251108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2252108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2253334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 225455055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 2255108438bcSVasanthakumar Thiagarajan ar->wdev = &vif->wdev; 22568dafb70eSVasanthakumar Thiagarajan 225755055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 225855055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 225955055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 226055055976SVasanthakumar Thiagarajan 0x2; 226155055976SVasanthakumar Thiagarajan 22628dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 22638dafb70eSVasanthakumar Thiagarajan 2264e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 22658dafb70eSVasanthakumar Thiagarajan 22668dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2267108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 22688dafb70eSVasanthakumar Thiagarajan goto err; 22698dafb70eSVasanthakumar Thiagarajan 227027929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 22718dafb70eSVasanthakumar Thiagarajan goto err; 22728dafb70eSVasanthakumar Thiagarajan 227355055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 227414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 227559c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 22768dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 227759c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 22788dafb70eSVasanthakumar Thiagarajan 227955055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 228055055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 228155055976SVasanthakumar Thiagarajan 2282990bd915SVasanthakumar Thiagarajan spin_lock(&ar->list_lock); 2283990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 2284990bd915SVasanthakumar Thiagarajan spin_unlock(&ar->list_lock); 2285990bd915SVasanthakumar Thiagarajan 22868dafb70eSVasanthakumar Thiagarajan return ndev; 22878dafb70eSVasanthakumar Thiagarajan 22888dafb70eSVasanthakumar Thiagarajan err: 228927929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 229027929723SVasanthakumar Thiagarajan free_netdev(ndev); 2291bdcd8170SKalle Valo return NULL; 2292bdcd8170SKalle Valo } 2293bdcd8170SKalle Valo 22948dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2295bdcd8170SKalle Valo { 2296be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2297be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2298bdcd8170SKalle Valo } 2299