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 26263541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 26363541212SAarthi Thiruvengadam { 26463541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 26563541212SAarthi Thiruvengadam pos[1] >= 4 && 26663541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 26763541212SAarthi Thiruvengadam pos[5] == 0x04); 26863541212SAarthi Thiruvengadam } 26963541212SAarthi Thiruvengadam 270334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 2716981ffdcSKevin Fang size_t ies_len) 2726981ffdcSKevin Fang { 273334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2746981ffdcSKevin Fang const u8 *pos; 2756981ffdcSKevin Fang u8 *buf = NULL; 2766981ffdcSKevin Fang size_t len = 0; 2776981ffdcSKevin Fang int ret; 2786981ffdcSKevin Fang 2796981ffdcSKevin Fang /* 28063541212SAarthi Thiruvengadam * Clear previously set flag 28163541212SAarthi Thiruvengadam */ 28263541212SAarthi Thiruvengadam 28363541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 28463541212SAarthi Thiruvengadam 28563541212SAarthi Thiruvengadam /* 2866981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2876981ffdcSKevin Fang */ 2886981ffdcSKevin Fang 2896981ffdcSKevin Fang if (ies && ies_len) { 2906981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2916981ffdcSKevin Fang if (buf == NULL) 2926981ffdcSKevin Fang return -ENOMEM; 2936981ffdcSKevin Fang pos = ies; 2946981ffdcSKevin Fang 2956981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 2966981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 2976981ffdcSKevin Fang break; 2986981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 2996981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3006981ffdcSKevin Fang len += 2 + pos[1]; 3016981ffdcSKevin Fang } 30263541212SAarthi Thiruvengadam 30363541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 30463541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 30563541212SAarthi Thiruvengadam 3066981ffdcSKevin Fang pos += 2 + pos[1]; 3076981ffdcSKevin Fang } 3086981ffdcSKevin Fang } 3096981ffdcSKevin Fang 310334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 311334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3126981ffdcSKevin Fang kfree(buf); 3136981ffdcSKevin Fang return ret; 3146981ffdcSKevin Fang } 3156981ffdcSKevin Fang 31655055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 31755055976SVasanthakumar Thiagarajan { 31855055976SVasanthakumar Thiagarajan switch (type) { 31955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 32055055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 32155055976SVasanthakumar Thiagarajan break; 32255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 32355055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 32455055976SVasanthakumar Thiagarajan break; 32555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 32655055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 32755055976SVasanthakumar Thiagarajan break; 32855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 32955055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 33055055976SVasanthakumar Thiagarajan break; 33155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 33255055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 33355055976SVasanthakumar Thiagarajan break; 33455055976SVasanthakumar Thiagarajan default: 33555055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 33655055976SVasanthakumar Thiagarajan return -ENOTSUPP; 33755055976SVasanthakumar Thiagarajan } 33855055976SVasanthakumar Thiagarajan 33955055976SVasanthakumar Thiagarajan return 0; 34055055976SVasanthakumar Thiagarajan } 34155055976SVasanthakumar Thiagarajan 34255055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 34355055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 34455055976SVasanthakumar Thiagarajan { 34555055976SVasanthakumar Thiagarajan int i; 34655055976SVasanthakumar Thiagarajan 34755055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 34855055976SVasanthakumar Thiagarajan return false; 34955055976SVasanthakumar Thiagarajan 35055055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 35155055976SVasanthakumar Thiagarajan ar->num_vif)) 35255055976SVasanthakumar Thiagarajan return false; 35355055976SVasanthakumar Thiagarajan 35455055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 35555055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 35655055976SVasanthakumar Thiagarajan for (i = 0; i < MAX_NUM_VIF; i++) { 35755055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 35855055976SVasanthakumar Thiagarajan *if_idx = i; 35955055976SVasanthakumar Thiagarajan return true; 36055055976SVasanthakumar Thiagarajan } 36155055976SVasanthakumar Thiagarajan } 36255055976SVasanthakumar Thiagarajan } 36355055976SVasanthakumar Thiagarajan 3643226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 3653226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 3663226f68aSVasanthakumar Thiagarajan for (i = ar->max_norm_iface; i < MAX_NUM_VIF; i++) { 3673226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 3683226f68aSVasanthakumar Thiagarajan *if_idx = i; 3693226f68aSVasanthakumar Thiagarajan return true; 3703226f68aSVasanthakumar Thiagarajan } 3713226f68aSVasanthakumar Thiagarajan } 3723226f68aSVasanthakumar Thiagarajan } 3733226f68aSVasanthakumar Thiagarajan 37455055976SVasanthakumar Thiagarajan return false; 37555055976SVasanthakumar Thiagarajan } 37655055976SVasanthakumar Thiagarajan 377bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 378bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 379bdcd8170SKalle Valo { 380bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 38159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 382bdcd8170SKalle Valo int status; 383bdcd8170SKalle Valo 38414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 385bdcd8170SKalle Valo 386990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 387bdcd8170SKalle Valo return -EIO; 388bdcd8170SKalle Valo 389bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 390bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 391bdcd8170SKalle Valo return -EBUSY; 392bdcd8170SKalle Valo } 393bdcd8170SKalle Valo 394bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 395bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 396bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 397bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 398bdcd8170SKalle Valo return -EINVAL; 399bdcd8170SKalle Valo } 400bdcd8170SKalle Valo 401bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 402bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 403bdcd8170SKalle Valo return -ERESTARTSYS; 404bdcd8170SKalle Valo } 405bdcd8170SKalle Valo 406bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 407bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 408bdcd8170SKalle Valo up(&ar->sem); 409bdcd8170SKalle Valo return -EBUSY; 410bdcd8170SKalle Valo } 411bdcd8170SKalle Valo 412bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 413bdcd8170SKalle Valo /* 414bdcd8170SKalle Valo * sleep until the command queue drains 415bdcd8170SKalle Valo */ 416bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 417bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 418bdcd8170SKalle Valo WMI_TIMEOUT); 419bdcd8170SKalle Valo if (signal_pending(current)) { 420bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 421bdcd8170SKalle Valo up(&ar->sem); 422bdcd8170SKalle Valo return -EINTR; 423bdcd8170SKalle Valo } 424bdcd8170SKalle Valo } 425bdcd8170SKalle Valo 4266981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 427334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 4286981ffdcSKevin Fang if (status) 4296981ffdcSKevin Fang return status; 4306981ffdcSKevin Fang } 4316981ffdcSKevin Fang 43259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4333450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4343450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 435cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 436334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 437334234b5SVasanthakumar Thiagarajan vif->req_bssid, 438f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 439bdcd8170SKalle Valo 440bdcd8170SKalle Valo up(&ar->sem); 441bdcd8170SKalle Valo if (status) { 442bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 443bdcd8170SKalle Valo return -EIO; 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo return 0; 4463450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4473450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 448240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 449bdcd8170SKalle Valo } 450bdcd8170SKalle Valo 4513450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4523450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4533450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 454bdcd8170SKalle Valo 455bdcd8170SKalle Valo if (sme->channel) 456f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 457bdcd8170SKalle Valo 4588c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 459bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 4608c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 461bdcd8170SKalle Valo 462240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 463bdcd8170SKalle Valo 464240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 465bdcd8170SKalle Valo if (status) { 466bdcd8170SKalle Valo up(&ar->sem); 467bdcd8170SKalle Valo return status; 468bdcd8170SKalle Valo } 469bdcd8170SKalle Valo 470bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 471240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 472bdcd8170SKalle Valo else 473240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 474bdcd8170SKalle Valo 475240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 476bdcd8170SKalle Valo 477bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 478240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 479bdcd8170SKalle Valo 480bdcd8170SKalle Valo if ((sme->key_len) && 4813450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 4823450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 483bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 484bdcd8170SKalle Valo 485bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 486bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 487bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 488bdcd8170SKalle Valo sme->key_idx); 489bdcd8170SKalle Valo up(&ar->sem); 490bdcd8170SKalle Valo return -ENOENT; 491bdcd8170SKalle Valo } 492bdcd8170SKalle Valo 4936f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 494bdcd8170SKalle Valo key->key_len = sme->key_len; 495bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 4963450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 4973450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 498bdcd8170SKalle Valo 499334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5003450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 501bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 502bdcd8170SKalle Valo key->key_len, 503f4bb9a6fSJouni Malinen NULL, 0, 504bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 505bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 508bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 50959c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 510240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 511240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 512bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 513bdcd8170SKalle Valo up(&ar->sem); 514bdcd8170SKalle Valo return -EIO; 515bdcd8170SKalle Valo } 516bdcd8170SKalle Valo } 517bdcd8170SKalle Valo 518f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 519bdcd8170SKalle Valo 520bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 521bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 522bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 523bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 524bdcd8170SKalle Valo __func__, 5253450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5263450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 527f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 528bdcd8170SKalle Valo 529cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 530334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5313450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5323450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5333450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5343450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5353450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 536f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 537bdcd8170SKalle Valo ar->connect_ctrl_flags); 538bdcd8170SKalle Valo 539bdcd8170SKalle Valo up(&ar->sem); 540bdcd8170SKalle Valo 541bdcd8170SKalle Valo if (status == -EINVAL) { 5423450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5433450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 544bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 545bdcd8170SKalle Valo return -ENOENT; 546bdcd8170SKalle Valo } else if (status) { 547bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 548bdcd8170SKalle Valo return -EIO; 549bdcd8170SKalle Valo } 550bdcd8170SKalle Valo 551bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5523450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5533450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 554de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 555bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 556bdcd8170SKalle Valo } 557bdcd8170SKalle Valo 558bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 55959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 560bdcd8170SKalle Valo 561bdcd8170SKalle Valo return 0; 562bdcd8170SKalle Valo } 563bdcd8170SKalle Valo 564240d2799SVasanthakumar Thiagarajan static int ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, const u8 *bssid, 56501cac476SJouni Malinen struct ieee80211_channel *chan, 56601cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 56701cac476SJouni Malinen { 568240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 56901cac476SJouni Malinen struct cfg80211_bss *bss; 57001cac476SJouni Malinen u8 *ie; 57101cac476SJouni Malinen 572be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 5733450334fSVasanthakumar Thiagarajan vif->ssid, vif->ssid_len, WLAN_CAPABILITY_ESS, 57401cac476SJouni Malinen WLAN_CAPABILITY_ESS); 57501cac476SJouni Malinen if (bss == NULL) { 57601cac476SJouni Malinen /* 57701cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 57801cac476SJouni Malinen * generate a partial entry until the first BSS info 57901cac476SJouni Malinen * event becomes available. 58001cac476SJouni Malinen * 58101cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 58201cac476SJouni Malinen * IEs from the target. 58301cac476SJouni Malinen */ 5843450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 58501cac476SJouni Malinen if (ie == NULL) 58601cac476SJouni Malinen return -ENOMEM; 58701cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 5883450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 5893450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 5903450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 591be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 59201cac476SJouni Malinen bssid, 0, WLAN_CAPABILITY_ESS, 100, 5933450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 59401cac476SJouni Malinen 0, GFP_KERNEL); 59501cac476SJouni Malinen if (bss) 59601cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for " 59701cac476SJouni Malinen "%pM prior to indicating connect/roamed " 59801cac476SJouni Malinen "event\n", bssid); 59901cac476SJouni Malinen kfree(ie); 60001cac476SJouni Malinen } else 60101cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 60201cac476SJouni Malinen "entry\n"); 60301cac476SJouni Malinen 60401cac476SJouni Malinen if (bss == NULL) 60501cac476SJouni Malinen return -ENOMEM; 60601cac476SJouni Malinen 60701cac476SJouni Malinen cfg80211_put_bss(bss); 60801cac476SJouni Malinen 60901cac476SJouni Malinen return 0; 61001cac476SJouni Malinen } 61101cac476SJouni Malinen 612240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 613bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 614bdcd8170SKalle Valo u16 beacon_intvl, 615bdcd8170SKalle Valo enum network_type nw_type, 616bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 617bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 618bdcd8170SKalle Valo { 61901cac476SJouni Malinen struct ieee80211_channel *chan; 620240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 621bdcd8170SKalle Valo 622bdcd8170SKalle Valo /* capinfo + listen interval */ 623bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 624bdcd8170SKalle Valo 625bdcd8170SKalle Valo /* capinfo + status code + associd */ 626bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 627bdcd8170SKalle Valo 628bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 629bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 630bdcd8170SKalle Valo assoc_resp_ie_offset; 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 633bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 634bdcd8170SKalle Valo 63532c10874SJouni Malinen /* 63632c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 63732c10874SJouni Malinen * a Beacon frame from the AP is seen. 63832c10874SJouni Malinen */ 639cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 64059c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 64132c10874SJouni Malinen 642bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 643551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 644bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 645bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 646bdcd8170SKalle Valo return; 647bdcd8170SKalle Valo } 648bdcd8170SKalle Valo } 649bdcd8170SKalle Valo 650bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 651551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 652551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 653bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 654bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 655bdcd8170SKalle Valo return; 656bdcd8170SKalle Valo } 657bdcd8170SKalle Valo } 658bdcd8170SKalle Valo 659be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 660bdcd8170SKalle Valo 661bdcd8170SKalle Valo 662bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 663240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 664bdcd8170SKalle Valo return; 665bdcd8170SKalle Valo } 666bdcd8170SKalle Valo 667240d2799SVasanthakumar Thiagarajan if (ath6kl_add_bss_if_needed(vif, bssid, chan, assoc_info, 66801cac476SJouni Malinen beacon_ie_len) < 0) { 66901cac476SJouni Malinen ath6kl_err("could not add cfg80211 bss entry for " 67001cac476SJouni Malinen "connect/roamed notification\n"); 67101cac476SJouni Malinen return; 67201cac476SJouni Malinen } 67301cac476SJouni Malinen 67414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 675bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 67614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 677240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 678bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 679bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 680bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 68114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 682bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 683240d2799SVasanthakumar Thiagarajan cfg80211_roamed(vif->ndev, chan, bssid, 684bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 685bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 686bdcd8170SKalle Valo } 687bdcd8170SKalle Valo } 688bdcd8170SKalle Valo 689bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 690bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 691bdcd8170SKalle Valo { 692bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 6933450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 694bdcd8170SKalle Valo 695bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 696bdcd8170SKalle Valo reason_code); 697bdcd8170SKalle Valo 698990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 699bdcd8170SKalle Valo return -EIO; 700bdcd8170SKalle Valo 701bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 702bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 703bdcd8170SKalle Valo return -EBUSY; 704bdcd8170SKalle Valo } 705bdcd8170SKalle Valo 706bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 707bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 708bdcd8170SKalle Valo return -ERESTARTSYS; 709bdcd8170SKalle Valo } 710bdcd8170SKalle Valo 711cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 712240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7133450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7143450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7178c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo up(&ar->sem); 720bdcd8170SKalle Valo 72114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 722170826ddSVasanthakumar Thiagarajan 723bdcd8170SKalle Valo return 0; 724bdcd8170SKalle Valo } 725bdcd8170SKalle Valo 726240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 727bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 728bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 729bdcd8170SKalle Valo { 730240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 73159c98449SVasanthakumar Thiagarajan 73214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 73314ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 73414ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 735bdcd8170SKalle Valo } 736bdcd8170SKalle Valo 737f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 738551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 739bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 740bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 741bdcd8170SKalle Valo return; 742bdcd8170SKalle Valo } 743bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 744240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 745bdcd8170SKalle Valo return; 746bdcd8170SKalle Valo } 747bdcd8170SKalle Valo 748f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 749551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 750551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 751bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 752bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 753bdcd8170SKalle Valo return; 754bdcd8170SKalle Valo } 755bdcd8170SKalle Valo } 756bdcd8170SKalle Valo 7571de547d6SVasanthakumar Thiagarajan /* 7581de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 7591de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 7601de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 7611de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 7621de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 7631de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 7641de547d6SVasanthakumar Thiagarajan */ 765bdcd8170SKalle Valo 7661de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 767334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 768bdcd8170SKalle Valo return; 769bdcd8170SKalle Valo } 770bdcd8170SKalle Valo 77159c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 772bdcd8170SKalle Valo 77314ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 774240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 775bdcd8170SKalle Valo bssid, NULL, 0, 776bdcd8170SKalle Valo NULL, 0, 777bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 778bdcd8170SKalle Valo GFP_KERNEL); 77914ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 780240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 781bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo 78414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 785bdcd8170SKalle Valo } 786bdcd8170SKalle Valo 787bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 788bdcd8170SKalle Valo struct cfg80211_scan_request *request) 789bdcd8170SKalle Valo { 790bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 79159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 7921276c9efSEdward Lu s8 n_channels = 0; 7931276c9efSEdward Lu u16 *channels = NULL; 794bdcd8170SKalle Valo int ret = 0; 795f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 796bdcd8170SKalle Valo 797990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 798bdcd8170SKalle Valo return -EIO; 799bdcd8170SKalle Valo 800bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 80159c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8021b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 803240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 80459c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8051b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8061b1e6ee3SJouni Malinen if (ret) { 807bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8081b1e6ee3SJouni Malinen return ret; 809bdcd8170SKalle Valo } 810bdcd8170SKalle Valo } 811bdcd8170SKalle Valo 812bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 813bdcd8170SKalle Valo u8 i; 814bdcd8170SKalle Valo 815bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 816bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 817bdcd8170SKalle Valo 818bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 819334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 820334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 821bdcd8170SKalle Valo request->ssids[i].ssid_len, 822bdcd8170SKalle Valo request->ssids[i].ssid); 823bdcd8170SKalle Valo } 824bdcd8170SKalle Valo 825b84da8c7SJouni Malinen if (request->ie) { 826334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 827334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 828b84da8c7SJouni Malinen request->ie, request->ie_len); 829b84da8c7SJouni Malinen if (ret) { 830b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 831b84da8c7SJouni Malinen "scan"); 832b84da8c7SJouni Malinen return ret; 833b84da8c7SJouni Malinen } 834b84da8c7SJouni Malinen } 835b84da8c7SJouni Malinen 83611869befSJouni Malinen /* 83711869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 83811869befSJouni Malinen * channels. If the list is longer than the target supports, do not 83911869befSJouni Malinen * configure the list and instead, scan all available channels. 84011869befSJouni Malinen */ 84111869befSJouni Malinen if (request->n_channels > 0 && 84211869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 8431276c9efSEdward Lu u8 i; 8441276c9efSEdward Lu 84511869befSJouni Malinen n_channels = request->n_channels; 8461276c9efSEdward Lu 8471276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 8481276c9efSEdward Lu if (channels == NULL) { 8491276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 8501276c9efSEdward Lu "scan all channels"); 8511276c9efSEdward Lu n_channels = 0; 8521276c9efSEdward Lu } 8531276c9efSEdward Lu 8541276c9efSEdward Lu for (i = 0; i < n_channels; i++) 8551276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 8561276c9efSEdward Lu } 8571276c9efSEdward Lu 85859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 859f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 860f1f92179SVasanthakumar Thiagarajan 861334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, WMI_LONG_SCAN, 862334234b5SVasanthakumar Thiagarajan force_fg_scan, false, 0, 0, n_channels, 863334234b5SVasanthakumar Thiagarajan channels); 8641b1e6ee3SJouni Malinen if (ret) 865bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 86611869befSJouni Malinen else 86714ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 868bdcd8170SKalle Valo 8691276c9efSEdward Lu kfree(channels); 8701276c9efSEdward Lu 871bdcd8170SKalle Valo return ret; 872bdcd8170SKalle Valo } 873bdcd8170SKalle Valo 8741c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 875bdcd8170SKalle Valo { 876240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 8776fd1eaceSKalle Valo int i; 878bdcd8170SKalle Valo 8791c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 8801c17d313SKalle Valo aborted ? " aborted" : ""); 881bdcd8170SKalle Valo 88214ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 8836fd1eaceSKalle Valo return; 8846fd1eaceSKalle Valo 8851c17d313SKalle Valo if (aborted) 8866fd1eaceSKalle Valo goto out; 887bdcd8170SKalle Valo 88814ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 88914ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 890334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 891334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 892bdcd8170SKalle Valo 0, NULL); 893bdcd8170SKalle Valo } 894bdcd8170SKalle Valo } 8956fd1eaceSKalle Valo 8966fd1eaceSKalle Valo out: 897cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 89814ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 899bdcd8170SKalle Valo } 900bdcd8170SKalle Valo 901bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 902bdcd8170SKalle Valo u8 key_index, bool pairwise, 903bdcd8170SKalle Valo const u8 *mac_addr, 904bdcd8170SKalle Valo struct key_params *params) 905bdcd8170SKalle Valo { 906bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 90759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 908bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 909bdcd8170SKalle Valo u8 key_usage; 910bdcd8170SKalle Valo u8 key_type; 911bdcd8170SKalle Valo int status = 0; 912bdcd8170SKalle Valo 913990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 914bdcd8170SKalle Valo return -EIO; 915bdcd8170SKalle Valo 916837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 917837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 918837cb97eSJouni Malinen return -EINVAL; 919240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 920240d2799SVasanthakumar Thiagarajan params->key); 921837cb97eSJouni Malinen } 922837cb97eSJouni Malinen 923bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 924bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 925bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 926bdcd8170SKalle Valo key_index); 927bdcd8170SKalle Valo return -ENOENT; 928bdcd8170SKalle Valo } 929bdcd8170SKalle Valo 9306f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 931bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 932bdcd8170SKalle Valo 933bdcd8170SKalle Valo if (pairwise) 934bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 935bdcd8170SKalle Valo else 936bdcd8170SKalle Valo key_usage = GROUP_USAGE; 937bdcd8170SKalle Valo 938bdcd8170SKalle Valo if (params) { 939bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 940bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 941bdcd8170SKalle Valo return -EINVAL; 942bdcd8170SKalle Valo 943bdcd8170SKalle Valo key->key_len = params->key_len; 944bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 945bdcd8170SKalle Valo key->seq_len = params->seq_len; 946bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 947bdcd8170SKalle Valo key->cipher = params->cipher; 948bdcd8170SKalle Valo } 949bdcd8170SKalle Valo 950bdcd8170SKalle Valo switch (key->cipher) { 951bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 952bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 953bdcd8170SKalle Valo key_type = WEP_CRYPT; 954bdcd8170SKalle Valo break; 955bdcd8170SKalle Valo 956bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 957bdcd8170SKalle Valo key_type = TKIP_CRYPT; 958bdcd8170SKalle Valo break; 959bdcd8170SKalle Valo 960bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 961bdcd8170SKalle Valo key_type = AES_CRYPT; 962bdcd8170SKalle Valo break; 963bdcd8170SKalle Valo 964bdcd8170SKalle Valo default: 965bdcd8170SKalle Valo return -ENOTSUPP; 966bdcd8170SKalle Valo } 967bdcd8170SKalle Valo 9683450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 9693450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 970bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 971de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 972bdcd8170SKalle Valo 973bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 974bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 975bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 976bdcd8170SKalle Valo key_usage, key->seq_len); 977bdcd8170SKalle Valo 9783450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 9799a5b1318SJouni Malinen 980f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 9819a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 9829a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 9839a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 9849a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 9859a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 9869a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 98759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 9889a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9899a5b1318SJouni Malinen "key configuration until AP mode has been " 9909a5b1318SJouni Malinen "started\n"); 9919a5b1318SJouni Malinen /* 9929a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9939a5b1318SJouni Malinen * the connected event is received from the target. 9949a5b1318SJouni Malinen */ 9959a5b1318SJouni Malinen return 0; 9969a5b1318SJouni Malinen } 9979a5b1318SJouni Malinen } 9989a5b1318SJouni Malinen 999f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 100059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1001151411e8SJouni Malinen /* 1002151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1003151411e8SJouni Malinen * the AP mode has properly started 1004151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1005151411e8SJouni Malinen */ 1006151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1007151411e8SJouni Malinen "until AP mode has been started\n"); 10086f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10096f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10106f2a73f9SVasanthakumar Thiagarajan key->key_len); 1011151411e8SJouni Malinen return 0; 1012151411e8SJouni Malinen } 1013151411e8SJouni Malinen 1014334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1015334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1016bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1017f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1018f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1019bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1020bdcd8170SKalle Valo 1021bdcd8170SKalle Valo if (status) 1022bdcd8170SKalle Valo return -EIO; 1023bdcd8170SKalle Valo 1024bdcd8170SKalle Valo return 0; 1025bdcd8170SKalle Valo } 1026bdcd8170SKalle Valo 1027bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1028bdcd8170SKalle Valo u8 key_index, bool pairwise, 1029bdcd8170SKalle Valo const u8 *mac_addr) 1030bdcd8170SKalle Valo { 1031bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 10326f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1035bdcd8170SKalle Valo 1036990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1037bdcd8170SKalle Valo return -EIO; 1038bdcd8170SKalle Valo 1039bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1040bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1041bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1042bdcd8170SKalle Valo key_index); 1043bdcd8170SKalle Valo return -ENOENT; 1044bdcd8170SKalle Valo } 1045bdcd8170SKalle Valo 10466f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1047bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1048bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1049bdcd8170SKalle Valo return 0; 1050bdcd8170SKalle Valo } 1051bdcd8170SKalle Valo 10526f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1053bdcd8170SKalle Valo 1054334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1055bdcd8170SKalle Valo } 1056bdcd8170SKalle Valo 1057bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1058bdcd8170SKalle Valo u8 key_index, bool pairwise, 1059bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1060bdcd8170SKalle Valo void (*callback) (void *cookie, 1061bdcd8170SKalle Valo struct key_params *)) 1062bdcd8170SKalle Valo { 10636f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1064bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1065bdcd8170SKalle Valo struct key_params params; 1066bdcd8170SKalle Valo 1067bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1068bdcd8170SKalle Valo 1069990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1070bdcd8170SKalle Valo return -EIO; 1071bdcd8170SKalle Valo 1072bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1073bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1074bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1075bdcd8170SKalle Valo key_index); 1076bdcd8170SKalle Valo return -ENOENT; 1077bdcd8170SKalle Valo } 1078bdcd8170SKalle Valo 10796f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1080bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1081bdcd8170SKalle Valo params.cipher = key->cipher; 1082bdcd8170SKalle Valo params.key_len = key->key_len; 1083bdcd8170SKalle Valo params.seq_len = key->seq_len; 1084bdcd8170SKalle Valo params.seq = key->seq; 1085bdcd8170SKalle Valo params.key = key->key; 1086bdcd8170SKalle Valo 1087bdcd8170SKalle Valo callback(cookie, ¶ms); 1088bdcd8170SKalle Valo 1089bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1090bdcd8170SKalle Valo } 1091bdcd8170SKalle Valo 1092bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1093bdcd8170SKalle Valo struct net_device *ndev, 1094bdcd8170SKalle Valo u8 key_index, bool unicast, 1095bdcd8170SKalle Valo bool multicast) 1096bdcd8170SKalle Valo { 1097bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 109859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1099bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1100bdcd8170SKalle Valo int status = 0; 1101bdcd8170SKalle Valo u8 key_usage; 1102229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1103bdcd8170SKalle Valo 1104bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1105bdcd8170SKalle Valo 1106990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1107bdcd8170SKalle Valo return -EIO; 1108bdcd8170SKalle Valo 1109bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1110bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1111bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1112bdcd8170SKalle Valo __func__, key_index); 1113bdcd8170SKalle Valo return -ENOENT; 1114bdcd8170SKalle Valo } 1115bdcd8170SKalle Valo 11166f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1117bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1118bdcd8170SKalle Valo __func__, key_index); 1119bdcd8170SKalle Valo return -EINVAL; 1120bdcd8170SKalle Valo } 1121bdcd8170SKalle Valo 11223450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11236f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1124bdcd8170SKalle Valo key_usage = GROUP_USAGE; 11253450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1126bdcd8170SKalle Valo key_usage |= TX_USAGE; 1127229ed6b5SEdward Lu if (unicast) 11283450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1129229ed6b5SEdward Lu if (multicast) 11303450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1131bdcd8170SKalle Valo 1132f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 11339a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 11349a5b1318SJouni Malinen 1135334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1136334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1137229ed6b5SEdward Lu key_type, key_usage, 1138f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1139f4bb9a6fSJouni Malinen key->key, 1140bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1141bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1142bdcd8170SKalle Valo if (status) 1143bdcd8170SKalle Valo return -EIO; 1144bdcd8170SKalle Valo 1145bdcd8170SKalle Valo return 0; 1146bdcd8170SKalle Valo } 1147bdcd8170SKalle Valo 1148240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1149bdcd8170SKalle Valo bool ismcast) 1150bdcd8170SKalle Valo { 1151bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1152bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1153bdcd8170SKalle Valo 1154240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1155bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1156bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1157bdcd8170SKalle Valo GFP_KERNEL); 1158bdcd8170SKalle Valo } 1159bdcd8170SKalle Valo 1160bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1161bdcd8170SKalle Valo { 1162bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1163990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1164bdcd8170SKalle Valo int ret; 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1167bdcd8170SKalle Valo changed); 1168bdcd8170SKalle Valo 1169990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1170990bd915SVasanthakumar Thiagarajan if (!vif) 1171990bd915SVasanthakumar Thiagarajan return -EIO; 1172990bd915SVasanthakumar Thiagarajan 1173990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1174bdcd8170SKalle Valo return -EIO; 1175bdcd8170SKalle Valo 1176bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1177bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1178bdcd8170SKalle Valo if (ret != 0) { 1179bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1180bdcd8170SKalle Valo return -EIO; 1181bdcd8170SKalle Valo } 1182bdcd8170SKalle Valo } 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo return 0; 1185bdcd8170SKalle Valo } 1186bdcd8170SKalle Valo 1187bdcd8170SKalle Valo /* 1188bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1189bdcd8170SKalle Valo * data type from 2.6.36 onwards 1190bdcd8170SKalle Valo */ 1191bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1192bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1193bdcd8170SKalle Valo int dbm) 1194bdcd8170SKalle Valo { 1195bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1196990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1197bdcd8170SKalle Valo u8 ath6kl_dbm; 1198bdcd8170SKalle Valo 1199bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1200bdcd8170SKalle Valo type, dbm); 1201bdcd8170SKalle Valo 1202990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1203990bd915SVasanthakumar Thiagarajan if (!vif) 1204990bd915SVasanthakumar Thiagarajan return -EIO; 1205990bd915SVasanthakumar Thiagarajan 1206990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1207bdcd8170SKalle Valo return -EIO; 1208bdcd8170SKalle Valo 1209bdcd8170SKalle Valo switch (type) { 1210bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1211bdcd8170SKalle Valo return 0; 1212bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1213bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1214bdcd8170SKalle Valo break; 1215bdcd8170SKalle Valo default: 1216bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1217bdcd8170SKalle Valo __func__, type); 1218bdcd8170SKalle Valo return -EOPNOTSUPP; 1219bdcd8170SKalle Valo } 1220bdcd8170SKalle Valo 1221990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1222bdcd8170SKalle Valo 1223bdcd8170SKalle Valo return 0; 1224bdcd8170SKalle Valo } 1225bdcd8170SKalle Valo 1226bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1227bdcd8170SKalle Valo { 1228bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1229990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1230bdcd8170SKalle Valo 1231990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1232990bd915SVasanthakumar Thiagarajan if (!vif) 1233990bd915SVasanthakumar Thiagarajan return -EIO; 1234990bd915SVasanthakumar Thiagarajan 1235990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1236bdcd8170SKalle Valo return -EIO; 1237bdcd8170SKalle Valo 123859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1239bdcd8170SKalle Valo ar->tx_pwr = 0; 1240bdcd8170SKalle Valo 1241990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1242bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1243bdcd8170SKalle Valo return -EIO; 1244bdcd8170SKalle Valo } 1245bdcd8170SKalle Valo 1246bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1247bdcd8170SKalle Valo 5 * HZ); 1248bdcd8170SKalle Valo 1249bdcd8170SKalle Valo if (signal_pending(current)) { 1250bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1251bdcd8170SKalle Valo return -EINTR; 1252bdcd8170SKalle Valo } 1253bdcd8170SKalle Valo } 1254bdcd8170SKalle Valo 1255bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1256bdcd8170SKalle Valo return 0; 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo 1259bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1260bdcd8170SKalle Valo struct net_device *dev, 1261bdcd8170SKalle Valo bool pmgmt, int timeout) 1262bdcd8170SKalle Valo { 1263bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1264bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1265334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1266bdcd8170SKalle Valo 1267bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1268bdcd8170SKalle Valo __func__, pmgmt, timeout); 1269bdcd8170SKalle Valo 1270990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1271bdcd8170SKalle Valo return -EIO; 1272bdcd8170SKalle Valo 1273bdcd8170SKalle Valo if (pmgmt) { 1274bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1275bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1276bdcd8170SKalle Valo } else { 1277bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1278bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1282334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1283bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1284bdcd8170SKalle Valo return -EIO; 1285bdcd8170SKalle Valo } 1286bdcd8170SKalle Valo 1287bdcd8170SKalle Valo return 0; 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo 129055055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 129155055976SVasanthakumar Thiagarajan char *name, 129255055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 129355055976SVasanthakumar Thiagarajan u32 *flags, 129455055976SVasanthakumar Thiagarajan struct vif_params *params) 129555055976SVasanthakumar Thiagarajan { 129655055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 129755055976SVasanthakumar Thiagarajan struct net_device *ndev; 129855055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 129955055976SVasanthakumar Thiagarajan 130055055976SVasanthakumar Thiagarajan if (ar->num_vif == MAX_NUM_VIF) { 130155055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 130255055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 130355055976SVasanthakumar Thiagarajan } 130455055976SVasanthakumar Thiagarajan 130555055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 130655055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 130755055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 130855055976SVasanthakumar Thiagarajan } 130955055976SVasanthakumar Thiagarajan 131055055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 131155055976SVasanthakumar Thiagarajan if (!ndev) 131255055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 131355055976SVasanthakumar Thiagarajan 131455055976SVasanthakumar Thiagarajan ar->num_vif++; 131555055976SVasanthakumar Thiagarajan 131655055976SVasanthakumar Thiagarajan return ndev; 131755055976SVasanthakumar Thiagarajan } 131855055976SVasanthakumar Thiagarajan 131955055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 132055055976SVasanthakumar Thiagarajan struct net_device *ndev) 132155055976SVasanthakumar Thiagarajan { 132255055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 132355055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 132455055976SVasanthakumar Thiagarajan 132511f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 132655055976SVasanthakumar Thiagarajan list_del(&vif->list); 132711f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 132855055976SVasanthakumar Thiagarajan 132955055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 133055055976SVasanthakumar Thiagarajan 133155055976SVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 133255055976SVasanthakumar Thiagarajan 133355055976SVasanthakumar Thiagarajan return 0; 133455055976SVasanthakumar Thiagarajan } 133555055976SVasanthakumar Thiagarajan 1336bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1337bdcd8170SKalle Valo struct net_device *ndev, 1338bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1339bdcd8170SKalle Valo struct vif_params *params) 1340bdcd8170SKalle Valo { 1341f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1344bdcd8170SKalle Valo 1345990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1346bdcd8170SKalle Valo return -EIO; 1347bdcd8170SKalle Valo 1348bdcd8170SKalle Valo switch (type) { 1349bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1350f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1351bdcd8170SKalle Valo break; 1352bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1353f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1354bdcd8170SKalle Valo break; 13556e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1356f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13576e4604c8SJouni Malinen break; 13586b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1359f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 13606b5e5d25SJouni Malinen break; 13616b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1362f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13636b5e5d25SJouni Malinen break; 1364bdcd8170SKalle Valo default: 1365bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1366bdcd8170SKalle Valo return -EOPNOTSUPP; 1367bdcd8170SKalle Valo } 1368bdcd8170SKalle Valo 1369551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1370bdcd8170SKalle Valo 1371bdcd8170SKalle Valo return 0; 1372bdcd8170SKalle Valo } 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1375bdcd8170SKalle Valo struct net_device *dev, 1376bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1377bdcd8170SKalle Valo { 1378bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 137959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1380bdcd8170SKalle Valo int status; 1381bdcd8170SKalle Valo 1382990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo 13853450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 13863450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1387bdcd8170SKalle Valo 1388bdcd8170SKalle Valo if (ibss_param->channel) 1389f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1392bdcd8170SKalle Valo /* 1393bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1394bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1395bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1396bdcd8170SKalle Valo * updated. 1397bdcd8170SKalle Valo */ 1398bdcd8170SKalle Valo return -EOPNOTSUPP; 1399bdcd8170SKalle Valo } 1400bdcd8170SKalle Valo 14018c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1402bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14038c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14048c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1405bdcd8170SKalle Valo 1406240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1407bdcd8170SKalle Valo 1408240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1409bdcd8170SKalle Valo if (status) 1410bdcd8170SKalle Valo return status; 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo if (ibss_param->privacy) { 1413240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1414240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1415bdcd8170SKalle Valo } else { 1416240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1417240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1418bdcd8170SKalle Valo } 1419bdcd8170SKalle Valo 1420f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1421bdcd8170SKalle Valo 1422bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1423bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1424bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1425bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1426bdcd8170SKalle Valo __func__, 14273450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14283450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1429f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1430bdcd8170SKalle Valo 1431334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 14323450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 14333450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 14343450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 14353450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 14363450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1437f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 1438bdcd8170SKalle Valo ar->connect_ctrl_flags); 143959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1440bdcd8170SKalle Valo 1441bdcd8170SKalle Valo return 0; 1442bdcd8170SKalle Valo } 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1445bdcd8170SKalle Valo struct net_device *dev) 1446bdcd8170SKalle Valo { 14473450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1448bdcd8170SKalle Valo 1449990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1450bdcd8170SKalle Valo return -EIO; 1451bdcd8170SKalle Valo 1452240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 14533450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 14543450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1455bdcd8170SKalle Valo 1456bdcd8170SKalle Valo return 0; 1457bdcd8170SKalle Valo } 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1460bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1461bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1462bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1463bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1464837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1465bdcd8170SKalle Valo }; 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1468bdcd8170SKalle Valo { 1469bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1470bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1471bdcd8170SKalle Valo 36000, 48000, 54000 1472bdcd8170SKalle Valo }; 1473bdcd8170SKalle Valo u8 i; 1474bdcd8170SKalle Valo 1475bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1476bdcd8170SKalle Valo if (rate == legacy[i]) 1477bdcd8170SKalle Valo return true; 1478bdcd8170SKalle Valo 1479bdcd8170SKalle Valo return false; 1480bdcd8170SKalle Valo } 1481bdcd8170SKalle Valo 1482bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1483bdcd8170SKalle Valo { 1484bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1485bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1486bdcd8170SKalle Valo }; 1487bdcd8170SKalle Valo u8 i; 1488bdcd8170SKalle Valo 1489bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1490bdcd8170SKalle Valo if (rate == ht20[i]) { 1491bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1492bdcd8170SKalle Valo /* last rate uses sgi */ 1493bdcd8170SKalle Valo *sgi = true; 1494bdcd8170SKalle Valo else 1495bdcd8170SKalle Valo *sgi = false; 1496bdcd8170SKalle Valo 1497bdcd8170SKalle Valo *mcs = i; 1498bdcd8170SKalle Valo return true; 1499bdcd8170SKalle Valo } 1500bdcd8170SKalle Valo } 1501bdcd8170SKalle Valo return false; 1502bdcd8170SKalle Valo } 1503bdcd8170SKalle Valo 1504bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1505bdcd8170SKalle Valo { 1506bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1507bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1508bdcd8170SKalle Valo 150000 1509bdcd8170SKalle Valo }; 1510bdcd8170SKalle Valo u8 i; 1511bdcd8170SKalle Valo 1512bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1513bdcd8170SKalle Valo if (rate == ht40[i]) { 1514bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1515bdcd8170SKalle Valo /* last rate uses sgi */ 1516bdcd8170SKalle Valo *sgi = true; 1517bdcd8170SKalle Valo else 1518bdcd8170SKalle Valo *sgi = false; 1519bdcd8170SKalle Valo 1520bdcd8170SKalle Valo *mcs = i; 1521bdcd8170SKalle Valo return true; 1522bdcd8170SKalle Valo } 1523bdcd8170SKalle Valo } 1524bdcd8170SKalle Valo 1525bdcd8170SKalle Valo return false; 1526bdcd8170SKalle Valo } 1527bdcd8170SKalle Valo 1528bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1529bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1530bdcd8170SKalle Valo { 1531bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 153259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1533bdcd8170SKalle Valo long left; 1534bdcd8170SKalle Valo bool sgi; 1535bdcd8170SKalle Valo s32 rate; 1536bdcd8170SKalle Valo int ret; 1537bdcd8170SKalle Valo u8 mcs; 1538bdcd8170SKalle Valo 15398c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1540bdcd8170SKalle Valo return -ENOENT; 1541bdcd8170SKalle Valo 1542bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1543bdcd8170SKalle Valo return -EBUSY; 1544bdcd8170SKalle Valo 1545b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1546bdcd8170SKalle Valo 1547334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1548bdcd8170SKalle Valo 1549bdcd8170SKalle Valo if (ret != 0) { 1550bdcd8170SKalle Valo up(&ar->sem); 1551bdcd8170SKalle Valo return -EIO; 1552bdcd8170SKalle Valo } 1553bdcd8170SKalle Valo 1554bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1555bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1556b95907a7SVasanthakumar Thiagarajan &vif->flags), 1557bdcd8170SKalle Valo WMI_TIMEOUT); 1558bdcd8170SKalle Valo 1559bdcd8170SKalle Valo up(&ar->sem); 1560bdcd8170SKalle Valo 1561bdcd8170SKalle Valo if (left == 0) 1562bdcd8170SKalle Valo return -ETIMEDOUT; 1563bdcd8170SKalle Valo else if (left < 0) 1564bdcd8170SKalle Valo return left; 1565bdcd8170SKalle Valo 1566b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1567b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1568bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1569b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1570bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1571bdcd8170SKalle Valo } 1572bdcd8170SKalle Valo 1573b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1574b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1575bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1576b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1577bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1578bdcd8170SKalle Valo } 1579bdcd8170SKalle Valo 1580b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1581bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1582bdcd8170SKalle Valo 1583b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1584bdcd8170SKalle Valo 1585bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1586bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1587bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1588bdcd8170SKalle Valo if (sgi) { 1589bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1590bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1591bdcd8170SKalle Valo } else { 1592bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1593bdcd8170SKalle Valo } 1594bdcd8170SKalle Valo 1595bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1596bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1597bdcd8170SKalle Valo if (sgi) { 1598bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1599bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1600bdcd8170SKalle Valo } else { 1601bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1602bdcd8170SKalle Valo } 1603bdcd8170SKalle Valo 1604bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1605bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1606bdcd8170SKalle Valo } else { 16079a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16089a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16099a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1610bdcd8170SKalle Valo return 0; 1611bdcd8170SKalle Valo } 1612bdcd8170SKalle Valo 1613bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1614bdcd8170SKalle Valo 161559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 161659c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1617f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 161832c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 161932c10874SJouni Malinen sinfo->bss_param.flags = 0; 1620cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1621cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 162232c10874SJouni Malinen } 162332c10874SJouni Malinen 1624bdcd8170SKalle Valo return 0; 1625bdcd8170SKalle Valo } 1626bdcd8170SKalle Valo 1627bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1628bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1629bdcd8170SKalle Valo { 1630bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1631334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1632334234b5SVasanthakumar Thiagarajan 1633334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1634bdcd8170SKalle Valo pmksa->pmkid, true); 1635bdcd8170SKalle Valo } 1636bdcd8170SKalle Valo 1637bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1638bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1639bdcd8170SKalle Valo { 1640bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1641334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1642334234b5SVasanthakumar Thiagarajan 1643334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1644bdcd8170SKalle Valo pmksa->pmkid, false); 1645bdcd8170SKalle Valo } 1646bdcd8170SKalle Valo 1647bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1648bdcd8170SKalle Valo { 1649bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 165059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 165159c98449SVasanthakumar Thiagarajan 165259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1653334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1654334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1655bdcd8170SKalle Valo return 0; 1656bdcd8170SKalle Valo } 1657bdcd8170SKalle Valo 165852d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 165952d81a68SKalle Valo enum ath6kl_cfg_suspend_mode mode) 166052d81a68SKalle Valo { 166152d81a68SKalle Valo int ret; 166252d81a68SKalle Valo 166352d81a68SKalle Valo ath6kl_cfg80211_stop(ar); 166452d81a68SKalle Valo 166552d81a68SKalle Valo switch (mode) { 166652d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 166752d81a68SKalle Valo /* save the current power mode before enabling power save */ 166852d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 166952d81a68SKalle Valo 167052d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 167152d81a68SKalle Valo if (ret) { 167252d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 167352d81a68SKalle Valo ret); 167452d81a68SKalle Valo } 167552d81a68SKalle Valo 167676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 167776a9fbe2SKalle Valo 167852d81a68SKalle Valo break; 1679b4b2a0b1SKalle Valo 1680b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1681b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1682b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1683b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1684b4b2a0b1SKalle Valo break; 1685b4b2a0b1SKalle Valo } 1686b4b2a0b1SKalle Valo 1687b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1688b4b2a0b1SKalle Valo 1689b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1690b4b2a0b1SKalle Valo if (ret) { 1691b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1692b4b2a0b1SKalle Valo ret); 1693b4b2a0b1SKalle Valo } 1694b4b2a0b1SKalle Valo 1695b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1696b4b2a0b1SKalle Valo 1697b4b2a0b1SKalle Valo break; 1698b4b2a0b1SKalle Valo 1699b4b2a0b1SKalle Valo default: 1700b4b2a0b1SKalle Valo break; 170152d81a68SKalle Valo } 170252d81a68SKalle Valo 170352d81a68SKalle Valo return 0; 170452d81a68SKalle Valo } 170552d81a68SKalle Valo 170652d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 170752d81a68SKalle Valo { 170876a9fbe2SKalle Valo int ret; 170976a9fbe2SKalle Valo 171076a9fbe2SKalle Valo switch (ar->state) { 171176a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 171252d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 171376a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 171476a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 171576a9fbe2SKalle Valo if (ret) { 171676a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 171776a9fbe2SKalle Valo ret); 171876a9fbe2SKalle Valo } 171976a9fbe2SKalle Valo } 172076a9fbe2SKalle Valo 172176a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 172276a9fbe2SKalle Valo 172376a9fbe2SKalle Valo break; 172476a9fbe2SKalle Valo 1725b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1726b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1727b4b2a0b1SKalle Valo 1728b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1729b4b2a0b1SKalle Valo if (ret) { 1730b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1731b4b2a0b1SKalle Valo return ret; 1732b4b2a0b1SKalle Valo } 1733b4b2a0b1SKalle Valo 173476a9fbe2SKalle Valo default: 173576a9fbe2SKalle Valo break; 173652d81a68SKalle Valo } 173752d81a68SKalle Valo 173852d81a68SKalle Valo return 0; 173952d81a68SKalle Valo } 174052d81a68SKalle Valo 1741abcb344bSKalle Valo #ifdef CONFIG_PM 174252d81a68SKalle Valo 174352d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 174452d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 1745abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1746abcb344bSKalle Valo { 1747abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1748abcb344bSKalle Valo 1749abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1750abcb344bSKalle Valo } 1751aa6cffc1SChilam Ng 175252d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 1753aa6cffc1SChilam Ng { 1754aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1755aa6cffc1SChilam Ng 1756aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1757aa6cffc1SChilam Ng } 1758abcb344bSKalle Valo #endif 1759abcb344bSKalle Valo 17606a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 17616a7c9badSJouni Malinen struct ieee80211_channel *chan, 17626a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 17636a7c9badSJouni Malinen { 1764cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17656a7c9badSJouni Malinen 1766990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 17676a7c9badSJouni Malinen return -EIO; 17686a7c9badSJouni Malinen 17696a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 17706a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 1771cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 17726a7c9badSJouni Malinen 17736a7c9badSJouni Malinen return 0; 17746a7c9badSJouni Malinen } 17756a7c9badSJouni Malinen 17768bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 17778bdfbf40SJouni Malinen { 17788bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 17798bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 17808bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 17818bdfbf40SJouni Malinen } 17828bdfbf40SJouni Malinen 1783334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 1784334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 17858bdfbf40SJouni Malinen { 1786334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 17878bdfbf40SJouni Malinen const u8 *pos; 17888bdfbf40SJouni Malinen u8 *buf = NULL; 17898bdfbf40SJouni Malinen size_t len = 0; 17908bdfbf40SJouni Malinen int ret; 17918bdfbf40SJouni Malinen 17928bdfbf40SJouni Malinen /* 17938bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 17948bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 17958bdfbf40SJouni Malinen */ 17968bdfbf40SJouni Malinen 17978bdfbf40SJouni Malinen if (ies && ies_len) { 17988bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 17998bdfbf40SJouni Malinen if (buf == NULL) 18008bdfbf40SJouni Malinen return -ENOMEM; 18018bdfbf40SJouni Malinen pos = ies; 18028bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 18038bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 18048bdfbf40SJouni Malinen break; 18058bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 18068bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 18078bdfbf40SJouni Malinen len += 2 + pos[1]; 18088bdfbf40SJouni Malinen } 18098bdfbf40SJouni Malinen pos += 2 + pos[1]; 18108bdfbf40SJouni Malinen } 18118bdfbf40SJouni Malinen } 18128bdfbf40SJouni Malinen 1813334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1814334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 18158bdfbf40SJouni Malinen kfree(buf); 18168bdfbf40SJouni Malinen return ret; 18178bdfbf40SJouni Malinen } 18188bdfbf40SJouni Malinen 18196a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 18206a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 18216a7c9badSJouni Malinen { 18226a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 18233450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18246a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 18256a7c9badSJouni Malinen u8 *ies; 18266a7c9badSJouni Malinen int ies_len; 18276a7c9badSJouni Malinen struct wmi_connect_cmd p; 18286a7c9badSJouni Malinen int res; 18296a7c9badSJouni Malinen int i; 18306a7c9badSJouni Malinen 18316a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 18326a7c9badSJouni Malinen 1833990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 18346a7c9badSJouni Malinen return -EIO; 18356a7c9badSJouni Malinen 1836f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 18376a7c9badSJouni Malinen return -EOPNOTSUPP; 18386a7c9badSJouni Malinen 18396a7c9badSJouni Malinen if (info->beacon_ies) { 1840334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1841334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 18426a7c9badSJouni Malinen info->beacon_ies, 18436a7c9badSJouni Malinen info->beacon_ies_len); 18446a7c9badSJouni Malinen if (res) 18456a7c9badSJouni Malinen return res; 18466a7c9badSJouni Malinen } 18476a7c9badSJouni Malinen if (info->proberesp_ies) { 1848334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 18496a7c9badSJouni Malinen info->proberesp_ies_len); 18506a7c9badSJouni Malinen if (res) 18516a7c9badSJouni Malinen return res; 18526a7c9badSJouni Malinen } 18536a7c9badSJouni Malinen if (info->assocresp_ies) { 1854334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1855334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 18566a7c9badSJouni Malinen info->assocresp_ies, 18576a7c9badSJouni Malinen info->assocresp_ies_len); 18586a7c9badSJouni Malinen if (res) 18596a7c9badSJouni Malinen return res; 18606a7c9badSJouni Malinen } 18616a7c9badSJouni Malinen 18626a7c9badSJouni Malinen if (!add) 18636a7c9badSJouni Malinen return 0; 18646a7c9badSJouni Malinen 18659a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 18669a5b1318SJouni Malinen 18676a7c9badSJouni Malinen /* TODO: 18686a7c9badSJouni Malinen * info->interval 18696a7c9badSJouni Malinen * info->dtim_period 18706a7c9badSJouni Malinen */ 18716a7c9badSJouni Malinen 18726a7c9badSJouni Malinen if (info->head == NULL) 18736a7c9badSJouni Malinen return -EINVAL; 18746a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 18756a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 18766a7c9badSJouni Malinen if (ies > info->head + info->head_len) 18776a7c9badSJouni Malinen return -EINVAL; 18786a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 18796a7c9badSJouni Malinen 18806a7c9badSJouni Malinen if (info->ssid == NULL) 18816a7c9badSJouni Malinen return -EINVAL; 18823450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 18833450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 18846a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 18856a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 18866a7c9badSJouni Malinen 18873450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 18886a7c9badSJouni Malinen 18896a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 18906a7c9badSJouni Malinen 18916a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 18926a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 18936a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 18946a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 18956a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 18966a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 18976a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 18986a7c9badSJouni Malinen break; 18996a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 19006a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 19016a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 19026a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 19036a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 19046a7c9badSJouni Malinen break; 19056a7c9badSJouni Malinen } 19066a7c9badSJouni Malinen } 19076a7c9badSJouni Malinen if (p.auth_mode == 0) 19086a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 19093450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 19106a7c9badSJouni Malinen 19116a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 19126a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 19136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 19146a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 19156a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 19166a7c9badSJouni Malinen break; 19176a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 19186a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 19196a7c9badSJouni Malinen break; 19206a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 19216a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 19226a7c9badSJouni Malinen break; 19236a7c9badSJouni Malinen } 19246a7c9badSJouni Malinen } 1925229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 19266a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1927240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1928229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1929240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 19306a7c9badSJouni Malinen 19316a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 19326a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 19336a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 19346a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 19356a7c9badSJouni Malinen break; 19366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 19376a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 19386a7c9badSJouni Malinen break; 19396a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 19406a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 19416a7c9badSJouni Malinen break; 19426a7c9badSJouni Malinen default: 19436a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 19446a7c9badSJouni Malinen break; 19456a7c9badSJouni Malinen } 1946240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 19476a7c9badSJouni Malinen 19486a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 1949f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 19506a7c9badSJouni Malinen 19513450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 19523450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 19533450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 1954cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 19556a7c9badSJouni Malinen 1956334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 19579a5b1318SJouni Malinen if (res < 0) 19589a5b1318SJouni Malinen return res; 19599a5b1318SJouni Malinen 19609a5b1318SJouni Malinen return 0; 19616a7c9badSJouni Malinen } 19626a7c9badSJouni Malinen 19636a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 19646a7c9badSJouni Malinen struct beacon_parameters *info) 19656a7c9badSJouni Malinen { 19666a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 19676a7c9badSJouni Malinen } 19686a7c9badSJouni Malinen 19696a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 19706a7c9badSJouni Malinen struct beacon_parameters *info) 19716a7c9badSJouni Malinen { 19726a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 19736a7c9badSJouni Malinen } 19746a7c9badSJouni Malinen 19756a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 19766a7c9badSJouni Malinen { 19776a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 197859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 19796a7c9badSJouni Malinen 1980f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 19816a7c9badSJouni Malinen return -EOPNOTSUPP; 198259c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 19836a7c9badSJouni Malinen return -ENOTCONN; 19846a7c9badSJouni Malinen 1985334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 198659c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 19876a7c9badSJouni Malinen 19886a7c9badSJouni Malinen return 0; 19896a7c9badSJouni Malinen } 19906a7c9badSJouni Malinen 199123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 199223875136SJouni Malinen u8 *mac, struct station_parameters *params) 199323875136SJouni Malinen { 199423875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1995f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 199623875136SJouni Malinen 1997f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 199823875136SJouni Malinen return -EOPNOTSUPP; 199923875136SJouni Malinen 200023875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 200123875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 200223875136SJouni Malinen return -EOPNOTSUPP; 200323875136SJouni Malinen 200423875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2005334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2006334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2007334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2008334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 200923875136SJouni Malinen } 201023875136SJouni Malinen 201163fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 201263fa1e0cSJouni Malinen struct net_device *dev, 201363fa1e0cSJouni Malinen struct ieee80211_channel *chan, 201463fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 201563fa1e0cSJouni Malinen unsigned int duration, 201663fa1e0cSJouni Malinen u64 *cookie) 201763fa1e0cSJouni Malinen { 201863fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2019334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 20201052261eSJouni Malinen u32 id; 202163fa1e0cSJouni Malinen 202263fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 202363fa1e0cSJouni Malinen * return -EBUSY */ 20241052261eSJouni Malinen id = ++vif->last_roc_id; 20251052261eSJouni Malinen if (id == 0) { 20261052261eSJouni Malinen /* Do not use 0 as the cookie value */ 20271052261eSJouni Malinen id = ++vif->last_roc_id; 20281052261eSJouni Malinen } 20291052261eSJouni Malinen *cookie = id; 203063fa1e0cSJouni Malinen 2031334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2032334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 203363fa1e0cSJouni Malinen } 203463fa1e0cSJouni Malinen 203563fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 203663fa1e0cSJouni Malinen struct net_device *dev, 203763fa1e0cSJouni Malinen u64 cookie) 203863fa1e0cSJouni Malinen { 203963fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2040334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 204163fa1e0cSJouni Malinen 20421052261eSJouni Malinen if (cookie != vif->last_roc_id) 204363fa1e0cSJouni Malinen return -ENOENT; 20441052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 204563fa1e0cSJouni Malinen 2046334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 204763fa1e0cSJouni Malinen } 204863fa1e0cSJouni Malinen 2049334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2050334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2051334234b5SVasanthakumar Thiagarajan unsigned int freq) 20528bdfbf40SJouni Malinen { 2053334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 20548bdfbf40SJouni Malinen const u8 *pos; 20558bdfbf40SJouni Malinen u8 *p2p; 20568bdfbf40SJouni Malinen int p2p_len; 20578bdfbf40SJouni Malinen int ret; 20588bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 20598bdfbf40SJouni Malinen 20608bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 20618bdfbf40SJouni Malinen 20628bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 20638bdfbf40SJouni Malinen 20648bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 20658bdfbf40SJouni Malinen if (p2p == NULL) 20668bdfbf40SJouni Malinen return -ENOMEM; 20678bdfbf40SJouni Malinen p2p_len = 0; 20688bdfbf40SJouni Malinen 20698bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 20708bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 20718bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 20728bdfbf40SJouni Malinen break; 20738bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 20748bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 20758bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 20768bdfbf40SJouni Malinen } 20778bdfbf40SJouni Malinen pos += 2 + pos[1]; 20788bdfbf40SJouni Malinen } 20798bdfbf40SJouni Malinen 2080334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2081334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 20828bdfbf40SJouni Malinen kfree(p2p); 20838bdfbf40SJouni Malinen return ret; 20848bdfbf40SJouni Malinen } 20858bdfbf40SJouni Malinen 20868a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 20878a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 20888a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 20898a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2090e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2091e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 20928a6c8060SJouni Malinen { 20938a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 209459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 20958a6c8060SJouni Malinen u32 id; 20968bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 20978bdfbf40SJouni Malinen 20988bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 20998bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2100f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 21018bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 21028bdfbf40SJouni Malinen /* 21038bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 21048bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 21058bdfbf40SJouni Malinen */ 21068bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2107334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 21088bdfbf40SJouni Malinen chan->center_freq); 21098bdfbf40SJouni Malinen } 21108a6c8060SJouni Malinen 2111cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 21128a6c8060SJouni Malinen if (id == 0) { 21138a6c8060SJouni Malinen /* 21148a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 21158a6c8060SJouni Malinen * used for the command. 21168a6c8060SJouni Malinen */ 2117cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 21188a6c8060SJouni Malinen } 21198a6c8060SJouni Malinen 21208a6c8060SJouni Malinen *cookie = id; 2121334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2122334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 21238a6c8060SJouni Malinen buf, len); 21248a6c8060SJouni Malinen } 21258a6c8060SJouni Malinen 2126ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2127ae32c30aSJouni Malinen struct net_device *dev, 2128ae32c30aSJouni Malinen u16 frame_type, bool reg) 2129ae32c30aSJouni Malinen { 2130cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2131ae32c30aSJouni Malinen 2132ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2133ae32c30aSJouni Malinen __func__, frame_type, reg); 2134ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2135ae32c30aSJouni Malinen /* 2136ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2137ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2138ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2139ae32c30aSJouni Malinen */ 2140cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2141ae32c30aSJouni Malinen } 2142ae32c30aSJouni Malinen } 2143ae32c30aSJouni Malinen 2144f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2145f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2146f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2147f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2148f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2149f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2150f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2151f80574aeSJouni Malinen }, 2152f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2153f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2154f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2155f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2156f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2157f80574aeSJouni Malinen }, 2158f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2159f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2160f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2161f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2162f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2163f80574aeSJouni Malinen }, 2164f80574aeSJouni Malinen }; 2165f80574aeSJouni Malinen 2166bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 216755055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 216855055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2169bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2170bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2171bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2172bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2173bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2174bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2175bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2176bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2177bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2178bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2179bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2180bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2181bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2182bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2183bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2184bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2185bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2186bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2187003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2188abcb344bSKalle Valo #ifdef CONFIG_PM 218952d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 219052d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2191abcb344bSKalle Valo #endif 21926a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 21936a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 21946a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 21956a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 219623875136SJouni Malinen .change_station = ath6kl_change_station, 219763fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 219863fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 21998a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2200ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 2201bdcd8170SKalle Valo }; 2202bdcd8170SKalle Valo 2203ec4b7f60SKalle Valo void ath6kl_cfg80211_stop(struct ath6kl *ar) 2204ec4b7f60SKalle Valo { 2205ec4b7f60SKalle Valo struct ath6kl_vif *vif; 2206ec4b7f60SKalle Valo 2207ec4b7f60SKalle Valo /* FIXME: for multi vif */ 2208ec4b7f60SKalle Valo vif = ath6kl_vif_first(ar); 2209ec4b7f60SKalle Valo if (!vif) { 2210ec4b7f60SKalle Valo /* save the current power mode before enabling power save */ 2211ec4b7f60SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 2212ec4b7f60SKalle Valo 2213ec4b7f60SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 2214ec4b7f60SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 2215ec4b7f60SKalle Valo "wmi_powermode_cmd failed\n"); 2216ec4b7f60SKalle Valo return; 2217ec4b7f60SKalle Valo } 2218ec4b7f60SKalle Valo 2219ec4b7f60SKalle Valo switch (vif->sme_state) { 2220ec4b7f60SKalle Valo case SME_CONNECTING: 2221ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2222ec4b7f60SKalle Valo NULL, 0, 2223ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2224ec4b7f60SKalle Valo GFP_KERNEL); 2225ec4b7f60SKalle Valo break; 2226ec4b7f60SKalle Valo case SME_CONNECTED: 2227ec4b7f60SKalle Valo default: 2228ec4b7f60SKalle Valo /* 2229ec4b7f60SKalle Valo * FIXME: oddly enough smeState is in DISCONNECTED during 2230ec4b7f60SKalle Valo * suspend, why? Need to send disconnected event in that 2231ec4b7f60SKalle Valo * state. 2232ec4b7f60SKalle Valo */ 2233ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2234ec4b7f60SKalle Valo break; 2235ec4b7f60SKalle Valo } 2236ec4b7f60SKalle Valo 2237ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2238ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 2239ec4b7f60SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 2240ec4b7f60SKalle Valo 2241ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 22421f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 22431f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2244ec4b7f60SKalle Valo 2245ec4b7f60SKalle Valo /* disable scanning */ 2246ec4b7f60SKalle Valo if (ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0xFFFF, 0, 0, 2247ec4b7f60SKalle Valo 0, 0, 0, 0, 0, 0, 0) != 0) 2248ec4b7f60SKalle Valo printk(KERN_WARNING "ath6kl: failed to disable scan " 2249ec4b7f60SKalle Valo "during suspend\n"); 2250ec4b7f60SKalle Valo 2251ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2252ec4b7f60SKalle Valo } 2253ec4b7f60SKalle Valo 22548dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 2255bdcd8170SKalle Valo { 22566bbc7c35SJouni Malinen struct ath6kl *ar; 2257be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 22588dafb70eSVasanthakumar Thiagarajan u8 ctr; 2259bdcd8170SKalle Valo 2260bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 2261be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 22628dafb70eSVasanthakumar Thiagarajan 2263be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 2264bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 2265bdcd8170SKalle Valo return NULL; 2266bdcd8170SKalle Valo } 2267bdcd8170SKalle Valo 2268be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 22693226f68aSVasanthakumar Thiagarajan if (!multi_norm_if_support) 22706bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 2271be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 22728dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 22738dafb70eSVasanthakumar Thiagarajan 22743226f68aSVasanthakumar Thiagarajan if (multi_norm_if_support) 22753226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 2; 22763226f68aSVasanthakumar Thiagarajan else 22773226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 22783226f68aSVasanthakumar Thiagarajan 22793226f68aSVasanthakumar Thiagarajan /* FIXME: Remove this once the multivif support is enabled */ 22803226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 22813226f68aSVasanthakumar Thiagarajan 22828dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 22838dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 2284990bd915SVasanthakumar Thiagarajan spin_lock_init(&ar->list_lock); 22858dafb70eSVasanthakumar Thiagarajan 22868dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 22878dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 22888dafb70eSVasanthakumar Thiagarajan 22898dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 2290990bd915SVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->vif_list); 22918dafb70eSVasanthakumar Thiagarajan 22928dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 22938dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 22948dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 22958dafb70eSVasanthakumar Thiagarajan 22968dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 22978dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 22988dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 22998dafb70eSVasanthakumar Thiagarajan 23008dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 23018dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 23028dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 23038dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 23048dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 23058dafb70eSVasanthakumar Thiagarajan 230676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_OFF; 230776a9fbe2SKalle Valo 23088dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 23098dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 23108dafb70eSVasanthakumar Thiagarajan 23118dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 23128dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 23138dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 23148dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 23158dafb70eSVasanthakumar Thiagarajan } 23168dafb70eSVasanthakumar Thiagarajan 23178dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 23188dafb70eSVasanthakumar Thiagarajan 23198dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 23208dafb70eSVasanthakumar Thiagarajan 23218dafb70eSVasanthakumar Thiagarajan return ar; 23228dafb70eSVasanthakumar Thiagarajan } 23238dafb70eSVasanthakumar Thiagarajan 23248dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 23258dafb70eSVasanthakumar Thiagarajan { 23268dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 23278dafb70eSVasanthakumar Thiagarajan int ret; 23286bbc7c35SJouni Malinen 2329be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2330f80574aeSJouni Malinen 2331be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 233263fa1e0cSJouni Malinen 2333bdcd8170SKalle Valo /* set device pointer for wiphy */ 23348dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2335bdcd8170SKalle Valo 2336be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 23378dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 23388dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 23396bbc7c35SJouni Malinen if (ar->p2p) { 2340be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 23416bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 23426bbc7c35SJouni Malinen } 23438dafb70eSVasanthakumar Thiagarajan 2344bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2345be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2346be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2347be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2348be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2349be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2350bdcd8170SKalle Valo 2351be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2352be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2353bdcd8170SKalle Valo 2354be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2355bdcd8170SKalle Valo if (ret < 0) { 2356bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 23578dafb70eSVasanthakumar Thiagarajan return ret; 23588dafb70eSVasanthakumar Thiagarajan } 23598dafb70eSVasanthakumar Thiagarajan 23608dafb70eSVasanthakumar Thiagarajan return 0; 23618dafb70eSVasanthakumar Thiagarajan } 23628dafb70eSVasanthakumar Thiagarajan 2363108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 23648dafb70eSVasanthakumar Thiagarajan { 23652132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 23662132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 23678dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 23688dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 23698dafb70eSVasanthakumar Thiagarajan } 23708dafb70eSVasanthakumar Thiagarajan 2371de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2372108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 2373de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2374478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 23758dafb70eSVasanthakumar Thiagarajan 23768dafb70eSVasanthakumar Thiagarajan return 0; 23778dafb70eSVasanthakumar Thiagarajan } 23788dafb70eSVasanthakumar Thiagarajan 2379108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 23808dafb70eSVasanthakumar Thiagarajan { 238155055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 238255055976SVasanthakumar Thiagarajan 23832132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2384108438bcSVasanthakumar Thiagarajan 238555055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 238655055976SVasanthakumar Thiagarajan 238755055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 238855055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 238955055976SVasanthakumar Thiagarajan 239027929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 239155055976SVasanthakumar Thiagarajan 239255055976SVasanthakumar Thiagarajan ar->num_vif--; 23938dafb70eSVasanthakumar Thiagarajan } 23948dafb70eSVasanthakumar Thiagarajan 23958dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 239655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 239755055976SVasanthakumar Thiagarajan u8 nw_type) 23988dafb70eSVasanthakumar Thiagarajan { 23998dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2400108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 24018dafb70eSVasanthakumar Thiagarajan 240255055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 24038dafb70eSVasanthakumar Thiagarajan if (!ndev) 24048dafb70eSVasanthakumar Thiagarajan return NULL; 24058dafb70eSVasanthakumar Thiagarajan 2406108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2407108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2408108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2409108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2410108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2411108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2412108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2413108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2414334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 241555055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 24168dafb70eSVasanthakumar Thiagarajan 241755055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 241855055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 241955055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 242055055976SVasanthakumar Thiagarajan 0x2; 242155055976SVasanthakumar Thiagarajan 24228dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 24238dafb70eSVasanthakumar Thiagarajan 2424e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 24258dafb70eSVasanthakumar Thiagarajan 24268dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2427108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 24288dafb70eSVasanthakumar Thiagarajan goto err; 24298dafb70eSVasanthakumar Thiagarajan 243027929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 24318dafb70eSVasanthakumar Thiagarajan goto err; 24328dafb70eSVasanthakumar Thiagarajan 243355055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 243414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 243559c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 24368dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 243759c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 24388dafb70eSVasanthakumar Thiagarajan 243955055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 244055055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 244155055976SVasanthakumar Thiagarajan 244211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2443990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 244411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2445990bd915SVasanthakumar Thiagarajan 24468dafb70eSVasanthakumar Thiagarajan return ndev; 24478dafb70eSVasanthakumar Thiagarajan 24488dafb70eSVasanthakumar Thiagarajan err: 244927929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 245027929723SVasanthakumar Thiagarajan free_netdev(ndev); 2451bdcd8170SKalle Valo return NULL; 2452bdcd8170SKalle Valo } 2453bdcd8170SKalle Valo 24548dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2455bdcd8170SKalle Valo { 2456be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2457be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2458bdcd8170SKalle Valo } 2459