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 176eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 18c08631c6SRaja Mani #include <linux/inetdevice.h> 196eb07cafSPaul Gortmaker 20bdcd8170SKalle Valo #include "core.h" 21bdcd8170SKalle Valo #include "cfg80211.h" 22bdcd8170SKalle Valo #include "debug.h" 23abcb344bSKalle Valo #include "hif-ops.h" 24003353b0SKalle Valo #include "testmode.h" 25bdcd8170SKalle Valo 26bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 27bdcd8170SKalle Valo .bitrate = (_rate), \ 28bdcd8170SKalle Valo .flags = (_flags), \ 29bdcd8170SKalle Valo .hw_value = (_rateid), \ 30bdcd8170SKalle Valo } 31bdcd8170SKalle Valo 32bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 33bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 34bdcd8170SKalle Valo .hw_value = (_channel), \ 35bdcd8170SKalle Valo .center_freq = (_freq), \ 36bdcd8170SKalle Valo .flags = (_flags), \ 37bdcd8170SKalle Valo .max_antenna_gain = 0, \ 38bdcd8170SKalle Valo .max_power = 30, \ 39bdcd8170SKalle Valo } 40bdcd8170SKalle Valo 41bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 42bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 43bdcd8170SKalle Valo .hw_value = (_channel), \ 44bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 45bdcd8170SKalle Valo .flags = (_flags), \ 46bdcd8170SKalle Valo .max_antenna_gain = 0, \ 47bdcd8170SKalle Valo .max_power = 30, \ 48bdcd8170SKalle Valo } 49bdcd8170SKalle Valo 50bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 51bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 52bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 53bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 54bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 55bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 56bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 57bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 58bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 59bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 60bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 61bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 62bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 63bdcd8170SKalle Valo }; 64bdcd8170SKalle Valo 65bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 66bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 67bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 68bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 69bdcd8170SKalle Valo 70bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 71bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 72bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 73bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 74bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 75bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 76bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 77bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 78bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 79bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 80bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 81bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 82bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 83bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 84bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 85bdcd8170SKalle Valo }; 86bdcd8170SKalle Valo 87bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 88bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 89bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 90bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 91bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 92bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 93bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 94bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 95bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 96bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 97bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 98bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 99bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 100bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 101bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 102bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 103bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 104bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 105bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 106bdcd8170SKalle Valo CHAN5G(216, 0), 107bdcd8170SKalle Valo }; 108bdcd8170SKalle Valo 109bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 110bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 111bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 112bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 113bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 114bdcd8170SKalle Valo }; 115bdcd8170SKalle Valo 116bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 117bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 118bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 119bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 120bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 121bdcd8170SKalle Valo }; 122bdcd8170SKalle Valo 123837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 124837cb97eSJouni Malinen 12510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 12610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 12710509f90SKalle Valo { 12810509f90SKalle Valo struct ath6kl *ar = vif->ar; 12910509f90SKalle Valo 13010509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 13110509f90SKalle Valo return false; 13210509f90SKalle Valo 13310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 13410509f90SKalle Valo 13510509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 13610509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 13710509f90SKalle Valo 13810509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 13910509f90SKalle Valo 14010509f90SKalle Valo return true; 14110509f90SKalle Valo } 14210509f90SKalle Valo 14310509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 14410509f90SKalle Valo { 14510509f90SKalle Valo struct ath6kl *ar = vif->ar; 14610509f90SKalle Valo bool stopped; 14710509f90SKalle Valo 14810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 14910509f90SKalle Valo 15010509f90SKalle Valo if (!stopped) 15110509f90SKalle Valo return; 15210509f90SKalle Valo 15310509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 15410509f90SKalle Valo } 15510509f90SKalle Valo 156240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 157bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 158bdcd8170SKalle Valo { 159bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 160bdcd8170SKalle Valo 161bdcd8170SKalle Valo if (!wpa_version) { 1623450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 163bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1643450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 165bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1663450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 167bdcd8170SKalle Valo } else { 168bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 169bdcd8170SKalle Valo return -ENOTSUPP; 170bdcd8170SKalle Valo } 171bdcd8170SKalle Valo 172bdcd8170SKalle Valo return 0; 173bdcd8170SKalle Valo } 174bdcd8170SKalle Valo 175240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 176bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 177bdcd8170SKalle Valo { 178bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 179bdcd8170SKalle Valo 180bdcd8170SKalle Valo switch (auth_type) { 181bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1823450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 183bdcd8170SKalle Valo break; 184bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1853450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 186bdcd8170SKalle Valo break; 187bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1883450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 189bdcd8170SKalle Valo break; 190bdcd8170SKalle Valo 191bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 1923450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo 195bdcd8170SKalle Valo default: 196bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 197bdcd8170SKalle Valo return -ENOTSUPP; 198bdcd8170SKalle Valo } 199bdcd8170SKalle Valo 200bdcd8170SKalle Valo return 0; 201bdcd8170SKalle Valo } 202bdcd8170SKalle Valo 203240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 204bdcd8170SKalle Valo { 2053450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2063450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2073450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 208bdcd8170SKalle Valo 209bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 210bdcd8170SKalle Valo __func__, cipher, ucast); 211bdcd8170SKalle Valo 212bdcd8170SKalle Valo switch (cipher) { 213bdcd8170SKalle Valo case 0: 214bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 215bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 216bdcd8170SKalle Valo *ar_cipher_len = 0; 217bdcd8170SKalle Valo break; 218bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 219bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 220bdcd8170SKalle Valo *ar_cipher_len = 5; 221bdcd8170SKalle Valo break; 222bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 223bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 224bdcd8170SKalle Valo *ar_cipher_len = 13; 225bdcd8170SKalle Valo break; 226bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 227bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 228bdcd8170SKalle Valo *ar_cipher_len = 0; 229bdcd8170SKalle Valo break; 230bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 231bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 232bdcd8170SKalle Valo *ar_cipher_len = 0; 233bdcd8170SKalle Valo break; 2345e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2355e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2365e07021eSDai Shuibing *ar_cipher_len = 0; 2375e07021eSDai Shuibing break; 238bdcd8170SKalle Valo default: 239bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 240bdcd8170SKalle Valo return -ENOTSUPP; 241bdcd8170SKalle Valo } 242bdcd8170SKalle Valo 243bdcd8170SKalle Valo return 0; 244bdcd8170SKalle Valo } 245bdcd8170SKalle Valo 246240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 247bdcd8170SKalle Valo { 248bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 249bdcd8170SKalle Valo 250bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2513450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2523450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2533450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2543450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 255837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2563450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2573450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2583450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2593450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 260bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2613450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 262bdcd8170SKalle Valo } 263bdcd8170SKalle Valo } 264bdcd8170SKalle Valo 265990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 266bdcd8170SKalle Valo { 267990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26859c98449SVasanthakumar Thiagarajan 269bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 270bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 271bdcd8170SKalle Valo return false; 272bdcd8170SKalle Valo } 273bdcd8170SKalle Valo 27459c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 275bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 276bdcd8170SKalle Valo return false; 277bdcd8170SKalle Valo } 278bdcd8170SKalle Valo 279bdcd8170SKalle Valo return true; 280bdcd8170SKalle Valo } 281bdcd8170SKalle Valo 2826981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2836981ffdcSKevin Fang { 2846981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2856981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2866981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2876981ffdcSKevin Fang } 2886981ffdcSKevin Fang 2896981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2906981ffdcSKevin Fang { 2916981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2926981ffdcSKevin Fang } 2936981ffdcSKevin Fang 29463541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 29563541212SAarthi Thiruvengadam { 29663541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 29763541212SAarthi Thiruvengadam pos[1] >= 4 && 29863541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 29963541212SAarthi Thiruvengadam pos[5] == 0x04); 30063541212SAarthi Thiruvengadam } 30163541212SAarthi Thiruvengadam 302334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3036981ffdcSKevin Fang size_t ies_len) 3046981ffdcSKevin Fang { 305334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3066981ffdcSKevin Fang const u8 *pos; 3076981ffdcSKevin Fang u8 *buf = NULL; 3086981ffdcSKevin Fang size_t len = 0; 3096981ffdcSKevin Fang int ret; 3106981ffdcSKevin Fang 3116981ffdcSKevin Fang /* 31263541212SAarthi Thiruvengadam * Clear previously set flag 31363541212SAarthi Thiruvengadam */ 31463541212SAarthi Thiruvengadam 31563541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 31663541212SAarthi Thiruvengadam 31763541212SAarthi Thiruvengadam /* 3186981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3196981ffdcSKevin Fang */ 3206981ffdcSKevin Fang 3216981ffdcSKevin Fang if (ies && ies_len) { 3226981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3236981ffdcSKevin Fang if (buf == NULL) 3246981ffdcSKevin Fang return -ENOMEM; 3256981ffdcSKevin Fang pos = ies; 3266981ffdcSKevin Fang 3276981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3286981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3296981ffdcSKevin Fang break; 3306981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3316981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3326981ffdcSKevin Fang len += 2 + pos[1]; 3336981ffdcSKevin Fang } 33463541212SAarthi Thiruvengadam 33563541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 33663541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 33763541212SAarthi Thiruvengadam 3386981ffdcSKevin Fang pos += 2 + pos[1]; 3396981ffdcSKevin Fang } 3406981ffdcSKevin Fang } 3416981ffdcSKevin Fang 342334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 343334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3446981ffdcSKevin Fang kfree(buf); 3456981ffdcSKevin Fang return ret; 3466981ffdcSKevin Fang } 3476981ffdcSKevin Fang 34855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 34955055976SVasanthakumar Thiagarajan { 35055055976SVasanthakumar Thiagarajan switch (type) { 35155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 35255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 35355055976SVasanthakumar Thiagarajan break; 35455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 35555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 35655055976SVasanthakumar Thiagarajan break; 35755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 35855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 35955055976SVasanthakumar Thiagarajan break; 36055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 36155055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36255055976SVasanthakumar Thiagarajan break; 36355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 36455055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36555055976SVasanthakumar Thiagarajan break; 36655055976SVasanthakumar Thiagarajan default: 36755055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 36855055976SVasanthakumar Thiagarajan return -ENOTSUPP; 36955055976SVasanthakumar Thiagarajan } 37055055976SVasanthakumar Thiagarajan 37155055976SVasanthakumar Thiagarajan return 0; 37255055976SVasanthakumar Thiagarajan } 37355055976SVasanthakumar Thiagarajan 37455055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 37555055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 37655055976SVasanthakumar Thiagarajan { 37755055976SVasanthakumar Thiagarajan int i; 37855055976SVasanthakumar Thiagarajan 37955055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 38055055976SVasanthakumar Thiagarajan return false; 38155055976SVasanthakumar Thiagarajan 38255055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 38355055976SVasanthakumar Thiagarajan ar->num_vif)) 38455055976SVasanthakumar Thiagarajan return false; 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 38755055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 38871f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 38955055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 39055055976SVasanthakumar Thiagarajan *if_idx = i; 39155055976SVasanthakumar Thiagarajan return true; 39255055976SVasanthakumar Thiagarajan } 39355055976SVasanthakumar Thiagarajan } 39455055976SVasanthakumar Thiagarajan } 39555055976SVasanthakumar Thiagarajan 3963226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 3973226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 39871f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 3993226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4003226f68aSVasanthakumar Thiagarajan *if_idx = i; 4013226f68aSVasanthakumar Thiagarajan return true; 4023226f68aSVasanthakumar Thiagarajan } 4033226f68aSVasanthakumar Thiagarajan } 4043226f68aSVasanthakumar Thiagarajan } 4053226f68aSVasanthakumar Thiagarajan 40655055976SVasanthakumar Thiagarajan return false; 40755055976SVasanthakumar Thiagarajan } 40855055976SVasanthakumar Thiagarajan 409bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 410bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 411bdcd8170SKalle Valo { 412bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 41359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 414bdcd8170SKalle Valo int status; 4153ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 416bdcd8170SKalle Valo 41710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 41810509f90SKalle Valo 41914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 420bdcd8170SKalle Valo 421990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 422bdcd8170SKalle Valo return -EIO; 423bdcd8170SKalle Valo 424bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 425bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 426bdcd8170SKalle Valo return -EBUSY; 427bdcd8170SKalle Valo } 428bdcd8170SKalle Valo 429bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 430bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 431bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 432bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 433bdcd8170SKalle Valo return -EINVAL; 434bdcd8170SKalle Valo } 435bdcd8170SKalle Valo 436bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 437bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 438bdcd8170SKalle Valo return -ERESTARTSYS; 439bdcd8170SKalle Valo } 440bdcd8170SKalle Valo 441bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 442bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 443bdcd8170SKalle Valo up(&ar->sem); 444bdcd8170SKalle Valo return -EBUSY; 445bdcd8170SKalle Valo } 446bdcd8170SKalle Valo 447bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 448bdcd8170SKalle Valo /* 449bdcd8170SKalle Valo * sleep until the command queue drains 450bdcd8170SKalle Valo */ 451bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 452bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 453bdcd8170SKalle Valo WMI_TIMEOUT); 454bdcd8170SKalle Valo if (signal_pending(current)) { 455bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 456bdcd8170SKalle Valo up(&ar->sem); 457bdcd8170SKalle Valo return -EINTR; 458bdcd8170SKalle Valo } 459bdcd8170SKalle Valo } 460bdcd8170SKalle Valo 461334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 462743b4518SDan Carpenter if (status) { 463743b4518SDan Carpenter up(&ar->sem); 4646981ffdcSKevin Fang return status; 465743b4518SDan Carpenter } 4666e786cb1SJouni Malinen 4676e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 468542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4696981ffdcSKevin Fang 47059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4713450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4723450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 473cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 474334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 475334234b5SVasanthakumar Thiagarajan vif->req_bssid, 476f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 477bdcd8170SKalle Valo 478bdcd8170SKalle Valo up(&ar->sem); 479bdcd8170SKalle Valo if (status) { 480bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 481bdcd8170SKalle Valo return -EIO; 482bdcd8170SKalle Valo } 483bdcd8170SKalle Valo return 0; 4843450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4853450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 486240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 487bdcd8170SKalle Valo } 488bdcd8170SKalle Valo 4893450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4903450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4913450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 492bdcd8170SKalle Valo 493bdcd8170SKalle Valo if (sme->channel) 494f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 495bdcd8170SKalle Valo 4968c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 497bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 4988c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 499bdcd8170SKalle Valo 500240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 501bdcd8170SKalle Valo 502240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 503bdcd8170SKalle Valo if (status) { 504bdcd8170SKalle Valo up(&ar->sem); 505bdcd8170SKalle Valo return status; 506bdcd8170SKalle Valo } 507bdcd8170SKalle Valo 508bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 509240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 510bdcd8170SKalle Valo else 511240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 512bdcd8170SKalle Valo 513240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 514bdcd8170SKalle Valo 515bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 516240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 517bdcd8170SKalle Valo 518bdcd8170SKalle Valo if ((sme->key_len) && 5193450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5203450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 521bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 522bdcd8170SKalle Valo 523792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 524bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 525bdcd8170SKalle Valo sme->key_idx); 526bdcd8170SKalle Valo up(&ar->sem); 527bdcd8170SKalle Valo return -ENOENT; 528bdcd8170SKalle Valo } 529bdcd8170SKalle Valo 5306f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 531bdcd8170SKalle Valo key->key_len = sme->key_len; 532bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5333450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5343450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 535bdcd8170SKalle Valo 536334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5373450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 538bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 539bdcd8170SKalle Valo key->key_len, 540f4bb9a6fSJouni Malinen NULL, 0, 541bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 542bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 543bdcd8170SKalle Valo } 544bdcd8170SKalle Valo 545bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 54659c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 547240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 548240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 549bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 550bdcd8170SKalle Valo up(&ar->sem); 551bdcd8170SKalle Valo return -EIO; 552bdcd8170SKalle Valo } 553bdcd8170SKalle Valo } 554bdcd8170SKalle Valo 555f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 556bdcd8170SKalle Valo 5573ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5583ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5593ca9d1fcSAarthi Thiruvengadam 560bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 561bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 562bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 563bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 564bdcd8170SKalle Valo __func__, 5653450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5663450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 567f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 568bdcd8170SKalle Valo 569cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 570334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5713450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5723450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5733450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5743450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5753450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 576f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 5773ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 578bdcd8170SKalle Valo 579bdcd8170SKalle Valo up(&ar->sem); 580bdcd8170SKalle Valo 581bdcd8170SKalle Valo if (status == -EINVAL) { 5823450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5833450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 584bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 585bdcd8170SKalle Valo return -ENOENT; 586bdcd8170SKalle Valo } else if (status) { 587bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 588bdcd8170SKalle Valo return -EIO; 589bdcd8170SKalle Valo } 590bdcd8170SKalle Valo 591bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5923450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5933450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 594de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 595bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 596bdcd8170SKalle Valo } 597bdcd8170SKalle Valo 598bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 59959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 600bdcd8170SKalle Valo 601bdcd8170SKalle Valo return 0; 602bdcd8170SKalle Valo } 603bdcd8170SKalle Valo 6045e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6055e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6064eab6f4fSRaja Mani enum network_type nw_type, 6074eab6f4fSRaja Mani const u8 *bssid, 60801cac476SJouni Malinen struct ieee80211_channel *chan, 6095e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6105e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 61101cac476SJouni Malinen { 612240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 61301cac476SJouni Malinen struct cfg80211_bss *bss; 6144eab6f4fSRaja Mani u16 cap_mask, cap_val; 61501cac476SJouni Malinen u8 *ie; 61601cac476SJouni Malinen 6174eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6184eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6194eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6204eab6f4fSRaja Mani } else { 6214eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6224eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6234eab6f4fSRaja Mani } 6244eab6f4fSRaja Mani 625be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6264eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6274eab6f4fSRaja Mani cap_mask, cap_val); 62801cac476SJouni Malinen if (bss == NULL) { 62901cac476SJouni Malinen /* 63001cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 63101cac476SJouni Malinen * generate a partial entry until the first BSS info 63201cac476SJouni Malinen * event becomes available. 63301cac476SJouni Malinen * 63401cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 63501cac476SJouni Malinen * IEs from the target. 63601cac476SJouni Malinen */ 6373450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 63801cac476SJouni Malinen if (ie == NULL) 6395e13fd35SVasanthakumar Thiagarajan return NULL; 64001cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6413450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6423450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6433450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 644be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6454eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6463450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 64701cac476SJouni Malinen 0, GFP_KERNEL); 64801cac476SJouni Malinen if (bss) 6494eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6504eab6f4fSRaja Mani "cfg80211\n", bssid); 65101cac476SJouni Malinen kfree(ie); 65201cac476SJouni Malinen } else 6535e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 65401cac476SJouni Malinen 6555e13fd35SVasanthakumar Thiagarajan return bss; 65601cac476SJouni Malinen } 65701cac476SJouni Malinen 658240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 659bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 660bdcd8170SKalle Valo u16 beacon_intvl, 661bdcd8170SKalle Valo enum network_type nw_type, 662bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 663bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 664bdcd8170SKalle Valo { 66501cac476SJouni Malinen struct ieee80211_channel *chan; 666240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6675e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 668bdcd8170SKalle Valo 669bdcd8170SKalle Valo /* capinfo + listen interval */ 670bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 671bdcd8170SKalle Valo 672bdcd8170SKalle Valo /* capinfo + status code + associd */ 673bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 674bdcd8170SKalle Valo 675bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 676bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 677bdcd8170SKalle Valo assoc_resp_ie_offset; 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 680bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 681bdcd8170SKalle Valo 68232c10874SJouni Malinen /* 68332c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 68432c10874SJouni Malinen * a Beacon frame from the AP is seen. 68532c10874SJouni Malinen */ 686cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 68759c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 68832c10874SJouni Malinen 689bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 690551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 691bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 692bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 693bdcd8170SKalle Valo return; 694bdcd8170SKalle Valo } 695bdcd8170SKalle Valo } 696bdcd8170SKalle Valo 697bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 698551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 699551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 700bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 701bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 702bdcd8170SKalle Valo return; 703bdcd8170SKalle Valo } 704bdcd8170SKalle Valo } 705bdcd8170SKalle Valo 706be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 707bdcd8170SKalle Valo 7085e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7095e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7105e13fd35SVasanthakumar Thiagarajan if (!bss) { 7114eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 712bdcd8170SKalle Valo return; 713bdcd8170SKalle Valo } 714bdcd8170SKalle Valo 7154eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7164eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7174eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7184eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7195e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 72001cac476SJouni Malinen return; 72101cac476SJouni Malinen } 72201cac476SJouni Malinen 72314ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 724bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 72514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 726240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 727bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 728bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 729bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7305e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 73114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 732bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7335e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 734bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 735bdcd8170SKalle Valo } 736bdcd8170SKalle Valo } 737bdcd8170SKalle Valo 738bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 739bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 740bdcd8170SKalle Valo { 741d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7423450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 743bdcd8170SKalle Valo 744bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 745bdcd8170SKalle Valo reason_code); 746bdcd8170SKalle Valo 74710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 74810509f90SKalle Valo 749990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 750bdcd8170SKalle Valo return -EIO; 751bdcd8170SKalle Valo 752bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 753bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 754bdcd8170SKalle Valo return -EBUSY; 755bdcd8170SKalle Valo } 756bdcd8170SKalle Valo 757bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 758bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 759bdcd8170SKalle Valo return -ERESTARTSYS; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 762cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 763240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7643450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7653450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 766bdcd8170SKalle Valo 767bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7688c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 769bdcd8170SKalle Valo 770bdcd8170SKalle Valo up(&ar->sem); 771bdcd8170SKalle Valo 77214ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 773170826ddSVasanthakumar Thiagarajan 774bdcd8170SKalle Valo return 0; 775bdcd8170SKalle Valo } 776bdcd8170SKalle Valo 777240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 778bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 779bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 780bdcd8170SKalle Valo { 781240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 78259c98449SVasanthakumar Thiagarajan 78314ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 78414ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 78514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 786bdcd8170SKalle Valo } 787bdcd8170SKalle Valo 788f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 789551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 790bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 791bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 792bdcd8170SKalle Valo return; 793bdcd8170SKalle Valo } 794bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 795240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 796bdcd8170SKalle Valo return; 797bdcd8170SKalle Valo } 798bdcd8170SKalle Valo 799f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 800551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 801551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 802bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 803bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 804bdcd8170SKalle Valo return; 805bdcd8170SKalle Valo } 806bdcd8170SKalle Valo } 807bdcd8170SKalle Valo 8081de547d6SVasanthakumar Thiagarajan /* 8091de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8101de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8111de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8121de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8131de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8141de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8151de547d6SVasanthakumar Thiagarajan */ 816bdcd8170SKalle Valo 8171de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 818334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 819bdcd8170SKalle Valo return; 820bdcd8170SKalle Valo } 821bdcd8170SKalle Valo 82259c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 823bdcd8170SKalle Valo 82414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 825240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 826bdcd8170SKalle Valo bssid, NULL, 0, 827bdcd8170SKalle Valo NULL, 0, 828bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 829bdcd8170SKalle Valo GFP_KERNEL); 83014ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 831240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 832bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 833bdcd8170SKalle Valo } 834bdcd8170SKalle Valo 83514ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 836bdcd8170SKalle Valo } 837bdcd8170SKalle Valo 838bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 839bdcd8170SKalle Valo struct cfg80211_scan_request *request) 840bdcd8170SKalle Valo { 841d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 84259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8431276c9efSEdward Lu s8 n_channels = 0; 8441276c9efSEdward Lu u16 *channels = NULL; 845bdcd8170SKalle Valo int ret = 0; 846f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 847bdcd8170SKalle Valo 848990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 849bdcd8170SKalle Valo return -EIO; 850bdcd8170SKalle Valo 85110509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 85210509f90SKalle Valo 853bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 85459c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8551b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 856240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 85759c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8581b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8591b1e6ee3SJouni Malinen if (ret) { 860bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8611b1e6ee3SJouni Malinen return ret; 862bdcd8170SKalle Valo } 863bdcd8170SKalle Valo } 864bdcd8170SKalle Valo 865bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 866bdcd8170SKalle Valo u8 i; 867bdcd8170SKalle Valo 868bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 869bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 870bdcd8170SKalle Valo 871bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 872334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 873334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 874bdcd8170SKalle Valo request->ssids[i].ssid_len, 875bdcd8170SKalle Valo request->ssids[i].ssid); 876bdcd8170SKalle Valo } 877bdcd8170SKalle Valo 87810509f90SKalle Valo /* 87910509f90SKalle Valo * FIXME: we should clear the IE in fw if it's not set so just 88010509f90SKalle Valo * remove the check altogether 88110509f90SKalle Valo */ 882b84da8c7SJouni Malinen if (request->ie) { 883334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 884334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 885b84da8c7SJouni Malinen request->ie, request->ie_len); 886b84da8c7SJouni Malinen if (ret) { 887b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 888b84da8c7SJouni Malinen "scan"); 889b84da8c7SJouni Malinen return ret; 890b84da8c7SJouni Malinen } 891b84da8c7SJouni Malinen } 892b84da8c7SJouni Malinen 89311869befSJouni Malinen /* 89411869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 89511869befSJouni Malinen * channels. If the list is longer than the target supports, do not 89611869befSJouni Malinen * configure the list and instead, scan all available channels. 89711869befSJouni Malinen */ 89811869befSJouni Malinen if (request->n_channels > 0 && 89911869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9001276c9efSEdward Lu u8 i; 9011276c9efSEdward Lu 90211869befSJouni Malinen n_channels = request->n_channels; 9031276c9efSEdward Lu 9041276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9051276c9efSEdward Lu if (channels == NULL) { 9061276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9071276c9efSEdward Lu "scan all channels"); 9081276c9efSEdward Lu n_channels = 0; 9091276c9efSEdward Lu } 9101276c9efSEdward Lu 9111276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9121276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9131276c9efSEdward Lu } 9141276c9efSEdward Lu 91559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 916f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 917f1f92179SVasanthakumar Thiagarajan 9183ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9193ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9203ca9d1fcSAarthi Thiruvengadam /* 9213ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9223ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9233ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9243ca9d1fcSAarthi Thiruvengadam * probe requests 9253ca9d1fcSAarthi Thiruvengadam */ 9263ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9273ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9283ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 9293ca9d1fcSAarthi Thiruvengadam channels, request->no_cck, 9303ca9d1fcSAarthi Thiruvengadam request->rates); 9313ca9d1fcSAarthi Thiruvengadam } else { 9323ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9333ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9343ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 935334234b5SVasanthakumar Thiagarajan channels); 9363ca9d1fcSAarthi Thiruvengadam } 9371b1e6ee3SJouni Malinen if (ret) 938bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 93911869befSJouni Malinen else 94014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 941bdcd8170SKalle Valo 9421276c9efSEdward Lu kfree(channels); 9431276c9efSEdward Lu 944bdcd8170SKalle Valo return ret; 945bdcd8170SKalle Valo } 946bdcd8170SKalle Valo 9471c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 948bdcd8170SKalle Valo { 949240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9506fd1eaceSKalle Valo int i; 951bdcd8170SKalle Valo 9521c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9531c17d313SKalle Valo aborted ? " aborted" : ""); 954bdcd8170SKalle Valo 95514ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9566fd1eaceSKalle Valo return; 9576fd1eaceSKalle Valo 9581c17d313SKalle Valo if (aborted) 9596fd1eaceSKalle Valo goto out; 960bdcd8170SKalle Valo 96114ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 96214ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 963334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 964334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 965bdcd8170SKalle Valo 0, NULL); 966bdcd8170SKalle Valo } 967bdcd8170SKalle Valo } 9686fd1eaceSKalle Valo 9696fd1eaceSKalle Valo out: 970cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 97114ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 972bdcd8170SKalle Valo } 973bdcd8170SKalle Valo 974bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 975bdcd8170SKalle Valo u8 key_index, bool pairwise, 976bdcd8170SKalle Valo const u8 *mac_addr, 977bdcd8170SKalle Valo struct key_params *params) 978bdcd8170SKalle Valo { 979d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 98059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 981bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 9824a8ce2fdSSujith Manoharan int seq_len; 983bdcd8170SKalle Valo u8 key_usage; 984bdcd8170SKalle Valo u8 key_type; 985bdcd8170SKalle Valo 986990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 987bdcd8170SKalle Valo return -EIO; 988bdcd8170SKalle Valo 989837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 990837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 991837cb97eSJouni Malinen return -EINVAL; 992240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 993240d2799SVasanthakumar Thiagarajan params->key); 994837cb97eSJouni Malinen } 995837cb97eSJouni Malinen 996792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 997bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 998bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 999bdcd8170SKalle Valo key_index); 1000bdcd8170SKalle Valo return -ENOENT; 1001bdcd8170SKalle Valo } 1002bdcd8170SKalle Valo 10036f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1004bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1005bdcd8170SKalle Valo 1006bdcd8170SKalle Valo if (pairwise) 1007bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1008bdcd8170SKalle Valo else 1009bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1010bdcd8170SKalle Valo 10114a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10125e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10135e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10145e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10155e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10165e07021eSDai Shuibing } 1017bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10185e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1019bdcd8170SKalle Valo return -EINVAL; 1020bdcd8170SKalle Valo 1021bdcd8170SKalle Valo key->key_len = params->key_len; 1022bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10235e07021eSDai Shuibing key->seq_len = seq_len; 1024bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1025bdcd8170SKalle Valo key->cipher = params->cipher; 1026bdcd8170SKalle Valo 1027bdcd8170SKalle Valo switch (key->cipher) { 1028bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1029bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1030bdcd8170SKalle Valo key_type = WEP_CRYPT; 1031bdcd8170SKalle Valo break; 1032bdcd8170SKalle Valo 1033bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1034bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1035bdcd8170SKalle Valo break; 1036bdcd8170SKalle Valo 1037bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1038bdcd8170SKalle Valo key_type = AES_CRYPT; 1039bdcd8170SKalle Valo break; 10405e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10415e07021eSDai Shuibing key_type = WAPI_CRYPT; 10425e07021eSDai Shuibing break; 1043bdcd8170SKalle Valo 1044bdcd8170SKalle Valo default: 1045bdcd8170SKalle Valo return -ENOTSUPP; 1046bdcd8170SKalle Valo } 1047bdcd8170SKalle Valo 10483450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10493450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1050bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1051de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1052bdcd8170SKalle Valo 1053bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1054bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1055bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1056bdcd8170SKalle Valo key_usage, key->seq_len); 1057bdcd8170SKalle Valo 1058f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10594703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 10604703290aSJouni Malinen key_type == WAPI_CRYPT) && params) { 10619a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10629a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10639a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10649a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10659a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 106659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10679a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10689a5b1318SJouni Malinen "key configuration until AP mode has been " 10699a5b1318SJouni Malinen "started\n"); 10709a5b1318SJouni Malinen /* 10719a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10729a5b1318SJouni Malinen * the connected event is received from the target. 10739a5b1318SJouni Malinen */ 10749a5b1318SJouni Malinen return 0; 10759a5b1318SJouni Malinen } 10769a5b1318SJouni Malinen } 10779a5b1318SJouni Malinen 1078f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 107959c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1080151411e8SJouni Malinen /* 1081151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1082151411e8SJouni Malinen * the AP mode has properly started 1083151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1084151411e8SJouni Malinen */ 1085151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1086151411e8SJouni Malinen "until AP mode has been started\n"); 10876f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10886f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10896f2a73f9SVasanthakumar Thiagarajan key->key_len); 1090151411e8SJouni Malinen return 0; 1091151411e8SJouni Malinen } 1092151411e8SJouni Malinen 10937cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1094bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1095f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1096f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1097bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1098bdcd8170SKalle Valo } 1099bdcd8170SKalle Valo 1100bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1101bdcd8170SKalle Valo u8 key_index, bool pairwise, 1102bdcd8170SKalle Valo const u8 *mac_addr) 1103bdcd8170SKalle Valo { 1104d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11056f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1106bdcd8170SKalle Valo 1107bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1108bdcd8170SKalle Valo 1109990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1110bdcd8170SKalle Valo return -EIO; 1111bdcd8170SKalle Valo 1112792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1113bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1114bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1115bdcd8170SKalle Valo key_index); 1116bdcd8170SKalle Valo return -ENOENT; 1117bdcd8170SKalle Valo } 1118bdcd8170SKalle Valo 11196f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1120bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1121bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1122bdcd8170SKalle Valo return 0; 1123bdcd8170SKalle Valo } 1124bdcd8170SKalle Valo 11256f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1126bdcd8170SKalle Valo 1127334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1128bdcd8170SKalle Valo } 1129bdcd8170SKalle Valo 1130bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1131bdcd8170SKalle Valo u8 key_index, bool pairwise, 1132bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1133bdcd8170SKalle Valo void (*callback) (void *cookie, 1134bdcd8170SKalle Valo struct key_params *)) 1135bdcd8170SKalle Valo { 11366f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1137bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1138bdcd8170SKalle Valo struct key_params params; 1139bdcd8170SKalle Valo 1140bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1141bdcd8170SKalle Valo 1142990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1143bdcd8170SKalle Valo return -EIO; 1144bdcd8170SKalle Valo 1145792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1146bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1147bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1148bdcd8170SKalle Valo key_index); 1149bdcd8170SKalle Valo return -ENOENT; 1150bdcd8170SKalle Valo } 1151bdcd8170SKalle Valo 11526f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1153bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1154bdcd8170SKalle Valo params.cipher = key->cipher; 1155bdcd8170SKalle Valo params.key_len = key->key_len; 1156bdcd8170SKalle Valo params.seq_len = key->seq_len; 1157bdcd8170SKalle Valo params.seq = key->seq; 1158bdcd8170SKalle Valo params.key = key->key; 1159bdcd8170SKalle Valo 1160bdcd8170SKalle Valo callback(cookie, ¶ms); 1161bdcd8170SKalle Valo 1162bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1163bdcd8170SKalle Valo } 1164bdcd8170SKalle Valo 1165bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1166bdcd8170SKalle Valo struct net_device *ndev, 1167bdcd8170SKalle Valo u8 key_index, bool unicast, 1168bdcd8170SKalle Valo bool multicast) 1169bdcd8170SKalle Valo { 1170d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 117159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1172bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1173bdcd8170SKalle Valo u8 key_usage; 1174229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1175bdcd8170SKalle Valo 1176bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1177bdcd8170SKalle Valo 1178990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1179bdcd8170SKalle Valo return -EIO; 1180bdcd8170SKalle Valo 1181792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1182bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1183bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1184bdcd8170SKalle Valo __func__, key_index); 1185bdcd8170SKalle Valo return -ENOENT; 1186bdcd8170SKalle Valo } 1187bdcd8170SKalle Valo 11886f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1189bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1190bdcd8170SKalle Valo __func__, key_index); 1191bdcd8170SKalle Valo return -EINVAL; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 11943450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11956f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1196bdcd8170SKalle Valo key_usage = GROUP_USAGE; 11973450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1198bdcd8170SKalle Valo key_usage |= TX_USAGE; 1199229ed6b5SEdward Lu if (unicast) 12003450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1201229ed6b5SEdward Lu if (multicast) 12023450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1203bdcd8170SKalle Valo 1204f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12059a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12069a5b1318SJouni Malinen 1207f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1208334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1209229ed6b5SEdward Lu key_type, key_usage, 1210f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1211f4bb9a6fSJouni Malinen key->key, 1212bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1213bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1214bdcd8170SKalle Valo } 1215bdcd8170SKalle Valo 1216240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1217bdcd8170SKalle Valo bool ismcast) 1218bdcd8170SKalle Valo { 1219bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1220bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1221bdcd8170SKalle Valo 1222240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1223bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1224bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1225bdcd8170SKalle Valo GFP_KERNEL); 1226bdcd8170SKalle Valo } 1227bdcd8170SKalle Valo 1228bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1229bdcd8170SKalle Valo { 1230bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1231990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1232bdcd8170SKalle Valo int ret; 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1235bdcd8170SKalle Valo changed); 1236bdcd8170SKalle Valo 1237990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1238990bd915SVasanthakumar Thiagarajan if (!vif) 1239990bd915SVasanthakumar Thiagarajan return -EIO; 1240990bd915SVasanthakumar Thiagarajan 1241990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1242bdcd8170SKalle Valo return -EIO; 1243bdcd8170SKalle Valo 1244bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1245bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1246bdcd8170SKalle Valo if (ret != 0) { 1247bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1248bdcd8170SKalle Valo return -EIO; 1249bdcd8170SKalle Valo } 1250bdcd8170SKalle Valo } 1251bdcd8170SKalle Valo 1252bdcd8170SKalle Valo return 0; 1253bdcd8170SKalle Valo } 1254bdcd8170SKalle Valo 1255bdcd8170SKalle Valo /* 1256bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1257bdcd8170SKalle Valo * data type from 2.6.36 onwards 1258bdcd8170SKalle Valo */ 1259bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1260bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1261b992a285SLuis R. Rodriguez int mbm) 1262bdcd8170SKalle Valo { 1263bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1264990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1265bdcd8170SKalle Valo u8 ath6kl_dbm; 1266b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1267bdcd8170SKalle Valo 1268bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1269bdcd8170SKalle Valo type, dbm); 1270bdcd8170SKalle Valo 1271990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1272990bd915SVasanthakumar Thiagarajan if (!vif) 1273990bd915SVasanthakumar Thiagarajan return -EIO; 1274990bd915SVasanthakumar Thiagarajan 1275990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1276bdcd8170SKalle Valo return -EIO; 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo switch (type) { 1279bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1280bdcd8170SKalle Valo return 0; 1281bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1282bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1283bdcd8170SKalle Valo break; 1284bdcd8170SKalle Valo default: 1285bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1286bdcd8170SKalle Valo __func__, type); 1287bdcd8170SKalle Valo return -EOPNOTSUPP; 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo 1290990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1291bdcd8170SKalle Valo 1292bdcd8170SKalle Valo return 0; 1293bdcd8170SKalle Valo } 1294bdcd8170SKalle Valo 1295bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1296bdcd8170SKalle Valo { 1297bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1298990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1299bdcd8170SKalle Valo 1300990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1301990bd915SVasanthakumar Thiagarajan if (!vif) 1302990bd915SVasanthakumar Thiagarajan return -EIO; 1303990bd915SVasanthakumar Thiagarajan 1304990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1305bdcd8170SKalle Valo return -EIO; 1306bdcd8170SKalle Valo 130759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1308bdcd8170SKalle Valo ar->tx_pwr = 0; 1309bdcd8170SKalle Valo 1310990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1311bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1312bdcd8170SKalle Valo return -EIO; 1313bdcd8170SKalle Valo } 1314bdcd8170SKalle Valo 1315bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1316bdcd8170SKalle Valo 5 * HZ); 1317bdcd8170SKalle Valo 1318bdcd8170SKalle Valo if (signal_pending(current)) { 1319bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1320bdcd8170SKalle Valo return -EINTR; 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo } 1323bdcd8170SKalle Valo 1324bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1325bdcd8170SKalle Valo return 0; 1326bdcd8170SKalle Valo } 1327bdcd8170SKalle Valo 1328bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1329bdcd8170SKalle Valo struct net_device *dev, 1330bdcd8170SKalle Valo bool pmgmt, int timeout) 1331bdcd8170SKalle Valo { 1332bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1333bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1334334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1335bdcd8170SKalle Valo 1336bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1337bdcd8170SKalle Valo __func__, pmgmt, timeout); 1338bdcd8170SKalle Valo 1339990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1340bdcd8170SKalle Valo return -EIO; 1341bdcd8170SKalle Valo 1342bdcd8170SKalle Valo if (pmgmt) { 1343bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1344bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1345bdcd8170SKalle Valo } else { 1346bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1347bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1348bdcd8170SKalle Valo } 1349bdcd8170SKalle Valo 1350334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1351334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1352bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1353bdcd8170SKalle Valo return -EIO; 1354bdcd8170SKalle Valo } 1355bdcd8170SKalle Valo 1356bdcd8170SKalle Valo return 0; 1357bdcd8170SKalle Valo } 1358bdcd8170SKalle Valo 135955055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 136055055976SVasanthakumar Thiagarajan char *name, 136155055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 136255055976SVasanthakumar Thiagarajan u32 *flags, 136355055976SVasanthakumar Thiagarajan struct vif_params *params) 136455055976SVasanthakumar Thiagarajan { 136555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 136655055976SVasanthakumar Thiagarajan struct net_device *ndev; 136755055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 136855055976SVasanthakumar Thiagarajan 136971f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 137055055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 137155055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137255055976SVasanthakumar Thiagarajan } 137355055976SVasanthakumar Thiagarajan 137455055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 137555055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 137655055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137755055976SVasanthakumar Thiagarajan } 137855055976SVasanthakumar Thiagarajan 137955055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 138055055976SVasanthakumar Thiagarajan if (!ndev) 138155055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 138255055976SVasanthakumar Thiagarajan 138355055976SVasanthakumar Thiagarajan ar->num_vif++; 138455055976SVasanthakumar Thiagarajan 138555055976SVasanthakumar Thiagarajan return ndev; 138655055976SVasanthakumar Thiagarajan } 138755055976SVasanthakumar Thiagarajan 138855055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 138955055976SVasanthakumar Thiagarajan struct net_device *ndev) 139055055976SVasanthakumar Thiagarajan { 139155055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139255055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 139355055976SVasanthakumar Thiagarajan 139411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 139555055976SVasanthakumar Thiagarajan list_del(&vif->list); 139611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 139755055976SVasanthakumar Thiagarajan 139855055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 139955055976SVasanthakumar Thiagarajan 1400c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 140155055976SVasanthakumar Thiagarajan 140255055976SVasanthakumar Thiagarajan return 0; 140355055976SVasanthakumar Thiagarajan } 140455055976SVasanthakumar Thiagarajan 1405bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1406bdcd8170SKalle Valo struct net_device *ndev, 1407bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1408bdcd8170SKalle Valo struct vif_params *params) 1409bdcd8170SKalle Valo { 1410f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1413bdcd8170SKalle Valo 1414bdcd8170SKalle Valo switch (type) { 1415bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1416f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1417bdcd8170SKalle Valo break; 1418bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1419f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1420bdcd8170SKalle Valo break; 14216e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1422f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14236e4604c8SJouni Malinen break; 14246b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1425f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14266b5e5d25SJouni Malinen break; 14276b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1428f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14296b5e5d25SJouni Malinen break; 1430bdcd8170SKalle Valo default: 1431bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1432bdcd8170SKalle Valo return -EOPNOTSUPP; 1433bdcd8170SKalle Valo } 1434bdcd8170SKalle Valo 1435551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1436bdcd8170SKalle Valo 1437bdcd8170SKalle Valo return 0; 1438bdcd8170SKalle Valo } 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1441bdcd8170SKalle Valo struct net_device *dev, 1442bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1443bdcd8170SKalle Valo { 1444bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 144559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1446bdcd8170SKalle Valo int status; 1447bdcd8170SKalle Valo 1448990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1449bdcd8170SKalle Valo return -EIO; 1450bdcd8170SKalle Valo 14513450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14523450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1453bdcd8170SKalle Valo 1454bdcd8170SKalle Valo if (ibss_param->channel) 1455f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1456bdcd8170SKalle Valo 1457bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1458bdcd8170SKalle Valo /* 1459bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1460bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1461bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1462bdcd8170SKalle Valo * updated. 1463bdcd8170SKalle Valo */ 1464bdcd8170SKalle Valo return -EOPNOTSUPP; 1465bdcd8170SKalle Valo } 1466bdcd8170SKalle Valo 14678c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1468bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14698c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14708c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1471bdcd8170SKalle Valo 1472240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1473bdcd8170SKalle Valo 1474240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1475bdcd8170SKalle Valo if (status) 1476bdcd8170SKalle Valo return status; 1477bdcd8170SKalle Valo 1478bdcd8170SKalle Valo if (ibss_param->privacy) { 1479240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1480240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1481bdcd8170SKalle Valo } else { 1482240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1483240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1484bdcd8170SKalle Valo } 1485bdcd8170SKalle Valo 1486f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1487bdcd8170SKalle Valo 1488bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1489bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1490bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1491bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1492bdcd8170SKalle Valo __func__, 14933450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14943450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1495f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1496bdcd8170SKalle Valo 1497334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 14983450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 14993450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15003450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15013450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15023450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1503f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15043ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 150559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1506bdcd8170SKalle Valo 1507bdcd8170SKalle Valo return 0; 1508bdcd8170SKalle Valo } 1509bdcd8170SKalle Valo 1510bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1511bdcd8170SKalle Valo struct net_device *dev) 1512bdcd8170SKalle Valo { 15133450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1514bdcd8170SKalle Valo 1515990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1516bdcd8170SKalle Valo return -EIO; 1517bdcd8170SKalle Valo 1518240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15193450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15203450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1521bdcd8170SKalle Valo 1522bdcd8170SKalle Valo return 0; 1523bdcd8170SKalle Valo } 1524bdcd8170SKalle Valo 1525bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1526bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1527bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1528bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1529bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1530837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15315e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1532bdcd8170SKalle Valo }; 1533bdcd8170SKalle Valo 1534bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1535bdcd8170SKalle Valo { 1536bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1537bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1538bdcd8170SKalle Valo 36000, 48000, 54000 1539bdcd8170SKalle Valo }; 1540bdcd8170SKalle Valo u8 i; 1541bdcd8170SKalle Valo 1542bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1543bdcd8170SKalle Valo if (rate == legacy[i]) 1544bdcd8170SKalle Valo return true; 1545bdcd8170SKalle Valo 1546bdcd8170SKalle Valo return false; 1547bdcd8170SKalle Valo } 1548bdcd8170SKalle Valo 1549bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1550bdcd8170SKalle Valo { 1551bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1552bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1553bdcd8170SKalle Valo }; 1554bdcd8170SKalle Valo u8 i; 1555bdcd8170SKalle Valo 1556bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1557bdcd8170SKalle Valo if (rate == ht20[i]) { 1558bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1559bdcd8170SKalle Valo /* last rate uses sgi */ 1560bdcd8170SKalle Valo *sgi = true; 1561bdcd8170SKalle Valo else 1562bdcd8170SKalle Valo *sgi = false; 1563bdcd8170SKalle Valo 1564bdcd8170SKalle Valo *mcs = i; 1565bdcd8170SKalle Valo return true; 1566bdcd8170SKalle Valo } 1567bdcd8170SKalle Valo } 1568bdcd8170SKalle Valo return false; 1569bdcd8170SKalle Valo } 1570bdcd8170SKalle Valo 1571bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1572bdcd8170SKalle Valo { 1573bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1574bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1575bdcd8170SKalle Valo 150000 1576bdcd8170SKalle Valo }; 1577bdcd8170SKalle Valo u8 i; 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1580bdcd8170SKalle Valo if (rate == ht40[i]) { 1581bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1582bdcd8170SKalle Valo /* last rate uses sgi */ 1583bdcd8170SKalle Valo *sgi = true; 1584bdcd8170SKalle Valo else 1585bdcd8170SKalle Valo *sgi = false; 1586bdcd8170SKalle Valo 1587bdcd8170SKalle Valo *mcs = i; 1588bdcd8170SKalle Valo return true; 1589bdcd8170SKalle Valo } 1590bdcd8170SKalle Valo } 1591bdcd8170SKalle Valo 1592bdcd8170SKalle Valo return false; 1593bdcd8170SKalle Valo } 1594bdcd8170SKalle Valo 1595bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1596bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1597bdcd8170SKalle Valo { 1598bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 159959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1600bdcd8170SKalle Valo long left; 1601bdcd8170SKalle Valo bool sgi; 1602bdcd8170SKalle Valo s32 rate; 1603bdcd8170SKalle Valo int ret; 1604bdcd8170SKalle Valo u8 mcs; 1605bdcd8170SKalle Valo 16068c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1607bdcd8170SKalle Valo return -ENOENT; 1608bdcd8170SKalle Valo 1609bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1610bdcd8170SKalle Valo return -EBUSY; 1611bdcd8170SKalle Valo 1612b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1613bdcd8170SKalle Valo 1614334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1615bdcd8170SKalle Valo 1616bdcd8170SKalle Valo if (ret != 0) { 1617bdcd8170SKalle Valo up(&ar->sem); 1618bdcd8170SKalle Valo return -EIO; 1619bdcd8170SKalle Valo } 1620bdcd8170SKalle Valo 1621bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1622bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1623b95907a7SVasanthakumar Thiagarajan &vif->flags), 1624bdcd8170SKalle Valo WMI_TIMEOUT); 1625bdcd8170SKalle Valo 1626bdcd8170SKalle Valo up(&ar->sem); 1627bdcd8170SKalle Valo 1628bdcd8170SKalle Valo if (left == 0) 1629bdcd8170SKalle Valo return -ETIMEDOUT; 1630bdcd8170SKalle Valo else if (left < 0) 1631bdcd8170SKalle Valo return left; 1632bdcd8170SKalle Valo 1633b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1634b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1635bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1636b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1637bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1638bdcd8170SKalle Valo } 1639bdcd8170SKalle Valo 1640b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1641b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1642bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1643b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1644bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1645bdcd8170SKalle Valo } 1646bdcd8170SKalle Valo 1647b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1648bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1649bdcd8170SKalle Valo 1650b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1651bdcd8170SKalle Valo 1652bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1653bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1654bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1655bdcd8170SKalle Valo if (sgi) { 1656bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1657bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1658bdcd8170SKalle Valo } else { 1659bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1660bdcd8170SKalle Valo } 1661bdcd8170SKalle Valo 1662bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1663bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1664bdcd8170SKalle Valo if (sgi) { 1665bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1666bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1667bdcd8170SKalle Valo } else { 1668bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1669bdcd8170SKalle Valo } 1670bdcd8170SKalle Valo 1671bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1672bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1673bdcd8170SKalle Valo } else { 16749a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16759a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16769a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1677bdcd8170SKalle Valo return 0; 1678bdcd8170SKalle Valo } 1679bdcd8170SKalle Valo 1680bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1681bdcd8170SKalle Valo 168259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 168359c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1684f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 168532c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 168632c10874SJouni Malinen sinfo->bss_param.flags = 0; 1687cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1688cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 168932c10874SJouni Malinen } 169032c10874SJouni Malinen 1691bdcd8170SKalle Valo return 0; 1692bdcd8170SKalle Valo } 1693bdcd8170SKalle Valo 1694bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1695bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1696bdcd8170SKalle Valo { 1697bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1698334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1699334234b5SVasanthakumar Thiagarajan 1700334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1701bdcd8170SKalle Valo pmksa->pmkid, true); 1702bdcd8170SKalle Valo } 1703bdcd8170SKalle Valo 1704bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1705bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1706bdcd8170SKalle Valo { 1707bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1708334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1709334234b5SVasanthakumar Thiagarajan 1710334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1711bdcd8170SKalle Valo pmksa->pmkid, false); 1712bdcd8170SKalle Valo } 1713bdcd8170SKalle Valo 1714bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1715bdcd8170SKalle Valo { 1716bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 171759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 171859c98449SVasanthakumar Thiagarajan 171959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1720334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1721334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1722bdcd8170SKalle Valo return 0; 1723bdcd8170SKalle Valo } 1724bdcd8170SKalle Valo 17256cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 17266cb3c714SRaja Mani { 1727c08631c6SRaja Mani struct in_device *in_dev; 1728c08631c6SRaja Mani struct in_ifaddr *ifa; 17296cb3c714SRaja Mani struct ath6kl_vif *vif; 17306cb3c714SRaja Mani int ret, pos, left; 17316cb3c714SRaja Mani u32 filter = 0; 17326cb3c714SRaja Mani u16 i; 1733c08631c6SRaja Mani u8 mask[WOW_MASK_SIZE], index = 0; 1734c08631c6SRaja Mani __be32 ips[MAX_IP_ADDRS]; 17356cb3c714SRaja Mani 17366cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 17376cb3c714SRaja Mani if (!vif) 17386cb3c714SRaja Mani return -EIO; 17396cb3c714SRaja Mani 17406cb3c714SRaja Mani if (!ath6kl_cfg80211_ready(vif)) 17416cb3c714SRaja Mani return -EIO; 17426cb3c714SRaja Mani 17436cb3c714SRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 17446cb3c714SRaja Mani return -EINVAL; 17456cb3c714SRaja Mani 17466cb3c714SRaja Mani /* Clear existing WOW patterns */ 17476cb3c714SRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 17486cb3c714SRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 17496cb3c714SRaja Mani WOW_LIST_ID, i); 17506cb3c714SRaja Mani /* Configure new WOW patterns */ 17516cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17526cb3c714SRaja Mani 17536cb3c714SRaja Mani /* 17546cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17556cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17566cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17576cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17586cb3c714SRaja Mani * then equivalent driver specific mask value is 17596cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17606cb3c714SRaja Mani */ 17616cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17626cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17636cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17646cb3c714SRaja Mani mask[pos] = 0xFF; 17656cb3c714SRaja Mani } 17666cb3c714SRaja Mani /* 17676cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17686cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17696cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17706cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17716cb3c714SRaja Mani */ 17726cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17736cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17746cb3c714SRaja Mani wow->patterns[i].pattern_len, 17756cb3c714SRaja Mani 0 /* pattern offset */, 17766cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17776cb3c714SRaja Mani if (ret) 17786cb3c714SRaja Mani return ret; 17796cb3c714SRaja Mani } 17806cb3c714SRaja Mani 1781c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1782c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1783c08631c6SRaja Mani if (!in_dev) 1784c08631c6SRaja Mani goto skip_arp; 1785c08631c6SRaja Mani 1786c08631c6SRaja Mani ifa = in_dev->ifa_list; 1787c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 1788c08631c6SRaja Mani 1789c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 1790c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 1791c08631c6SRaja Mani ips[index] = ifa->ifa_local; 1792c08631c6SRaja Mani ifa = ifa->ifa_next; 1793c08631c6SRaja Mani index++; 1794c08631c6SRaja Mani } 1795c08631c6SRaja Mani 1796c08631c6SRaja Mani if (ifa) { 1797c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 1798c08631c6SRaja Mani return -EINVAL; 1799c08631c6SRaja Mani } 1800c08631c6SRaja Mani 1801c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 1802c08631c6SRaja Mani if (ret) { 1803c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 1804c08631c6SRaja Mani return ret; 1805c08631c6SRaja Mani } 1806c08631c6SRaja Mani 1807c08631c6SRaja Mani skip_arp: 18086cb3c714SRaja Mani if (wow->disconnect) 18096cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 18106cb3c714SRaja Mani 18116cb3c714SRaja Mani if (wow->magic_pkt) 18126cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 18136cb3c714SRaja Mani 18146cb3c714SRaja Mani if (wow->gtk_rekey_failure) 18156cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_GTK_ERROR; 18166cb3c714SRaja Mani 18176cb3c714SRaja Mani if (wow->eap_identity_req) 18186cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_EAP_REQ; 18196cb3c714SRaja Mani 18206cb3c714SRaja Mani if (wow->four_way_handshake) 18216cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 18226cb3c714SRaja Mani 18236cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 18246cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 18256cb3c714SRaja Mani filter, 18266cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 18276cb3c714SRaja Mani if (ret) 18286cb3c714SRaja Mani return ret; 18296cb3c714SRaja Mani 18306cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18316cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 18326cb3c714SRaja Mani if (ret) 18336cb3c714SRaja Mani return ret; 18346cb3c714SRaja Mani 18356cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 18366cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 18376cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 18386cb3c714SRaja Mani if (left == 0) { 18396cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 18406cb3c714SRaja Mani ret = -ETIMEDOUT; 18416cb3c714SRaja Mani } else if (left < 0) { 18426cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 18436cb3c714SRaja Mani ret = left; 18446cb3c714SRaja Mani } 18456cb3c714SRaja Mani } 18466cb3c714SRaja Mani 18476cb3c714SRaja Mani return ret; 18486cb3c714SRaja Mani } 18496cb3c714SRaja Mani 18506cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 18516cb3c714SRaja Mani { 18526cb3c714SRaja Mani struct ath6kl_vif *vif; 18536cb3c714SRaja Mani int ret; 18546cb3c714SRaja Mani 18556cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 18566cb3c714SRaja Mani if (!vif) 18576cb3c714SRaja Mani return -EIO; 18586cb3c714SRaja Mani 18596cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18606cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 18616cb3c714SRaja Mani return ret; 18626cb3c714SRaja Mani } 18636cb3c714SRaja Mani 186452d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 18650f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 18660f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 186752d81a68SKalle Valo { 186852d81a68SKalle Valo int ret; 186952d81a68SKalle Valo 187052d81a68SKalle Valo switch (mode) { 1871d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 1872d7c44e0bSRaja Mani 1873d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 1874d7c44e0bSRaja Mani 1875d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 1876d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 1877d7c44e0bSRaja Mani 1878d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 1879d7c44e0bSRaja Mani if (ret) { 1880d7c44e0bSRaja Mani ath6kl_err("wow suspend failed: %d\n", ret); 1881d7c44e0bSRaja Mani return ret; 1882d7c44e0bSRaja Mani } 1883d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 1884d7c44e0bSRaja Mani break; 1885d7c44e0bSRaja Mani 188652d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 1887524441e3SRaja Mani 18887125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1889524441e3SRaja Mani 189052d81a68SKalle Valo /* save the current power mode before enabling power save */ 189152d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 189252d81a68SKalle Valo 189352d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 189452d81a68SKalle Valo if (ret) { 189552d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 189652d81a68SKalle Valo ret); 189752d81a68SKalle Valo } 189852d81a68SKalle Valo 189976a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 190076a9fbe2SKalle Valo 190152d81a68SKalle Valo break; 1902b4b2a0b1SKalle Valo 1903b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1904524441e3SRaja Mani 19057125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1906524441e3SRaja Mani 1907b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1908b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1909b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1910b4b2a0b1SKalle Valo break; 1911b4b2a0b1SKalle Valo } 1912b4b2a0b1SKalle Valo 1913b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1914b4b2a0b1SKalle Valo 1915b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1916b4b2a0b1SKalle Valo if (ret) { 1917b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1918b4b2a0b1SKalle Valo ret); 1919b4b2a0b1SKalle Valo } 1920b4b2a0b1SKalle Valo 1921b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1922b4b2a0b1SKalle Valo 1923b4b2a0b1SKalle Valo break; 1924b4b2a0b1SKalle Valo 192510509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 192610509f90SKalle Valo /* 192710509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 192810509f90SKalle Valo * wow mode and sleeping most of the time. 192910509f90SKalle Valo */ 193010509f90SKalle Valo break; 193110509f90SKalle Valo 1932b4b2a0b1SKalle Valo default: 1933b4b2a0b1SKalle Valo break; 193452d81a68SKalle Valo } 193552d81a68SKalle Valo 193652d81a68SKalle Valo return 0; 193752d81a68SKalle Valo } 193852d81a68SKalle Valo 193952d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 194052d81a68SKalle Valo { 194176a9fbe2SKalle Valo int ret; 194276a9fbe2SKalle Valo 194376a9fbe2SKalle Valo switch (ar->state) { 1944d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 1945d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 1946d7c44e0bSRaja Mani 1947d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 1948d7c44e0bSRaja Mani if (ret) { 1949d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 1950d7c44e0bSRaja Mani return ret; 1951d7c44e0bSRaja Mani } 1952d7c44e0bSRaja Mani 1953d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_ON; 1954d7c44e0bSRaja Mani break; 1955d7c44e0bSRaja Mani 195676a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 195752d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 195876a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 195976a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 196076a9fbe2SKalle Valo if (ret) { 196176a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 196276a9fbe2SKalle Valo ret); 196376a9fbe2SKalle Valo } 196476a9fbe2SKalle Valo } 196576a9fbe2SKalle Valo 196676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 196776a9fbe2SKalle Valo 196876a9fbe2SKalle Valo break; 196976a9fbe2SKalle Valo 1970b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1971b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1972b4b2a0b1SKalle Valo 1973b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1974b4b2a0b1SKalle Valo if (ret) { 1975b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1976b4b2a0b1SKalle Valo return ret; 1977b4b2a0b1SKalle Valo } 1978d7c44e0bSRaja Mani break; 1979b4b2a0b1SKalle Valo 198010509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 198110509f90SKalle Valo break; 198210509f90SKalle Valo 198376a9fbe2SKalle Valo default: 198476a9fbe2SKalle Valo break; 198552d81a68SKalle Valo } 198652d81a68SKalle Valo 198752d81a68SKalle Valo return 0; 198852d81a68SKalle Valo } 198952d81a68SKalle Valo 1990abcb344bSKalle Valo #ifdef CONFIG_PM 199152d81a68SKalle Valo 199252d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 199352d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 1994abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1995abcb344bSKalle Valo { 1996abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1997abcb344bSKalle Valo 19980f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 1999abcb344bSKalle Valo } 2000aa6cffc1SChilam Ng 200152d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2002aa6cffc1SChilam Ng { 2003aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2004aa6cffc1SChilam Ng 2005aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2006aa6cffc1SChilam Ng } 2007a918fb3cSRaja Mani 2008a918fb3cSRaja Mani /* 2009a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2010a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2011a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2012a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2013a918fb3cSRaja Mani * 2014a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2015a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2016a918fb3cSRaja Mani * 2017a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2018a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2019a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2020a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2021a918fb3cSRaja Mani * 2022a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2023a918fb3cSRaja Mani */ 2024a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2025a918fb3cSRaja Mani { 2026a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2027a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2028a918fb3cSRaja Mani } 2029a918fb3cSRaja Mani 2030a918fb3cSRaja Mani #else 2031a918fb3cSRaja Mani 2032a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2033a918fb3cSRaja Mani { 2034a918fb3cSRaja Mani } 2035abcb344bSKalle Valo #endif 2036abcb344bSKalle Valo 20376a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 20386a7c9badSJouni Malinen struct ieee80211_channel *chan, 20396a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 20406a7c9badSJouni Malinen { 2041e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2042e68f6750SSujith Manoharan 2043e68f6750SSujith Manoharan /* 2044e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2045e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2046e68f6750SSujith Manoharan * 2047e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2048e68f6750SSujith Manoharan */ 2049e68f6750SSujith Manoharan if (!dev) 2050e68f6750SSujith Manoharan return -EBUSY; 2051e68f6750SSujith Manoharan 2052e68f6750SSujith Manoharan vif = netdev_priv(dev); 20536a7c9badSJouni Malinen 2054990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 20556a7c9badSJouni Malinen return -EIO; 20566a7c9badSJouni Malinen 20576a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 20586a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2059cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 20606a7c9badSJouni Malinen 20616a7c9badSJouni Malinen return 0; 20626a7c9badSJouni Malinen } 20636a7c9badSJouni Malinen 20648bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 20658bdfbf40SJouni Malinen { 20668bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 20678bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 20688bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 20698bdfbf40SJouni Malinen } 20708bdfbf40SJouni Malinen 2071334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2072334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 20738bdfbf40SJouni Malinen { 2074334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 20758bdfbf40SJouni Malinen const u8 *pos; 20768bdfbf40SJouni Malinen u8 *buf = NULL; 20778bdfbf40SJouni Malinen size_t len = 0; 20788bdfbf40SJouni Malinen int ret; 20798bdfbf40SJouni Malinen 20808bdfbf40SJouni Malinen /* 20818bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 20828bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 20838bdfbf40SJouni Malinen */ 20848bdfbf40SJouni Malinen 20858bdfbf40SJouni Malinen if (ies && ies_len) { 20868bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 20878bdfbf40SJouni Malinen if (buf == NULL) 20888bdfbf40SJouni Malinen return -ENOMEM; 20898bdfbf40SJouni Malinen pos = ies; 20908bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 20918bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 20928bdfbf40SJouni Malinen break; 20938bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 20948bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 20958bdfbf40SJouni Malinen len += 2 + pos[1]; 20968bdfbf40SJouni Malinen } 20978bdfbf40SJouni Malinen pos += 2 + pos[1]; 20988bdfbf40SJouni Malinen } 20998bdfbf40SJouni Malinen } 21008bdfbf40SJouni Malinen 2101334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2102334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 21038bdfbf40SJouni Malinen kfree(buf); 21048bdfbf40SJouni Malinen return ret; 21058bdfbf40SJouni Malinen } 21068bdfbf40SJouni Malinen 21076a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 21086a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 21096a7c9badSJouni Malinen { 21106a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 21113450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 21126a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 21136a7c9badSJouni Malinen u8 *ies; 21146a7c9badSJouni Malinen int ies_len; 21156a7c9badSJouni Malinen struct wmi_connect_cmd p; 21166a7c9badSJouni Malinen int res; 2117be5abaafSVasanthakumar Thiagarajan int i, ret; 21186a7c9badSJouni Malinen 21196a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 21206a7c9badSJouni Malinen 2121990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 21226a7c9badSJouni Malinen return -EIO; 21236a7c9badSJouni Malinen 2124f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 21256a7c9badSJouni Malinen return -EOPNOTSUPP; 21266a7c9badSJouni Malinen 21276a7c9badSJouni Malinen if (info->beacon_ies) { 2128334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2129334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 21306a7c9badSJouni Malinen info->beacon_ies, 21316a7c9badSJouni Malinen info->beacon_ies_len); 21326a7c9badSJouni Malinen if (res) 21336a7c9badSJouni Malinen return res; 21346a7c9badSJouni Malinen } 21356a7c9badSJouni Malinen if (info->proberesp_ies) { 2136334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 21376a7c9badSJouni Malinen info->proberesp_ies_len); 21386a7c9badSJouni Malinen if (res) 21396a7c9badSJouni Malinen return res; 21406a7c9badSJouni Malinen } 21416a7c9badSJouni Malinen if (info->assocresp_ies) { 2142334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2143334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 21446a7c9badSJouni Malinen info->assocresp_ies, 21456a7c9badSJouni Malinen info->assocresp_ies_len); 21466a7c9badSJouni Malinen if (res) 21476a7c9badSJouni Malinen return res; 21486a7c9badSJouni Malinen } 21496a7c9badSJouni Malinen 21506a7c9badSJouni Malinen if (!add) 21516a7c9badSJouni Malinen return 0; 21526a7c9badSJouni Malinen 21539a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 21549a5b1318SJouni Malinen 21556a7c9badSJouni Malinen /* TODO: 21566a7c9badSJouni Malinen * info->interval 21576a7c9badSJouni Malinen * info->dtim_period 21586a7c9badSJouni Malinen */ 21596a7c9badSJouni Malinen 21606a7c9badSJouni Malinen if (info->head == NULL) 21616a7c9badSJouni Malinen return -EINVAL; 21626a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 21636a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 21646a7c9badSJouni Malinen if (ies > info->head + info->head_len) 21656a7c9badSJouni Malinen return -EINVAL; 21666a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 21676a7c9badSJouni Malinen 21686a7c9badSJouni Malinen if (info->ssid == NULL) 21696a7c9badSJouni Malinen return -EINVAL; 21703450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 21713450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 21726a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 21736a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 21746a7c9badSJouni Malinen 2175be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2176be5abaafSVasanthakumar Thiagarajan if (ret) 2177be5abaafSVasanthakumar Thiagarajan return ret; 21786a7c9badSJouni Malinen 21796a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 21806a7c9badSJouni Malinen 21816a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 21826a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 21836a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 21846a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21856a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 21866a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21876a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 21886a7c9badSJouni Malinen break; 21896a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 21906a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21916a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 21926a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21936a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 21946a7c9badSJouni Malinen break; 21956a7c9badSJouni Malinen } 21966a7c9badSJouni Malinen } 21976a7c9badSJouni Malinen if (p.auth_mode == 0) 21986a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 21993450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 22006a7c9badSJouni Malinen 22016a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 22026a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 22036a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22046a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22056a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 22066a7c9badSJouni Malinen break; 22076a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22086a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 22096a7c9badSJouni Malinen break; 22106a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22116a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 22126a7c9badSJouni Malinen break; 2213b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2214b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2215b8214df1SDai Shuibing break; 22166a7c9badSJouni Malinen } 22176a7c9badSJouni Malinen } 2218229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 22196a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2220240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2221229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2222240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 22236a7c9badSJouni Malinen 22246a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 22256a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22266a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22276a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 22286a7c9badSJouni Malinen break; 22296a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22306a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 22316a7c9badSJouni Malinen break; 22326a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22336a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 22346a7c9badSJouni Malinen break; 2235b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2236b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2237b8214df1SDai Shuibing break; 22386a7c9badSJouni Malinen default: 22396a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 22406a7c9badSJouni Malinen break; 22416a7c9badSJouni Malinen } 2242240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 22436a7c9badSJouni Malinen 22446a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2245f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 22466a7c9badSJouni Malinen 22473450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 22483450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 22493450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2250cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 22516a7c9badSJouni Malinen 2252c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2253c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2254c1762a3fSThirumalai Pachamuthu if (res < 0) 2255c1762a3fSThirumalai Pachamuthu return res; 2256c1762a3fSThirumalai Pachamuthu 22573ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 22583ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 22593ca9d1fcSAarthi Thiruvengadam } else { 22603ca9d1fcSAarthi Thiruvengadam /* 22613ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 22623ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 22633ca9d1fcSAarthi Thiruvengadam */ 22643ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 22653ca9d1fcSAarthi Thiruvengadam } 22663ca9d1fcSAarthi Thiruvengadam 2267334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 22689a5b1318SJouni Malinen if (res < 0) 22699a5b1318SJouni Malinen return res; 22709a5b1318SJouni Malinen 22719a5b1318SJouni Malinen return 0; 22726a7c9badSJouni Malinen } 22736a7c9badSJouni Malinen 22746a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 22756a7c9badSJouni Malinen struct beacon_parameters *info) 22766a7c9badSJouni Malinen { 22776a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 22786a7c9badSJouni Malinen } 22796a7c9badSJouni Malinen 22806a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 22816a7c9badSJouni Malinen struct beacon_parameters *info) 22826a7c9badSJouni Malinen { 22836a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 22846a7c9badSJouni Malinen } 22856a7c9badSJouni Malinen 22866a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 22876a7c9badSJouni Malinen { 22886a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 228959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22906a7c9badSJouni Malinen 2291f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 22926a7c9badSJouni Malinen return -EOPNOTSUPP; 229359c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 22946a7c9badSJouni Malinen return -ENOTCONN; 22956a7c9badSJouni Malinen 2296334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 229759c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 22986a7c9badSJouni Malinen 22996a7c9badSJouni Malinen return 0; 23006a7c9badSJouni Malinen } 23016a7c9badSJouni Malinen 230233e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 230333e5308dSJouni Malinen 230433e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 230533e5308dSJouni Malinen u8 *mac) 230633e5308dSJouni Malinen { 230733e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 230833e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 230933e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 231033e5308dSJouni Malinen 231133e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 231233e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 231333e5308dSJouni Malinen } 231433e5308dSJouni Malinen 231523875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 231623875136SJouni Malinen u8 *mac, struct station_parameters *params) 231723875136SJouni Malinen { 231823875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2319f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 232023875136SJouni Malinen 2321f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 232223875136SJouni Malinen return -EOPNOTSUPP; 232323875136SJouni Malinen 232423875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 232523875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 232623875136SJouni Malinen return -EOPNOTSUPP; 232723875136SJouni Malinen 232823875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2329334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2330334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2331334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2332334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 233323875136SJouni Malinen } 233423875136SJouni Malinen 233563fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 233663fa1e0cSJouni Malinen struct net_device *dev, 233763fa1e0cSJouni Malinen struct ieee80211_channel *chan, 233863fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 233963fa1e0cSJouni Malinen unsigned int duration, 234063fa1e0cSJouni Malinen u64 *cookie) 234163fa1e0cSJouni Malinen { 234263fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2343334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23441052261eSJouni Malinen u32 id; 234563fa1e0cSJouni Malinen 234663fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 234763fa1e0cSJouni Malinen * return -EBUSY */ 23481052261eSJouni Malinen id = ++vif->last_roc_id; 23491052261eSJouni Malinen if (id == 0) { 23501052261eSJouni Malinen /* Do not use 0 as the cookie value */ 23511052261eSJouni Malinen id = ++vif->last_roc_id; 23521052261eSJouni Malinen } 23531052261eSJouni Malinen *cookie = id; 235463fa1e0cSJouni Malinen 2355334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2356334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 235763fa1e0cSJouni Malinen } 235863fa1e0cSJouni Malinen 235963fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 236063fa1e0cSJouni Malinen struct net_device *dev, 236163fa1e0cSJouni Malinen u64 cookie) 236263fa1e0cSJouni Malinen { 236363fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2364334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 236563fa1e0cSJouni Malinen 23661052261eSJouni Malinen if (cookie != vif->last_roc_id) 236763fa1e0cSJouni Malinen return -ENOENT; 23681052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 236963fa1e0cSJouni Malinen 2370334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 237163fa1e0cSJouni Malinen } 237263fa1e0cSJouni Malinen 2373334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2374334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2375334234b5SVasanthakumar Thiagarajan unsigned int freq) 23768bdfbf40SJouni Malinen { 2377334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23788bdfbf40SJouni Malinen const u8 *pos; 23798bdfbf40SJouni Malinen u8 *p2p; 23808bdfbf40SJouni Malinen int p2p_len; 23818bdfbf40SJouni Malinen int ret; 23828bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 23838bdfbf40SJouni Malinen 23848bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 23858bdfbf40SJouni Malinen 23868bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 23878bdfbf40SJouni Malinen 23888bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 23898bdfbf40SJouni Malinen if (p2p == NULL) 23908bdfbf40SJouni Malinen return -ENOMEM; 23918bdfbf40SJouni Malinen p2p_len = 0; 23928bdfbf40SJouni Malinen 23938bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 23948bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 23958bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 23968bdfbf40SJouni Malinen break; 23978bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 23988bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 23998bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 24008bdfbf40SJouni Malinen } 24018bdfbf40SJouni Malinen pos += 2 + pos[1]; 24028bdfbf40SJouni Malinen } 24038bdfbf40SJouni Malinen 2404334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2405334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 24068bdfbf40SJouni Malinen kfree(p2p); 24078bdfbf40SJouni Malinen return ret; 24088bdfbf40SJouni Malinen } 24098bdfbf40SJouni Malinen 24108a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 24118a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 24128a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 24138a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2414e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2415e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 24168a6c8060SJouni Malinen { 24178a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 241859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24198a6c8060SJouni Malinen u32 id; 24208bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 24218bdfbf40SJouni Malinen 24228bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 24238bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2424f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 24258bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 24268bdfbf40SJouni Malinen /* 24278bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 24288bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 24298bdfbf40SJouni Malinen */ 24308bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2431334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 24328bdfbf40SJouni Malinen chan->center_freq); 24338bdfbf40SJouni Malinen } 24348a6c8060SJouni Malinen 2435cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24368a6c8060SJouni Malinen if (id == 0) { 24378a6c8060SJouni Malinen /* 24388a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 24398a6c8060SJouni Malinen * used for the command. 24408a6c8060SJouni Malinen */ 2441cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24428a6c8060SJouni Malinen } 24438a6c8060SJouni Malinen 24448a6c8060SJouni Malinen *cookie = id; 24453ca9d1fcSAarthi Thiruvengadam 24463ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 24473ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 24483ca9d1fcSAarthi Thiruvengadam /* 24493ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 24503ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 24513ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 24523ca9d1fcSAarthi Thiruvengadam * probe requests 24533ca9d1fcSAarthi Thiruvengadam */ 24543ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 24553ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 24563ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 24573ca9d1fcSAarthi Thiruvengadam } else { 2458334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2459334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 24608a6c8060SJouni Malinen buf, len); 24618a6c8060SJouni Malinen } 24623ca9d1fcSAarthi Thiruvengadam } 24638a6c8060SJouni Malinen 2464ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2465ae32c30aSJouni Malinen struct net_device *dev, 2466ae32c30aSJouni Malinen u16 frame_type, bool reg) 2467ae32c30aSJouni Malinen { 2468cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2469ae32c30aSJouni Malinen 2470ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2471ae32c30aSJouni Malinen __func__, frame_type, reg); 2472ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2473ae32c30aSJouni Malinen /* 2474ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2475ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2476ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2477ae32c30aSJouni Malinen */ 2478cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2479ae32c30aSJouni Malinen } 2480ae32c30aSJouni Malinen } 2481ae32c30aSJouni Malinen 248210509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 248310509f90SKalle Valo struct net_device *dev, 248410509f90SKalle Valo struct cfg80211_sched_scan_request *request) 248510509f90SKalle Valo { 248610509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 248710509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 248810509f90SKalle Valo u16 interval; 248910509f90SKalle Valo int ret; 249010509f90SKalle Valo u8 i; 249110509f90SKalle Valo 249210509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 249310509f90SKalle Valo return -EIO; 249410509f90SKalle Valo 249510509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 249610509f90SKalle Valo return -EBUSY; 249710509f90SKalle Valo 249810509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 249910509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 250010509f90SKalle Valo i, DISABLE_SSID_FLAG, 250110509f90SKalle Valo 0, NULL); 250210509f90SKalle Valo } 250310509f90SKalle Valo 250410509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 250510509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 250610509f90SKalle Valo 250710509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 250810509f90SKalle Valo interval, interval, 250910509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 251010509f90SKalle Valo 251110509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 251210509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 251310509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 251410509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 251510509f90SKalle Valo request->ssids[i].ssid_len, 251610509f90SKalle Valo request->ssids[i].ssid); 251710509f90SKalle Valo } 251810509f90SKalle Valo } 251910509f90SKalle Valo 252010509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 252110509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 252210509f90SKalle Valo WOW_FILTER_SSID, 252310509f90SKalle Valo WOW_HOST_REQ_DELAY); 252410509f90SKalle Valo if (ret) { 252510509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 252610509f90SKalle Valo return ret; 252710509f90SKalle Valo } 252810509f90SKalle Valo 252910509f90SKalle Valo /* this also clears IE in fw if it's not set */ 253010509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 253110509f90SKalle Valo WMI_FRAME_PROBE_REQ, 253210509f90SKalle Valo request->ie, request->ie_len); 253310509f90SKalle Valo if (ret) { 253410509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 253510509f90SKalle Valo ret); 253610509f90SKalle Valo return ret; 253710509f90SKalle Valo } 253810509f90SKalle Valo 253910509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 254010509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 254110509f90SKalle Valo if (ret) { 254210509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 254310509f90SKalle Valo ret); 254410509f90SKalle Valo return ret; 254510509f90SKalle Valo } 254610509f90SKalle Valo 254710509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 254810509f90SKalle Valo 254910509f90SKalle Valo return ret; 255010509f90SKalle Valo } 255110509f90SKalle Valo 255210509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 255310509f90SKalle Valo struct net_device *dev) 255410509f90SKalle Valo { 255510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 255610509f90SKalle Valo bool stopped; 255710509f90SKalle Valo 255810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 255910509f90SKalle Valo 256010509f90SKalle Valo if (!stopped) 256110509f90SKalle Valo return -EIO; 256210509f90SKalle Valo 256310509f90SKalle Valo return 0; 256410509f90SKalle Valo } 256510509f90SKalle Valo 2566f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2567f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2568f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2569f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2570f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2571f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2572f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2573f80574aeSJouni Malinen }, 2574ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2575ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2576ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2577ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2578ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2579ba1f6fe3SJouni Malinen }, 2580f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2581f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2582f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2583f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2584f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2585f80574aeSJouni Malinen }, 2586f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2587f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2588f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2589f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2590f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2591f80574aeSJouni Malinen }, 2592f80574aeSJouni Malinen }; 2593f80574aeSJouni Malinen 2594bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 259555055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 259655055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2597bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2598bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2599bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2600bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2601bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2602bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2603bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2604bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2605bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2606bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2607bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2608bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2609bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2610bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2611bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2612bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2613bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2614bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2615003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2616abcb344bSKalle Valo #ifdef CONFIG_PM 261752d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 261852d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2619abcb344bSKalle Valo #endif 26206a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 26216a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 26226a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 26236a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 262433e5308dSJouni Malinen .del_station = ath6kl_del_station, 262523875136SJouni Malinen .change_station = ath6kl_change_station, 262663fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 262763fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 26288a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2629ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 263010509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 263110509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2632bdcd8170SKalle Valo }; 2633bdcd8170SKalle Valo 26347125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2635ec4b7f60SKalle Valo { 263610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 263710509f90SKalle Valo 2638ec4b7f60SKalle Valo switch (vif->sme_state) { 2639c97a31b0SKalle Valo case SME_DISCONNECTED: 2640c97a31b0SKalle Valo break; 2641ec4b7f60SKalle Valo case SME_CONNECTING: 2642ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2643ec4b7f60SKalle Valo NULL, 0, 2644ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2645ec4b7f60SKalle Valo GFP_KERNEL); 2646ec4b7f60SKalle Valo break; 2647ec4b7f60SKalle Valo case SME_CONNECTED: 2648ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2649ec4b7f60SKalle Valo break; 2650ec4b7f60SKalle Valo } 2651ec4b7f60SKalle Valo 2652ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2653ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 26547125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2655ec4b7f60SKalle Valo 2656ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 26571f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 26581f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2659ec4b7f60SKalle Valo 2660ec4b7f60SKalle Valo /* disable scanning */ 26617125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 26627125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 26637125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 2664ec4b7f60SKalle Valo 2665ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2666ec4b7f60SKalle Valo } 2667ec4b7f60SKalle Valo 26687125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 26697125f01dSKalle Valo { 26707125f01dSKalle Valo struct ath6kl_vif *vif; 26717125f01dSKalle Valo 26727125f01dSKalle Valo vif = ath6kl_vif_first(ar); 26737125f01dSKalle Valo if (!vif) { 26747125f01dSKalle Valo /* save the current power mode before enabling power save */ 26757125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 26767125f01dSKalle Valo 26777125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 26787125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 26797125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 26807125f01dSKalle Valo return; 26817125f01dSKalle Valo } 26827125f01dSKalle Valo 26837125f01dSKalle Valo /* 26847125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 26857125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 26867125f01dSKalle Valo * sleeps. 26877125f01dSKalle Valo */ 26887125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 26897125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 26907125f01dSKalle Valo } 26917125f01dSKalle Valo 2692c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 26938dafb70eSVasanthakumar Thiagarajan { 26942132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 26952132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 26968dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 26978dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 26988dafb70eSVasanthakumar Thiagarajan } 26998dafb70eSVasanthakumar Thiagarajan 2700de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2701108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 270210509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 270310509f90SKalle Valo (unsigned long) vif); 270410509f90SKalle Valo 2705de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2706478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 27078dafb70eSVasanthakumar Thiagarajan 270880abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 270980abaf9bSVasanthakumar Thiagarajan 27108dafb70eSVasanthakumar Thiagarajan return 0; 27118dafb70eSVasanthakumar Thiagarajan } 27128dafb70eSVasanthakumar Thiagarajan 2713c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 27148dafb70eSVasanthakumar Thiagarajan { 271555055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 271680abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 271755055976SVasanthakumar Thiagarajan 27182132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2719108438bcSVasanthakumar Thiagarajan 272055055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 272155055976SVasanthakumar Thiagarajan 272255055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 272355055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 272455055976SVasanthakumar Thiagarajan 272580abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 272680abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 272780abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 272880abaf9bSVasanthakumar Thiagarajan } 272980abaf9bSVasanthakumar Thiagarajan 273027929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 273155055976SVasanthakumar Thiagarajan 273255055976SVasanthakumar Thiagarajan ar->num_vif--; 27338dafb70eSVasanthakumar Thiagarajan } 27348dafb70eSVasanthakumar Thiagarajan 27358dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 273655055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 273755055976SVasanthakumar Thiagarajan u8 nw_type) 27388dafb70eSVasanthakumar Thiagarajan { 27398dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2740108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 27418dafb70eSVasanthakumar Thiagarajan 274255055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 27438dafb70eSVasanthakumar Thiagarajan if (!ndev) 27448dafb70eSVasanthakumar Thiagarajan return NULL; 27458dafb70eSVasanthakumar Thiagarajan 2746108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2747108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2748108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2749108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2750108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2751108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2752108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2753108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2754334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 275555055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 27568dafb70eSVasanthakumar Thiagarajan 275755055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 275855055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 275955055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 276055055976SVasanthakumar Thiagarajan 0x2; 276155055976SVasanthakumar Thiagarajan 27628dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 27638dafb70eSVasanthakumar Thiagarajan 2764e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 27658dafb70eSVasanthakumar Thiagarajan 2766c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 27678dafb70eSVasanthakumar Thiagarajan goto err; 27688dafb70eSVasanthakumar Thiagarajan 276927929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 27708dafb70eSVasanthakumar Thiagarajan goto err; 27718dafb70eSVasanthakumar Thiagarajan 277255055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 277314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 277459c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 27758dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 277659c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 27778dafb70eSVasanthakumar Thiagarajan 277855055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 277955055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 278055055976SVasanthakumar Thiagarajan 278111f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2782990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 278311f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2784990bd915SVasanthakumar Thiagarajan 27858dafb70eSVasanthakumar Thiagarajan return ndev; 27868dafb70eSVasanthakumar Thiagarajan 27878dafb70eSVasanthakumar Thiagarajan err: 278827929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 278927929723SVasanthakumar Thiagarajan free_netdev(ndev); 2790bdcd8170SKalle Valo return NULL; 2791bdcd8170SKalle Valo } 2792bdcd8170SKalle Valo 279346d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 279446d33a21SKalle Valo { 279546d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 279646d33a21SKalle Valo int ret; 279746d33a21SKalle Valo 279846d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 279946d33a21SKalle Valo 280046d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 280146d33a21SKalle Valo 280246d33a21SKalle Valo /* set device pointer for wiphy */ 280346d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 280446d33a21SKalle Valo 280546d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 280646d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 280746d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 280846d33a21SKalle Valo if (ar->p2p) { 280946d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 281046d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 281146d33a21SKalle Valo } 281246d33a21SKalle Valo 281346d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 281446d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 281546d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 281646d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 281746d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 281846d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 281946d33a21SKalle Valo 282046d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 282146d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 282246d33a21SKalle Valo 282346d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 282446d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 282546d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 282646d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 282746d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 282846d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 282946d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 283046d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 283146d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 283246d33a21SKalle Valo 283346d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 283446d33a21SKalle Valo 283546d33a21SKalle Valo ret = wiphy_register(wiphy); 283646d33a21SKalle Valo if (ret < 0) { 283746d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 283846d33a21SKalle Valo return ret; 283946d33a21SKalle Valo } 284046d33a21SKalle Valo 284146d33a21SKalle Valo return 0; 284246d33a21SKalle Valo } 284346d33a21SKalle Valo 284446d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 2845bdcd8170SKalle Valo { 2846be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 284745eaa78fSKalle Valo } 284846d33a21SKalle Valo 284945eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 285045eaa78fSKalle Valo { 285145eaa78fSKalle Valo struct ath6kl *ar; 285245eaa78fSKalle Valo struct wiphy *wiphy; 285345eaa78fSKalle Valo 285445eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 285545eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 285645eaa78fSKalle Valo 285745eaa78fSKalle Valo if (!wiphy) { 285845eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 285945eaa78fSKalle Valo return NULL; 286045eaa78fSKalle Valo } 286145eaa78fSKalle Valo 286245eaa78fSKalle Valo ar = wiphy_priv(wiphy); 286345eaa78fSKalle Valo ar->wiphy = wiphy; 286445eaa78fSKalle Valo 286545eaa78fSKalle Valo return ar; 286645eaa78fSKalle Valo } 286745eaa78fSKalle Valo 286845eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 286945eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 287045eaa78fSKalle Valo { 2871be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2872bdcd8170SKalle Valo } 287345eaa78fSKalle Valo 2874