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> 19d6a434d6SKalle Valo #include <linux/export.h> 206eb07cafSPaul Gortmaker 21bdcd8170SKalle Valo #include "core.h" 22bdcd8170SKalle Valo #include "cfg80211.h" 23bdcd8170SKalle Valo #include "debug.h" 24abcb344bSKalle Valo #include "hif-ops.h" 25003353b0SKalle Valo #include "testmode.h" 26bdcd8170SKalle Valo 27bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 28bdcd8170SKalle Valo .bitrate = (_rate), \ 29bdcd8170SKalle Valo .flags = (_flags), \ 30bdcd8170SKalle Valo .hw_value = (_rateid), \ 31bdcd8170SKalle Valo } 32bdcd8170SKalle Valo 33bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 34bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 35bdcd8170SKalle Valo .hw_value = (_channel), \ 36bdcd8170SKalle Valo .center_freq = (_freq), \ 37bdcd8170SKalle Valo .flags = (_flags), \ 38bdcd8170SKalle Valo .max_antenna_gain = 0, \ 39bdcd8170SKalle Valo .max_power = 30, \ 40bdcd8170SKalle Valo } 41bdcd8170SKalle Valo 42bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 43bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 44bdcd8170SKalle Valo .hw_value = (_channel), \ 45bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 46bdcd8170SKalle Valo .flags = (_flags), \ 47bdcd8170SKalle Valo .max_antenna_gain = 0, \ 48bdcd8170SKalle Valo .max_power = 30, \ 49bdcd8170SKalle Valo } 50bdcd8170SKalle Valo 51bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 52bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 53bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 54bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 55bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 56bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 57bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 58bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 59bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 60bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 61bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 62bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 63bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 64bdcd8170SKalle Valo }; 65bdcd8170SKalle Valo 66bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 67bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 68bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 69bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 70bdcd8170SKalle Valo 71bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 72bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 73bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 74bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 75bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 76bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 77bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 78bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 79bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 80bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 81bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 82bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 83bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 84bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 85bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 86bdcd8170SKalle Valo }; 87bdcd8170SKalle Valo 88bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 89bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 90bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 91bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 92bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 93bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 94bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 95bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 96bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 97bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 98bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 99bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 100bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 101bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 102bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 103bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 104bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 105bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 106bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 107bdcd8170SKalle Valo CHAN5G(216, 0), 108bdcd8170SKalle Valo }; 109bdcd8170SKalle Valo 110bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 111bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 112bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 113bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 114bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 115bdcd8170SKalle Valo }; 116bdcd8170SKalle Valo 117bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 118bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 119bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 120bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 121bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 122bdcd8170SKalle Valo }; 123bdcd8170SKalle Valo 124837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 125837cb97eSJouni Malinen 12610509f90SKalle Valo /* returns true if scheduled scan was stopped */ 12710509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 12810509f90SKalle Valo { 12910509f90SKalle Valo struct ath6kl *ar = vif->ar; 13010509f90SKalle Valo 13110509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 13210509f90SKalle Valo return false; 13310509f90SKalle Valo 13410509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 13510509f90SKalle Valo 13610509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 13710509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 13810509f90SKalle Valo 13910509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 14010509f90SKalle Valo 14110509f90SKalle Valo return true; 14210509f90SKalle Valo } 14310509f90SKalle Valo 14410509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 14510509f90SKalle Valo { 14610509f90SKalle Valo struct ath6kl *ar = vif->ar; 14710509f90SKalle Valo bool stopped; 14810509f90SKalle Valo 14910509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 15010509f90SKalle Valo 15110509f90SKalle Valo if (!stopped) 15210509f90SKalle Valo return; 15310509f90SKalle Valo 15410509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 15510509f90SKalle Valo } 15610509f90SKalle Valo 157240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 158bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 159bdcd8170SKalle Valo { 160bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 161bdcd8170SKalle Valo 162bdcd8170SKalle Valo if (!wpa_version) { 1633450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 164bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1653450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 166bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1673450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 168bdcd8170SKalle Valo } else { 169bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 170bdcd8170SKalle Valo return -ENOTSUPP; 171bdcd8170SKalle Valo } 172bdcd8170SKalle Valo 173bdcd8170SKalle Valo return 0; 174bdcd8170SKalle Valo } 175bdcd8170SKalle Valo 176240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 177bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 178bdcd8170SKalle Valo { 179bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 180bdcd8170SKalle Valo 181bdcd8170SKalle Valo switch (auth_type) { 182bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1833450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 184bdcd8170SKalle Valo break; 185bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1863450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 187bdcd8170SKalle Valo break; 188bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1893450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 190bdcd8170SKalle Valo break; 191bdcd8170SKalle Valo 192bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 1933450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 194bdcd8170SKalle Valo break; 195bdcd8170SKalle Valo 196bdcd8170SKalle Valo default: 197bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 198bdcd8170SKalle Valo return -ENOTSUPP; 199bdcd8170SKalle Valo } 200bdcd8170SKalle Valo 201bdcd8170SKalle Valo return 0; 202bdcd8170SKalle Valo } 203bdcd8170SKalle Valo 204240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 205bdcd8170SKalle Valo { 2063450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2073450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2083450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 211bdcd8170SKalle Valo __func__, cipher, ucast); 212bdcd8170SKalle Valo 213bdcd8170SKalle Valo switch (cipher) { 214bdcd8170SKalle Valo case 0: 215bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 216bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 217bdcd8170SKalle Valo *ar_cipher_len = 0; 218bdcd8170SKalle Valo break; 219bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 220bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 221bdcd8170SKalle Valo *ar_cipher_len = 5; 222bdcd8170SKalle Valo break; 223bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 224bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 225bdcd8170SKalle Valo *ar_cipher_len = 13; 226bdcd8170SKalle Valo break; 227bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 228bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 229bdcd8170SKalle Valo *ar_cipher_len = 0; 230bdcd8170SKalle Valo break; 231bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 232bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 233bdcd8170SKalle Valo *ar_cipher_len = 0; 234bdcd8170SKalle Valo break; 2355e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2365e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2375e07021eSDai Shuibing *ar_cipher_len = 0; 2385e07021eSDai Shuibing break; 239bdcd8170SKalle Valo default: 240bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 241bdcd8170SKalle Valo return -ENOTSUPP; 242bdcd8170SKalle Valo } 243bdcd8170SKalle Valo 244bdcd8170SKalle Valo return 0; 245bdcd8170SKalle Valo } 246bdcd8170SKalle Valo 247240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 248bdcd8170SKalle Valo { 249bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 250bdcd8170SKalle Valo 251bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2523450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2533450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2543450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2553450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 256837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2573450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2583450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2593450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2603450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 261bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2623450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 263bdcd8170SKalle Valo } 264bdcd8170SKalle Valo } 265bdcd8170SKalle Valo 266990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 267bdcd8170SKalle Valo { 268990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26959c98449SVasanthakumar Thiagarajan 270bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 271bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 272bdcd8170SKalle Valo return false; 273bdcd8170SKalle Valo } 274bdcd8170SKalle Valo 27559c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 276bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 277bdcd8170SKalle Valo return false; 278bdcd8170SKalle Valo } 279bdcd8170SKalle Valo 280bdcd8170SKalle Valo return true; 281bdcd8170SKalle Valo } 282bdcd8170SKalle Valo 2836981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2846981ffdcSKevin Fang { 2856981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2866981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2876981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2886981ffdcSKevin Fang } 2896981ffdcSKevin Fang 2906981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2916981ffdcSKevin Fang { 2926981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2936981ffdcSKevin Fang } 2946981ffdcSKevin Fang 29563541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 29663541212SAarthi Thiruvengadam { 29763541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 29863541212SAarthi Thiruvengadam pos[1] >= 4 && 29963541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 30063541212SAarthi Thiruvengadam pos[5] == 0x04); 30163541212SAarthi Thiruvengadam } 30263541212SAarthi Thiruvengadam 303334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3046981ffdcSKevin Fang size_t ies_len) 3056981ffdcSKevin Fang { 306334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3076981ffdcSKevin Fang const u8 *pos; 3086981ffdcSKevin Fang u8 *buf = NULL; 3096981ffdcSKevin Fang size_t len = 0; 3106981ffdcSKevin Fang int ret; 3116981ffdcSKevin Fang 3126981ffdcSKevin Fang /* 31363541212SAarthi Thiruvengadam * Clear previously set flag 31463541212SAarthi Thiruvengadam */ 31563541212SAarthi Thiruvengadam 31663541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 31763541212SAarthi Thiruvengadam 31863541212SAarthi Thiruvengadam /* 3196981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3206981ffdcSKevin Fang */ 3216981ffdcSKevin Fang 3226981ffdcSKevin Fang if (ies && ies_len) { 3236981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3246981ffdcSKevin Fang if (buf == NULL) 3256981ffdcSKevin Fang return -ENOMEM; 3266981ffdcSKevin Fang pos = ies; 3276981ffdcSKevin Fang 3286981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3296981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3306981ffdcSKevin Fang break; 3316981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3326981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3336981ffdcSKevin Fang len += 2 + pos[1]; 3346981ffdcSKevin Fang } 33563541212SAarthi Thiruvengadam 33663541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 33763541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 33863541212SAarthi Thiruvengadam 3396981ffdcSKevin Fang pos += 2 + pos[1]; 3406981ffdcSKevin Fang } 3416981ffdcSKevin Fang } 3426981ffdcSKevin Fang 343334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 344334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3456981ffdcSKevin Fang kfree(buf); 3466981ffdcSKevin Fang return ret; 3476981ffdcSKevin Fang } 3486981ffdcSKevin Fang 34955055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 35055055976SVasanthakumar Thiagarajan { 35155055976SVasanthakumar Thiagarajan switch (type) { 35255055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 35355055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 35455055976SVasanthakumar Thiagarajan break; 35555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 35655055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 35755055976SVasanthakumar Thiagarajan break; 35855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 35955055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36055055976SVasanthakumar Thiagarajan break; 36155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 36255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36355055976SVasanthakumar Thiagarajan break; 36455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 36555055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36655055976SVasanthakumar Thiagarajan break; 36755055976SVasanthakumar Thiagarajan default: 36855055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 36955055976SVasanthakumar Thiagarajan return -ENOTSUPP; 37055055976SVasanthakumar Thiagarajan } 37155055976SVasanthakumar Thiagarajan 37255055976SVasanthakumar Thiagarajan return 0; 37355055976SVasanthakumar Thiagarajan } 37455055976SVasanthakumar Thiagarajan 37555055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 37655055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 37755055976SVasanthakumar Thiagarajan { 37855055976SVasanthakumar Thiagarajan int i; 37955055976SVasanthakumar Thiagarajan 38055055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 38155055976SVasanthakumar Thiagarajan return false; 38255055976SVasanthakumar Thiagarajan 38355055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 38455055976SVasanthakumar Thiagarajan ar->num_vif)) 38555055976SVasanthakumar Thiagarajan return false; 38655055976SVasanthakumar Thiagarajan 38755055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 38855055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 38971f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 39055055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 39155055976SVasanthakumar Thiagarajan *if_idx = i; 39255055976SVasanthakumar Thiagarajan return true; 39355055976SVasanthakumar Thiagarajan } 39455055976SVasanthakumar Thiagarajan } 39555055976SVasanthakumar Thiagarajan } 39655055976SVasanthakumar Thiagarajan 3973226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 3983226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 39971f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4003226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4013226f68aSVasanthakumar Thiagarajan *if_idx = i; 4023226f68aSVasanthakumar Thiagarajan return true; 4033226f68aSVasanthakumar Thiagarajan } 4043226f68aSVasanthakumar Thiagarajan } 4053226f68aSVasanthakumar Thiagarajan } 4063226f68aSVasanthakumar Thiagarajan 40755055976SVasanthakumar Thiagarajan return false; 40855055976SVasanthakumar Thiagarajan } 40955055976SVasanthakumar Thiagarajan 410bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 411bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 412bdcd8170SKalle Valo { 413bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 41459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 415bdcd8170SKalle Valo int status; 4163ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 417bdcd8170SKalle Valo 41810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 41910509f90SKalle Valo 42014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 421bdcd8170SKalle Valo 422990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 423bdcd8170SKalle Valo return -EIO; 424bdcd8170SKalle Valo 425bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 426bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 427bdcd8170SKalle Valo return -EBUSY; 428bdcd8170SKalle Valo } 429bdcd8170SKalle Valo 430bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 431bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 432bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 433bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 434bdcd8170SKalle Valo return -EINVAL; 435bdcd8170SKalle Valo } 436bdcd8170SKalle Valo 437bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 438bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 439bdcd8170SKalle Valo return -ERESTARTSYS; 440bdcd8170SKalle Valo } 441bdcd8170SKalle Valo 442bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 443bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 444bdcd8170SKalle Valo up(&ar->sem); 445bdcd8170SKalle Valo return -EBUSY; 446bdcd8170SKalle Valo } 447bdcd8170SKalle Valo 448bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 449bdcd8170SKalle Valo /* 450bdcd8170SKalle Valo * sleep until the command queue drains 451bdcd8170SKalle Valo */ 452bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 453bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 454bdcd8170SKalle Valo WMI_TIMEOUT); 455bdcd8170SKalle Valo if (signal_pending(current)) { 456bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 457bdcd8170SKalle Valo up(&ar->sem); 458bdcd8170SKalle Valo return -EINTR; 459bdcd8170SKalle Valo } 460bdcd8170SKalle Valo } 461bdcd8170SKalle Valo 462334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 463743b4518SDan Carpenter if (status) { 464743b4518SDan Carpenter up(&ar->sem); 4656981ffdcSKevin Fang return status; 466743b4518SDan Carpenter } 4676e786cb1SJouni Malinen 4686e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 469542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4706981ffdcSKevin Fang 47159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4723450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4733450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 474cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 475334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 476334234b5SVasanthakumar Thiagarajan vif->req_bssid, 477f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 478bdcd8170SKalle Valo 479bdcd8170SKalle Valo up(&ar->sem); 480bdcd8170SKalle Valo if (status) { 481bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 482bdcd8170SKalle Valo return -EIO; 483bdcd8170SKalle Valo } 484bdcd8170SKalle Valo return 0; 4853450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4863450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 487240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 488bdcd8170SKalle Valo } 489bdcd8170SKalle Valo 4903450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4913450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4923450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 493bdcd8170SKalle Valo 494bdcd8170SKalle Valo if (sme->channel) 495f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 496bdcd8170SKalle Valo 4978c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 498bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 4998c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 500bdcd8170SKalle Valo 501240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 502bdcd8170SKalle Valo 503240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 504bdcd8170SKalle Valo if (status) { 505bdcd8170SKalle Valo up(&ar->sem); 506bdcd8170SKalle Valo return status; 507bdcd8170SKalle Valo } 508bdcd8170SKalle Valo 509bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 511bdcd8170SKalle Valo else 512240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 513bdcd8170SKalle Valo 514240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 515bdcd8170SKalle Valo 516bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 517240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 518bdcd8170SKalle Valo 519bdcd8170SKalle Valo if ((sme->key_len) && 5203450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5213450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 522bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 523bdcd8170SKalle Valo 524792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 525bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 526bdcd8170SKalle Valo sme->key_idx); 527bdcd8170SKalle Valo up(&ar->sem); 528bdcd8170SKalle Valo return -ENOENT; 529bdcd8170SKalle Valo } 530bdcd8170SKalle Valo 5316f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 532bdcd8170SKalle Valo key->key_len = sme->key_len; 533bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5343450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5353450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 536bdcd8170SKalle Valo 537334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5383450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 539bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 540bdcd8170SKalle Valo key->key_len, 541f4bb9a6fSJouni Malinen NULL, 0, 542bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 543bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 544bdcd8170SKalle Valo } 545bdcd8170SKalle Valo 546bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 54759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 548240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 549240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 550bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 551bdcd8170SKalle Valo up(&ar->sem); 552bdcd8170SKalle Valo return -EIO; 553bdcd8170SKalle Valo } 554bdcd8170SKalle Valo } 555bdcd8170SKalle Valo 556f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 557bdcd8170SKalle Valo 5583ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5593ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5603ca9d1fcSAarthi Thiruvengadam 561bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 562bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 563bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 564bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 565bdcd8170SKalle Valo __func__, 5663450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5673450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 568f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 569bdcd8170SKalle Valo 570cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 571334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5723450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5733450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5743450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5753450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5763450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 577f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 5783ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 579bdcd8170SKalle Valo 580bdcd8170SKalle Valo up(&ar->sem); 581bdcd8170SKalle Valo 582bdcd8170SKalle Valo if (status == -EINVAL) { 5833450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5843450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 585bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 586bdcd8170SKalle Valo return -ENOENT; 587bdcd8170SKalle Valo } else if (status) { 588bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 589bdcd8170SKalle Valo return -EIO; 590bdcd8170SKalle Valo } 591bdcd8170SKalle Valo 592bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5933450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5943450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 595de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 596bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 597bdcd8170SKalle Valo } 598bdcd8170SKalle Valo 599bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 60059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 601bdcd8170SKalle Valo 602bdcd8170SKalle Valo return 0; 603bdcd8170SKalle Valo } 604bdcd8170SKalle Valo 6055e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6065e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6074eab6f4fSRaja Mani enum network_type nw_type, 6084eab6f4fSRaja Mani const u8 *bssid, 60901cac476SJouni Malinen struct ieee80211_channel *chan, 6105e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6115e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 61201cac476SJouni Malinen { 613240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 61401cac476SJouni Malinen struct cfg80211_bss *bss; 6154eab6f4fSRaja Mani u16 cap_mask, cap_val; 61601cac476SJouni Malinen u8 *ie; 61701cac476SJouni Malinen 6184eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6194eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6204eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6214eab6f4fSRaja Mani } else { 6224eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6234eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6244eab6f4fSRaja Mani } 6254eab6f4fSRaja Mani 626be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6274eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6284eab6f4fSRaja Mani cap_mask, cap_val); 62901cac476SJouni Malinen if (bss == NULL) { 63001cac476SJouni Malinen /* 63101cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 63201cac476SJouni Malinen * generate a partial entry until the first BSS info 63301cac476SJouni Malinen * event becomes available. 63401cac476SJouni Malinen * 63501cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 63601cac476SJouni Malinen * IEs from the target. 63701cac476SJouni Malinen */ 6383450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 63901cac476SJouni Malinen if (ie == NULL) 6405e13fd35SVasanthakumar Thiagarajan return NULL; 64101cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6423450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6433450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6443450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 645be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6464eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6473450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 64801cac476SJouni Malinen 0, GFP_KERNEL); 64901cac476SJouni Malinen if (bss) 6504eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6514eab6f4fSRaja Mani "cfg80211\n", bssid); 65201cac476SJouni Malinen kfree(ie); 65301cac476SJouni Malinen } else 6545e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 65501cac476SJouni Malinen 6565e13fd35SVasanthakumar Thiagarajan return bss; 65701cac476SJouni Malinen } 65801cac476SJouni Malinen 659240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 660bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 661bdcd8170SKalle Valo u16 beacon_intvl, 662bdcd8170SKalle Valo enum network_type nw_type, 663bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 664bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 665bdcd8170SKalle Valo { 66601cac476SJouni Malinen struct ieee80211_channel *chan; 667240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6685e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 669bdcd8170SKalle Valo 670bdcd8170SKalle Valo /* capinfo + listen interval */ 671bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 672bdcd8170SKalle Valo 673bdcd8170SKalle Valo /* capinfo + status code + associd */ 674bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 675bdcd8170SKalle Valo 676bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 677bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 678bdcd8170SKalle Valo assoc_resp_ie_offset; 679bdcd8170SKalle Valo 680bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 681bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 682bdcd8170SKalle Valo 68332c10874SJouni Malinen /* 68432c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 68532c10874SJouni Malinen * a Beacon frame from the AP is seen. 68632c10874SJouni Malinen */ 687cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 68859c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 68932c10874SJouni Malinen 690bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 691551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 692bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 693bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 694bdcd8170SKalle Valo return; 695bdcd8170SKalle Valo } 696bdcd8170SKalle Valo } 697bdcd8170SKalle Valo 698bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 699551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 700551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 701bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 702bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 703bdcd8170SKalle Valo return; 704bdcd8170SKalle Valo } 705bdcd8170SKalle Valo } 706bdcd8170SKalle Valo 707be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 708bdcd8170SKalle Valo 7095e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7105e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7115e13fd35SVasanthakumar Thiagarajan if (!bss) { 7124eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 713bdcd8170SKalle Valo return; 714bdcd8170SKalle Valo } 715bdcd8170SKalle Valo 7164eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7174eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7184eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7194eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7205e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 72101cac476SJouni Malinen return; 72201cac476SJouni Malinen } 72301cac476SJouni Malinen 72414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 725bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 72614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 727240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 728bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 729bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 730bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7315e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 73214ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 733bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7345e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 735bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 736bdcd8170SKalle Valo } 737bdcd8170SKalle Valo } 738bdcd8170SKalle Valo 739bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 740bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 741bdcd8170SKalle Valo { 742d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7433450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 744bdcd8170SKalle Valo 745bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 746bdcd8170SKalle Valo reason_code); 747bdcd8170SKalle Valo 74810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 74910509f90SKalle Valo 750990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 751bdcd8170SKalle Valo return -EIO; 752bdcd8170SKalle Valo 753bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 754bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 755bdcd8170SKalle Valo return -EBUSY; 756bdcd8170SKalle Valo } 757bdcd8170SKalle Valo 758bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 759bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 760bdcd8170SKalle Valo return -ERESTARTSYS; 761bdcd8170SKalle Valo } 762bdcd8170SKalle Valo 763cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 764240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7653450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7663450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 767bdcd8170SKalle Valo 768bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7698c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 770bdcd8170SKalle Valo 771bdcd8170SKalle Valo up(&ar->sem); 772bdcd8170SKalle Valo 77314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 774170826ddSVasanthakumar Thiagarajan 775bdcd8170SKalle Valo return 0; 776bdcd8170SKalle Valo } 777bdcd8170SKalle Valo 778240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 779bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 780bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 781bdcd8170SKalle Valo { 782240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 78359c98449SVasanthakumar Thiagarajan 78414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 78514ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 78614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 787bdcd8170SKalle Valo } 788bdcd8170SKalle Valo 789f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 790551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 791bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 792bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 793bdcd8170SKalle Valo return; 794bdcd8170SKalle Valo } 795bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 796240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 797bdcd8170SKalle Valo return; 798bdcd8170SKalle Valo } 799bdcd8170SKalle Valo 800f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 801551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 802551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 803bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 804bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 805bdcd8170SKalle Valo return; 806bdcd8170SKalle Valo } 807bdcd8170SKalle Valo } 808bdcd8170SKalle Valo 8091de547d6SVasanthakumar Thiagarajan /* 8101de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8111de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8121de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8131de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8141de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8151de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8161de547d6SVasanthakumar Thiagarajan */ 817bdcd8170SKalle Valo 8181de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 819334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 820bdcd8170SKalle Valo return; 821bdcd8170SKalle Valo } 822bdcd8170SKalle Valo 82359c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 824bdcd8170SKalle Valo 82514ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 826240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 827bdcd8170SKalle Valo bssid, NULL, 0, 828bdcd8170SKalle Valo NULL, 0, 829bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 830bdcd8170SKalle Valo GFP_KERNEL); 83114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 832240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 833bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 834bdcd8170SKalle Valo } 835bdcd8170SKalle Valo 83614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 839bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 840bdcd8170SKalle Valo struct cfg80211_scan_request *request) 841bdcd8170SKalle Valo { 842d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 84359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8441276c9efSEdward Lu s8 n_channels = 0; 8451276c9efSEdward Lu u16 *channels = NULL; 846bdcd8170SKalle Valo int ret = 0; 847f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 848bdcd8170SKalle Valo 849990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 850bdcd8170SKalle Valo return -EIO; 851bdcd8170SKalle Valo 85210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 85310509f90SKalle Valo 854bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 85559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8561b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 857240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 85859c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8591b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8601b1e6ee3SJouni Malinen if (ret) { 861bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8621b1e6ee3SJouni Malinen return ret; 863bdcd8170SKalle Valo } 864bdcd8170SKalle Valo } 865bdcd8170SKalle Valo 866bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 867bdcd8170SKalle Valo u8 i; 868bdcd8170SKalle Valo 869bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 870bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 871bdcd8170SKalle Valo 872bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 873334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 874334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 875bdcd8170SKalle Valo request->ssids[i].ssid_len, 876bdcd8170SKalle Valo request->ssids[i].ssid); 877bdcd8170SKalle Valo } 878bdcd8170SKalle Valo 87910509f90SKalle Valo /* 88010509f90SKalle Valo * FIXME: we should clear the IE in fw if it's not set so just 88110509f90SKalle Valo * remove the check altogether 88210509f90SKalle Valo */ 883b84da8c7SJouni Malinen if (request->ie) { 884334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 885334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 886b84da8c7SJouni Malinen request->ie, request->ie_len); 887b84da8c7SJouni Malinen if (ret) { 888b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 889b84da8c7SJouni Malinen "scan"); 890b84da8c7SJouni Malinen return ret; 891b84da8c7SJouni Malinen } 892b84da8c7SJouni Malinen } 893b84da8c7SJouni Malinen 89411869befSJouni Malinen /* 89511869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 89611869befSJouni Malinen * channels. If the list is longer than the target supports, do not 89711869befSJouni Malinen * configure the list and instead, scan all available channels. 89811869befSJouni Malinen */ 89911869befSJouni Malinen if (request->n_channels > 0 && 90011869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9011276c9efSEdward Lu u8 i; 9021276c9efSEdward Lu 90311869befSJouni Malinen n_channels = request->n_channels; 9041276c9efSEdward Lu 9051276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9061276c9efSEdward Lu if (channels == NULL) { 9071276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9081276c9efSEdward Lu "scan all channels"); 9091276c9efSEdward Lu n_channels = 0; 9101276c9efSEdward Lu } 9111276c9efSEdward Lu 9121276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9131276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9141276c9efSEdward Lu } 9151276c9efSEdward Lu 91659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 917f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 918f1f92179SVasanthakumar Thiagarajan 9193ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9203ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9213ca9d1fcSAarthi Thiruvengadam /* 9223ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9233ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9243ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9253ca9d1fcSAarthi Thiruvengadam * probe requests 9263ca9d1fcSAarthi Thiruvengadam */ 9273ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9283ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9293ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 9303ca9d1fcSAarthi Thiruvengadam channels, request->no_cck, 9313ca9d1fcSAarthi Thiruvengadam request->rates); 9323ca9d1fcSAarthi Thiruvengadam } else { 9333ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9343ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9353ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 936334234b5SVasanthakumar Thiagarajan channels); 9373ca9d1fcSAarthi Thiruvengadam } 9381b1e6ee3SJouni Malinen if (ret) 939bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 94011869befSJouni Malinen else 94114ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 942bdcd8170SKalle Valo 9431276c9efSEdward Lu kfree(channels); 9441276c9efSEdward Lu 945bdcd8170SKalle Valo return ret; 946bdcd8170SKalle Valo } 947bdcd8170SKalle Valo 9481c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 949bdcd8170SKalle Valo { 950240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9516fd1eaceSKalle Valo int i; 952bdcd8170SKalle Valo 9531c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9541c17d313SKalle Valo aborted ? " aborted" : ""); 955bdcd8170SKalle Valo 95614ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9576fd1eaceSKalle Valo return; 9586fd1eaceSKalle Valo 9591c17d313SKalle Valo if (aborted) 9606fd1eaceSKalle Valo goto out; 961bdcd8170SKalle Valo 96214ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 96314ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 964334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 965334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 966bdcd8170SKalle Valo 0, NULL); 967bdcd8170SKalle Valo } 968bdcd8170SKalle Valo } 9696fd1eaceSKalle Valo 9706fd1eaceSKalle Valo out: 971cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 97214ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 973bdcd8170SKalle Valo } 974bdcd8170SKalle Valo 975bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 976bdcd8170SKalle Valo u8 key_index, bool pairwise, 977bdcd8170SKalle Valo const u8 *mac_addr, 978bdcd8170SKalle Valo struct key_params *params) 979bdcd8170SKalle Valo { 980d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 98159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 982bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 9834a8ce2fdSSujith Manoharan int seq_len; 984bdcd8170SKalle Valo u8 key_usage; 985bdcd8170SKalle Valo u8 key_type; 986bdcd8170SKalle Valo 987990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 988bdcd8170SKalle Valo return -EIO; 989bdcd8170SKalle Valo 990837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 991837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 992837cb97eSJouni Malinen return -EINVAL; 993240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 994240d2799SVasanthakumar Thiagarajan params->key); 995837cb97eSJouni Malinen } 996837cb97eSJouni Malinen 997792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 998bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 999bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1000bdcd8170SKalle Valo key_index); 1001bdcd8170SKalle Valo return -ENOENT; 1002bdcd8170SKalle Valo } 1003bdcd8170SKalle Valo 10046f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1005bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1006bdcd8170SKalle Valo 1007bdcd8170SKalle Valo if (pairwise) 1008bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1009bdcd8170SKalle Valo else 1010bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1011bdcd8170SKalle Valo 10124a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10135e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10145e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10155e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10165e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10175e07021eSDai Shuibing } 1018bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10195e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1020bdcd8170SKalle Valo return -EINVAL; 1021bdcd8170SKalle Valo 1022bdcd8170SKalle Valo key->key_len = params->key_len; 1023bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10245e07021eSDai Shuibing key->seq_len = seq_len; 1025bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1026bdcd8170SKalle Valo key->cipher = params->cipher; 1027bdcd8170SKalle Valo 1028bdcd8170SKalle Valo switch (key->cipher) { 1029bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1030bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1031bdcd8170SKalle Valo key_type = WEP_CRYPT; 1032bdcd8170SKalle Valo break; 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1035bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1036bdcd8170SKalle Valo break; 1037bdcd8170SKalle Valo 1038bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1039bdcd8170SKalle Valo key_type = AES_CRYPT; 1040bdcd8170SKalle Valo break; 10415e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10425e07021eSDai Shuibing key_type = WAPI_CRYPT; 10435e07021eSDai Shuibing break; 1044bdcd8170SKalle Valo 1045bdcd8170SKalle Valo default: 1046bdcd8170SKalle Valo return -ENOTSUPP; 1047bdcd8170SKalle Valo } 1048bdcd8170SKalle Valo 10493450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10503450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1051bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1052de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1053bdcd8170SKalle Valo 1054bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1055bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1056bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1057bdcd8170SKalle Valo key_usage, key->seq_len); 1058bdcd8170SKalle Valo 1059f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10604703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 10614703290aSJouni Malinen key_type == WAPI_CRYPT) && params) { 10629a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10639a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10649a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10659a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10669a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 106759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10689a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10699a5b1318SJouni Malinen "key configuration until AP mode has been " 10709a5b1318SJouni Malinen "started\n"); 10719a5b1318SJouni Malinen /* 10729a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10739a5b1318SJouni Malinen * the connected event is received from the target. 10749a5b1318SJouni Malinen */ 10759a5b1318SJouni Malinen return 0; 10769a5b1318SJouni Malinen } 10779a5b1318SJouni Malinen } 10789a5b1318SJouni Malinen 1079f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 108059c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1081151411e8SJouni Malinen /* 1082151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1083151411e8SJouni Malinen * the AP mode has properly started 1084151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1085151411e8SJouni Malinen */ 1086151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1087151411e8SJouni Malinen "until AP mode has been started\n"); 10886f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10896f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10906f2a73f9SVasanthakumar Thiagarajan key->key_len); 1091151411e8SJouni Malinen return 0; 1092151411e8SJouni Malinen } 1093151411e8SJouni Malinen 10947cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1095bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1096f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1097f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1098bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1099bdcd8170SKalle Valo } 1100bdcd8170SKalle Valo 1101bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1102bdcd8170SKalle Valo u8 key_index, bool pairwise, 1103bdcd8170SKalle Valo const u8 *mac_addr) 1104bdcd8170SKalle Valo { 1105d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11066f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1109bdcd8170SKalle Valo 1110990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1111bdcd8170SKalle Valo return -EIO; 1112bdcd8170SKalle Valo 1113792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1114bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1115bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1116bdcd8170SKalle Valo key_index); 1117bdcd8170SKalle Valo return -ENOENT; 1118bdcd8170SKalle Valo } 1119bdcd8170SKalle Valo 11206f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1121bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1122bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1123bdcd8170SKalle Valo return 0; 1124bdcd8170SKalle Valo } 1125bdcd8170SKalle Valo 11266f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1127bdcd8170SKalle Valo 1128334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1129bdcd8170SKalle Valo } 1130bdcd8170SKalle Valo 1131bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1132bdcd8170SKalle Valo u8 key_index, bool pairwise, 1133bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1134bdcd8170SKalle Valo void (*callback) (void *cookie, 1135bdcd8170SKalle Valo struct key_params *)) 1136bdcd8170SKalle Valo { 11376f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1138bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1139bdcd8170SKalle Valo struct key_params params; 1140bdcd8170SKalle Valo 1141bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1142bdcd8170SKalle Valo 1143990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1144bdcd8170SKalle Valo return -EIO; 1145bdcd8170SKalle Valo 1146792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1147bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1148bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1149bdcd8170SKalle Valo key_index); 1150bdcd8170SKalle Valo return -ENOENT; 1151bdcd8170SKalle Valo } 1152bdcd8170SKalle Valo 11536f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1154bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1155bdcd8170SKalle Valo params.cipher = key->cipher; 1156bdcd8170SKalle Valo params.key_len = key->key_len; 1157bdcd8170SKalle Valo params.seq_len = key->seq_len; 1158bdcd8170SKalle Valo params.seq = key->seq; 1159bdcd8170SKalle Valo params.key = key->key; 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo callback(cookie, ¶ms); 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1164bdcd8170SKalle Valo } 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1167bdcd8170SKalle Valo struct net_device *ndev, 1168bdcd8170SKalle Valo u8 key_index, bool unicast, 1169bdcd8170SKalle Valo bool multicast) 1170bdcd8170SKalle Valo { 1171d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 117259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1173bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1174bdcd8170SKalle Valo u8 key_usage; 1175229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1176bdcd8170SKalle Valo 1177bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1178bdcd8170SKalle Valo 1179990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1180bdcd8170SKalle Valo return -EIO; 1181bdcd8170SKalle Valo 1182792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1183bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1184bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1185bdcd8170SKalle Valo __func__, key_index); 1186bdcd8170SKalle Valo return -ENOENT; 1187bdcd8170SKalle Valo } 1188bdcd8170SKalle Valo 11896f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1191bdcd8170SKalle Valo __func__, key_index); 1192bdcd8170SKalle Valo return -EINVAL; 1193bdcd8170SKalle Valo } 1194bdcd8170SKalle Valo 11953450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11966f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1197bdcd8170SKalle Valo key_usage = GROUP_USAGE; 11983450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1199bdcd8170SKalle Valo key_usage |= TX_USAGE; 1200229ed6b5SEdward Lu if (unicast) 12013450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1202229ed6b5SEdward Lu if (multicast) 12033450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1204bdcd8170SKalle Valo 1205f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12069a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12079a5b1318SJouni Malinen 1208f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1209334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1210229ed6b5SEdward Lu key_type, key_usage, 1211f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1212f4bb9a6fSJouni Malinen key->key, 1213bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1214bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1215bdcd8170SKalle Valo } 1216bdcd8170SKalle Valo 1217240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1218bdcd8170SKalle Valo bool ismcast) 1219bdcd8170SKalle Valo { 1220bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1221bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1222bdcd8170SKalle Valo 1223240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1224bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1225bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1226bdcd8170SKalle Valo GFP_KERNEL); 1227bdcd8170SKalle Valo } 1228bdcd8170SKalle Valo 1229bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1230bdcd8170SKalle Valo { 1231bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1232990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1233bdcd8170SKalle Valo int ret; 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1236bdcd8170SKalle Valo changed); 1237bdcd8170SKalle Valo 1238990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1239990bd915SVasanthakumar Thiagarajan if (!vif) 1240990bd915SVasanthakumar Thiagarajan return -EIO; 1241990bd915SVasanthakumar Thiagarajan 1242990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1243bdcd8170SKalle Valo return -EIO; 1244bdcd8170SKalle Valo 1245bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1246bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1247bdcd8170SKalle Valo if (ret != 0) { 1248bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1249bdcd8170SKalle Valo return -EIO; 1250bdcd8170SKalle Valo } 1251bdcd8170SKalle Valo } 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo return 0; 1254bdcd8170SKalle Valo } 1255bdcd8170SKalle Valo 1256bdcd8170SKalle Valo /* 1257bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1258bdcd8170SKalle Valo * data type from 2.6.36 onwards 1259bdcd8170SKalle Valo */ 1260bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1261bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1262b992a285SLuis R. Rodriguez int mbm) 1263bdcd8170SKalle Valo { 1264bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1265990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1266bdcd8170SKalle Valo u8 ath6kl_dbm; 1267b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1270bdcd8170SKalle Valo type, dbm); 1271bdcd8170SKalle Valo 1272990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1273990bd915SVasanthakumar Thiagarajan if (!vif) 1274990bd915SVasanthakumar Thiagarajan return -EIO; 1275990bd915SVasanthakumar Thiagarajan 1276990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1277bdcd8170SKalle Valo return -EIO; 1278bdcd8170SKalle Valo 1279bdcd8170SKalle Valo switch (type) { 1280bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1281bdcd8170SKalle Valo return 0; 1282bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1283bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1284bdcd8170SKalle Valo break; 1285bdcd8170SKalle Valo default: 1286bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1287bdcd8170SKalle Valo __func__, type); 1288bdcd8170SKalle Valo return -EOPNOTSUPP; 1289bdcd8170SKalle Valo } 1290bdcd8170SKalle Valo 1291990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1292bdcd8170SKalle Valo 1293bdcd8170SKalle Valo return 0; 1294bdcd8170SKalle Valo } 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1297bdcd8170SKalle Valo { 1298bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1299990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1300bdcd8170SKalle Valo 1301990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1302990bd915SVasanthakumar Thiagarajan if (!vif) 1303990bd915SVasanthakumar Thiagarajan return -EIO; 1304990bd915SVasanthakumar Thiagarajan 1305990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1306bdcd8170SKalle Valo return -EIO; 1307bdcd8170SKalle Valo 130859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1309bdcd8170SKalle Valo ar->tx_pwr = 0; 1310bdcd8170SKalle Valo 1311990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1312bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1313bdcd8170SKalle Valo return -EIO; 1314bdcd8170SKalle Valo } 1315bdcd8170SKalle Valo 1316bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1317bdcd8170SKalle Valo 5 * HZ); 1318bdcd8170SKalle Valo 1319bdcd8170SKalle Valo if (signal_pending(current)) { 1320bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1321bdcd8170SKalle Valo return -EINTR; 1322bdcd8170SKalle Valo } 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1326bdcd8170SKalle Valo return 0; 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo 1329bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1330bdcd8170SKalle Valo struct net_device *dev, 1331bdcd8170SKalle Valo bool pmgmt, int timeout) 1332bdcd8170SKalle Valo { 1333bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1334bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1335334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1338bdcd8170SKalle Valo __func__, pmgmt, timeout); 1339bdcd8170SKalle Valo 1340990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1341bdcd8170SKalle Valo return -EIO; 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo if (pmgmt) { 1344bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1345bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1346bdcd8170SKalle Valo } else { 1347bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1348bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1349bdcd8170SKalle Valo } 1350bdcd8170SKalle Valo 1351334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1352334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1353bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1354bdcd8170SKalle Valo return -EIO; 1355bdcd8170SKalle Valo } 1356bdcd8170SKalle Valo 1357bdcd8170SKalle Valo return 0; 1358bdcd8170SKalle Valo } 1359bdcd8170SKalle Valo 136055055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 136155055976SVasanthakumar Thiagarajan char *name, 136255055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 136355055976SVasanthakumar Thiagarajan u32 *flags, 136455055976SVasanthakumar Thiagarajan struct vif_params *params) 136555055976SVasanthakumar Thiagarajan { 136655055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 136755055976SVasanthakumar Thiagarajan struct net_device *ndev; 136855055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 136955055976SVasanthakumar Thiagarajan 137071f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 137155055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 137255055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137355055976SVasanthakumar Thiagarajan } 137455055976SVasanthakumar Thiagarajan 137555055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 137655055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 137755055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137855055976SVasanthakumar Thiagarajan } 137955055976SVasanthakumar Thiagarajan 138055055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 138155055976SVasanthakumar Thiagarajan if (!ndev) 138255055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 138355055976SVasanthakumar Thiagarajan 138455055976SVasanthakumar Thiagarajan ar->num_vif++; 138555055976SVasanthakumar Thiagarajan 138655055976SVasanthakumar Thiagarajan return ndev; 138755055976SVasanthakumar Thiagarajan } 138855055976SVasanthakumar Thiagarajan 138955055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 139055055976SVasanthakumar Thiagarajan struct net_device *ndev) 139155055976SVasanthakumar Thiagarajan { 139255055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139355055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 139455055976SVasanthakumar Thiagarajan 139511f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 139655055976SVasanthakumar Thiagarajan list_del(&vif->list); 139711f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 139855055976SVasanthakumar Thiagarajan 139955055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 140055055976SVasanthakumar Thiagarajan 1401c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 140255055976SVasanthakumar Thiagarajan 140355055976SVasanthakumar Thiagarajan return 0; 140455055976SVasanthakumar Thiagarajan } 140555055976SVasanthakumar Thiagarajan 1406bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1407bdcd8170SKalle Valo struct net_device *ndev, 1408bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1409bdcd8170SKalle Valo struct vif_params *params) 1410bdcd8170SKalle Valo { 1411f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1412bdcd8170SKalle Valo 1413bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo switch (type) { 1416bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1417f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1418bdcd8170SKalle Valo break; 1419bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1420f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1421bdcd8170SKalle Valo break; 14226e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1423f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14246e4604c8SJouni Malinen break; 14256b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1426f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14276b5e5d25SJouni Malinen break; 14286b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1429f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14306b5e5d25SJouni Malinen break; 1431bdcd8170SKalle Valo default: 1432bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1433bdcd8170SKalle Valo return -EOPNOTSUPP; 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1437bdcd8170SKalle Valo 1438bdcd8170SKalle Valo return 0; 1439bdcd8170SKalle Valo } 1440bdcd8170SKalle Valo 1441bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1442bdcd8170SKalle Valo struct net_device *dev, 1443bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1444bdcd8170SKalle Valo { 1445bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 144659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1447bdcd8170SKalle Valo int status; 1448bdcd8170SKalle Valo 1449990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1450bdcd8170SKalle Valo return -EIO; 1451bdcd8170SKalle Valo 14523450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14533450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1454bdcd8170SKalle Valo 1455bdcd8170SKalle Valo if (ibss_param->channel) 1456f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1457bdcd8170SKalle Valo 1458bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1459bdcd8170SKalle Valo /* 1460bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1461bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1462bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1463bdcd8170SKalle Valo * updated. 1464bdcd8170SKalle Valo */ 1465bdcd8170SKalle Valo return -EOPNOTSUPP; 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 14688c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1469bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14708c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14718c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1472bdcd8170SKalle Valo 1473240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1474bdcd8170SKalle Valo 1475240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1476bdcd8170SKalle Valo if (status) 1477bdcd8170SKalle Valo return status; 1478bdcd8170SKalle Valo 1479bdcd8170SKalle Valo if (ibss_param->privacy) { 1480240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1481240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1482bdcd8170SKalle Valo } else { 1483240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1484240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1485bdcd8170SKalle Valo } 1486bdcd8170SKalle Valo 1487f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1488bdcd8170SKalle Valo 1489bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1490bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1491bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1492bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1493bdcd8170SKalle Valo __func__, 14943450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14953450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1496f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1497bdcd8170SKalle Valo 1498334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 14993450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15003450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15013450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15023450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15033450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1504f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15053ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 150659c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1507bdcd8170SKalle Valo 1508bdcd8170SKalle Valo return 0; 1509bdcd8170SKalle Valo } 1510bdcd8170SKalle Valo 1511bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1512bdcd8170SKalle Valo struct net_device *dev) 1513bdcd8170SKalle Valo { 15143450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1515bdcd8170SKalle Valo 1516990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1517bdcd8170SKalle Valo return -EIO; 1518bdcd8170SKalle Valo 1519240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15203450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15213450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1522bdcd8170SKalle Valo 1523bdcd8170SKalle Valo return 0; 1524bdcd8170SKalle Valo } 1525bdcd8170SKalle Valo 1526bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1527bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1528bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1529bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1530bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1531837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15325e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1533bdcd8170SKalle Valo }; 1534bdcd8170SKalle Valo 1535bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1536bdcd8170SKalle Valo { 1537bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1538bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1539bdcd8170SKalle Valo 36000, 48000, 54000 1540bdcd8170SKalle Valo }; 1541bdcd8170SKalle Valo u8 i; 1542bdcd8170SKalle Valo 1543bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1544bdcd8170SKalle Valo if (rate == legacy[i]) 1545bdcd8170SKalle Valo return true; 1546bdcd8170SKalle Valo 1547bdcd8170SKalle Valo return false; 1548bdcd8170SKalle Valo } 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1551bdcd8170SKalle Valo { 1552bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1553bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1554bdcd8170SKalle Valo }; 1555bdcd8170SKalle Valo u8 i; 1556bdcd8170SKalle Valo 1557bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1558bdcd8170SKalle Valo if (rate == ht20[i]) { 1559bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1560bdcd8170SKalle Valo /* last rate uses sgi */ 1561bdcd8170SKalle Valo *sgi = true; 1562bdcd8170SKalle Valo else 1563bdcd8170SKalle Valo *sgi = false; 1564bdcd8170SKalle Valo 1565bdcd8170SKalle Valo *mcs = i; 1566bdcd8170SKalle Valo return true; 1567bdcd8170SKalle Valo } 1568bdcd8170SKalle Valo } 1569bdcd8170SKalle Valo return false; 1570bdcd8170SKalle Valo } 1571bdcd8170SKalle Valo 1572bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1573bdcd8170SKalle Valo { 1574bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1575bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1576bdcd8170SKalle Valo 150000 1577bdcd8170SKalle Valo }; 1578bdcd8170SKalle Valo u8 i; 1579bdcd8170SKalle Valo 1580bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1581bdcd8170SKalle Valo if (rate == ht40[i]) { 1582bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1583bdcd8170SKalle Valo /* last rate uses sgi */ 1584bdcd8170SKalle Valo *sgi = true; 1585bdcd8170SKalle Valo else 1586bdcd8170SKalle Valo *sgi = false; 1587bdcd8170SKalle Valo 1588bdcd8170SKalle Valo *mcs = i; 1589bdcd8170SKalle Valo return true; 1590bdcd8170SKalle Valo } 1591bdcd8170SKalle Valo } 1592bdcd8170SKalle Valo 1593bdcd8170SKalle Valo return false; 1594bdcd8170SKalle Valo } 1595bdcd8170SKalle Valo 1596bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1597bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1598bdcd8170SKalle Valo { 1599bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 160059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1601bdcd8170SKalle Valo long left; 1602bdcd8170SKalle Valo bool sgi; 1603bdcd8170SKalle Valo s32 rate; 1604bdcd8170SKalle Valo int ret; 1605bdcd8170SKalle Valo u8 mcs; 1606bdcd8170SKalle Valo 16078c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1608bdcd8170SKalle Valo return -ENOENT; 1609bdcd8170SKalle Valo 1610bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1611bdcd8170SKalle Valo return -EBUSY; 1612bdcd8170SKalle Valo 1613b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1614bdcd8170SKalle Valo 1615334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1616bdcd8170SKalle Valo 1617bdcd8170SKalle Valo if (ret != 0) { 1618bdcd8170SKalle Valo up(&ar->sem); 1619bdcd8170SKalle Valo return -EIO; 1620bdcd8170SKalle Valo } 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1623bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1624b95907a7SVasanthakumar Thiagarajan &vif->flags), 1625bdcd8170SKalle Valo WMI_TIMEOUT); 1626bdcd8170SKalle Valo 1627bdcd8170SKalle Valo up(&ar->sem); 1628bdcd8170SKalle Valo 1629bdcd8170SKalle Valo if (left == 0) 1630bdcd8170SKalle Valo return -ETIMEDOUT; 1631bdcd8170SKalle Valo else if (left < 0) 1632bdcd8170SKalle Valo return left; 1633bdcd8170SKalle Valo 1634b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1635b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1636bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1637b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1638bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1639bdcd8170SKalle Valo } 1640bdcd8170SKalle Valo 1641b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1642b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1643bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1644b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1645bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1646bdcd8170SKalle Valo } 1647bdcd8170SKalle Valo 1648b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1649bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1650bdcd8170SKalle Valo 1651b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1652bdcd8170SKalle Valo 1653bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1654bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1655bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1656bdcd8170SKalle Valo if (sgi) { 1657bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1658bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1659bdcd8170SKalle Valo } else { 1660bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1661bdcd8170SKalle Valo } 1662bdcd8170SKalle Valo 1663bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1664bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1665bdcd8170SKalle Valo if (sgi) { 1666bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1667bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1668bdcd8170SKalle Valo } else { 1669bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1670bdcd8170SKalle Valo } 1671bdcd8170SKalle Valo 1672bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1673bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1674bdcd8170SKalle Valo } else { 16759a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16769a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16779a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1678bdcd8170SKalle Valo return 0; 1679bdcd8170SKalle Valo } 1680bdcd8170SKalle Valo 1681bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1682bdcd8170SKalle Valo 168359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 168459c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1685f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 168632c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 168732c10874SJouni Malinen sinfo->bss_param.flags = 0; 1688cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1689cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 169032c10874SJouni Malinen } 169132c10874SJouni Malinen 1692bdcd8170SKalle Valo return 0; 1693bdcd8170SKalle Valo } 1694bdcd8170SKalle Valo 1695bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1696bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1697bdcd8170SKalle Valo { 1698bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1699334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1700334234b5SVasanthakumar Thiagarajan 1701334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1702bdcd8170SKalle Valo pmksa->pmkid, true); 1703bdcd8170SKalle Valo } 1704bdcd8170SKalle Valo 1705bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1706bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1707bdcd8170SKalle Valo { 1708bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1709334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1710334234b5SVasanthakumar Thiagarajan 1711334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1712bdcd8170SKalle Valo pmksa->pmkid, false); 1713bdcd8170SKalle Valo } 1714bdcd8170SKalle Valo 1715bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1716bdcd8170SKalle Valo { 1717bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 171859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 171959c98449SVasanthakumar Thiagarajan 172059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1721334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1722334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1723bdcd8170SKalle Valo return 0; 1724bdcd8170SKalle Valo } 1725bdcd8170SKalle Valo 17266cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 17276cb3c714SRaja Mani { 1728c08631c6SRaja Mani struct in_device *in_dev; 1729c08631c6SRaja Mani struct in_ifaddr *ifa; 17306cb3c714SRaja Mani struct ath6kl_vif *vif; 17316cb3c714SRaja Mani int ret, pos, left; 17326cb3c714SRaja Mani u32 filter = 0; 17336cb3c714SRaja Mani u16 i; 1734c08631c6SRaja Mani u8 mask[WOW_MASK_SIZE], index = 0; 1735c08631c6SRaja Mani __be32 ips[MAX_IP_ADDRS]; 17366cb3c714SRaja Mani 17376cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 17386cb3c714SRaja Mani if (!vif) 17396cb3c714SRaja Mani return -EIO; 17406cb3c714SRaja Mani 17416cb3c714SRaja Mani if (!ath6kl_cfg80211_ready(vif)) 17426cb3c714SRaja Mani return -EIO; 17436cb3c714SRaja Mani 17446cb3c714SRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 17456cb3c714SRaja Mani return -EINVAL; 17466cb3c714SRaja Mani 17476cb3c714SRaja Mani /* Clear existing WOW patterns */ 17486cb3c714SRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 17496cb3c714SRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 17506cb3c714SRaja Mani WOW_LIST_ID, i); 17516cb3c714SRaja Mani /* Configure new WOW patterns */ 17526cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17536cb3c714SRaja Mani 17546cb3c714SRaja Mani /* 17556cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17566cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17576cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17586cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17596cb3c714SRaja Mani * then equivalent driver specific mask value is 17606cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17616cb3c714SRaja Mani */ 17626cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17636cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17646cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17656cb3c714SRaja Mani mask[pos] = 0xFF; 17666cb3c714SRaja Mani } 17676cb3c714SRaja Mani /* 17686cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17696cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17706cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17716cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17726cb3c714SRaja Mani */ 17736cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17746cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17756cb3c714SRaja Mani wow->patterns[i].pattern_len, 17766cb3c714SRaja Mani 0 /* pattern offset */, 17776cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17786cb3c714SRaja Mani if (ret) 17796cb3c714SRaja Mani return ret; 17806cb3c714SRaja Mani } 17816cb3c714SRaja Mani 1782c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1783c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1784c08631c6SRaja Mani if (!in_dev) 1785c08631c6SRaja Mani goto skip_arp; 1786c08631c6SRaja Mani 1787c08631c6SRaja Mani ifa = in_dev->ifa_list; 1788c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 1789c08631c6SRaja Mani 1790c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 1791c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 1792c08631c6SRaja Mani ips[index] = ifa->ifa_local; 1793c08631c6SRaja Mani ifa = ifa->ifa_next; 1794c08631c6SRaja Mani index++; 1795c08631c6SRaja Mani } 1796c08631c6SRaja Mani 1797c08631c6SRaja Mani if (ifa) { 1798c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 1799c08631c6SRaja Mani return -EINVAL; 1800c08631c6SRaja Mani } 1801c08631c6SRaja Mani 1802c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 1803c08631c6SRaja Mani if (ret) { 1804c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 1805c08631c6SRaja Mani return ret; 1806c08631c6SRaja Mani } 1807c08631c6SRaja Mani 1808c08631c6SRaja Mani skip_arp: 18096cb3c714SRaja Mani if (wow->disconnect) 18106cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 18116cb3c714SRaja Mani 18126cb3c714SRaja Mani if (wow->magic_pkt) 18136cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 18146cb3c714SRaja Mani 18156cb3c714SRaja Mani if (wow->gtk_rekey_failure) 18166cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_GTK_ERROR; 18176cb3c714SRaja Mani 18186cb3c714SRaja Mani if (wow->eap_identity_req) 18196cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_EAP_REQ; 18206cb3c714SRaja Mani 18216cb3c714SRaja Mani if (wow->four_way_handshake) 18226cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 18236cb3c714SRaja Mani 18246cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 18256cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 18266cb3c714SRaja Mani filter, 18276cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 18286cb3c714SRaja Mani if (ret) 18296cb3c714SRaja Mani return ret; 18306cb3c714SRaja Mani 18316cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18326cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 18336cb3c714SRaja Mani if (ret) 18346cb3c714SRaja Mani return ret; 18356cb3c714SRaja Mani 18366cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 18376cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 18386cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 18396cb3c714SRaja Mani if (left == 0) { 18406cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 18416cb3c714SRaja Mani ret = -ETIMEDOUT; 18426cb3c714SRaja Mani } else if (left < 0) { 18436cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 18446cb3c714SRaja Mani ret = left; 18456cb3c714SRaja Mani } 18466cb3c714SRaja Mani } 18476cb3c714SRaja Mani 18486cb3c714SRaja Mani return ret; 18496cb3c714SRaja Mani } 18506cb3c714SRaja Mani 18516cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 18526cb3c714SRaja Mani { 18536cb3c714SRaja Mani struct ath6kl_vif *vif; 18546cb3c714SRaja Mani int ret; 18556cb3c714SRaja Mani 18566cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 18576cb3c714SRaja Mani if (!vif) 18586cb3c714SRaja Mani return -EIO; 18596cb3c714SRaja Mani 18606cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18616cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 18626cb3c714SRaja Mani return ret; 18636cb3c714SRaja Mani } 18646cb3c714SRaja Mani 186552d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 18660f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 18670f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 186852d81a68SKalle Valo { 186952d81a68SKalle Valo int ret; 187052d81a68SKalle Valo 187152d81a68SKalle Valo switch (mode) { 1872d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 1873d7c44e0bSRaja Mani 1874d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 1875d7c44e0bSRaja Mani 1876d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 1877d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 1878d7c44e0bSRaja Mani 1879d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 1880d7c44e0bSRaja Mani if (ret) { 1881d7c44e0bSRaja Mani ath6kl_err("wow suspend failed: %d\n", ret); 1882d7c44e0bSRaja Mani return ret; 1883d7c44e0bSRaja Mani } 1884d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 1885d7c44e0bSRaja Mani break; 1886d7c44e0bSRaja Mani 188752d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 1888524441e3SRaja Mani 18897125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1890524441e3SRaja Mani 189152d81a68SKalle Valo /* save the current power mode before enabling power save */ 189252d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 189352d81a68SKalle Valo 189452d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 189552d81a68SKalle Valo if (ret) { 189652d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 189752d81a68SKalle Valo ret); 189852d81a68SKalle Valo } 189952d81a68SKalle Valo 190076a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 190176a9fbe2SKalle Valo 190252d81a68SKalle Valo break; 1903b4b2a0b1SKalle Valo 1904b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1905524441e3SRaja Mani 19067125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1907524441e3SRaja Mani 1908b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1909b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1910b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1911b4b2a0b1SKalle Valo break; 1912b4b2a0b1SKalle Valo } 1913b4b2a0b1SKalle Valo 1914b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1915b4b2a0b1SKalle Valo 1916b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1917b4b2a0b1SKalle Valo if (ret) { 1918b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1919b4b2a0b1SKalle Valo ret); 1920b4b2a0b1SKalle Valo } 1921b4b2a0b1SKalle Valo 1922b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1923b4b2a0b1SKalle Valo 1924b4b2a0b1SKalle Valo break; 1925b4b2a0b1SKalle Valo 192610509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 192710509f90SKalle Valo /* 192810509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 192910509f90SKalle Valo * wow mode and sleeping most of the time. 193010509f90SKalle Valo */ 193110509f90SKalle Valo break; 193210509f90SKalle Valo 1933b4b2a0b1SKalle Valo default: 1934b4b2a0b1SKalle Valo break; 193552d81a68SKalle Valo } 193652d81a68SKalle Valo 193752d81a68SKalle Valo return 0; 193852d81a68SKalle Valo } 1939d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 194052d81a68SKalle Valo 194152d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 194252d81a68SKalle Valo { 194376a9fbe2SKalle Valo int ret; 194476a9fbe2SKalle Valo 194576a9fbe2SKalle Valo switch (ar->state) { 1946d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 1947d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 1948d7c44e0bSRaja Mani 1949d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 1950d7c44e0bSRaja Mani if (ret) { 1951d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 1952d7c44e0bSRaja Mani return ret; 1953d7c44e0bSRaja Mani } 1954d7c44e0bSRaja Mani 1955d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_ON; 1956d7c44e0bSRaja Mani break; 1957d7c44e0bSRaja Mani 195876a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 195952d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 196076a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 196176a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 196276a9fbe2SKalle Valo if (ret) { 196376a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 196476a9fbe2SKalle Valo ret); 196576a9fbe2SKalle Valo } 196676a9fbe2SKalle Valo } 196776a9fbe2SKalle Valo 196876a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 196976a9fbe2SKalle Valo 197076a9fbe2SKalle Valo break; 197176a9fbe2SKalle Valo 1972b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1973b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1974b4b2a0b1SKalle Valo 1975b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1976b4b2a0b1SKalle Valo if (ret) { 1977b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1978b4b2a0b1SKalle Valo return ret; 1979b4b2a0b1SKalle Valo } 1980d7c44e0bSRaja Mani break; 1981b4b2a0b1SKalle Valo 198210509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 198310509f90SKalle Valo break; 198410509f90SKalle Valo 198576a9fbe2SKalle Valo default: 198676a9fbe2SKalle Valo break; 198752d81a68SKalle Valo } 198852d81a68SKalle Valo 198952d81a68SKalle Valo return 0; 199052d81a68SKalle Valo } 1991d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 199252d81a68SKalle Valo 1993abcb344bSKalle Valo #ifdef CONFIG_PM 199452d81a68SKalle Valo 199552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 199652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 1997abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1998abcb344bSKalle Valo { 1999abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2000abcb344bSKalle Valo 20010f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2002abcb344bSKalle Valo } 2003aa6cffc1SChilam Ng 200452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2005aa6cffc1SChilam Ng { 2006aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2007aa6cffc1SChilam Ng 2008aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2009aa6cffc1SChilam Ng } 2010a918fb3cSRaja Mani 2011a918fb3cSRaja Mani /* 2012a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2013a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2014a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2015a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2016a918fb3cSRaja Mani * 2017a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2018a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2019a918fb3cSRaja Mani * 2020a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2021a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2022a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2023a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2024a918fb3cSRaja Mani * 2025a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2026a918fb3cSRaja Mani */ 2027a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2028a918fb3cSRaja Mani { 2029a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2030a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2031a918fb3cSRaja Mani } 2032a918fb3cSRaja Mani 2033a918fb3cSRaja Mani #else 2034a918fb3cSRaja Mani 2035a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2036a918fb3cSRaja Mani { 2037a918fb3cSRaja Mani } 2038abcb344bSKalle Valo #endif 2039abcb344bSKalle Valo 20406a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 20416a7c9badSJouni Malinen struct ieee80211_channel *chan, 20426a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 20436a7c9badSJouni Malinen { 2044e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2045e68f6750SSujith Manoharan 2046e68f6750SSujith Manoharan /* 2047e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2048e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2049e68f6750SSujith Manoharan * 2050e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2051e68f6750SSujith Manoharan */ 2052e68f6750SSujith Manoharan if (!dev) 2053e68f6750SSujith Manoharan return -EBUSY; 2054e68f6750SSujith Manoharan 2055e68f6750SSujith Manoharan vif = netdev_priv(dev); 20566a7c9badSJouni Malinen 2057990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 20586a7c9badSJouni Malinen return -EIO; 20596a7c9badSJouni Malinen 20606a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 20616a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2062cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 20636a7c9badSJouni Malinen 20646a7c9badSJouni Malinen return 0; 20656a7c9badSJouni Malinen } 20666a7c9badSJouni Malinen 20678bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 20688bdfbf40SJouni Malinen { 20698bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 20708bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 20718bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 20728bdfbf40SJouni Malinen } 20738bdfbf40SJouni Malinen 2074334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2075334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 20768bdfbf40SJouni Malinen { 2077334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 20788bdfbf40SJouni Malinen const u8 *pos; 20798bdfbf40SJouni Malinen u8 *buf = NULL; 20808bdfbf40SJouni Malinen size_t len = 0; 20818bdfbf40SJouni Malinen int ret; 20828bdfbf40SJouni Malinen 20838bdfbf40SJouni Malinen /* 20848bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 20858bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 20868bdfbf40SJouni Malinen */ 20878bdfbf40SJouni Malinen 20888bdfbf40SJouni Malinen if (ies && ies_len) { 20898bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 20908bdfbf40SJouni Malinen if (buf == NULL) 20918bdfbf40SJouni Malinen return -ENOMEM; 20928bdfbf40SJouni Malinen pos = ies; 20938bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 20948bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 20958bdfbf40SJouni Malinen break; 20968bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 20978bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 20988bdfbf40SJouni Malinen len += 2 + pos[1]; 20998bdfbf40SJouni Malinen } 21008bdfbf40SJouni Malinen pos += 2 + pos[1]; 21018bdfbf40SJouni Malinen } 21028bdfbf40SJouni Malinen } 21038bdfbf40SJouni Malinen 2104334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2105334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 21068bdfbf40SJouni Malinen kfree(buf); 21078bdfbf40SJouni Malinen return ret; 21088bdfbf40SJouni Malinen } 21098bdfbf40SJouni Malinen 21106a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 21116a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 21126a7c9badSJouni Malinen { 21136a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 21143450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 21156a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 21166a7c9badSJouni Malinen u8 *ies; 21176a7c9badSJouni Malinen int ies_len; 21186a7c9badSJouni Malinen struct wmi_connect_cmd p; 21196a7c9badSJouni Malinen int res; 2120be5abaafSVasanthakumar Thiagarajan int i, ret; 21216a7c9badSJouni Malinen 21226a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 21236a7c9badSJouni Malinen 2124990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 21256a7c9badSJouni Malinen return -EIO; 21266a7c9badSJouni Malinen 2127f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 21286a7c9badSJouni Malinen return -EOPNOTSUPP; 21296a7c9badSJouni Malinen 21306a7c9badSJouni Malinen if (info->beacon_ies) { 2131334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2132334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 21336a7c9badSJouni Malinen info->beacon_ies, 21346a7c9badSJouni Malinen info->beacon_ies_len); 21356a7c9badSJouni Malinen if (res) 21366a7c9badSJouni Malinen return res; 21376a7c9badSJouni Malinen } 21386a7c9badSJouni Malinen if (info->proberesp_ies) { 2139334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 21406a7c9badSJouni Malinen info->proberesp_ies_len); 21416a7c9badSJouni Malinen if (res) 21426a7c9badSJouni Malinen return res; 21436a7c9badSJouni Malinen } 21446a7c9badSJouni Malinen if (info->assocresp_ies) { 2145334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2146334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 21476a7c9badSJouni Malinen info->assocresp_ies, 21486a7c9badSJouni Malinen info->assocresp_ies_len); 21496a7c9badSJouni Malinen if (res) 21506a7c9badSJouni Malinen return res; 21516a7c9badSJouni Malinen } 21526a7c9badSJouni Malinen 21536a7c9badSJouni Malinen if (!add) 21546a7c9badSJouni Malinen return 0; 21556a7c9badSJouni Malinen 21569a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 21579a5b1318SJouni Malinen 21586a7c9badSJouni Malinen /* TODO: 21596a7c9badSJouni Malinen * info->interval 21606a7c9badSJouni Malinen * info->dtim_period 21616a7c9badSJouni Malinen */ 21626a7c9badSJouni Malinen 21636a7c9badSJouni Malinen if (info->head == NULL) 21646a7c9badSJouni Malinen return -EINVAL; 21656a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 21666a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 21676a7c9badSJouni Malinen if (ies > info->head + info->head_len) 21686a7c9badSJouni Malinen return -EINVAL; 21696a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 21706a7c9badSJouni Malinen 21716a7c9badSJouni Malinen if (info->ssid == NULL) 21726a7c9badSJouni Malinen return -EINVAL; 21733450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 21743450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 21756a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 21766a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 21776a7c9badSJouni Malinen 2178be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2179be5abaafSVasanthakumar Thiagarajan if (ret) 2180be5abaafSVasanthakumar Thiagarajan return ret; 21816a7c9badSJouni Malinen 21826a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 21836a7c9badSJouni Malinen 21846a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 21856a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 21866a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 21876a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21886a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 21896a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21906a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 21916a7c9badSJouni Malinen break; 21926a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 21936a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21946a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 21956a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21966a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 21976a7c9badSJouni Malinen break; 21986a7c9badSJouni Malinen } 21996a7c9badSJouni Malinen } 22006a7c9badSJouni Malinen if (p.auth_mode == 0) 22016a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 22023450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 22036a7c9badSJouni Malinen 22046a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 22056a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 22066a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22076a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22086a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 22096a7c9badSJouni Malinen break; 22106a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22116a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 22126a7c9badSJouni Malinen break; 22136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22146a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 22156a7c9badSJouni Malinen break; 2216b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2217b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2218b8214df1SDai Shuibing break; 22196a7c9badSJouni Malinen } 22206a7c9badSJouni Malinen } 2221229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 22226a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2223240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2224229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2225240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 22266a7c9badSJouni Malinen 22276a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 22286a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22296a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22306a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 22316a7c9badSJouni Malinen break; 22326a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22336a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 22346a7c9badSJouni Malinen break; 22356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22366a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 22376a7c9badSJouni Malinen break; 2238b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2239b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2240b8214df1SDai Shuibing break; 22416a7c9badSJouni Malinen default: 22426a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 22436a7c9badSJouni Malinen break; 22446a7c9badSJouni Malinen } 2245240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 22466a7c9badSJouni Malinen 22476a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2248f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 22496a7c9badSJouni Malinen 22503450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 22513450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 22523450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2253cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 22546a7c9badSJouni Malinen 2255c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2256c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2257c1762a3fSThirumalai Pachamuthu if (res < 0) 2258c1762a3fSThirumalai Pachamuthu return res; 2259c1762a3fSThirumalai Pachamuthu 22603ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 22613ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 22623ca9d1fcSAarthi Thiruvengadam } else { 22633ca9d1fcSAarthi Thiruvengadam /* 22643ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 22653ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 22663ca9d1fcSAarthi Thiruvengadam */ 22673ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 22683ca9d1fcSAarthi Thiruvengadam } 22693ca9d1fcSAarthi Thiruvengadam 2270334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 22719a5b1318SJouni Malinen if (res < 0) 22729a5b1318SJouni Malinen return res; 22739a5b1318SJouni Malinen 22749a5b1318SJouni Malinen return 0; 22756a7c9badSJouni Malinen } 22766a7c9badSJouni Malinen 22776a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 22786a7c9badSJouni Malinen struct beacon_parameters *info) 22796a7c9badSJouni Malinen { 22806a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 22816a7c9badSJouni Malinen } 22826a7c9badSJouni Malinen 22836a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 22846a7c9badSJouni Malinen struct beacon_parameters *info) 22856a7c9badSJouni Malinen { 22866a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 22876a7c9badSJouni Malinen } 22886a7c9badSJouni Malinen 22896a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 22906a7c9badSJouni Malinen { 22916a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 229259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22936a7c9badSJouni Malinen 2294f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 22956a7c9badSJouni Malinen return -EOPNOTSUPP; 229659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 22976a7c9badSJouni Malinen return -ENOTCONN; 22986a7c9badSJouni Malinen 2299334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 230059c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 23016a7c9badSJouni Malinen 23026a7c9badSJouni Malinen return 0; 23036a7c9badSJouni Malinen } 23046a7c9badSJouni Malinen 230533e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 230633e5308dSJouni Malinen 230733e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 230833e5308dSJouni Malinen u8 *mac) 230933e5308dSJouni Malinen { 231033e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 231133e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 231233e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 231333e5308dSJouni Malinen 231433e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 231533e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 231633e5308dSJouni Malinen } 231733e5308dSJouni Malinen 231823875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 231923875136SJouni Malinen u8 *mac, struct station_parameters *params) 232023875136SJouni Malinen { 232123875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2322f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 232323875136SJouni Malinen 2324f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 232523875136SJouni Malinen return -EOPNOTSUPP; 232623875136SJouni Malinen 232723875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 232823875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 232923875136SJouni Malinen return -EOPNOTSUPP; 233023875136SJouni Malinen 233123875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2332334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2333334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2334334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2335334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 233623875136SJouni Malinen } 233723875136SJouni Malinen 233863fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 233963fa1e0cSJouni Malinen struct net_device *dev, 234063fa1e0cSJouni Malinen struct ieee80211_channel *chan, 234163fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 234263fa1e0cSJouni Malinen unsigned int duration, 234363fa1e0cSJouni Malinen u64 *cookie) 234463fa1e0cSJouni Malinen { 234563fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2346334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23471052261eSJouni Malinen u32 id; 234863fa1e0cSJouni Malinen 234963fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 235063fa1e0cSJouni Malinen * return -EBUSY */ 23511052261eSJouni Malinen id = ++vif->last_roc_id; 23521052261eSJouni Malinen if (id == 0) { 23531052261eSJouni Malinen /* Do not use 0 as the cookie value */ 23541052261eSJouni Malinen id = ++vif->last_roc_id; 23551052261eSJouni Malinen } 23561052261eSJouni Malinen *cookie = id; 235763fa1e0cSJouni Malinen 2358334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2359334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 236063fa1e0cSJouni Malinen } 236163fa1e0cSJouni Malinen 236263fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 236363fa1e0cSJouni Malinen struct net_device *dev, 236463fa1e0cSJouni Malinen u64 cookie) 236563fa1e0cSJouni Malinen { 236663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2367334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 236863fa1e0cSJouni Malinen 23691052261eSJouni Malinen if (cookie != vif->last_roc_id) 237063fa1e0cSJouni Malinen return -ENOENT; 23711052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 237263fa1e0cSJouni Malinen 2373334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 237463fa1e0cSJouni Malinen } 237563fa1e0cSJouni Malinen 2376334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2377334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2378334234b5SVasanthakumar Thiagarajan unsigned int freq) 23798bdfbf40SJouni Malinen { 2380334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23818bdfbf40SJouni Malinen const u8 *pos; 23828bdfbf40SJouni Malinen u8 *p2p; 23838bdfbf40SJouni Malinen int p2p_len; 23848bdfbf40SJouni Malinen int ret; 23858bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 23868bdfbf40SJouni Malinen 23878bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 23888bdfbf40SJouni Malinen 23898bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 23908bdfbf40SJouni Malinen 23918bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 23928bdfbf40SJouni Malinen if (p2p == NULL) 23938bdfbf40SJouni Malinen return -ENOMEM; 23948bdfbf40SJouni Malinen p2p_len = 0; 23958bdfbf40SJouni Malinen 23968bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 23978bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 23988bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 23998bdfbf40SJouni Malinen break; 24008bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 24018bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 24028bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 24038bdfbf40SJouni Malinen } 24048bdfbf40SJouni Malinen pos += 2 + pos[1]; 24058bdfbf40SJouni Malinen } 24068bdfbf40SJouni Malinen 2407334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2408334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 24098bdfbf40SJouni Malinen kfree(p2p); 24108bdfbf40SJouni Malinen return ret; 24118bdfbf40SJouni Malinen } 24128bdfbf40SJouni Malinen 24138a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 24148a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 24158a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 24168a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2417e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2418e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 24198a6c8060SJouni Malinen { 24208a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 242159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24228a6c8060SJouni Malinen u32 id; 24238bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 24248bdfbf40SJouni Malinen 24258bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 24268bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2427f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 24288bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 24298bdfbf40SJouni Malinen /* 24308bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 24318bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 24328bdfbf40SJouni Malinen */ 24338bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2434334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 24358bdfbf40SJouni Malinen chan->center_freq); 24368bdfbf40SJouni Malinen } 24378a6c8060SJouni Malinen 2438cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24398a6c8060SJouni Malinen if (id == 0) { 24408a6c8060SJouni Malinen /* 24418a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 24428a6c8060SJouni Malinen * used for the command. 24438a6c8060SJouni Malinen */ 2444cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24458a6c8060SJouni Malinen } 24468a6c8060SJouni Malinen 24478a6c8060SJouni Malinen *cookie = id; 24483ca9d1fcSAarthi Thiruvengadam 24493ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 24503ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 24513ca9d1fcSAarthi Thiruvengadam /* 24523ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 24533ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 24543ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 24553ca9d1fcSAarthi Thiruvengadam * probe requests 24563ca9d1fcSAarthi Thiruvengadam */ 24573ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 24583ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 24593ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 24603ca9d1fcSAarthi Thiruvengadam } else { 2461334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2462334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 24638a6c8060SJouni Malinen buf, len); 24648a6c8060SJouni Malinen } 24653ca9d1fcSAarthi Thiruvengadam } 24668a6c8060SJouni Malinen 2467ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2468ae32c30aSJouni Malinen struct net_device *dev, 2469ae32c30aSJouni Malinen u16 frame_type, bool reg) 2470ae32c30aSJouni Malinen { 2471cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2472ae32c30aSJouni Malinen 2473ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2474ae32c30aSJouni Malinen __func__, frame_type, reg); 2475ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2476ae32c30aSJouni Malinen /* 2477ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2478ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2479ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2480ae32c30aSJouni Malinen */ 2481cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2482ae32c30aSJouni Malinen } 2483ae32c30aSJouni Malinen } 2484ae32c30aSJouni Malinen 248510509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 248610509f90SKalle Valo struct net_device *dev, 248710509f90SKalle Valo struct cfg80211_sched_scan_request *request) 248810509f90SKalle Valo { 248910509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 249010509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 249110509f90SKalle Valo u16 interval; 249210509f90SKalle Valo int ret; 249310509f90SKalle Valo u8 i; 249410509f90SKalle Valo 249510509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 249610509f90SKalle Valo return -EIO; 249710509f90SKalle Valo 249810509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 249910509f90SKalle Valo return -EBUSY; 250010509f90SKalle Valo 250110509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 250210509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 250310509f90SKalle Valo i, DISABLE_SSID_FLAG, 250410509f90SKalle Valo 0, NULL); 250510509f90SKalle Valo } 250610509f90SKalle Valo 250710509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 250810509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 250910509f90SKalle Valo 251010509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 251110509f90SKalle Valo interval, interval, 251210509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 251310509f90SKalle Valo 251410509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 251510509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 251610509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 251710509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 251810509f90SKalle Valo request->ssids[i].ssid_len, 251910509f90SKalle Valo request->ssids[i].ssid); 252010509f90SKalle Valo } 252110509f90SKalle Valo } 252210509f90SKalle Valo 252310509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 252410509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 252510509f90SKalle Valo WOW_FILTER_SSID, 252610509f90SKalle Valo WOW_HOST_REQ_DELAY); 252710509f90SKalle Valo if (ret) { 252810509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 252910509f90SKalle Valo return ret; 253010509f90SKalle Valo } 253110509f90SKalle Valo 253210509f90SKalle Valo /* this also clears IE in fw if it's not set */ 253310509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 253410509f90SKalle Valo WMI_FRAME_PROBE_REQ, 253510509f90SKalle Valo request->ie, request->ie_len); 253610509f90SKalle Valo if (ret) { 253710509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 253810509f90SKalle Valo ret); 253910509f90SKalle Valo return ret; 254010509f90SKalle Valo } 254110509f90SKalle Valo 254210509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 254310509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 254410509f90SKalle Valo if (ret) { 254510509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 254610509f90SKalle Valo ret); 254710509f90SKalle Valo return ret; 254810509f90SKalle Valo } 254910509f90SKalle Valo 255010509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 255110509f90SKalle Valo 255210509f90SKalle Valo return ret; 255310509f90SKalle Valo } 255410509f90SKalle Valo 255510509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 255610509f90SKalle Valo struct net_device *dev) 255710509f90SKalle Valo { 255810509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 255910509f90SKalle Valo bool stopped; 256010509f90SKalle Valo 256110509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 256210509f90SKalle Valo 256310509f90SKalle Valo if (!stopped) 256410509f90SKalle Valo return -EIO; 256510509f90SKalle Valo 256610509f90SKalle Valo return 0; 256710509f90SKalle Valo } 256810509f90SKalle Valo 2569f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2570f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2571f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2572f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2573f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2574f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2575f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2576f80574aeSJouni Malinen }, 2577ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2578ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2579ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2580ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2581ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2582ba1f6fe3SJouni Malinen }, 2583f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2584f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2585f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2586f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2587f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2588f80574aeSJouni Malinen }, 2589f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2590f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2591f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2592f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2593f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2594f80574aeSJouni Malinen }, 2595f80574aeSJouni Malinen }; 2596f80574aeSJouni Malinen 2597bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 259855055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 259955055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2600bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2601bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2602bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2603bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2604bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2605bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2606bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2607bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2608bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2609bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2610bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2611bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2612bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2613bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2614bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2615bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2616bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2617bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2618003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2619abcb344bSKalle Valo #ifdef CONFIG_PM 262052d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 262152d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2622abcb344bSKalle Valo #endif 26236a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 26246a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 26256a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 26266a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 262733e5308dSJouni Malinen .del_station = ath6kl_del_station, 262823875136SJouni Malinen .change_station = ath6kl_change_station, 262963fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 263063fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 26318a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2632ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 263310509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 263410509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2635bdcd8170SKalle Valo }; 2636bdcd8170SKalle Valo 26377125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2638ec4b7f60SKalle Valo { 263910509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 264010509f90SKalle Valo 2641ec4b7f60SKalle Valo switch (vif->sme_state) { 2642c97a31b0SKalle Valo case SME_DISCONNECTED: 2643c97a31b0SKalle Valo break; 2644ec4b7f60SKalle Valo case SME_CONNECTING: 2645ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2646ec4b7f60SKalle Valo NULL, 0, 2647ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2648ec4b7f60SKalle Valo GFP_KERNEL); 2649ec4b7f60SKalle Valo break; 2650ec4b7f60SKalle Valo case SME_CONNECTED: 2651ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2652ec4b7f60SKalle Valo break; 2653ec4b7f60SKalle Valo } 2654ec4b7f60SKalle Valo 2655ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2656ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 26577125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2658ec4b7f60SKalle Valo 2659ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 26601f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 26611f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2662ec4b7f60SKalle Valo 2663ec4b7f60SKalle Valo /* disable scanning */ 26647125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 26657125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 26667125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 2667ec4b7f60SKalle Valo 2668ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2669ec4b7f60SKalle Valo } 2670ec4b7f60SKalle Valo 26717125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 26727125f01dSKalle Valo { 26737125f01dSKalle Valo struct ath6kl_vif *vif; 26747125f01dSKalle Valo 26757125f01dSKalle Valo vif = ath6kl_vif_first(ar); 26767125f01dSKalle Valo if (!vif) { 26777125f01dSKalle Valo /* save the current power mode before enabling power save */ 26787125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 26797125f01dSKalle Valo 26807125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 26817125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 26827125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 26837125f01dSKalle Valo return; 26847125f01dSKalle Valo } 26857125f01dSKalle Valo 26867125f01dSKalle Valo /* 26877125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 26887125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 26897125f01dSKalle Valo * sleeps. 26907125f01dSKalle Valo */ 26917125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 26927125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 26937125f01dSKalle Valo } 26947125f01dSKalle Valo 2695c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 26968dafb70eSVasanthakumar Thiagarajan { 26977baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 26982132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 26998dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 27008dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 27018dafb70eSVasanthakumar Thiagarajan } 27028dafb70eSVasanthakumar Thiagarajan 2703de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2704108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 270510509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 270610509f90SKalle Valo (unsigned long) vif); 270710509f90SKalle Valo 2708de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2709478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 27108dafb70eSVasanthakumar Thiagarajan 271180abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 271280abaf9bSVasanthakumar Thiagarajan 27138dafb70eSVasanthakumar Thiagarajan return 0; 27148dafb70eSVasanthakumar Thiagarajan } 27158dafb70eSVasanthakumar Thiagarajan 2716c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 27178dafb70eSVasanthakumar Thiagarajan { 271855055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 271980abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 272055055976SVasanthakumar Thiagarajan 27212132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2722108438bcSVasanthakumar Thiagarajan 272355055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 272455055976SVasanthakumar Thiagarajan 272555055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 272655055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 272755055976SVasanthakumar Thiagarajan 272880abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 272980abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 273080abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 273180abaf9bSVasanthakumar Thiagarajan } 273280abaf9bSVasanthakumar Thiagarajan 273327929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 273455055976SVasanthakumar Thiagarajan 273555055976SVasanthakumar Thiagarajan ar->num_vif--; 27368dafb70eSVasanthakumar Thiagarajan } 27378dafb70eSVasanthakumar Thiagarajan 27388dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 273955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 274055055976SVasanthakumar Thiagarajan u8 nw_type) 27418dafb70eSVasanthakumar Thiagarajan { 27428dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2743108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 27448dafb70eSVasanthakumar Thiagarajan 274555055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 27468dafb70eSVasanthakumar Thiagarajan if (!ndev) 27478dafb70eSVasanthakumar Thiagarajan return NULL; 27488dafb70eSVasanthakumar Thiagarajan 2749108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2750108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2751108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2752108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2753108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2754108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2755108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2756108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2757334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 275855055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 27598dafb70eSVasanthakumar Thiagarajan 276055055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 276155055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 276255055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 276355055976SVasanthakumar Thiagarajan 0x2; 276455055976SVasanthakumar Thiagarajan 27658dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 27668dafb70eSVasanthakumar Thiagarajan 2767e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 27688dafb70eSVasanthakumar Thiagarajan 2769c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 27708dafb70eSVasanthakumar Thiagarajan goto err; 27718dafb70eSVasanthakumar Thiagarajan 277227929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 27738dafb70eSVasanthakumar Thiagarajan goto err; 27748dafb70eSVasanthakumar Thiagarajan 277555055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 277614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 277759c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 27788dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 277959c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 27808dafb70eSVasanthakumar Thiagarajan 278155055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 278255055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 278355055976SVasanthakumar Thiagarajan 278411f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2785990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 278611f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2787990bd915SVasanthakumar Thiagarajan 27888dafb70eSVasanthakumar Thiagarajan return ndev; 27898dafb70eSVasanthakumar Thiagarajan 27908dafb70eSVasanthakumar Thiagarajan err: 279127929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 279227929723SVasanthakumar Thiagarajan free_netdev(ndev); 2793bdcd8170SKalle Valo return NULL; 2794bdcd8170SKalle Valo } 2795bdcd8170SKalle Valo 279646d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 279746d33a21SKalle Valo { 279846d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 279946d33a21SKalle Valo int ret; 280046d33a21SKalle Valo 280146d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 280246d33a21SKalle Valo 280346d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 280446d33a21SKalle Valo 280546d33a21SKalle Valo /* set device pointer for wiphy */ 280646d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 280746d33a21SKalle Valo 280846d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 280946d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 281046d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 281146d33a21SKalle Valo if (ar->p2p) { 281246d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 281346d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 281446d33a21SKalle Valo } 281546d33a21SKalle Valo 281646d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 281746d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 281846d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 281946d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 282046d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 282146d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 282246d33a21SKalle Valo 282346d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 282446d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 282546d33a21SKalle Valo 282646d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 282746d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 282846d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 282946d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 283046d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 283146d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 283246d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 283346d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 283446d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 283546d33a21SKalle Valo 283646d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 283746d33a21SKalle Valo 283846d33a21SKalle Valo ret = wiphy_register(wiphy); 283946d33a21SKalle Valo if (ret < 0) { 284046d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 284146d33a21SKalle Valo return ret; 284246d33a21SKalle Valo } 284346d33a21SKalle Valo 284446d33a21SKalle Valo return 0; 284546d33a21SKalle Valo } 284646d33a21SKalle Valo 284746d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 2848bdcd8170SKalle Valo { 2849be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 285045eaa78fSKalle Valo } 285146d33a21SKalle Valo 285245eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 285345eaa78fSKalle Valo { 285445eaa78fSKalle Valo struct ath6kl *ar; 285545eaa78fSKalle Valo struct wiphy *wiphy; 285645eaa78fSKalle Valo 285745eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 285845eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 285945eaa78fSKalle Valo 286045eaa78fSKalle Valo if (!wiphy) { 286145eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 286245eaa78fSKalle Valo return NULL; 286345eaa78fSKalle Valo } 286445eaa78fSKalle Valo 286545eaa78fSKalle Valo ar = wiphy_priv(wiphy); 286645eaa78fSKalle Valo ar->wiphy = wiphy; 286745eaa78fSKalle Valo 286845eaa78fSKalle Valo return ar; 286945eaa78fSKalle Valo } 287045eaa78fSKalle Valo 287145eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 287245eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 287345eaa78fSKalle Valo { 2874be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2875bdcd8170SKalle Valo } 287645eaa78fSKalle Valo 2877