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; 2065e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2075e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2085e07021eSDai Shuibing *ar_cipher_len = 0; 2095e07021eSDai Shuibing break; 210bdcd8170SKalle Valo default: 211bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 212bdcd8170SKalle Valo return -ENOTSUPP; 213bdcd8170SKalle Valo } 214bdcd8170SKalle Valo 215bdcd8170SKalle Valo return 0; 216bdcd8170SKalle Valo } 217bdcd8170SKalle Valo 218240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 219bdcd8170SKalle Valo { 220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 221bdcd8170SKalle Valo 222bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2233450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2243450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2253450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2263450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 227837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2283450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2293450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2303450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2313450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 232bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2333450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 234bdcd8170SKalle Valo } 235bdcd8170SKalle Valo } 236bdcd8170SKalle Valo 237990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 238bdcd8170SKalle Valo { 239990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 24059c98449SVasanthakumar Thiagarajan 241bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 242bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 243bdcd8170SKalle Valo return false; 244bdcd8170SKalle Valo } 245bdcd8170SKalle Valo 24659c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 247bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 248bdcd8170SKalle Valo return false; 249bdcd8170SKalle Valo } 250bdcd8170SKalle Valo 251bdcd8170SKalle Valo return true; 252bdcd8170SKalle Valo } 253bdcd8170SKalle Valo 2546981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2556981ffdcSKevin Fang { 2566981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2576981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2586981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2596981ffdcSKevin Fang } 2606981ffdcSKevin Fang 2616981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2626981ffdcSKevin Fang { 2636981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2646981ffdcSKevin Fang } 2656981ffdcSKevin Fang 26663541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 26763541212SAarthi Thiruvengadam { 26863541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 26963541212SAarthi Thiruvengadam pos[1] >= 4 && 27063541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 27163541212SAarthi Thiruvengadam pos[5] == 0x04); 27263541212SAarthi Thiruvengadam } 27363541212SAarthi Thiruvengadam 274334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 2756981ffdcSKevin Fang size_t ies_len) 2766981ffdcSKevin Fang { 277334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2786981ffdcSKevin Fang const u8 *pos; 2796981ffdcSKevin Fang u8 *buf = NULL; 2806981ffdcSKevin Fang size_t len = 0; 2816981ffdcSKevin Fang int ret; 2826981ffdcSKevin Fang 2836981ffdcSKevin Fang /* 28463541212SAarthi Thiruvengadam * Clear previously set flag 28563541212SAarthi Thiruvengadam */ 28663541212SAarthi Thiruvengadam 28763541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 28863541212SAarthi Thiruvengadam 28963541212SAarthi Thiruvengadam /* 2906981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2916981ffdcSKevin Fang */ 2926981ffdcSKevin Fang 2936981ffdcSKevin Fang if (ies && ies_len) { 2946981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2956981ffdcSKevin Fang if (buf == NULL) 2966981ffdcSKevin Fang return -ENOMEM; 2976981ffdcSKevin Fang pos = ies; 2986981ffdcSKevin Fang 2996981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3006981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3016981ffdcSKevin Fang break; 3026981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3036981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3046981ffdcSKevin Fang len += 2 + pos[1]; 3056981ffdcSKevin Fang } 30663541212SAarthi Thiruvengadam 30763541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 30863541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 30963541212SAarthi Thiruvengadam 3106981ffdcSKevin Fang pos += 2 + pos[1]; 3116981ffdcSKevin Fang } 3126981ffdcSKevin Fang } 3136981ffdcSKevin Fang 314334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 315334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3166981ffdcSKevin Fang kfree(buf); 3176981ffdcSKevin Fang return ret; 3186981ffdcSKevin Fang } 3196981ffdcSKevin Fang 32055055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 32155055976SVasanthakumar Thiagarajan { 32255055976SVasanthakumar Thiagarajan switch (type) { 32355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 32455055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 32555055976SVasanthakumar Thiagarajan break; 32655055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 32755055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 32855055976SVasanthakumar Thiagarajan break; 32955055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 33055055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 33155055976SVasanthakumar Thiagarajan break; 33255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 33355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 33455055976SVasanthakumar Thiagarajan break; 33555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 33655055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 33755055976SVasanthakumar Thiagarajan break; 33855055976SVasanthakumar Thiagarajan default: 33955055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 34055055976SVasanthakumar Thiagarajan return -ENOTSUPP; 34155055976SVasanthakumar Thiagarajan } 34255055976SVasanthakumar Thiagarajan 34355055976SVasanthakumar Thiagarajan return 0; 34455055976SVasanthakumar Thiagarajan } 34555055976SVasanthakumar Thiagarajan 34655055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 34755055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 34855055976SVasanthakumar Thiagarajan { 34955055976SVasanthakumar Thiagarajan int i; 35055055976SVasanthakumar Thiagarajan 35155055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 35255055976SVasanthakumar Thiagarajan return false; 35355055976SVasanthakumar Thiagarajan 35455055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 35555055976SVasanthakumar Thiagarajan ar->num_vif)) 35655055976SVasanthakumar Thiagarajan return false; 35755055976SVasanthakumar Thiagarajan 35855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 35955055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 36055055976SVasanthakumar Thiagarajan for (i = 0; i < MAX_NUM_VIF; i++) { 36155055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 36255055976SVasanthakumar Thiagarajan *if_idx = i; 36355055976SVasanthakumar Thiagarajan return true; 36455055976SVasanthakumar Thiagarajan } 36555055976SVasanthakumar Thiagarajan } 36655055976SVasanthakumar Thiagarajan } 36755055976SVasanthakumar Thiagarajan 3683226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 3693226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 3703226f68aSVasanthakumar Thiagarajan for (i = ar->max_norm_iface; i < MAX_NUM_VIF; i++) { 3713226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 3723226f68aSVasanthakumar Thiagarajan *if_idx = i; 3733226f68aSVasanthakumar Thiagarajan return true; 3743226f68aSVasanthakumar Thiagarajan } 3753226f68aSVasanthakumar Thiagarajan } 3763226f68aSVasanthakumar Thiagarajan } 3773226f68aSVasanthakumar Thiagarajan 37855055976SVasanthakumar Thiagarajan return false; 37955055976SVasanthakumar Thiagarajan } 38055055976SVasanthakumar Thiagarajan 381bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 382bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 383bdcd8170SKalle Valo { 384bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 38559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 386bdcd8170SKalle Valo int status; 387bdcd8170SKalle Valo 38814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 389bdcd8170SKalle Valo 390990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 391bdcd8170SKalle Valo return -EIO; 392bdcd8170SKalle Valo 393bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 394bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 395bdcd8170SKalle Valo return -EBUSY; 396bdcd8170SKalle Valo } 397bdcd8170SKalle Valo 398bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 399bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 400bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 401bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 402bdcd8170SKalle Valo return -EINVAL; 403bdcd8170SKalle Valo } 404bdcd8170SKalle Valo 405bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 406bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 407bdcd8170SKalle Valo return -ERESTARTSYS; 408bdcd8170SKalle Valo } 409bdcd8170SKalle Valo 410bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 411bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 412bdcd8170SKalle Valo up(&ar->sem); 413bdcd8170SKalle Valo return -EBUSY; 414bdcd8170SKalle Valo } 415bdcd8170SKalle Valo 416bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 417bdcd8170SKalle Valo /* 418bdcd8170SKalle Valo * sleep until the command queue drains 419bdcd8170SKalle Valo */ 420bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 421bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 422bdcd8170SKalle Valo WMI_TIMEOUT); 423bdcd8170SKalle Valo if (signal_pending(current)) { 424bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 425bdcd8170SKalle Valo up(&ar->sem); 426bdcd8170SKalle Valo return -EINTR; 427bdcd8170SKalle Valo } 428bdcd8170SKalle Valo } 429bdcd8170SKalle Valo 4306981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 431334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 4326981ffdcSKevin Fang if (status) 4336981ffdcSKevin Fang return status; 4346981ffdcSKevin Fang } 4356981ffdcSKevin Fang 43659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4373450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4383450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 439cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 440334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 441334234b5SVasanthakumar Thiagarajan vif->req_bssid, 442f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 443bdcd8170SKalle Valo 444bdcd8170SKalle Valo up(&ar->sem); 445bdcd8170SKalle Valo if (status) { 446bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 447bdcd8170SKalle Valo return -EIO; 448bdcd8170SKalle Valo } 449bdcd8170SKalle Valo return 0; 4503450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4513450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 452240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 453bdcd8170SKalle Valo } 454bdcd8170SKalle Valo 4553450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4563450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4573450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 458bdcd8170SKalle Valo 459bdcd8170SKalle Valo if (sme->channel) 460f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 461bdcd8170SKalle Valo 4628c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 463bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 4648c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 465bdcd8170SKalle Valo 466240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 467bdcd8170SKalle Valo 468240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 469bdcd8170SKalle Valo if (status) { 470bdcd8170SKalle Valo up(&ar->sem); 471bdcd8170SKalle Valo return status; 472bdcd8170SKalle Valo } 473bdcd8170SKalle Valo 474bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 475240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 476bdcd8170SKalle Valo else 477240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 478bdcd8170SKalle Valo 479240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 480bdcd8170SKalle Valo 481bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 482240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 483bdcd8170SKalle Valo 484bdcd8170SKalle Valo if ((sme->key_len) && 4853450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 4863450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 487bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 488bdcd8170SKalle Valo 489bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 490bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 491bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 492bdcd8170SKalle Valo sme->key_idx); 493bdcd8170SKalle Valo up(&ar->sem); 494bdcd8170SKalle Valo return -ENOENT; 495bdcd8170SKalle Valo } 496bdcd8170SKalle Valo 4976f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 498bdcd8170SKalle Valo key->key_len = sme->key_len; 499bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5003450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5013450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 502bdcd8170SKalle Valo 503334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5043450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 505bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 506bdcd8170SKalle Valo key->key_len, 507f4bb9a6fSJouni Malinen NULL, 0, 508bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 509bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 510bdcd8170SKalle Valo } 511bdcd8170SKalle Valo 512bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 51359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 514240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 515240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 516bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 517bdcd8170SKalle Valo up(&ar->sem); 518bdcd8170SKalle Valo return -EIO; 519bdcd8170SKalle Valo } 520bdcd8170SKalle Valo } 521bdcd8170SKalle Valo 522f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 523bdcd8170SKalle Valo 524bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 525bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 526bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 527bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 528bdcd8170SKalle Valo __func__, 5293450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5303450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 531f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 532bdcd8170SKalle Valo 533cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 534334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5353450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5363450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5373450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5383450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5393450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 540f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 541bdcd8170SKalle Valo ar->connect_ctrl_flags); 542bdcd8170SKalle Valo 543bdcd8170SKalle Valo up(&ar->sem); 544bdcd8170SKalle Valo 545bdcd8170SKalle Valo if (status == -EINVAL) { 5463450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5473450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 548bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 549bdcd8170SKalle Valo return -ENOENT; 550bdcd8170SKalle Valo } else if (status) { 551bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 552bdcd8170SKalle Valo return -EIO; 553bdcd8170SKalle Valo } 554bdcd8170SKalle Valo 555bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5563450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5573450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 558de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 559bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 560bdcd8170SKalle Valo } 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 56359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 564bdcd8170SKalle Valo 565bdcd8170SKalle Valo return 0; 566bdcd8170SKalle Valo } 567bdcd8170SKalle Valo 5684eab6f4fSRaja Mani static int ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 5694eab6f4fSRaja Mani enum network_type nw_type, 5704eab6f4fSRaja Mani const u8 *bssid, 57101cac476SJouni Malinen struct ieee80211_channel *chan, 57201cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 57301cac476SJouni Malinen { 574240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 57501cac476SJouni Malinen struct cfg80211_bss *bss; 5764eab6f4fSRaja Mani u16 cap_mask, cap_val; 57701cac476SJouni Malinen u8 *ie; 57801cac476SJouni Malinen 5794eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 5804eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 5814eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 5824eab6f4fSRaja Mani } else { 5834eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 5844eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 5854eab6f4fSRaja Mani } 5864eab6f4fSRaja Mani 587be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 5884eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 5894eab6f4fSRaja Mani cap_mask, cap_val); 59001cac476SJouni Malinen if (bss == NULL) { 59101cac476SJouni Malinen /* 59201cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 59301cac476SJouni Malinen * generate a partial entry until the first BSS info 59401cac476SJouni Malinen * event becomes available. 59501cac476SJouni Malinen * 59601cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 59701cac476SJouni Malinen * IEs from the target. 59801cac476SJouni Malinen */ 5993450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 60001cac476SJouni Malinen if (ie == NULL) 60101cac476SJouni Malinen return -ENOMEM; 60201cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6033450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6043450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6053450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 606be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6074eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6083450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 60901cac476SJouni Malinen 0, GFP_KERNEL); 61001cac476SJouni Malinen if (bss) 6114eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6124eab6f4fSRaja Mani "cfg80211\n", bssid); 61301cac476SJouni Malinen kfree(ie); 61401cac476SJouni Malinen } else 61501cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 61601cac476SJouni Malinen "entry\n"); 61701cac476SJouni Malinen 61801cac476SJouni Malinen if (bss == NULL) 61901cac476SJouni Malinen return -ENOMEM; 62001cac476SJouni Malinen 62101cac476SJouni Malinen cfg80211_put_bss(bss); 62201cac476SJouni Malinen 62301cac476SJouni Malinen return 0; 62401cac476SJouni Malinen } 62501cac476SJouni Malinen 626240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 627bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 628bdcd8170SKalle Valo u16 beacon_intvl, 629bdcd8170SKalle Valo enum network_type nw_type, 630bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 631bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 632bdcd8170SKalle Valo { 63301cac476SJouni Malinen struct ieee80211_channel *chan; 634240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 635bdcd8170SKalle Valo 636bdcd8170SKalle Valo /* capinfo + listen interval */ 637bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 638bdcd8170SKalle Valo 639bdcd8170SKalle Valo /* capinfo + status code + associd */ 640bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 641bdcd8170SKalle Valo 642bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 643bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 644bdcd8170SKalle Valo assoc_resp_ie_offset; 645bdcd8170SKalle Valo 646bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 647bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 648bdcd8170SKalle Valo 64932c10874SJouni Malinen /* 65032c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 65132c10874SJouni Malinen * a Beacon frame from the AP is seen. 65232c10874SJouni Malinen */ 653cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 65459c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 65532c10874SJouni Malinen 656bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 657551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 658bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 659bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 660bdcd8170SKalle Valo return; 661bdcd8170SKalle Valo } 662bdcd8170SKalle Valo } 663bdcd8170SKalle Valo 664bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 665551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 666551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 667bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 668bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 669bdcd8170SKalle Valo return; 670bdcd8170SKalle Valo } 671bdcd8170SKalle Valo } 672bdcd8170SKalle Valo 673be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 674bdcd8170SKalle Valo 6754eab6f4fSRaja Mani if (ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, assoc_info, 6764eab6f4fSRaja Mani beacon_ie_len) < 0) { 6774eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 678bdcd8170SKalle Valo return; 679bdcd8170SKalle Valo } 680bdcd8170SKalle Valo 6814eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6824eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 6834eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 6844eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 68501cac476SJouni Malinen return; 68601cac476SJouni Malinen } 68701cac476SJouni Malinen 68814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 689bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 69014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 691240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 692bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 693bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 694bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 69514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 696bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 697240d2799SVasanthakumar Thiagarajan cfg80211_roamed(vif->ndev, chan, bssid, 698bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 699bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 700bdcd8170SKalle Valo } 701bdcd8170SKalle Valo } 702bdcd8170SKalle Valo 703bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 704bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 705bdcd8170SKalle Valo { 706bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 7073450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 708bdcd8170SKalle Valo 709bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 710bdcd8170SKalle Valo reason_code); 711bdcd8170SKalle Valo 712990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 713bdcd8170SKalle Valo return -EIO; 714bdcd8170SKalle Valo 715bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 716bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 717bdcd8170SKalle Valo return -EBUSY; 718bdcd8170SKalle Valo } 719bdcd8170SKalle Valo 720bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 721bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 722bdcd8170SKalle Valo return -ERESTARTSYS; 723bdcd8170SKalle Valo } 724bdcd8170SKalle Valo 725cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 726240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7273450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7283450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 729bdcd8170SKalle Valo 730bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7318c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 732bdcd8170SKalle Valo 733bdcd8170SKalle Valo up(&ar->sem); 734bdcd8170SKalle Valo 73514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 736170826ddSVasanthakumar Thiagarajan 737bdcd8170SKalle Valo return 0; 738bdcd8170SKalle Valo } 739bdcd8170SKalle Valo 740240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 741bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 742bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 743bdcd8170SKalle Valo { 744240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 74559c98449SVasanthakumar Thiagarajan 74614ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 74714ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 74814ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 749bdcd8170SKalle Valo } 750bdcd8170SKalle Valo 751f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 752551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 753bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 754bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 755bdcd8170SKalle Valo return; 756bdcd8170SKalle Valo } 757bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 758240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 759bdcd8170SKalle Valo return; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 762f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 763551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 764551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 765bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 766bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 767bdcd8170SKalle Valo return; 768bdcd8170SKalle Valo } 769bdcd8170SKalle Valo } 770bdcd8170SKalle Valo 7711de547d6SVasanthakumar Thiagarajan /* 7721de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 7731de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 7741de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 7751de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 7761de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 7771de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 7781de547d6SVasanthakumar Thiagarajan */ 779bdcd8170SKalle Valo 7801de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 781334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 782bdcd8170SKalle Valo return; 783bdcd8170SKalle Valo } 784bdcd8170SKalle Valo 78559c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 786bdcd8170SKalle Valo 78714ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 788240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 789bdcd8170SKalle Valo bssid, NULL, 0, 790bdcd8170SKalle Valo NULL, 0, 791bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 792bdcd8170SKalle Valo GFP_KERNEL); 79314ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 794240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 795bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 796bdcd8170SKalle Valo } 797bdcd8170SKalle Valo 79814ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 799bdcd8170SKalle Valo } 800bdcd8170SKalle Valo 801bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 802bdcd8170SKalle Valo struct cfg80211_scan_request *request) 803bdcd8170SKalle Valo { 804bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 80559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8061276c9efSEdward Lu s8 n_channels = 0; 8071276c9efSEdward Lu u16 *channels = NULL; 808bdcd8170SKalle Valo int ret = 0; 809f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 810bdcd8170SKalle Valo 811990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 812bdcd8170SKalle Valo return -EIO; 813bdcd8170SKalle Valo 814bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 81559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8161b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 817240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 81859c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8191b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8201b1e6ee3SJouni Malinen if (ret) { 821bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8221b1e6ee3SJouni Malinen return ret; 823bdcd8170SKalle Valo } 824bdcd8170SKalle Valo } 825bdcd8170SKalle Valo 826bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 827bdcd8170SKalle Valo u8 i; 828bdcd8170SKalle Valo 829bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 830bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 831bdcd8170SKalle Valo 832bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 833334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 834334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 835bdcd8170SKalle Valo request->ssids[i].ssid_len, 836bdcd8170SKalle Valo request->ssids[i].ssid); 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 839b84da8c7SJouni Malinen if (request->ie) { 840334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 841334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 842b84da8c7SJouni Malinen request->ie, request->ie_len); 843b84da8c7SJouni Malinen if (ret) { 844b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 845b84da8c7SJouni Malinen "scan"); 846b84da8c7SJouni Malinen return ret; 847b84da8c7SJouni Malinen } 848b84da8c7SJouni Malinen } 849b84da8c7SJouni Malinen 85011869befSJouni Malinen /* 85111869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 85211869befSJouni Malinen * channels. If the list is longer than the target supports, do not 85311869befSJouni Malinen * configure the list and instead, scan all available channels. 85411869befSJouni Malinen */ 85511869befSJouni Malinen if (request->n_channels > 0 && 85611869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 8571276c9efSEdward Lu u8 i; 8581276c9efSEdward Lu 85911869befSJouni Malinen n_channels = request->n_channels; 8601276c9efSEdward Lu 8611276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 8621276c9efSEdward Lu if (channels == NULL) { 8631276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 8641276c9efSEdward Lu "scan all channels"); 8651276c9efSEdward Lu n_channels = 0; 8661276c9efSEdward Lu } 8671276c9efSEdward Lu 8681276c9efSEdward Lu for (i = 0; i < n_channels; i++) 8691276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 8701276c9efSEdward Lu } 8711276c9efSEdward Lu 87259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 873f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 874f1f92179SVasanthakumar Thiagarajan 875334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, WMI_LONG_SCAN, 876334234b5SVasanthakumar Thiagarajan force_fg_scan, false, 0, 0, n_channels, 877334234b5SVasanthakumar Thiagarajan channels); 8781b1e6ee3SJouni Malinen if (ret) 879bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 88011869befSJouni Malinen else 88114ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 882bdcd8170SKalle Valo 8831276c9efSEdward Lu kfree(channels); 8841276c9efSEdward Lu 885bdcd8170SKalle Valo return ret; 886bdcd8170SKalle Valo } 887bdcd8170SKalle Valo 8881c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 889bdcd8170SKalle Valo { 890240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 8916fd1eaceSKalle Valo int i; 892bdcd8170SKalle Valo 8931c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 8941c17d313SKalle Valo aborted ? " aborted" : ""); 895bdcd8170SKalle Valo 89614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 8976fd1eaceSKalle Valo return; 8986fd1eaceSKalle Valo 8991c17d313SKalle Valo if (aborted) 9006fd1eaceSKalle Valo goto out; 901bdcd8170SKalle Valo 90214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 90314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 904334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 905334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 906bdcd8170SKalle Valo 0, NULL); 907bdcd8170SKalle Valo } 908bdcd8170SKalle Valo } 9096fd1eaceSKalle Valo 9106fd1eaceSKalle Valo out: 911cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 91214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 913bdcd8170SKalle Valo } 914bdcd8170SKalle Valo 915bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 916bdcd8170SKalle Valo u8 key_index, bool pairwise, 917bdcd8170SKalle Valo const u8 *mac_addr, 918bdcd8170SKalle Valo struct key_params *params) 919bdcd8170SKalle Valo { 920bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 92159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 922bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 923bdcd8170SKalle Valo u8 key_usage; 924bdcd8170SKalle Valo u8 key_type; 925bdcd8170SKalle Valo 926990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 927bdcd8170SKalle Valo return -EIO; 928bdcd8170SKalle Valo 929837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 930837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 931837cb97eSJouni Malinen return -EINVAL; 932240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 933240d2799SVasanthakumar Thiagarajan params->key); 934837cb97eSJouni Malinen } 935837cb97eSJouni Malinen 936bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 937bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 938bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 939bdcd8170SKalle Valo key_index); 940bdcd8170SKalle Valo return -ENOENT; 941bdcd8170SKalle Valo } 942bdcd8170SKalle Valo 9436f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 944bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 945bdcd8170SKalle Valo 946bdcd8170SKalle Valo if (pairwise) 947bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 948bdcd8170SKalle Valo else 949bdcd8170SKalle Valo key_usage = GROUP_USAGE; 950bdcd8170SKalle Valo 951bdcd8170SKalle Valo if (params) { 9525e07021eSDai Shuibing int seq_len = params->seq_len; 9535e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 9545e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 9555e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 9565e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 9575e07021eSDai Shuibing } 958bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 9595e07021eSDai Shuibing seq_len > sizeof(key->seq)) 960bdcd8170SKalle Valo return -EINVAL; 961bdcd8170SKalle Valo 962bdcd8170SKalle Valo key->key_len = params->key_len; 963bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 9645e07021eSDai Shuibing key->seq_len = seq_len; 965bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 966bdcd8170SKalle Valo key->cipher = params->cipher; 967bdcd8170SKalle Valo } 968bdcd8170SKalle Valo 969bdcd8170SKalle Valo switch (key->cipher) { 970bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 971bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 972bdcd8170SKalle Valo key_type = WEP_CRYPT; 973bdcd8170SKalle Valo break; 974bdcd8170SKalle Valo 975bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 976bdcd8170SKalle Valo key_type = TKIP_CRYPT; 977bdcd8170SKalle Valo break; 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 980bdcd8170SKalle Valo key_type = AES_CRYPT; 981bdcd8170SKalle Valo break; 9825e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 9835e07021eSDai Shuibing key_type = WAPI_CRYPT; 9845e07021eSDai Shuibing break; 985bdcd8170SKalle Valo 986bdcd8170SKalle Valo default: 987bdcd8170SKalle Valo return -ENOTSUPP; 988bdcd8170SKalle Valo } 989bdcd8170SKalle Valo 9903450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 9913450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 992bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 993de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 994bdcd8170SKalle Valo 995bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 996bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 997bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 998bdcd8170SKalle Valo key_usage, key->seq_len); 999bdcd8170SKalle Valo 1000f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10019a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 10029a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10039a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10049a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10059a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10069a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 100759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10089a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10099a5b1318SJouni Malinen "key configuration until AP mode has been " 10109a5b1318SJouni Malinen "started\n"); 10119a5b1318SJouni Malinen /* 10129a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10139a5b1318SJouni Malinen * the connected event is received from the target. 10149a5b1318SJouni Malinen */ 10159a5b1318SJouni Malinen return 0; 10169a5b1318SJouni Malinen } 10179a5b1318SJouni Malinen } 10189a5b1318SJouni Malinen 1019f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 102059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1021151411e8SJouni Malinen /* 1022151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1023151411e8SJouni Malinen * the AP mode has properly started 1024151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1025151411e8SJouni Malinen */ 1026151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1027151411e8SJouni Malinen "until AP mode has been started\n"); 10286f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10296f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10306f2a73f9SVasanthakumar Thiagarajan key->key_len); 1031151411e8SJouni Malinen return 0; 1032151411e8SJouni Malinen } 1033151411e8SJouni Malinen 10347cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1035bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1036f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1037f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1038bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1039bdcd8170SKalle Valo } 1040bdcd8170SKalle Valo 1041bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1042bdcd8170SKalle Valo u8 key_index, bool pairwise, 1043bdcd8170SKalle Valo const u8 *mac_addr) 1044bdcd8170SKalle Valo { 1045bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 10466f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1047bdcd8170SKalle Valo 1048bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1049bdcd8170SKalle Valo 1050990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1051bdcd8170SKalle Valo return -EIO; 1052bdcd8170SKalle Valo 1053bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1054bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1055bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1056bdcd8170SKalle Valo key_index); 1057bdcd8170SKalle Valo return -ENOENT; 1058bdcd8170SKalle Valo } 1059bdcd8170SKalle Valo 10606f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1061bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1062bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1063bdcd8170SKalle Valo return 0; 1064bdcd8170SKalle Valo } 1065bdcd8170SKalle Valo 10666f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1067bdcd8170SKalle Valo 1068334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1069bdcd8170SKalle Valo } 1070bdcd8170SKalle Valo 1071bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1072bdcd8170SKalle Valo u8 key_index, bool pairwise, 1073bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1074bdcd8170SKalle Valo void (*callback) (void *cookie, 1075bdcd8170SKalle Valo struct key_params *)) 1076bdcd8170SKalle Valo { 10776f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1078bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1079bdcd8170SKalle Valo struct key_params params; 1080bdcd8170SKalle Valo 1081bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1082bdcd8170SKalle Valo 1083990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1084bdcd8170SKalle Valo return -EIO; 1085bdcd8170SKalle Valo 1086bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1087bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1088bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1089bdcd8170SKalle Valo key_index); 1090bdcd8170SKalle Valo return -ENOENT; 1091bdcd8170SKalle Valo } 1092bdcd8170SKalle Valo 10936f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1094bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1095bdcd8170SKalle Valo params.cipher = key->cipher; 1096bdcd8170SKalle Valo params.key_len = key->key_len; 1097bdcd8170SKalle Valo params.seq_len = key->seq_len; 1098bdcd8170SKalle Valo params.seq = key->seq; 1099bdcd8170SKalle Valo params.key = key->key; 1100bdcd8170SKalle Valo 1101bdcd8170SKalle Valo callback(cookie, ¶ms); 1102bdcd8170SKalle Valo 1103bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1104bdcd8170SKalle Valo } 1105bdcd8170SKalle Valo 1106bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1107bdcd8170SKalle Valo struct net_device *ndev, 1108bdcd8170SKalle Valo u8 key_index, bool unicast, 1109bdcd8170SKalle Valo bool multicast) 1110bdcd8170SKalle Valo { 1111bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 111259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1113bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1114bdcd8170SKalle Valo u8 key_usage; 1115229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1116bdcd8170SKalle Valo 1117bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1118bdcd8170SKalle Valo 1119990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1120bdcd8170SKalle Valo return -EIO; 1121bdcd8170SKalle Valo 1122bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1123bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1124bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1125bdcd8170SKalle Valo __func__, key_index); 1126bdcd8170SKalle Valo return -ENOENT; 1127bdcd8170SKalle Valo } 1128bdcd8170SKalle Valo 11296f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1130bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1131bdcd8170SKalle Valo __func__, key_index); 1132bdcd8170SKalle Valo return -EINVAL; 1133bdcd8170SKalle Valo } 1134bdcd8170SKalle Valo 11353450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11366f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1137bdcd8170SKalle Valo key_usage = GROUP_USAGE; 11383450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1139bdcd8170SKalle Valo key_usage |= TX_USAGE; 1140229ed6b5SEdward Lu if (unicast) 11413450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1142229ed6b5SEdward Lu if (multicast) 11433450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1144bdcd8170SKalle Valo 1145f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 11469a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 11479a5b1318SJouni Malinen 1148f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1149334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1150229ed6b5SEdward Lu key_type, key_usage, 1151f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1152f4bb9a6fSJouni Malinen key->key, 1153bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1154bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1155bdcd8170SKalle Valo } 1156bdcd8170SKalle Valo 1157240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1158bdcd8170SKalle Valo bool ismcast) 1159bdcd8170SKalle Valo { 1160bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1161bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1162bdcd8170SKalle Valo 1163240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1164bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1165bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1166bdcd8170SKalle Valo GFP_KERNEL); 1167bdcd8170SKalle Valo } 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1170bdcd8170SKalle Valo { 1171bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1172990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1173bdcd8170SKalle Valo int ret; 1174bdcd8170SKalle Valo 1175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1176bdcd8170SKalle Valo changed); 1177bdcd8170SKalle Valo 1178990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1179990bd915SVasanthakumar Thiagarajan if (!vif) 1180990bd915SVasanthakumar Thiagarajan return -EIO; 1181990bd915SVasanthakumar Thiagarajan 1182990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1183bdcd8170SKalle Valo return -EIO; 1184bdcd8170SKalle Valo 1185bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1186bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1187bdcd8170SKalle Valo if (ret != 0) { 1188bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1189bdcd8170SKalle Valo return -EIO; 1190bdcd8170SKalle Valo } 1191bdcd8170SKalle Valo } 1192bdcd8170SKalle Valo 1193bdcd8170SKalle Valo return 0; 1194bdcd8170SKalle Valo } 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo /* 1197bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1198bdcd8170SKalle Valo * data type from 2.6.36 onwards 1199bdcd8170SKalle Valo */ 1200bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1201bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1202bdcd8170SKalle Valo int dbm) 1203bdcd8170SKalle Valo { 1204bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1205990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1206bdcd8170SKalle Valo u8 ath6kl_dbm; 1207bdcd8170SKalle Valo 1208bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1209bdcd8170SKalle Valo type, dbm); 1210bdcd8170SKalle Valo 1211990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1212990bd915SVasanthakumar Thiagarajan if (!vif) 1213990bd915SVasanthakumar Thiagarajan return -EIO; 1214990bd915SVasanthakumar Thiagarajan 1215990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1216bdcd8170SKalle Valo return -EIO; 1217bdcd8170SKalle Valo 1218bdcd8170SKalle Valo switch (type) { 1219bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1220bdcd8170SKalle Valo return 0; 1221bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1222bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1223bdcd8170SKalle Valo break; 1224bdcd8170SKalle Valo default: 1225bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1226bdcd8170SKalle Valo __func__, type); 1227bdcd8170SKalle Valo return -EOPNOTSUPP; 1228bdcd8170SKalle Valo } 1229bdcd8170SKalle Valo 1230990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1231bdcd8170SKalle Valo 1232bdcd8170SKalle Valo return 0; 1233bdcd8170SKalle Valo } 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1236bdcd8170SKalle Valo { 1237bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1238990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1239bdcd8170SKalle Valo 1240990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1241990bd915SVasanthakumar Thiagarajan if (!vif) 1242990bd915SVasanthakumar Thiagarajan return -EIO; 1243990bd915SVasanthakumar Thiagarajan 1244990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1245bdcd8170SKalle Valo return -EIO; 1246bdcd8170SKalle Valo 124759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1248bdcd8170SKalle Valo ar->tx_pwr = 0; 1249bdcd8170SKalle Valo 1250990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1251bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1252bdcd8170SKalle Valo return -EIO; 1253bdcd8170SKalle Valo } 1254bdcd8170SKalle Valo 1255bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1256bdcd8170SKalle Valo 5 * HZ); 1257bdcd8170SKalle Valo 1258bdcd8170SKalle Valo if (signal_pending(current)) { 1259bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1260bdcd8170SKalle Valo return -EINTR; 1261bdcd8170SKalle Valo } 1262bdcd8170SKalle Valo } 1263bdcd8170SKalle Valo 1264bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1265bdcd8170SKalle Valo return 0; 1266bdcd8170SKalle Valo } 1267bdcd8170SKalle Valo 1268bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1269bdcd8170SKalle Valo struct net_device *dev, 1270bdcd8170SKalle Valo bool pmgmt, int timeout) 1271bdcd8170SKalle Valo { 1272bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1273bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1274334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1275bdcd8170SKalle Valo 1276bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1277bdcd8170SKalle Valo __func__, pmgmt, timeout); 1278bdcd8170SKalle Valo 1279990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1280bdcd8170SKalle Valo return -EIO; 1281bdcd8170SKalle Valo 1282bdcd8170SKalle Valo if (pmgmt) { 1283bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1284bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1285bdcd8170SKalle Valo } else { 1286bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1287bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo 1290334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1291334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1292bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1293bdcd8170SKalle Valo return -EIO; 1294bdcd8170SKalle Valo } 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo return 0; 1297bdcd8170SKalle Valo } 1298bdcd8170SKalle Valo 129955055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 130055055976SVasanthakumar Thiagarajan char *name, 130155055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 130255055976SVasanthakumar Thiagarajan u32 *flags, 130355055976SVasanthakumar Thiagarajan struct vif_params *params) 130455055976SVasanthakumar Thiagarajan { 130555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 130655055976SVasanthakumar Thiagarajan struct net_device *ndev; 130755055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 130855055976SVasanthakumar Thiagarajan 130955055976SVasanthakumar Thiagarajan if (ar->num_vif == MAX_NUM_VIF) { 131055055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 131155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 131255055976SVasanthakumar Thiagarajan } 131355055976SVasanthakumar Thiagarajan 131455055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 131555055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 131655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 131755055976SVasanthakumar Thiagarajan } 131855055976SVasanthakumar Thiagarajan 131955055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 132055055976SVasanthakumar Thiagarajan if (!ndev) 132155055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 132255055976SVasanthakumar Thiagarajan 132355055976SVasanthakumar Thiagarajan ar->num_vif++; 132455055976SVasanthakumar Thiagarajan 132555055976SVasanthakumar Thiagarajan return ndev; 132655055976SVasanthakumar Thiagarajan } 132755055976SVasanthakumar Thiagarajan 132855055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 132955055976SVasanthakumar Thiagarajan struct net_device *ndev) 133055055976SVasanthakumar Thiagarajan { 133155055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 133255055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 133355055976SVasanthakumar Thiagarajan 133411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 133555055976SVasanthakumar Thiagarajan list_del(&vif->list); 133611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 133755055976SVasanthakumar Thiagarajan 133855055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 133955055976SVasanthakumar Thiagarajan 134055055976SVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 134155055976SVasanthakumar Thiagarajan 134255055976SVasanthakumar Thiagarajan return 0; 134355055976SVasanthakumar Thiagarajan } 134455055976SVasanthakumar Thiagarajan 1345bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1346bdcd8170SKalle Valo struct net_device *ndev, 1347bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1348bdcd8170SKalle Valo struct vif_params *params) 1349bdcd8170SKalle Valo { 1350f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1353bdcd8170SKalle Valo 1354990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1355bdcd8170SKalle Valo return -EIO; 1356bdcd8170SKalle Valo 1357bdcd8170SKalle Valo switch (type) { 1358bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1359f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1360bdcd8170SKalle Valo break; 1361bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1362f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1363bdcd8170SKalle Valo break; 13646e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1365f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13666e4604c8SJouni Malinen break; 13676b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1368f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 13696b5e5d25SJouni Malinen break; 13706b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1371f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 13726b5e5d25SJouni Malinen break; 1373bdcd8170SKalle Valo default: 1374bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1375bdcd8170SKalle Valo return -EOPNOTSUPP; 1376bdcd8170SKalle Valo } 1377bdcd8170SKalle Valo 1378551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1379bdcd8170SKalle Valo 1380bdcd8170SKalle Valo return 0; 1381bdcd8170SKalle Valo } 1382bdcd8170SKalle Valo 1383bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1384bdcd8170SKalle Valo struct net_device *dev, 1385bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1386bdcd8170SKalle Valo { 1387bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 138859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1389bdcd8170SKalle Valo int status; 1390bdcd8170SKalle Valo 1391990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1392bdcd8170SKalle Valo return -EIO; 1393bdcd8170SKalle Valo 13943450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 13953450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1396bdcd8170SKalle Valo 1397bdcd8170SKalle Valo if (ibss_param->channel) 1398f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1399bdcd8170SKalle Valo 1400bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1401bdcd8170SKalle Valo /* 1402bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1403bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1404bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1405bdcd8170SKalle Valo * updated. 1406bdcd8170SKalle Valo */ 1407bdcd8170SKalle Valo return -EOPNOTSUPP; 1408bdcd8170SKalle Valo } 1409bdcd8170SKalle Valo 14108c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1411bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14128c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14138c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1414bdcd8170SKalle Valo 1415240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1416bdcd8170SKalle Valo 1417240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1418bdcd8170SKalle Valo if (status) 1419bdcd8170SKalle Valo return status; 1420bdcd8170SKalle Valo 1421bdcd8170SKalle Valo if (ibss_param->privacy) { 1422240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1423240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1424bdcd8170SKalle Valo } else { 1425240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1426240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1427bdcd8170SKalle Valo } 1428bdcd8170SKalle Valo 1429f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1430bdcd8170SKalle Valo 1431bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1432bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1433bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1434bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1435bdcd8170SKalle Valo __func__, 14363450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14373450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1438f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1439bdcd8170SKalle Valo 1440334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 14413450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 14423450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 14433450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 14443450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 14453450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1446f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 1447bdcd8170SKalle Valo ar->connect_ctrl_flags); 144859c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1449bdcd8170SKalle Valo 1450bdcd8170SKalle Valo return 0; 1451bdcd8170SKalle Valo } 1452bdcd8170SKalle Valo 1453bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1454bdcd8170SKalle Valo struct net_device *dev) 1455bdcd8170SKalle Valo { 14563450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1457bdcd8170SKalle Valo 1458990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1459bdcd8170SKalle Valo return -EIO; 1460bdcd8170SKalle Valo 1461240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 14623450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 14633450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo return 0; 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1469bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1470bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1471bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1472bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1473837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 14745e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1475bdcd8170SKalle Valo }; 1476bdcd8170SKalle Valo 1477bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1478bdcd8170SKalle Valo { 1479bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1480bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1481bdcd8170SKalle Valo 36000, 48000, 54000 1482bdcd8170SKalle Valo }; 1483bdcd8170SKalle Valo u8 i; 1484bdcd8170SKalle Valo 1485bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1486bdcd8170SKalle Valo if (rate == legacy[i]) 1487bdcd8170SKalle Valo return true; 1488bdcd8170SKalle Valo 1489bdcd8170SKalle Valo return false; 1490bdcd8170SKalle Valo } 1491bdcd8170SKalle Valo 1492bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1493bdcd8170SKalle Valo { 1494bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1495bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1496bdcd8170SKalle Valo }; 1497bdcd8170SKalle Valo u8 i; 1498bdcd8170SKalle Valo 1499bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1500bdcd8170SKalle Valo if (rate == ht20[i]) { 1501bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1502bdcd8170SKalle Valo /* last rate uses sgi */ 1503bdcd8170SKalle Valo *sgi = true; 1504bdcd8170SKalle Valo else 1505bdcd8170SKalle Valo *sgi = false; 1506bdcd8170SKalle Valo 1507bdcd8170SKalle Valo *mcs = i; 1508bdcd8170SKalle Valo return true; 1509bdcd8170SKalle Valo } 1510bdcd8170SKalle Valo } 1511bdcd8170SKalle Valo return false; 1512bdcd8170SKalle Valo } 1513bdcd8170SKalle Valo 1514bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1515bdcd8170SKalle Valo { 1516bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1517bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1518bdcd8170SKalle Valo 150000 1519bdcd8170SKalle Valo }; 1520bdcd8170SKalle Valo u8 i; 1521bdcd8170SKalle Valo 1522bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1523bdcd8170SKalle Valo if (rate == ht40[i]) { 1524bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1525bdcd8170SKalle Valo /* last rate uses sgi */ 1526bdcd8170SKalle Valo *sgi = true; 1527bdcd8170SKalle Valo else 1528bdcd8170SKalle Valo *sgi = false; 1529bdcd8170SKalle Valo 1530bdcd8170SKalle Valo *mcs = i; 1531bdcd8170SKalle Valo return true; 1532bdcd8170SKalle Valo } 1533bdcd8170SKalle Valo } 1534bdcd8170SKalle Valo 1535bdcd8170SKalle Valo return false; 1536bdcd8170SKalle Valo } 1537bdcd8170SKalle Valo 1538bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1539bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1540bdcd8170SKalle Valo { 1541bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 154259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1543bdcd8170SKalle Valo long left; 1544bdcd8170SKalle Valo bool sgi; 1545bdcd8170SKalle Valo s32 rate; 1546bdcd8170SKalle Valo int ret; 1547bdcd8170SKalle Valo u8 mcs; 1548bdcd8170SKalle Valo 15498c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1550bdcd8170SKalle Valo return -ENOENT; 1551bdcd8170SKalle Valo 1552bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1553bdcd8170SKalle Valo return -EBUSY; 1554bdcd8170SKalle Valo 1555b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1556bdcd8170SKalle Valo 1557334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1558bdcd8170SKalle Valo 1559bdcd8170SKalle Valo if (ret != 0) { 1560bdcd8170SKalle Valo up(&ar->sem); 1561bdcd8170SKalle Valo return -EIO; 1562bdcd8170SKalle Valo } 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1565bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1566b95907a7SVasanthakumar Thiagarajan &vif->flags), 1567bdcd8170SKalle Valo WMI_TIMEOUT); 1568bdcd8170SKalle Valo 1569bdcd8170SKalle Valo up(&ar->sem); 1570bdcd8170SKalle Valo 1571bdcd8170SKalle Valo if (left == 0) 1572bdcd8170SKalle Valo return -ETIMEDOUT; 1573bdcd8170SKalle Valo else if (left < 0) 1574bdcd8170SKalle Valo return left; 1575bdcd8170SKalle Valo 1576b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1577b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1578bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1579b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1580bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1581bdcd8170SKalle Valo } 1582bdcd8170SKalle Valo 1583b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1584b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1585bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1586b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1587bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1588bdcd8170SKalle Valo } 1589bdcd8170SKalle Valo 1590b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1591bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1592bdcd8170SKalle Valo 1593b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1594bdcd8170SKalle Valo 1595bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1596bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1597bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1598bdcd8170SKalle Valo if (sgi) { 1599bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1600bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1601bdcd8170SKalle Valo } else { 1602bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1603bdcd8170SKalle Valo } 1604bdcd8170SKalle Valo 1605bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1606bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1607bdcd8170SKalle Valo if (sgi) { 1608bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1609bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1610bdcd8170SKalle Valo } else { 1611bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1612bdcd8170SKalle Valo } 1613bdcd8170SKalle Valo 1614bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1615bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1616bdcd8170SKalle Valo } else { 16179a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16189a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16199a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1620bdcd8170SKalle Valo return 0; 1621bdcd8170SKalle Valo } 1622bdcd8170SKalle Valo 1623bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1624bdcd8170SKalle Valo 162559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 162659c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1627f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 162832c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 162932c10874SJouni Malinen sinfo->bss_param.flags = 0; 1630cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1631cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 163232c10874SJouni Malinen } 163332c10874SJouni Malinen 1634bdcd8170SKalle Valo return 0; 1635bdcd8170SKalle Valo } 1636bdcd8170SKalle Valo 1637bdcd8170SKalle Valo static int ath6kl_set_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, true); 1645bdcd8170SKalle Valo } 1646bdcd8170SKalle Valo 1647bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1648bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1649bdcd8170SKalle Valo { 1650bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1651334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1652334234b5SVasanthakumar Thiagarajan 1653334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1654bdcd8170SKalle Valo pmksa->pmkid, false); 1655bdcd8170SKalle Valo } 1656bdcd8170SKalle Valo 1657bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1658bdcd8170SKalle Valo { 1659bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 166059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 166159c98449SVasanthakumar Thiagarajan 166259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1663334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1664334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1665bdcd8170SKalle Valo return 0; 1666bdcd8170SKalle Valo } 1667bdcd8170SKalle Valo 16686cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 16696cb3c714SRaja Mani { 16706cb3c714SRaja Mani struct ath6kl_vif *vif; 16716cb3c714SRaja Mani int ret, pos, left; 16726cb3c714SRaja Mani u32 filter = 0; 16736cb3c714SRaja Mani u16 i; 16746cb3c714SRaja Mani u8 mask[WOW_MASK_SIZE]; 16756cb3c714SRaja Mani 16766cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 16776cb3c714SRaja Mani if (!vif) 16786cb3c714SRaja Mani return -EIO; 16796cb3c714SRaja Mani 16806cb3c714SRaja Mani if (!ath6kl_cfg80211_ready(vif)) 16816cb3c714SRaja Mani return -EIO; 16826cb3c714SRaja Mani 16836cb3c714SRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 16846cb3c714SRaja Mani return -EINVAL; 16856cb3c714SRaja Mani 16866cb3c714SRaja Mani /* Clear existing WOW patterns */ 16876cb3c714SRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 16886cb3c714SRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 16896cb3c714SRaja Mani WOW_LIST_ID, i); 16906cb3c714SRaja Mani /* Configure new WOW patterns */ 16916cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 16926cb3c714SRaja Mani 16936cb3c714SRaja Mani /* 16946cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 16956cb3c714SRaja Mani * driver specific mask value and send it to the chip along 16966cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 16976cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 16986cb3c714SRaja Mani * then equivalent driver specific mask value is 16996cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17006cb3c714SRaja Mani */ 17016cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17026cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17036cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17046cb3c714SRaja Mani mask[pos] = 0xFF; 17056cb3c714SRaja Mani } 17066cb3c714SRaja Mani /* 17076cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17086cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17096cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17106cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17116cb3c714SRaja Mani */ 17126cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17136cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17146cb3c714SRaja Mani wow->patterns[i].pattern_len, 17156cb3c714SRaja Mani 0 /* pattern offset */, 17166cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17176cb3c714SRaja Mani if (ret) 17186cb3c714SRaja Mani return ret; 17196cb3c714SRaja Mani } 17206cb3c714SRaja Mani 17216cb3c714SRaja Mani if (wow->disconnect) 17226cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 17236cb3c714SRaja Mani 17246cb3c714SRaja Mani if (wow->magic_pkt) 17256cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 17266cb3c714SRaja Mani 17276cb3c714SRaja Mani if (wow->gtk_rekey_failure) 17286cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_GTK_ERROR; 17296cb3c714SRaja Mani 17306cb3c714SRaja Mani if (wow->eap_identity_req) 17316cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_EAP_REQ; 17326cb3c714SRaja Mani 17336cb3c714SRaja Mani if (wow->four_way_handshake) 17346cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 17356cb3c714SRaja Mani 17366cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 17376cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 17386cb3c714SRaja Mani filter, 17396cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 17406cb3c714SRaja Mani if (ret) 17416cb3c714SRaja Mani return ret; 17426cb3c714SRaja Mani 17436cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 17446cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 17456cb3c714SRaja Mani if (ret) 17466cb3c714SRaja Mani return ret; 17476cb3c714SRaja Mani 17486cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 17496cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 17506cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 17516cb3c714SRaja Mani if (left == 0) { 17526cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 17536cb3c714SRaja Mani ret = -ETIMEDOUT; 17546cb3c714SRaja Mani } else if (left < 0) { 17556cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 17566cb3c714SRaja Mani ret = left; 17576cb3c714SRaja Mani } 17586cb3c714SRaja Mani } 17596cb3c714SRaja Mani 17606cb3c714SRaja Mani return ret; 17616cb3c714SRaja Mani } 17626cb3c714SRaja Mani 17636cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 17646cb3c714SRaja Mani { 17656cb3c714SRaja Mani struct ath6kl_vif *vif; 17666cb3c714SRaja Mani int ret; 17676cb3c714SRaja Mani 17686cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 17696cb3c714SRaja Mani if (!vif) 17706cb3c714SRaja Mani return -EIO; 17716cb3c714SRaja Mani 17726cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 17736cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 17746cb3c714SRaja Mani return ret; 17756cb3c714SRaja Mani } 17766cb3c714SRaja Mani 177752d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 17780f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 17790f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 178052d81a68SKalle Valo { 178152d81a68SKalle Valo int ret; 178252d81a68SKalle Valo 178352d81a68SKalle Valo switch (mode) { 1784d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 1785d7c44e0bSRaja Mani 1786d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 1787d7c44e0bSRaja Mani 1788d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 1789d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 1790d7c44e0bSRaja Mani 1791d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 1792d7c44e0bSRaja Mani if (ret) { 1793d7c44e0bSRaja Mani ath6kl_err("wow suspend failed: %d\n", ret); 1794d7c44e0bSRaja Mani return ret; 1795d7c44e0bSRaja Mani } 1796d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 1797d7c44e0bSRaja Mani break; 1798d7c44e0bSRaja Mani 179952d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 1800524441e3SRaja Mani 1801524441e3SRaja Mani ath6kl_cfg80211_stop(ar); 1802524441e3SRaja Mani 180352d81a68SKalle Valo /* save the current power mode before enabling power save */ 180452d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 180552d81a68SKalle Valo 180652d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 180752d81a68SKalle Valo if (ret) { 180852d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 180952d81a68SKalle Valo ret); 181052d81a68SKalle Valo } 181152d81a68SKalle Valo 181276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 181376a9fbe2SKalle Valo 181452d81a68SKalle Valo break; 1815b4b2a0b1SKalle Valo 1816b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1817524441e3SRaja Mani 1818524441e3SRaja Mani ath6kl_cfg80211_stop(ar); 1819524441e3SRaja Mani 1820b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1821b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1822b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1823b4b2a0b1SKalle Valo break; 1824b4b2a0b1SKalle Valo } 1825b4b2a0b1SKalle Valo 1826b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1827b4b2a0b1SKalle Valo 1828b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1829b4b2a0b1SKalle Valo if (ret) { 1830b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1831b4b2a0b1SKalle Valo ret); 1832b4b2a0b1SKalle Valo } 1833b4b2a0b1SKalle Valo 1834b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1835b4b2a0b1SKalle Valo 1836b4b2a0b1SKalle Valo break; 1837b4b2a0b1SKalle Valo 1838b4b2a0b1SKalle Valo default: 1839b4b2a0b1SKalle Valo break; 184052d81a68SKalle Valo } 184152d81a68SKalle Valo 184252d81a68SKalle Valo return 0; 184352d81a68SKalle Valo } 184452d81a68SKalle Valo 184552d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 184652d81a68SKalle Valo { 184776a9fbe2SKalle Valo int ret; 184876a9fbe2SKalle Valo 184976a9fbe2SKalle Valo switch (ar->state) { 1850d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 1851d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 1852d7c44e0bSRaja Mani 1853d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 1854d7c44e0bSRaja Mani if (ret) { 1855d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 1856d7c44e0bSRaja Mani return ret; 1857d7c44e0bSRaja Mani } 1858d7c44e0bSRaja Mani 1859d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_ON; 1860d7c44e0bSRaja Mani break; 1861d7c44e0bSRaja Mani 186276a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 186352d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 186476a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 186576a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 186676a9fbe2SKalle Valo if (ret) { 186776a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 186876a9fbe2SKalle Valo ret); 186976a9fbe2SKalle Valo } 187076a9fbe2SKalle Valo } 187176a9fbe2SKalle Valo 187276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 187376a9fbe2SKalle Valo 187476a9fbe2SKalle Valo break; 187576a9fbe2SKalle Valo 1876b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1877b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1878b4b2a0b1SKalle Valo 1879b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1880b4b2a0b1SKalle Valo if (ret) { 1881b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1882b4b2a0b1SKalle Valo return ret; 1883b4b2a0b1SKalle Valo } 1884d7c44e0bSRaja Mani break; 1885b4b2a0b1SKalle Valo 188676a9fbe2SKalle Valo default: 188776a9fbe2SKalle Valo break; 188852d81a68SKalle Valo } 188952d81a68SKalle Valo 189052d81a68SKalle Valo return 0; 189152d81a68SKalle Valo } 189252d81a68SKalle Valo 1893abcb344bSKalle Valo #ifdef CONFIG_PM 189452d81a68SKalle Valo 189552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 189652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 1897abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1898abcb344bSKalle Valo { 1899abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1900abcb344bSKalle Valo 19010f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 1902abcb344bSKalle Valo } 1903aa6cffc1SChilam Ng 190452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 1905aa6cffc1SChilam Ng { 1906aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1907aa6cffc1SChilam Ng 1908aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1909aa6cffc1SChilam Ng } 1910a918fb3cSRaja Mani 1911a918fb3cSRaja Mani /* 1912a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 1913a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 1914a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 1915a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 1916a918fb3cSRaja Mani * 1917a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 1918a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 1919a918fb3cSRaja Mani * 1920a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 1921a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 1922a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 1923a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 1924a918fb3cSRaja Mani * 1925a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 1926a918fb3cSRaja Mani */ 1927a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 1928a918fb3cSRaja Mani { 1929a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 1930a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 1931a918fb3cSRaja Mani } 1932a918fb3cSRaja Mani 1933a918fb3cSRaja Mani #else 1934a918fb3cSRaja Mani 1935a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 1936a918fb3cSRaja Mani { 1937a918fb3cSRaja Mani } 1938abcb344bSKalle Valo #endif 1939abcb344bSKalle Valo 19406a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 19416a7c9badSJouni Malinen struct ieee80211_channel *chan, 19426a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 19436a7c9badSJouni Malinen { 1944cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 19456a7c9badSJouni Malinen 1946990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 19476a7c9badSJouni Malinen return -EIO; 19486a7c9badSJouni Malinen 19496a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 19506a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 1951cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 19526a7c9badSJouni Malinen 19536a7c9badSJouni Malinen return 0; 19546a7c9badSJouni Malinen } 19556a7c9badSJouni Malinen 19568bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 19578bdfbf40SJouni Malinen { 19588bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 19598bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 19608bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 19618bdfbf40SJouni Malinen } 19628bdfbf40SJouni Malinen 1963334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 1964334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 19658bdfbf40SJouni Malinen { 1966334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 19678bdfbf40SJouni Malinen const u8 *pos; 19688bdfbf40SJouni Malinen u8 *buf = NULL; 19698bdfbf40SJouni Malinen size_t len = 0; 19708bdfbf40SJouni Malinen int ret; 19718bdfbf40SJouni Malinen 19728bdfbf40SJouni Malinen /* 19738bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 19748bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 19758bdfbf40SJouni Malinen */ 19768bdfbf40SJouni Malinen 19778bdfbf40SJouni Malinen if (ies && ies_len) { 19788bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 19798bdfbf40SJouni Malinen if (buf == NULL) 19808bdfbf40SJouni Malinen return -ENOMEM; 19818bdfbf40SJouni Malinen pos = ies; 19828bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 19838bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 19848bdfbf40SJouni Malinen break; 19858bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 19868bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 19878bdfbf40SJouni Malinen len += 2 + pos[1]; 19888bdfbf40SJouni Malinen } 19898bdfbf40SJouni Malinen pos += 2 + pos[1]; 19908bdfbf40SJouni Malinen } 19918bdfbf40SJouni Malinen } 19928bdfbf40SJouni Malinen 1993334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 1994334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 19958bdfbf40SJouni Malinen kfree(buf); 19968bdfbf40SJouni Malinen return ret; 19978bdfbf40SJouni Malinen } 19988bdfbf40SJouni Malinen 19996a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 20006a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 20016a7c9badSJouni Malinen { 20026a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 20033450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 20046a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 20056a7c9badSJouni Malinen u8 *ies; 20066a7c9badSJouni Malinen int ies_len; 20076a7c9badSJouni Malinen struct wmi_connect_cmd p; 20086a7c9badSJouni Malinen int res; 2009be5abaafSVasanthakumar Thiagarajan int i, ret; 20106a7c9badSJouni Malinen 20116a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 20126a7c9badSJouni Malinen 2013990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 20146a7c9badSJouni Malinen return -EIO; 20156a7c9badSJouni Malinen 2016f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 20176a7c9badSJouni Malinen return -EOPNOTSUPP; 20186a7c9badSJouni Malinen 20196a7c9badSJouni Malinen if (info->beacon_ies) { 2020334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2021334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 20226a7c9badSJouni Malinen info->beacon_ies, 20236a7c9badSJouni Malinen info->beacon_ies_len); 20246a7c9badSJouni Malinen if (res) 20256a7c9badSJouni Malinen return res; 20266a7c9badSJouni Malinen } 20276a7c9badSJouni Malinen if (info->proberesp_ies) { 2028334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 20296a7c9badSJouni Malinen info->proberesp_ies_len); 20306a7c9badSJouni Malinen if (res) 20316a7c9badSJouni Malinen return res; 20326a7c9badSJouni Malinen } 20336a7c9badSJouni Malinen if (info->assocresp_ies) { 2034334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2035334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 20366a7c9badSJouni Malinen info->assocresp_ies, 20376a7c9badSJouni Malinen info->assocresp_ies_len); 20386a7c9badSJouni Malinen if (res) 20396a7c9badSJouni Malinen return res; 20406a7c9badSJouni Malinen } 20416a7c9badSJouni Malinen 20426a7c9badSJouni Malinen if (!add) 20436a7c9badSJouni Malinen return 0; 20446a7c9badSJouni Malinen 20459a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 20469a5b1318SJouni Malinen 20476a7c9badSJouni Malinen /* TODO: 20486a7c9badSJouni Malinen * info->interval 20496a7c9badSJouni Malinen * info->dtim_period 20506a7c9badSJouni Malinen */ 20516a7c9badSJouni Malinen 20526a7c9badSJouni Malinen if (info->head == NULL) 20536a7c9badSJouni Malinen return -EINVAL; 20546a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 20556a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 20566a7c9badSJouni Malinen if (ies > info->head + info->head_len) 20576a7c9badSJouni Malinen return -EINVAL; 20586a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 20596a7c9badSJouni Malinen 20606a7c9badSJouni Malinen if (info->ssid == NULL) 20616a7c9badSJouni Malinen return -EINVAL; 20623450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 20633450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 20646a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 20656a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 20666a7c9badSJouni Malinen 2067be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2068be5abaafSVasanthakumar Thiagarajan if (ret) 2069be5abaafSVasanthakumar Thiagarajan return ret; 20706a7c9badSJouni Malinen 20716a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 20726a7c9badSJouni Malinen 20736a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 20746a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 20756a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 20766a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 20776a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 20786a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 20796a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 20806a7c9badSJouni Malinen break; 20816a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 20826a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 20836a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 20846a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 20856a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 20866a7c9badSJouni Malinen break; 20876a7c9badSJouni Malinen } 20886a7c9badSJouni Malinen } 20896a7c9badSJouni Malinen if (p.auth_mode == 0) 20906a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 20913450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 20926a7c9badSJouni Malinen 20936a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 20946a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 20956a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 20966a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 20976a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 20986a7c9badSJouni Malinen break; 20996a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 21006a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 21016a7c9badSJouni Malinen break; 21026a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 21036a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 21046a7c9badSJouni Malinen break; 2105b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2106b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2107b8214df1SDai Shuibing break; 21086a7c9badSJouni Malinen } 21096a7c9badSJouni Malinen } 2110229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 21116a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2112240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2113229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2114240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 21156a7c9badSJouni Malinen 21166a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 21176a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 21186a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 21196a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 21206a7c9badSJouni Malinen break; 21216a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 21226a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 21236a7c9badSJouni Malinen break; 21246a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 21256a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 21266a7c9badSJouni Malinen break; 2127b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2128b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2129b8214df1SDai Shuibing break; 21306a7c9badSJouni Malinen default: 21316a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 21326a7c9badSJouni Malinen break; 21336a7c9badSJouni Malinen } 2134240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 21356a7c9badSJouni Malinen 21366a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2137f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 21386a7c9badSJouni Malinen 21393450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 21403450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 21413450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2142cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 21436a7c9badSJouni Malinen 2144334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 21459a5b1318SJouni Malinen if (res < 0) 21469a5b1318SJouni Malinen return res; 21479a5b1318SJouni Malinen 21489a5b1318SJouni Malinen return 0; 21496a7c9badSJouni Malinen } 21506a7c9badSJouni Malinen 21516a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 21526a7c9badSJouni Malinen struct beacon_parameters *info) 21536a7c9badSJouni Malinen { 21546a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 21556a7c9badSJouni Malinen } 21566a7c9badSJouni Malinen 21576a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 21586a7c9badSJouni Malinen struct beacon_parameters *info) 21596a7c9badSJouni Malinen { 21606a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 21616a7c9badSJouni Malinen } 21626a7c9badSJouni Malinen 21636a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 21646a7c9badSJouni Malinen { 21656a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 216659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 21676a7c9badSJouni Malinen 2168f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 21696a7c9badSJouni Malinen return -EOPNOTSUPP; 217059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 21716a7c9badSJouni Malinen return -ENOTCONN; 21726a7c9badSJouni Malinen 2173334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 217459c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 21756a7c9badSJouni Malinen 21766a7c9badSJouni Malinen return 0; 21776a7c9badSJouni Malinen } 21786a7c9badSJouni Malinen 217923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 218023875136SJouni Malinen u8 *mac, struct station_parameters *params) 218123875136SJouni Malinen { 218223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2183f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 218423875136SJouni Malinen 2185f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 218623875136SJouni Malinen return -EOPNOTSUPP; 218723875136SJouni Malinen 218823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 218923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 219023875136SJouni Malinen return -EOPNOTSUPP; 219123875136SJouni Malinen 219223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2193334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2194334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2195334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2196334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 219723875136SJouni Malinen } 219823875136SJouni Malinen 219963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 220063fa1e0cSJouni Malinen struct net_device *dev, 220163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 220263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 220363fa1e0cSJouni Malinen unsigned int duration, 220463fa1e0cSJouni Malinen u64 *cookie) 220563fa1e0cSJouni Malinen { 220663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2207334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22081052261eSJouni Malinen u32 id; 220963fa1e0cSJouni Malinen 221063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 221163fa1e0cSJouni Malinen * return -EBUSY */ 22121052261eSJouni Malinen id = ++vif->last_roc_id; 22131052261eSJouni Malinen if (id == 0) { 22141052261eSJouni Malinen /* Do not use 0 as the cookie value */ 22151052261eSJouni Malinen id = ++vif->last_roc_id; 22161052261eSJouni Malinen } 22171052261eSJouni Malinen *cookie = id; 221863fa1e0cSJouni Malinen 2219334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2220334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 222163fa1e0cSJouni Malinen } 222263fa1e0cSJouni Malinen 222363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 222463fa1e0cSJouni Malinen struct net_device *dev, 222563fa1e0cSJouni Malinen u64 cookie) 222663fa1e0cSJouni Malinen { 222763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2228334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 222963fa1e0cSJouni Malinen 22301052261eSJouni Malinen if (cookie != vif->last_roc_id) 223163fa1e0cSJouni Malinen return -ENOENT; 22321052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 223363fa1e0cSJouni Malinen 2234334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 223563fa1e0cSJouni Malinen } 223663fa1e0cSJouni Malinen 2237334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2238334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2239334234b5SVasanthakumar Thiagarajan unsigned int freq) 22408bdfbf40SJouni Malinen { 2241334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 22428bdfbf40SJouni Malinen const u8 *pos; 22438bdfbf40SJouni Malinen u8 *p2p; 22448bdfbf40SJouni Malinen int p2p_len; 22458bdfbf40SJouni Malinen int ret; 22468bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 22478bdfbf40SJouni Malinen 22488bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 22498bdfbf40SJouni Malinen 22508bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 22518bdfbf40SJouni Malinen 22528bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 22538bdfbf40SJouni Malinen if (p2p == NULL) 22548bdfbf40SJouni Malinen return -ENOMEM; 22558bdfbf40SJouni Malinen p2p_len = 0; 22568bdfbf40SJouni Malinen 22578bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 22588bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 22598bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 22608bdfbf40SJouni Malinen break; 22618bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 22628bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 22638bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 22648bdfbf40SJouni Malinen } 22658bdfbf40SJouni Malinen pos += 2 + pos[1]; 22668bdfbf40SJouni Malinen } 22678bdfbf40SJouni Malinen 2268334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2269334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 22708bdfbf40SJouni Malinen kfree(p2p); 22718bdfbf40SJouni Malinen return ret; 22728bdfbf40SJouni Malinen } 22738bdfbf40SJouni Malinen 22748a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 22758a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 22768a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 22778a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2278e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2279e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 22808a6c8060SJouni Malinen { 22818a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 228259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22838a6c8060SJouni Malinen u32 id; 22848bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 22858bdfbf40SJouni Malinen 22868bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 22878bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2288f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 22898bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 22908bdfbf40SJouni Malinen /* 22918bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 22928bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 22938bdfbf40SJouni Malinen */ 22948bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2295334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 22968bdfbf40SJouni Malinen chan->center_freq); 22978bdfbf40SJouni Malinen } 22988a6c8060SJouni Malinen 2299cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 23008a6c8060SJouni Malinen if (id == 0) { 23018a6c8060SJouni Malinen /* 23028a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 23038a6c8060SJouni Malinen * used for the command. 23048a6c8060SJouni Malinen */ 2305cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 23068a6c8060SJouni Malinen } 23078a6c8060SJouni Malinen 23088a6c8060SJouni Malinen *cookie = id; 2309334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2310334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 23118a6c8060SJouni Malinen buf, len); 23128a6c8060SJouni Malinen } 23138a6c8060SJouni Malinen 2314ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2315ae32c30aSJouni Malinen struct net_device *dev, 2316ae32c30aSJouni Malinen u16 frame_type, bool reg) 2317ae32c30aSJouni Malinen { 2318cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2319ae32c30aSJouni Malinen 2320ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2321ae32c30aSJouni Malinen __func__, frame_type, reg); 2322ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2323ae32c30aSJouni Malinen /* 2324ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2325ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2326ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2327ae32c30aSJouni Malinen */ 2328cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2329ae32c30aSJouni Malinen } 2330ae32c30aSJouni Malinen } 2331ae32c30aSJouni Malinen 2332f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2333f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2334f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2335f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2336f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2337f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2338f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2339f80574aeSJouni Malinen }, 2340f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2341f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2342f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2343f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2344f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2345f80574aeSJouni Malinen }, 2346f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2347f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2348f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2349f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2350f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2351f80574aeSJouni Malinen }, 2352f80574aeSJouni Malinen }; 2353f80574aeSJouni Malinen 2354bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 235555055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 235655055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2357bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2358bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2359bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2360bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2361bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2362bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2363bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2364bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2365bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2366bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2367bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2368bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2369bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2370bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2371bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2372bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2373bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2374bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2375003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2376abcb344bSKalle Valo #ifdef CONFIG_PM 237752d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 237852d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2379abcb344bSKalle Valo #endif 23806a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 23816a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 23826a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 23836a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 238423875136SJouni Malinen .change_station = ath6kl_change_station, 238563fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 238663fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 23878a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2388ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 2389bdcd8170SKalle Valo }; 2390bdcd8170SKalle Valo 2391ec4b7f60SKalle Valo void ath6kl_cfg80211_stop(struct ath6kl *ar) 2392ec4b7f60SKalle Valo { 2393ec4b7f60SKalle Valo struct ath6kl_vif *vif; 2394ec4b7f60SKalle Valo 2395ec4b7f60SKalle Valo /* FIXME: for multi vif */ 2396ec4b7f60SKalle Valo vif = ath6kl_vif_first(ar); 2397ec4b7f60SKalle Valo if (!vif) { 2398ec4b7f60SKalle Valo /* save the current power mode before enabling power save */ 2399ec4b7f60SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 2400ec4b7f60SKalle Valo 2401ec4b7f60SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 2402ec4b7f60SKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 2403ec4b7f60SKalle Valo "wmi_powermode_cmd failed\n"); 2404ec4b7f60SKalle Valo return; 2405ec4b7f60SKalle Valo } 2406ec4b7f60SKalle Valo 2407ec4b7f60SKalle Valo switch (vif->sme_state) { 2408ec4b7f60SKalle Valo case SME_CONNECTING: 2409ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2410ec4b7f60SKalle Valo NULL, 0, 2411ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2412ec4b7f60SKalle Valo GFP_KERNEL); 2413ec4b7f60SKalle Valo break; 2414ec4b7f60SKalle Valo case SME_CONNECTED: 2415ec4b7f60SKalle Valo default: 2416ec4b7f60SKalle Valo /* 2417ec4b7f60SKalle Valo * FIXME: oddly enough smeState is in DISCONNECTED during 2418ec4b7f60SKalle Valo * suspend, why? Need to send disconnected event in that 2419ec4b7f60SKalle Valo * state. 2420ec4b7f60SKalle Valo */ 2421ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2422ec4b7f60SKalle Valo break; 2423ec4b7f60SKalle Valo } 2424ec4b7f60SKalle Valo 2425ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2426ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 2427ec4b7f60SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 2428ec4b7f60SKalle Valo 2429ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 24301f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 24311f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2432ec4b7f60SKalle Valo 2433ec4b7f60SKalle Valo /* disable scanning */ 2434ec4b7f60SKalle Valo if (ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0xFFFF, 0, 0, 2435ec4b7f60SKalle Valo 0, 0, 0, 0, 0, 0, 0) != 0) 2436ec4b7f60SKalle Valo printk(KERN_WARNING "ath6kl: failed to disable scan " 2437ec4b7f60SKalle Valo "during suspend\n"); 2438ec4b7f60SKalle Valo 2439ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2440ec4b7f60SKalle Valo } 2441ec4b7f60SKalle Valo 24428dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 2443bdcd8170SKalle Valo { 24446bbc7c35SJouni Malinen struct ath6kl *ar; 2445be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 24468dafb70eSVasanthakumar Thiagarajan u8 ctr; 2447bdcd8170SKalle Valo 2448bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 2449be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 24508dafb70eSVasanthakumar Thiagarajan 2451be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 2452bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 2453bdcd8170SKalle Valo return NULL; 2454bdcd8170SKalle Valo } 2455bdcd8170SKalle Valo 2456be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 24573226f68aSVasanthakumar Thiagarajan if (!multi_norm_if_support) 24586bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 2459be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 24608dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 24618dafb70eSVasanthakumar Thiagarajan 24623226f68aSVasanthakumar Thiagarajan if (multi_norm_if_support) 24633226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 2; 24643226f68aSVasanthakumar Thiagarajan else 24653226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 24663226f68aSVasanthakumar Thiagarajan 24673226f68aSVasanthakumar Thiagarajan /* FIXME: Remove this once the multivif support is enabled */ 24683226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 24693226f68aSVasanthakumar Thiagarajan 24708dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 24718dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 2472990bd915SVasanthakumar Thiagarajan spin_lock_init(&ar->list_lock); 24738dafb70eSVasanthakumar Thiagarajan 24748dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 24758dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 24768dafb70eSVasanthakumar Thiagarajan 24778dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 2478990bd915SVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->vif_list); 24798dafb70eSVasanthakumar Thiagarajan 24808dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 24818dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 24828dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 24838dafb70eSVasanthakumar Thiagarajan 24848dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 24858dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 24868dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 24878dafb70eSVasanthakumar Thiagarajan 24888dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 24898dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 24908dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 24918dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 24928dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 24938dafb70eSVasanthakumar Thiagarajan 249476a9fbe2SKalle Valo ar->state = ATH6KL_STATE_OFF; 249576a9fbe2SKalle Valo 24968dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 24978dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 24988dafb70eSVasanthakumar Thiagarajan 24998dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 25008dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 25018dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 25028dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 25038dafb70eSVasanthakumar Thiagarajan } 25048dafb70eSVasanthakumar Thiagarajan 25058dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 25068dafb70eSVasanthakumar Thiagarajan 25078dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 25088dafb70eSVasanthakumar Thiagarajan 25098dafb70eSVasanthakumar Thiagarajan return ar; 25108dafb70eSVasanthakumar Thiagarajan } 25118dafb70eSVasanthakumar Thiagarajan 25128dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 25138dafb70eSVasanthakumar Thiagarajan { 25148dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 25158dafb70eSVasanthakumar Thiagarajan int ret; 25166bbc7c35SJouni Malinen 2517be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2518f80574aeSJouni Malinen 2519be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 252063fa1e0cSJouni Malinen 2521bdcd8170SKalle Valo /* set device pointer for wiphy */ 25228dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2523bdcd8170SKalle Valo 2524be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 25258dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 25268dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 25276bbc7c35SJouni Malinen if (ar->p2p) { 2528be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 25296bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 25306bbc7c35SJouni Malinen } 25318dafb70eSVasanthakumar Thiagarajan 2532bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2533be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2534be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2535be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2536be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2537be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2538bdcd8170SKalle Valo 2539be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2540be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2541bdcd8170SKalle Valo 2542eae9e066SRaja Mani wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 2543eae9e066SRaja Mani WIPHY_WOWLAN_DISCONNECT | 2544eae9e066SRaja Mani WIPHY_WOWLAN_GTK_REKEY_FAILURE | 2545eae9e066SRaja Mani WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 2546eae9e066SRaja Mani WIPHY_WOWLAN_EAP_IDENTITY_REQ | 2547eae9e066SRaja Mani WIPHY_WOWLAN_4WAY_HANDSHAKE; 2548eae9e066SRaja Mani wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 2549eae9e066SRaja Mani wiphy->wowlan.pattern_min_len = 1; 2550eae9e066SRaja Mani wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 2551eae9e066SRaja Mani 2552be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2553bdcd8170SKalle Valo if (ret < 0) { 2554bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 25558dafb70eSVasanthakumar Thiagarajan return ret; 25568dafb70eSVasanthakumar Thiagarajan } 25578dafb70eSVasanthakumar Thiagarajan 25588dafb70eSVasanthakumar Thiagarajan return 0; 25598dafb70eSVasanthakumar Thiagarajan } 25608dafb70eSVasanthakumar Thiagarajan 2561108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 25628dafb70eSVasanthakumar Thiagarajan { 25632132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 25642132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 25658dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 25668dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 25678dafb70eSVasanthakumar Thiagarajan } 25688dafb70eSVasanthakumar Thiagarajan 2569de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2570108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 2571de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2572478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 25738dafb70eSVasanthakumar Thiagarajan 25748dafb70eSVasanthakumar Thiagarajan return 0; 25758dafb70eSVasanthakumar Thiagarajan } 25768dafb70eSVasanthakumar Thiagarajan 2577108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 25788dafb70eSVasanthakumar Thiagarajan { 257955055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 258055055976SVasanthakumar Thiagarajan 25812132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2582108438bcSVasanthakumar Thiagarajan 258355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 258455055976SVasanthakumar Thiagarajan 258555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 258655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 258755055976SVasanthakumar Thiagarajan 258827929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 258955055976SVasanthakumar Thiagarajan 259055055976SVasanthakumar Thiagarajan ar->num_vif--; 25918dafb70eSVasanthakumar Thiagarajan } 25928dafb70eSVasanthakumar Thiagarajan 25938dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 259455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 259555055976SVasanthakumar Thiagarajan u8 nw_type) 25968dafb70eSVasanthakumar Thiagarajan { 25978dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2598108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 25998dafb70eSVasanthakumar Thiagarajan 260055055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 26018dafb70eSVasanthakumar Thiagarajan if (!ndev) 26028dafb70eSVasanthakumar Thiagarajan return NULL; 26038dafb70eSVasanthakumar Thiagarajan 2604108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2605108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2606108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2607108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2608108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2609108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2610108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2611108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2612334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 261355055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 26148dafb70eSVasanthakumar Thiagarajan 261555055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 261655055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 261755055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 261855055976SVasanthakumar Thiagarajan 0x2; 261955055976SVasanthakumar Thiagarajan 26208dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 26218dafb70eSVasanthakumar Thiagarajan 2622e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 26238dafb70eSVasanthakumar Thiagarajan 26248dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2625108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 26268dafb70eSVasanthakumar Thiagarajan goto err; 26278dafb70eSVasanthakumar Thiagarajan 262827929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 26298dafb70eSVasanthakumar Thiagarajan goto err; 26308dafb70eSVasanthakumar Thiagarajan 263155055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 263214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 263359c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 26348dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 263559c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 26368dafb70eSVasanthakumar Thiagarajan 263755055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 263855055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 263955055976SVasanthakumar Thiagarajan 264011f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2641990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 264211f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2643990bd915SVasanthakumar Thiagarajan 26448dafb70eSVasanthakumar Thiagarajan return ndev; 26458dafb70eSVasanthakumar Thiagarajan 26468dafb70eSVasanthakumar Thiagarajan err: 264727929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 264827929723SVasanthakumar Thiagarajan free_netdev(ndev); 2649bdcd8170SKalle Valo return NULL; 2650bdcd8170SKalle Valo } 2651bdcd8170SKalle Valo 26528dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2653bdcd8170SKalle Valo { 2654be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2655be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2656bdcd8170SKalle Valo } 2657