1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 31b2df407SVasanthakumar Thiagarajan * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4bdcd8170SKalle Valo * 5bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 6bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 7bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 8bdcd8170SKalle Valo * 9bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16bdcd8170SKalle Valo */ 17bdcd8170SKalle Valo 186eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 19c08631c6SRaja Mani #include <linux/inetdevice.h> 20d6a434d6SKalle Valo #include <linux/export.h> 216eb07cafSPaul Gortmaker 22bdcd8170SKalle Valo #include "core.h" 23bdcd8170SKalle Valo #include "cfg80211.h" 24bdcd8170SKalle Valo #include "debug.h" 25abcb344bSKalle Valo #include "hif-ops.h" 26003353b0SKalle Valo #include "testmode.h" 27bdcd8170SKalle Valo 28bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 29bdcd8170SKalle Valo .bitrate = (_rate), \ 30bdcd8170SKalle Valo .flags = (_flags), \ 31bdcd8170SKalle Valo .hw_value = (_rateid), \ 32bdcd8170SKalle Valo } 33bdcd8170SKalle Valo 34bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 35bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 36bdcd8170SKalle Valo .hw_value = (_channel), \ 37bdcd8170SKalle Valo .center_freq = (_freq), \ 38bdcd8170SKalle Valo .flags = (_flags), \ 39bdcd8170SKalle Valo .max_antenna_gain = 0, \ 40bdcd8170SKalle Valo .max_power = 30, \ 41bdcd8170SKalle Valo } 42bdcd8170SKalle Valo 43bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 44bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 45bdcd8170SKalle Valo .hw_value = (_channel), \ 46bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 47bdcd8170SKalle Valo .flags = (_flags), \ 48bdcd8170SKalle Valo .max_antenna_gain = 0, \ 49bdcd8170SKalle Valo .max_power = 30, \ 50bdcd8170SKalle Valo } 51bdcd8170SKalle Valo 52bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 53bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 54bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 55bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 56bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 57bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 58bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 59bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 60bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 61bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 62bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 63bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 64bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 65bdcd8170SKalle Valo }; 66bdcd8170SKalle Valo 67bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 68bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 69bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 70bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 71bdcd8170SKalle Valo 72faaf1929SVasanthakumar Thiagarajan #define ath6kl_g_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 73faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_20 | \ 74faaf1929SVasanthakumar Thiagarajan IEEE80211_HT_CAP_SGI_40) 75faaf1929SVasanthakumar Thiagarajan 76bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 77bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 78bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 79bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 80bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 81bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 82bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 83bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 84bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 85bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 86bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 87bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 88bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 89bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 90bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 91bdcd8170SKalle Valo }; 92bdcd8170SKalle Valo 93bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 94bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 95bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 96bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 97bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 98bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 99bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 100bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 101bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 102bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 103bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 104bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 105bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 106bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 107bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 108bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 109bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 110bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 111bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 112bdcd8170SKalle Valo CHAN5G(216, 0), 113bdcd8170SKalle Valo }; 114bdcd8170SKalle Valo 115bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 116bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 117bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 118bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 119bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 120faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 121faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 122bdcd8170SKalle Valo }; 123bdcd8170SKalle Valo 124bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 125bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 126bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 127bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 128bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 129faaf1929SVasanthakumar Thiagarajan .ht_cap.cap = ath6kl_g_htcap, 130faaf1929SVasanthakumar Thiagarajan .ht_cap.ht_supported = true, 131bdcd8170SKalle Valo }; 132bdcd8170SKalle Valo 133837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 134837cb97eSJouni Malinen 13510509f90SKalle Valo /* returns true if scheduled scan was stopped */ 13610509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 13710509f90SKalle Valo { 13810509f90SKalle Valo struct ath6kl *ar = vif->ar; 13910509f90SKalle Valo 14010509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 14110509f90SKalle Valo return false; 14210509f90SKalle Valo 14310509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 14410509f90SKalle Valo 14510509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 14610509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 14710509f90SKalle Valo 14810509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 14910509f90SKalle Valo 15010509f90SKalle Valo return true; 15110509f90SKalle Valo } 15210509f90SKalle Valo 15310509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 15410509f90SKalle Valo { 15510509f90SKalle Valo struct ath6kl *ar = vif->ar; 15610509f90SKalle Valo bool stopped; 15710509f90SKalle Valo 15810509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 15910509f90SKalle Valo 16010509f90SKalle Valo if (!stopped) 16110509f90SKalle Valo return; 16210509f90SKalle Valo 16310509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 16410509f90SKalle Valo } 16510509f90SKalle Valo 166240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 167bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 168bdcd8170SKalle Valo { 169bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 170bdcd8170SKalle Valo 171bdcd8170SKalle Valo if (!wpa_version) { 1723450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 173bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1743450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 175bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1763450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 177bdcd8170SKalle Valo } else { 178bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 179bdcd8170SKalle Valo return -ENOTSUPP; 180bdcd8170SKalle Valo } 181bdcd8170SKalle Valo 182bdcd8170SKalle Valo return 0; 183bdcd8170SKalle Valo } 184bdcd8170SKalle Valo 185240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 186bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 187bdcd8170SKalle Valo { 188bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 189bdcd8170SKalle Valo 190bdcd8170SKalle Valo switch (auth_type) { 191bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1923450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1953450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 196bdcd8170SKalle Valo break; 197bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1983450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 199bdcd8170SKalle Valo break; 200bdcd8170SKalle Valo 201bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 2023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 203bdcd8170SKalle Valo break; 204bdcd8170SKalle Valo 205bdcd8170SKalle Valo default: 2063c325fbdSMasanari Iida ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 207bdcd8170SKalle Valo return -ENOTSUPP; 208bdcd8170SKalle Valo } 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo return 0; 211bdcd8170SKalle Valo } 212bdcd8170SKalle Valo 213240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 214bdcd8170SKalle Valo { 2153450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2163450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2173450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 218bdcd8170SKalle Valo 219bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 220bdcd8170SKalle Valo __func__, cipher, ucast); 221bdcd8170SKalle Valo 222bdcd8170SKalle Valo switch (cipher) { 223bdcd8170SKalle Valo case 0: 224bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 225bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 226bdcd8170SKalle Valo *ar_cipher_len = 0; 227bdcd8170SKalle Valo break; 228bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 229bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 230bdcd8170SKalle Valo *ar_cipher_len = 5; 231bdcd8170SKalle Valo break; 232bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 233bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 234bdcd8170SKalle Valo *ar_cipher_len = 13; 235bdcd8170SKalle Valo break; 236bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 237bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 238bdcd8170SKalle Valo *ar_cipher_len = 0; 239bdcd8170SKalle Valo break; 240bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 241bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 242bdcd8170SKalle Valo *ar_cipher_len = 0; 243bdcd8170SKalle Valo break; 2445e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2455e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2465e07021eSDai Shuibing *ar_cipher_len = 0; 2475e07021eSDai Shuibing break; 248bdcd8170SKalle Valo default: 249bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 250bdcd8170SKalle Valo return -ENOTSUPP; 251bdcd8170SKalle Valo } 252bdcd8170SKalle Valo 253bdcd8170SKalle Valo return 0; 254bdcd8170SKalle Valo } 255bdcd8170SKalle Valo 256240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 257bdcd8170SKalle Valo { 258bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 259bdcd8170SKalle Valo 260bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2613450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2623450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2633450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2643450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 265837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2663450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2673450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2683450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2693450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 270bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2713450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 272bdcd8170SKalle Valo } 273bdcd8170SKalle Valo } 274bdcd8170SKalle Valo 275990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 276bdcd8170SKalle Valo { 277990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27859c98449SVasanthakumar Thiagarajan 279bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 280bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 281bdcd8170SKalle Valo return false; 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo 28459c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 285bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 286bdcd8170SKalle Valo return false; 287bdcd8170SKalle Valo } 288bdcd8170SKalle Valo 289bdcd8170SKalle Valo return true; 290bdcd8170SKalle Valo } 291bdcd8170SKalle Valo 2926981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2936981ffdcSKevin Fang { 2946981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2956981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2966981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2976981ffdcSKevin Fang } 2986981ffdcSKevin Fang 2996981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 3006981ffdcSKevin Fang { 3016981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 3026981ffdcSKevin Fang } 3036981ffdcSKevin Fang 30463541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 30563541212SAarthi Thiruvengadam { 30663541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 30763541212SAarthi Thiruvengadam pos[1] >= 4 && 30863541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 30963541212SAarthi Thiruvengadam pos[5] == 0x04); 31063541212SAarthi Thiruvengadam } 31163541212SAarthi Thiruvengadam 312334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3136981ffdcSKevin Fang size_t ies_len) 3146981ffdcSKevin Fang { 315334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3166981ffdcSKevin Fang const u8 *pos; 3176981ffdcSKevin Fang u8 *buf = NULL; 3186981ffdcSKevin Fang size_t len = 0; 3196981ffdcSKevin Fang int ret; 3206981ffdcSKevin Fang 3216981ffdcSKevin Fang /* 32263541212SAarthi Thiruvengadam * Clear previously set flag 32363541212SAarthi Thiruvengadam */ 32463541212SAarthi Thiruvengadam 32563541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 32663541212SAarthi Thiruvengadam 32763541212SAarthi Thiruvengadam /* 3286981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3296981ffdcSKevin Fang */ 3306981ffdcSKevin Fang 3316981ffdcSKevin Fang if (ies && ies_len) { 3326981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3336981ffdcSKevin Fang if (buf == NULL) 3346981ffdcSKevin Fang return -ENOMEM; 3356981ffdcSKevin Fang pos = ies; 3366981ffdcSKevin Fang 3376981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3386981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3396981ffdcSKevin Fang break; 3406981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3416981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3426981ffdcSKevin Fang len += 2 + pos[1]; 3436981ffdcSKevin Fang } 34463541212SAarthi Thiruvengadam 34563541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 34663541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 34763541212SAarthi Thiruvengadam 3486981ffdcSKevin Fang pos += 2 + pos[1]; 3496981ffdcSKevin Fang } 3506981ffdcSKevin Fang } 3516981ffdcSKevin Fang 352334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 353334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3546981ffdcSKevin Fang kfree(buf); 3556981ffdcSKevin Fang return ret; 3566981ffdcSKevin Fang } 3576981ffdcSKevin Fang 35855055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 35955055976SVasanthakumar Thiagarajan { 36055055976SVasanthakumar Thiagarajan switch (type) { 36155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 36255055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36355055976SVasanthakumar Thiagarajan break; 36455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 36555055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 36655055976SVasanthakumar Thiagarajan break; 36755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 36855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36955055976SVasanthakumar Thiagarajan break; 37055055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 37155055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 37255055976SVasanthakumar Thiagarajan break; 37355055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 37455055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 37555055976SVasanthakumar Thiagarajan break; 37655055976SVasanthakumar Thiagarajan default: 37755055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 37855055976SVasanthakumar Thiagarajan return -ENOTSUPP; 37955055976SVasanthakumar Thiagarajan } 38055055976SVasanthakumar Thiagarajan 38155055976SVasanthakumar Thiagarajan return 0; 38255055976SVasanthakumar Thiagarajan } 38355055976SVasanthakumar Thiagarajan 38455055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 38555055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38655055976SVasanthakumar Thiagarajan { 38755055976SVasanthakumar Thiagarajan int i; 38855055976SVasanthakumar Thiagarajan 38955055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 39055055976SVasanthakumar Thiagarajan return false; 39155055976SVasanthakumar Thiagarajan 39255055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 39355055976SVasanthakumar Thiagarajan ar->num_vif)) 39455055976SVasanthakumar Thiagarajan return false; 39555055976SVasanthakumar Thiagarajan 39655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39755055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 39871f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 39955055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 40055055976SVasanthakumar Thiagarajan *if_idx = i; 40155055976SVasanthakumar Thiagarajan return true; 40255055976SVasanthakumar Thiagarajan } 40355055976SVasanthakumar Thiagarajan } 40455055976SVasanthakumar Thiagarajan } 40555055976SVasanthakumar Thiagarajan 4063226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4073226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 40871f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4093226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4103226f68aSVasanthakumar Thiagarajan *if_idx = i; 4113226f68aSVasanthakumar Thiagarajan return true; 4123226f68aSVasanthakumar Thiagarajan } 4133226f68aSVasanthakumar Thiagarajan } 4143226f68aSVasanthakumar Thiagarajan } 4153226f68aSVasanthakumar Thiagarajan 41655055976SVasanthakumar Thiagarajan return false; 41755055976SVasanthakumar Thiagarajan } 41855055976SVasanthakumar Thiagarajan 4198c9bb054SKalle Valo static bool ath6kl_is_tx_pending(struct ath6kl *ar) 4208c9bb054SKalle Valo { 4218c9bb054SKalle Valo return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 4228c9bb054SKalle Valo } 4238c9bb054SKalle Valo 4248c9bb054SKalle Valo 425bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 426bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 427bdcd8170SKalle Valo { 428bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 42959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 430bdcd8170SKalle Valo int status; 4313ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 432ce0dc0cfSRaja Mani u16 interval; 433bdcd8170SKalle Valo 43410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 43510509f90SKalle Valo 43614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 437bdcd8170SKalle Valo 438990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 439bdcd8170SKalle Valo return -EIO; 440bdcd8170SKalle Valo 441bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 442bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 443bdcd8170SKalle Valo return -EBUSY; 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 447bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 448bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 449bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 450bdcd8170SKalle Valo return -EINVAL; 451bdcd8170SKalle Valo } 452bdcd8170SKalle Valo 453bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 454bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 455bdcd8170SKalle Valo return -ERESTARTSYS; 456bdcd8170SKalle Valo } 457bdcd8170SKalle Valo 458bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 459bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 460bdcd8170SKalle Valo up(&ar->sem); 461bdcd8170SKalle Valo return -EBUSY; 462bdcd8170SKalle Valo } 463bdcd8170SKalle Valo 464bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 465bdcd8170SKalle Valo /* 466bdcd8170SKalle Valo * sleep until the command queue drains 467bdcd8170SKalle Valo */ 468bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 4698c9bb054SKalle Valo ath6kl_is_tx_pending(ar), 470bdcd8170SKalle Valo WMI_TIMEOUT); 471bdcd8170SKalle Valo if (signal_pending(current)) { 472bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 473bdcd8170SKalle Valo up(&ar->sem); 474bdcd8170SKalle Valo return -EINTR; 475bdcd8170SKalle Valo } 476bdcd8170SKalle Valo } 477bdcd8170SKalle Valo 478334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 479743b4518SDan Carpenter if (status) { 480743b4518SDan Carpenter up(&ar->sem); 4816981ffdcSKevin Fang return status; 482743b4518SDan Carpenter } 4836e786cb1SJouni Malinen 4846e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 485542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4866981ffdcSKevin Fang 48759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4883450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4893450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 490cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 491334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 492334234b5SVasanthakumar Thiagarajan vif->req_bssid, 493f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 494bdcd8170SKalle Valo 495bdcd8170SKalle Valo up(&ar->sem); 496bdcd8170SKalle Valo if (status) { 497bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 498bdcd8170SKalle Valo return -EIO; 499bdcd8170SKalle Valo } 500bdcd8170SKalle Valo return 0; 5013450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 5023450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 503240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo 5063450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5073450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5083450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 509bdcd8170SKalle Valo 510bdcd8170SKalle Valo if (sme->channel) 511f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 512bdcd8170SKalle Valo 5138c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 514bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5158c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 516bdcd8170SKalle Valo 517240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 518bdcd8170SKalle Valo 519240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 520bdcd8170SKalle Valo if (status) { 521bdcd8170SKalle Valo up(&ar->sem); 522bdcd8170SKalle Valo return status; 523bdcd8170SKalle Valo } 524bdcd8170SKalle Valo 525bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 526240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 527bdcd8170SKalle Valo else 528240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 529bdcd8170SKalle Valo 530240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 531bdcd8170SKalle Valo 532bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 533240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 534bdcd8170SKalle Valo 535bdcd8170SKalle Valo if ((sme->key_len) && 5363450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5373450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 538bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 539bdcd8170SKalle Valo 540792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 541bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 542bdcd8170SKalle Valo sme->key_idx); 543bdcd8170SKalle Valo up(&ar->sem); 544bdcd8170SKalle Valo return -ENOENT; 545bdcd8170SKalle Valo } 546bdcd8170SKalle Valo 5476f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 548bdcd8170SKalle Valo key->key_len = sme->key_len; 549bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5503450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5513450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 552bdcd8170SKalle Valo 553334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5543450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 555bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 556bdcd8170SKalle Valo key->key_len, 557f4bb9a6fSJouni Malinen NULL, 0, 558bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 559bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 560bdcd8170SKalle Valo } 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 56359c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 564240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 565240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 566bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 567bdcd8170SKalle Valo up(&ar->sem); 568bdcd8170SKalle Valo return -EIO; 569bdcd8170SKalle Valo } 570bdcd8170SKalle Valo } 571bdcd8170SKalle Valo 572f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 573bdcd8170SKalle Valo 5743ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5753ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5763ca9d1fcSAarthi Thiruvengadam 577bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 578bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 579bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 580bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 581bdcd8170SKalle Valo __func__, 5823450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5833450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 584f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 585bdcd8170SKalle Valo 586cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 587ce0dc0cfSRaja Mani 588ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 589b5283871SKalle Valo interval = max_t(u16, vif->listen_intvl_t, 590b5283871SKalle Valo ATH6KL_MAX_WOW_LISTEN_INTL); 591ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 592ce0dc0cfSRaja Mani interval, 593ce0dc0cfSRaja Mani 0); 594ce0dc0cfSRaja Mani if (status) { 595ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 596ce0dc0cfSRaja Mani up(&ar->sem); 597ce0dc0cfSRaja Mani return status; 598ce0dc0cfSRaja Mani } 599ce0dc0cfSRaja Mani } 600ce0dc0cfSRaja Mani 601334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 6023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 6033450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 6043450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 6053450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6063450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 607f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6083ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 609bdcd8170SKalle Valo 610bdcd8170SKalle Valo up(&ar->sem); 611bdcd8170SKalle Valo 612bdcd8170SKalle Valo if (status == -EINVAL) { 6133450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6143450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 615bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 616bdcd8170SKalle Valo return -ENOENT; 617bdcd8170SKalle Valo } else if (status) { 618bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 619bdcd8170SKalle Valo return -EIO; 620bdcd8170SKalle Valo } 621bdcd8170SKalle Valo 622bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 623ddc3d77cSKalle Valo ((vif->auth_mode == WPA_PSK_AUTH) || 624ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH))) { 625de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 626bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 627bdcd8170SKalle Valo } 628bdcd8170SKalle Valo 629bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 63059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo return 0; 633bdcd8170SKalle Valo } 634bdcd8170SKalle Valo 6355e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6365e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6374eab6f4fSRaja Mani enum network_type nw_type, 6384eab6f4fSRaja Mani const u8 *bssid, 63901cac476SJouni Malinen struct ieee80211_channel *chan, 6405e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6415e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 64201cac476SJouni Malinen { 643240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 64401cac476SJouni Malinen struct cfg80211_bss *bss; 6454eab6f4fSRaja Mani u16 cap_mask, cap_val; 64601cac476SJouni Malinen u8 *ie; 64701cac476SJouni Malinen 6484eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6494eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6504eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6514eab6f4fSRaja Mani } else { 6524eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6534eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6544eab6f4fSRaja Mani } 6554eab6f4fSRaja Mani 656be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6574eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6584eab6f4fSRaja Mani cap_mask, cap_val); 65901cac476SJouni Malinen if (bss == NULL) { 66001cac476SJouni Malinen /* 66101cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 66201cac476SJouni Malinen * generate a partial entry until the first BSS info 66301cac476SJouni Malinen * event becomes available. 66401cac476SJouni Malinen * 66501cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 66601cac476SJouni Malinen * IEs from the target. 66701cac476SJouni Malinen */ 6683450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 66901cac476SJouni Malinen if (ie == NULL) 6705e13fd35SVasanthakumar Thiagarajan return NULL; 67101cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6723450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6733450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6743450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 675be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6764eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6773450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 67801cac476SJouni Malinen 0, GFP_KERNEL); 67901cac476SJouni Malinen if (bss) 6804eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6814eab6f4fSRaja Mani "cfg80211\n", bssid); 68201cac476SJouni Malinen kfree(ie); 68301cac476SJouni Malinen } else 6845e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 68501cac476SJouni Malinen 6865e13fd35SVasanthakumar Thiagarajan return bss; 68701cac476SJouni Malinen } 68801cac476SJouni Malinen 689240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 690bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 691bdcd8170SKalle Valo u16 beacon_intvl, 692bdcd8170SKalle Valo enum network_type nw_type, 693bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 694bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 695bdcd8170SKalle Valo { 69601cac476SJouni Malinen struct ieee80211_channel *chan; 697240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6985e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 699bdcd8170SKalle Valo 700bdcd8170SKalle Valo /* capinfo + listen interval */ 701bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 702bdcd8170SKalle Valo 703bdcd8170SKalle Valo /* capinfo + status code + associd */ 704bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 705bdcd8170SKalle Valo 706bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 707bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 708bdcd8170SKalle Valo assoc_resp_ie_offset; 709bdcd8170SKalle Valo 710bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 711bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 712bdcd8170SKalle Valo 71332c10874SJouni Malinen /* 71432c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 71532c10874SJouni Malinen * a Beacon frame from the AP is seen. 71632c10874SJouni Malinen */ 717cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 71859c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 71932c10874SJouni Malinen 720bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 721551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 722bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 723bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 724bdcd8170SKalle Valo return; 725bdcd8170SKalle Valo } 726bdcd8170SKalle Valo } 727bdcd8170SKalle Valo 728bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 729551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 730551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 731bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 732bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 733bdcd8170SKalle Valo return; 734bdcd8170SKalle Valo } 735bdcd8170SKalle Valo } 736bdcd8170SKalle Valo 737be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 738bdcd8170SKalle Valo 7395e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7405e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7415e13fd35SVasanthakumar Thiagarajan if (!bss) { 7424eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 743bdcd8170SKalle Valo return; 744bdcd8170SKalle Valo } 745bdcd8170SKalle Valo 7464eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7474eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7484eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7494eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7505e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 75101cac476SJouni Malinen return; 75201cac476SJouni Malinen } 75301cac476SJouni Malinen 75414ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 755bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 75614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 757240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 758bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 759bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 760bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7615e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 76214ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 763bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7645e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 765bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 766bdcd8170SKalle Valo } 767bdcd8170SKalle Valo } 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 770bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 771bdcd8170SKalle Valo { 772d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7733450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 774bdcd8170SKalle Valo 775bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 776bdcd8170SKalle Valo reason_code); 777bdcd8170SKalle Valo 77810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 77910509f90SKalle Valo 780990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 781bdcd8170SKalle Valo return -EIO; 782bdcd8170SKalle Valo 783bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 784bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 785bdcd8170SKalle Valo return -EBUSY; 786bdcd8170SKalle Valo } 787bdcd8170SKalle Valo 788bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 789bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 790bdcd8170SKalle Valo return -ERESTARTSYS; 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo 793cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 794240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7953450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7963450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 797bdcd8170SKalle Valo 798bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7998c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 800bdcd8170SKalle Valo 801bdcd8170SKalle Valo up(&ar->sem); 802bdcd8170SKalle Valo 80314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 804170826ddSVasanthakumar Thiagarajan 805bdcd8170SKalle Valo return 0; 806bdcd8170SKalle Valo } 807bdcd8170SKalle Valo 808240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 809bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 810bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 811bdcd8170SKalle Valo { 812240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 81359c98449SVasanthakumar Thiagarajan 81414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 81514ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 81614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 817bdcd8170SKalle Valo } 818bdcd8170SKalle Valo 819f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 820551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 821bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 822bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 823bdcd8170SKalle Valo return; 824bdcd8170SKalle Valo } 825bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 826240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 827bdcd8170SKalle Valo return; 828bdcd8170SKalle Valo } 829bdcd8170SKalle Valo 830f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 831551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 832551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 833bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 834bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 835bdcd8170SKalle Valo return; 836bdcd8170SKalle Valo } 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 8391de547d6SVasanthakumar Thiagarajan /* 8401de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8411de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8421de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8431de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8441de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8451de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8461de547d6SVasanthakumar Thiagarajan */ 847bdcd8170SKalle Valo 8481de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 849334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 850bdcd8170SKalle Valo return; 851bdcd8170SKalle Valo } 852bdcd8170SKalle Valo 85359c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 854bdcd8170SKalle Valo 85514ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 856240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 857bdcd8170SKalle Valo bssid, NULL, 0, 858bdcd8170SKalle Valo NULL, 0, 859bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 860bdcd8170SKalle Valo GFP_KERNEL); 86114ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 862240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 863bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 864bdcd8170SKalle Valo } 865bdcd8170SKalle Valo 86614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo 869bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 870bdcd8170SKalle Valo struct cfg80211_scan_request *request) 871bdcd8170SKalle Valo { 872d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 87359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8741276c9efSEdward Lu s8 n_channels = 0; 8751276c9efSEdward Lu u16 *channels = NULL; 876bdcd8170SKalle Valo int ret = 0; 877f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 878bdcd8170SKalle Valo 879990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 880bdcd8170SKalle Valo return -EIO; 881bdcd8170SKalle Valo 88210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 88310509f90SKalle Valo 884bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 88559c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8861b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 887240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 88859c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8891b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8901b1e6ee3SJouni Malinen if (ret) { 891bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8921b1e6ee3SJouni Malinen return ret; 893bdcd8170SKalle Valo } 894bdcd8170SKalle Valo } 895bdcd8170SKalle Valo 896bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 897bdcd8170SKalle Valo u8 i; 898bdcd8170SKalle Valo 899bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 900bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 901bdcd8170SKalle Valo 902bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 903334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 904334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 905bdcd8170SKalle Valo request->ssids[i].ssid_len, 906bdcd8170SKalle Valo request->ssids[i].ssid); 907bdcd8170SKalle Valo } 908bdcd8170SKalle Valo 909080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 910334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 911334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 912b84da8c7SJouni Malinen request->ie, request->ie_len); 913b84da8c7SJouni Malinen if (ret) { 914b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 915b84da8c7SJouni Malinen "scan"); 916b84da8c7SJouni Malinen return ret; 917b84da8c7SJouni Malinen } 918b84da8c7SJouni Malinen 91911869befSJouni Malinen /* 92011869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 92111869befSJouni Malinen * channels. If the list is longer than the target supports, do not 92211869befSJouni Malinen * configure the list and instead, scan all available channels. 92311869befSJouni Malinen */ 92411869befSJouni Malinen if (request->n_channels > 0 && 92511869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9261276c9efSEdward Lu u8 i; 9271276c9efSEdward Lu 92811869befSJouni Malinen n_channels = request->n_channels; 9291276c9efSEdward Lu 9301276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9311276c9efSEdward Lu if (channels == NULL) { 9321276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9331276c9efSEdward Lu "scan all channels"); 9341276c9efSEdward Lu n_channels = 0; 9351276c9efSEdward Lu } 9361276c9efSEdward Lu 9371276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9381276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9391276c9efSEdward Lu } 9401276c9efSEdward Lu 94159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 942f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 943f1f92179SVasanthakumar Thiagarajan 9443ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9453ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9463ca9d1fcSAarthi Thiruvengadam /* 9473ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9483ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9493ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9503ca9d1fcSAarthi Thiruvengadam * probe requests 9513ca9d1fcSAarthi Thiruvengadam */ 9523ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9533ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 95413423c31SVasanthakumar Thiagarajan false, 0, 95513423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95613423c31SVasanthakumar Thiagarajan n_channels, channels, 95713423c31SVasanthakumar Thiagarajan request->no_cck, 9583ca9d1fcSAarthi Thiruvengadam request->rates); 9593ca9d1fcSAarthi Thiruvengadam } else { 9603ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9613ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 96213423c31SVasanthakumar Thiagarajan false, 0, 96313423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 96413423c31SVasanthakumar Thiagarajan n_channels, channels); 9653ca9d1fcSAarthi Thiruvengadam } 9661b1e6ee3SJouni Malinen if (ret) 967bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 96811869befSJouni Malinen else 96914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 970bdcd8170SKalle Valo 9711276c9efSEdward Lu kfree(channels); 9721276c9efSEdward Lu 973bdcd8170SKalle Valo return ret; 974bdcd8170SKalle Valo } 975bdcd8170SKalle Valo 9761c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 977bdcd8170SKalle Valo { 978240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9796fd1eaceSKalle Valo int i; 980bdcd8170SKalle Valo 9811c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9821c17d313SKalle Valo aborted ? " aborted" : ""); 983bdcd8170SKalle Valo 98414ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9856fd1eaceSKalle Valo return; 9866fd1eaceSKalle Valo 9871c17d313SKalle Valo if (aborted) 9886fd1eaceSKalle Valo goto out; 989bdcd8170SKalle Valo 99014ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 99114ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 992334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 993334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 994bdcd8170SKalle Valo 0, NULL); 995bdcd8170SKalle Valo } 996bdcd8170SKalle Valo } 9976fd1eaceSKalle Valo 9986fd1eaceSKalle Valo out: 999cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 100014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 1001bdcd8170SKalle Valo } 1002bdcd8170SKalle Valo 1003bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1004bdcd8170SKalle Valo u8 key_index, bool pairwise, 1005bdcd8170SKalle Valo const u8 *mac_addr, 1006bdcd8170SKalle Valo struct key_params *params) 1007bdcd8170SKalle Valo { 1008d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 100959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1010bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10114a8ce2fdSSujith Manoharan int seq_len; 1012bdcd8170SKalle Valo u8 key_usage; 1013bdcd8170SKalle Valo u8 key_type; 1014bdcd8170SKalle Valo 1015990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1016bdcd8170SKalle Valo return -EIO; 1017bdcd8170SKalle Valo 1018837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1019837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1020837cb97eSJouni Malinen return -EINVAL; 1021240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1022240d2799SVasanthakumar Thiagarajan params->key); 1023837cb97eSJouni Malinen } 1024837cb97eSJouni Malinen 1025792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1026bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1027bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1028bdcd8170SKalle Valo key_index); 1029bdcd8170SKalle Valo return -ENOENT; 1030bdcd8170SKalle Valo } 1031bdcd8170SKalle Valo 10326f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1033bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1034bdcd8170SKalle Valo 1035bdcd8170SKalle Valo if (pairwise) 1036bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1037bdcd8170SKalle Valo else 1038bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1039bdcd8170SKalle Valo 10404a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10415e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10425e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10435e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10445e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10455e07021eSDai Shuibing } 1046bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10475e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1048bdcd8170SKalle Valo return -EINVAL; 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo key->key_len = params->key_len; 1051bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10525e07021eSDai Shuibing key->seq_len = seq_len; 1053bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1054bdcd8170SKalle Valo key->cipher = params->cipher; 1055bdcd8170SKalle Valo 1056bdcd8170SKalle Valo switch (key->cipher) { 1057bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1058bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1059bdcd8170SKalle Valo key_type = WEP_CRYPT; 1060bdcd8170SKalle Valo break; 1061bdcd8170SKalle Valo 1062bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1063bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1064bdcd8170SKalle Valo break; 1065bdcd8170SKalle Valo 1066bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1067bdcd8170SKalle Valo key_type = AES_CRYPT; 1068bdcd8170SKalle Valo break; 10695e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10705e07021eSDai Shuibing key_type = WAPI_CRYPT; 10715e07021eSDai Shuibing break; 1072bdcd8170SKalle Valo 1073bdcd8170SKalle Valo default: 1074bdcd8170SKalle Valo return -ENOTSUPP; 1075bdcd8170SKalle Valo } 1076bdcd8170SKalle Valo 1077ddc3d77cSKalle Valo if (((vif->auth_mode == WPA_PSK_AUTH) || 1078ddc3d77cSKalle Valo (vif->auth_mode == WPA2_PSK_AUTH)) && 1079ddc3d77cSKalle Valo (key_usage & GROUP_USAGE)) 1080de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1081bdcd8170SKalle Valo 1082bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1083bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1084bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1085bdcd8170SKalle Valo key_usage, key->seq_len); 1086bdcd8170SKalle Valo 1087f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10884703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1089cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10909a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10919a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10929a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10939a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10949a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 109559c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10969a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10979a5b1318SJouni Malinen "key configuration until AP mode has been " 10989a5b1318SJouni Malinen "started\n"); 10999a5b1318SJouni Malinen /* 11009a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 11019a5b1318SJouni Malinen * the connected event is received from the target. 11029a5b1318SJouni Malinen */ 11039a5b1318SJouni Malinen return 0; 11049a5b1318SJouni Malinen } 11059a5b1318SJouni Malinen } 11069a5b1318SJouni Malinen 1107f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 110859c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1109151411e8SJouni Malinen /* 1110151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1111151411e8SJouni Malinen * the AP mode has properly started 1112151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1113151411e8SJouni Malinen */ 1114151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1115151411e8SJouni Malinen "until AP mode has been started\n"); 11166f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11176f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11186f2a73f9SVasanthakumar Thiagarajan key->key_len); 1119151411e8SJouni Malinen return 0; 1120151411e8SJouni Malinen } 1121151411e8SJouni Malinen 11227cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1123bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1124f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1125f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1126bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1127bdcd8170SKalle Valo } 1128bdcd8170SKalle Valo 1129bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1130bdcd8170SKalle Valo u8 key_index, bool pairwise, 1131bdcd8170SKalle Valo const u8 *mac_addr) 1132bdcd8170SKalle Valo { 1133d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11346f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1135bdcd8170SKalle Valo 1136bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1137bdcd8170SKalle Valo 1138990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1139bdcd8170SKalle Valo return -EIO; 1140bdcd8170SKalle Valo 1141792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1142bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1143bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1144bdcd8170SKalle Valo key_index); 1145bdcd8170SKalle Valo return -ENOENT; 1146bdcd8170SKalle Valo } 1147bdcd8170SKalle Valo 11486f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1149bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1150bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1151bdcd8170SKalle Valo return 0; 1152bdcd8170SKalle Valo } 1153bdcd8170SKalle Valo 11546f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1155bdcd8170SKalle Valo 1156334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1157bdcd8170SKalle Valo } 1158bdcd8170SKalle Valo 1159bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1160bdcd8170SKalle Valo u8 key_index, bool pairwise, 1161bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1162bdcd8170SKalle Valo void (*callback) (void *cookie, 1163bdcd8170SKalle Valo struct key_params *)) 1164bdcd8170SKalle Valo { 11656f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1166bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1167bdcd8170SKalle Valo struct key_params params; 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1170bdcd8170SKalle Valo 1171990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1172bdcd8170SKalle Valo return -EIO; 1173bdcd8170SKalle Valo 1174792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1176bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1177bdcd8170SKalle Valo key_index); 1178bdcd8170SKalle Valo return -ENOENT; 1179bdcd8170SKalle Valo } 1180bdcd8170SKalle Valo 11816f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1182bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1183bdcd8170SKalle Valo params.cipher = key->cipher; 1184bdcd8170SKalle Valo params.key_len = key->key_len; 1185bdcd8170SKalle Valo params.seq_len = key->seq_len; 1186bdcd8170SKalle Valo params.seq = key->seq; 1187bdcd8170SKalle Valo params.key = key->key; 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo callback(cookie, ¶ms); 1190bdcd8170SKalle Valo 1191bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 1194bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1195bdcd8170SKalle Valo struct net_device *ndev, 1196bdcd8170SKalle Valo u8 key_index, bool unicast, 1197bdcd8170SKalle Valo bool multicast) 1198bdcd8170SKalle Valo { 1199d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 120059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1201bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1202bdcd8170SKalle Valo u8 key_usage; 1203229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1206bdcd8170SKalle Valo 1207990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1208bdcd8170SKalle Valo return -EIO; 1209bdcd8170SKalle Valo 1210792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1211bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1212bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1213bdcd8170SKalle Valo __func__, key_index); 1214bdcd8170SKalle Valo return -ENOENT; 1215bdcd8170SKalle Valo } 1216bdcd8170SKalle Valo 12176f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1218bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1219bdcd8170SKalle Valo __func__, key_index); 1220bdcd8170SKalle Valo return -EINVAL; 1221bdcd8170SKalle Valo } 1222bdcd8170SKalle Valo 12233450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12246f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1225bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12263450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1227bdcd8170SKalle Valo key_usage |= TX_USAGE; 1228229ed6b5SEdward Lu if (unicast) 12293450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1230229ed6b5SEdward Lu if (multicast) 12313450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1232bdcd8170SKalle Valo 1233f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12349a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12359a5b1318SJouni Malinen 1236f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1237334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1238229ed6b5SEdward Lu key_type, key_usage, 1239f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1240f4bb9a6fSJouni Malinen key->key, 1241bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1242bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1243bdcd8170SKalle Valo } 1244bdcd8170SKalle Valo 1245240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1246bdcd8170SKalle Valo bool ismcast) 1247bdcd8170SKalle Valo { 1248bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1249bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1250bdcd8170SKalle Valo 1251240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1252bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1253bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1254bdcd8170SKalle Valo GFP_KERNEL); 1255bdcd8170SKalle Valo } 1256bdcd8170SKalle Valo 1257bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1258bdcd8170SKalle Valo { 1259bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1260990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1261bdcd8170SKalle Valo int ret; 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1264bdcd8170SKalle Valo changed); 1265bdcd8170SKalle Valo 1266990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1267990bd915SVasanthakumar Thiagarajan if (!vif) 1268990bd915SVasanthakumar Thiagarajan return -EIO; 1269990bd915SVasanthakumar Thiagarajan 1270990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1271bdcd8170SKalle Valo return -EIO; 1272bdcd8170SKalle Valo 1273bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1274bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1275bdcd8170SKalle Valo if (ret != 0) { 1276bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1277bdcd8170SKalle Valo return -EIO; 1278bdcd8170SKalle Valo } 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo return 0; 1282bdcd8170SKalle Valo } 1283bdcd8170SKalle Valo 1284bdcd8170SKalle Valo /* 1285bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1286bdcd8170SKalle Valo * data type from 2.6.36 onwards 1287bdcd8170SKalle Valo */ 1288bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1289bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1290b992a285SLuis R. Rodriguez int mbm) 1291bdcd8170SKalle Valo { 1292bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1293990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1294b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1297bdcd8170SKalle Valo type, dbm); 1298bdcd8170SKalle Valo 1299990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1300990bd915SVasanthakumar Thiagarajan if (!vif) 1301990bd915SVasanthakumar Thiagarajan return -EIO; 1302990bd915SVasanthakumar Thiagarajan 1303990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1304bdcd8170SKalle Valo return -EIO; 1305bdcd8170SKalle Valo 1306bdcd8170SKalle Valo switch (type) { 1307bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1308bdcd8170SKalle Valo return 0; 1309bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1310d0d670abSKalle Valo ar->tx_pwr = dbm; 1311bdcd8170SKalle Valo break; 1312bdcd8170SKalle Valo default: 1313bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1314bdcd8170SKalle Valo __func__, type); 1315bdcd8170SKalle Valo return -EOPNOTSUPP; 1316bdcd8170SKalle Valo } 1317bdcd8170SKalle Valo 1318d0d670abSKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1319bdcd8170SKalle Valo 1320bdcd8170SKalle Valo return 0; 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo 1323bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1324bdcd8170SKalle Valo { 1325bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1326990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1327bdcd8170SKalle Valo 1328990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1329990bd915SVasanthakumar Thiagarajan if (!vif) 1330990bd915SVasanthakumar Thiagarajan return -EIO; 1331990bd915SVasanthakumar Thiagarajan 1332990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1333bdcd8170SKalle Valo return -EIO; 1334bdcd8170SKalle Valo 133559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1336bdcd8170SKalle Valo ar->tx_pwr = 0; 1337bdcd8170SKalle Valo 1338990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1339bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1340bdcd8170SKalle Valo return -EIO; 1341bdcd8170SKalle Valo } 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1344bdcd8170SKalle Valo 5 * HZ); 1345bdcd8170SKalle Valo 1346bdcd8170SKalle Valo if (signal_pending(current)) { 1347bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1348bdcd8170SKalle Valo return -EINTR; 1349bdcd8170SKalle Valo } 1350bdcd8170SKalle Valo } 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1353bdcd8170SKalle Valo return 0; 1354bdcd8170SKalle Valo } 1355bdcd8170SKalle Valo 1356bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1357bdcd8170SKalle Valo struct net_device *dev, 1358bdcd8170SKalle Valo bool pmgmt, int timeout) 1359bdcd8170SKalle Valo { 1360bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1361bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1362334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1363bdcd8170SKalle Valo 1364bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1365bdcd8170SKalle Valo __func__, pmgmt, timeout); 1366bdcd8170SKalle Valo 1367990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1368bdcd8170SKalle Valo return -EIO; 1369bdcd8170SKalle Valo 1370bdcd8170SKalle Valo if (pmgmt) { 1371bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1372bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1373bdcd8170SKalle Valo } else { 1374bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1375bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1376bdcd8170SKalle Valo } 1377bdcd8170SKalle Valo 1378334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1379334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1380bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1381bdcd8170SKalle Valo return -EIO; 1382bdcd8170SKalle Valo } 1383bdcd8170SKalle Valo 1384bdcd8170SKalle Valo return 0; 1385bdcd8170SKalle Valo } 1386bdcd8170SKalle Valo 138755055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 138855055976SVasanthakumar Thiagarajan char *name, 138955055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 139055055976SVasanthakumar Thiagarajan u32 *flags, 139155055976SVasanthakumar Thiagarajan struct vif_params *params) 139255055976SVasanthakumar Thiagarajan { 139355055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139455055976SVasanthakumar Thiagarajan struct net_device *ndev; 139555055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 139655055976SVasanthakumar Thiagarajan 139771f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 139855055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 139955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140055055976SVasanthakumar Thiagarajan } 140155055976SVasanthakumar Thiagarajan 140255055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 140355055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 140455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140555055976SVasanthakumar Thiagarajan } 140655055976SVasanthakumar Thiagarajan 140755055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 140855055976SVasanthakumar Thiagarajan if (!ndev) 140955055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 141055055976SVasanthakumar Thiagarajan 141155055976SVasanthakumar Thiagarajan ar->num_vif++; 141255055976SVasanthakumar Thiagarajan 141355055976SVasanthakumar Thiagarajan return ndev; 141455055976SVasanthakumar Thiagarajan } 141555055976SVasanthakumar Thiagarajan 141655055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 141755055976SVasanthakumar Thiagarajan struct net_device *ndev) 141855055976SVasanthakumar Thiagarajan { 141955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 142055055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 142155055976SVasanthakumar Thiagarajan 142211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 142355055976SVasanthakumar Thiagarajan list_del(&vif->list); 142411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 142555055976SVasanthakumar Thiagarajan 142655055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 142755055976SVasanthakumar Thiagarajan 1428c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 142955055976SVasanthakumar Thiagarajan 143055055976SVasanthakumar Thiagarajan return 0; 143155055976SVasanthakumar Thiagarajan } 143255055976SVasanthakumar Thiagarajan 1433bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1434bdcd8170SKalle Valo struct net_device *ndev, 1435bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1436bdcd8170SKalle Valo struct vif_params *params) 1437bdcd8170SKalle Valo { 1438f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1441bdcd8170SKalle Valo 1442bdcd8170SKalle Valo switch (type) { 1443bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1444f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1445bdcd8170SKalle Valo break; 1446bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1447f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1448bdcd8170SKalle Valo break; 14496e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1450f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14516e4604c8SJouni Malinen break; 14526b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1453f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14546b5e5d25SJouni Malinen break; 14556b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1456f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14576b5e5d25SJouni Malinen break; 1458bdcd8170SKalle Valo default: 1459bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1460bdcd8170SKalle Valo return -EOPNOTSUPP; 1461bdcd8170SKalle Valo } 1462bdcd8170SKalle Valo 1463551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo return 0; 1466bdcd8170SKalle Valo } 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1469bdcd8170SKalle Valo struct net_device *dev, 1470bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1471bdcd8170SKalle Valo { 1472bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 147359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1474bdcd8170SKalle Valo int status; 1475bdcd8170SKalle Valo 1476990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1477bdcd8170SKalle Valo return -EIO; 1478bdcd8170SKalle Valo 14793450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14803450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1481bdcd8170SKalle Valo 1482bdcd8170SKalle Valo if (ibss_param->channel) 1483f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1484bdcd8170SKalle Valo 1485bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1486bdcd8170SKalle Valo /* 1487bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1488bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1489bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1490bdcd8170SKalle Valo * updated. 1491bdcd8170SKalle Valo */ 1492bdcd8170SKalle Valo return -EOPNOTSUPP; 1493bdcd8170SKalle Valo } 1494bdcd8170SKalle Valo 14958c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1496bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14978c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14988c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1499bdcd8170SKalle Valo 1500240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1501bdcd8170SKalle Valo 1502240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1503bdcd8170SKalle Valo if (status) 1504bdcd8170SKalle Valo return status; 1505bdcd8170SKalle Valo 1506bdcd8170SKalle Valo if (ibss_param->privacy) { 1507240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1508240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1509bdcd8170SKalle Valo } else { 1510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1511240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1512bdcd8170SKalle Valo } 1513bdcd8170SKalle Valo 1514f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1515bdcd8170SKalle Valo 1516bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1517bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1518bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1519bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1520bdcd8170SKalle Valo __func__, 15213450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15223450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1523f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1524bdcd8170SKalle Valo 1525334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15263450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15273450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15283450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15293450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15303450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1531f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15323ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 153359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1534bdcd8170SKalle Valo 1535bdcd8170SKalle Valo return 0; 1536bdcd8170SKalle Valo } 1537bdcd8170SKalle Valo 1538bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1539bdcd8170SKalle Valo struct net_device *dev) 1540bdcd8170SKalle Valo { 15413450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1542bdcd8170SKalle Valo 1543990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1544bdcd8170SKalle Valo return -EIO; 1545bdcd8170SKalle Valo 1546240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15473450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15483450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo return 0; 1551bdcd8170SKalle Valo } 1552bdcd8170SKalle Valo 1553bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1554bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1555bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1556bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1557bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1558837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15595e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1560bdcd8170SKalle Valo }; 1561bdcd8170SKalle Valo 1562bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1563bdcd8170SKalle Valo { 1564bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1565bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1566bdcd8170SKalle Valo 36000, 48000, 54000 1567bdcd8170SKalle Valo }; 1568bdcd8170SKalle Valo u8 i; 1569bdcd8170SKalle Valo 1570bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1571bdcd8170SKalle Valo if (rate == legacy[i]) 1572bdcd8170SKalle Valo return true; 1573bdcd8170SKalle Valo 1574bdcd8170SKalle Valo return false; 1575bdcd8170SKalle Valo } 1576bdcd8170SKalle Valo 1577bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1578bdcd8170SKalle Valo { 1579bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1580bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1581bdcd8170SKalle Valo }; 1582bdcd8170SKalle Valo u8 i; 1583bdcd8170SKalle Valo 1584bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1585bdcd8170SKalle Valo if (rate == ht20[i]) { 1586bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1587bdcd8170SKalle Valo /* last rate uses sgi */ 1588bdcd8170SKalle Valo *sgi = true; 1589bdcd8170SKalle Valo else 1590bdcd8170SKalle Valo *sgi = false; 1591bdcd8170SKalle Valo 1592bdcd8170SKalle Valo *mcs = i; 1593bdcd8170SKalle Valo return true; 1594bdcd8170SKalle Valo } 1595bdcd8170SKalle Valo } 1596bdcd8170SKalle Valo return false; 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo 1599bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1600bdcd8170SKalle Valo { 1601bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1602bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1603bdcd8170SKalle Valo 150000 1604bdcd8170SKalle Valo }; 1605bdcd8170SKalle Valo u8 i; 1606bdcd8170SKalle Valo 1607bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1608bdcd8170SKalle Valo if (rate == ht40[i]) { 1609bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1610bdcd8170SKalle Valo /* last rate uses sgi */ 1611bdcd8170SKalle Valo *sgi = true; 1612bdcd8170SKalle Valo else 1613bdcd8170SKalle Valo *sgi = false; 1614bdcd8170SKalle Valo 1615bdcd8170SKalle Valo *mcs = i; 1616bdcd8170SKalle Valo return true; 1617bdcd8170SKalle Valo } 1618bdcd8170SKalle Valo } 1619bdcd8170SKalle Valo 1620bdcd8170SKalle Valo return false; 1621bdcd8170SKalle Valo } 1622bdcd8170SKalle Valo 1623bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1624bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1625bdcd8170SKalle Valo { 1626bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1628bdcd8170SKalle Valo long left; 1629bdcd8170SKalle Valo bool sgi; 1630bdcd8170SKalle Valo s32 rate; 1631bdcd8170SKalle Valo int ret; 1632bdcd8170SKalle Valo u8 mcs; 1633bdcd8170SKalle Valo 16348c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1635bdcd8170SKalle Valo return -ENOENT; 1636bdcd8170SKalle Valo 1637bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1638bdcd8170SKalle Valo return -EBUSY; 1639bdcd8170SKalle Valo 1640b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1641bdcd8170SKalle Valo 1642334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1643bdcd8170SKalle Valo 1644bdcd8170SKalle Valo if (ret != 0) { 1645bdcd8170SKalle Valo up(&ar->sem); 1646bdcd8170SKalle Valo return -EIO; 1647bdcd8170SKalle Valo } 1648bdcd8170SKalle Valo 1649bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1650bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1651b95907a7SVasanthakumar Thiagarajan &vif->flags), 1652bdcd8170SKalle Valo WMI_TIMEOUT); 1653bdcd8170SKalle Valo 1654bdcd8170SKalle Valo up(&ar->sem); 1655bdcd8170SKalle Valo 1656bdcd8170SKalle Valo if (left == 0) 1657bdcd8170SKalle Valo return -ETIMEDOUT; 1658bdcd8170SKalle Valo else if (left < 0) 1659bdcd8170SKalle Valo return left; 1660bdcd8170SKalle Valo 1661b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1662b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1663bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1664b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1665bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1666bdcd8170SKalle Valo } 1667bdcd8170SKalle Valo 1668b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1669b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1670bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1671b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1672bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1673bdcd8170SKalle Valo } 1674bdcd8170SKalle Valo 1675b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1676bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1677bdcd8170SKalle Valo 1678b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1679bdcd8170SKalle Valo 1680bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1681bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1682bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1683bdcd8170SKalle Valo if (sgi) { 1684bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1685bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1686bdcd8170SKalle Valo } else { 1687bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1688bdcd8170SKalle Valo } 1689bdcd8170SKalle Valo 1690bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1691bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1692bdcd8170SKalle Valo if (sgi) { 1693bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1694bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1695bdcd8170SKalle Valo } else { 1696bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1697bdcd8170SKalle Valo } 1698bdcd8170SKalle Valo 1699bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1700bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1701bdcd8170SKalle Valo } else { 17029a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 17039a730834SKalle Valo "invalid rate from stats: %d\n", rate); 17049a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1705bdcd8170SKalle Valo return 0; 1706bdcd8170SKalle Valo } 1707bdcd8170SKalle Valo 1708bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1709bdcd8170SKalle Valo 171059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 171159c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1712f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 171332c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 171432c10874SJouni Malinen sinfo->bss_param.flags = 0; 1715cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1716cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 171732c10874SJouni Malinen } 171832c10874SJouni Malinen 1719bdcd8170SKalle Valo return 0; 1720bdcd8170SKalle Valo } 1721bdcd8170SKalle Valo 1722bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1723bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1724bdcd8170SKalle Valo { 1725bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1726334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1727334234b5SVasanthakumar Thiagarajan 1728334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1729bdcd8170SKalle Valo pmksa->pmkid, true); 1730bdcd8170SKalle Valo } 1731bdcd8170SKalle Valo 1732bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1733bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1734bdcd8170SKalle Valo { 1735bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1736334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1737334234b5SVasanthakumar Thiagarajan 1738334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1739bdcd8170SKalle Valo pmksa->pmkid, false); 1740bdcd8170SKalle Valo } 1741bdcd8170SKalle Valo 1742bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1743bdcd8170SKalle Valo { 1744bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 174559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 174659c98449SVasanthakumar Thiagarajan 174759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1748334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1749334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1750bdcd8170SKalle Valo return 0; 1751bdcd8170SKalle Valo } 1752bdcd8170SKalle Valo 1753d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1754d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17556cb3c714SRaja Mani { 1756d91e8eeeSRaja Mani int ret, pos; 1757d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17586cb3c714SRaja Mani u16 i; 17596cb3c714SRaja Mani 1760d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17616cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17626cb3c714SRaja Mani 17636cb3c714SRaja Mani /* 17646cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17656cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17666cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17676cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17686cb3c714SRaja Mani * then equivalent driver specific mask value is 17696cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17706cb3c714SRaja Mani */ 17716cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17726cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17736cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17746cb3c714SRaja Mani mask[pos] = 0xFF; 17756cb3c714SRaja Mani } 17766cb3c714SRaja Mani /* 17776cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17786cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17796cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17806cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17816cb3c714SRaja Mani */ 17826cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17836cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17846cb3c714SRaja Mani wow->patterns[i].pattern_len, 17856cb3c714SRaja Mani 0 /* pattern offset */, 17866cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17876cb3c714SRaja Mani if (ret) 17886cb3c714SRaja Mani return ret; 17896cb3c714SRaja Mani } 17906cb3c714SRaja Mani 1791d91e8eeeSRaja Mani if (wow->disconnect) 1792d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1793d91e8eeeSRaja Mani 1794d91e8eeeSRaja Mani if (wow->magic_pkt) 1795d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1796d91e8eeeSRaja Mani 1797d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1798d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1799d91e8eeeSRaja Mani 1800d91e8eeeSRaja Mani if (wow->eap_identity_req) 1801d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1802d91e8eeeSRaja Mani 1803d91e8eeeSRaja Mani if (wow->four_way_handshake) 1804d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1805d91e8eeeSRaja Mani 1806d91e8eeeSRaja Mani return 0; 1807d91e8eeeSRaja Mani } 1808d91e8eeeSRaja Mani 1809d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1810d91e8eeeSRaja Mani { 1811d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1812d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1813d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1814d91e8eeeSRaja Mani 0x00, 0x08 }; 1815d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1816d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1817d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1818d91e8eeeSRaja Mani 0x00, 0x7f }; 1819d91e8eeeSRaja Mani u8 unicst_offset = 0; 1820d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1821d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1822d91e8eeeSRaja Mani u8 arp_offset = 20; 1823d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1824d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1825d91e8eeeSRaja Mani u8 discvr_offset = 38; 1826d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1827d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1828d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1829d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1830d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1832d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1833d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1834d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1835d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1836d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1837d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1838d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1839d91e8eeeSRaja Mani int ret; 1840d91e8eeeSRaja Mani 1841d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1842d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1843d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1844d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1845d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1846d91e8eeeSRaja Mani if (ret) { 1847d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1848d91e8eeeSRaja Mani return ret; 1849d91e8eeeSRaja Mani } 1850d91e8eeeSRaja Mani 1851d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1852d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1853d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1854d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1855d91e8eeeSRaja Mani arp_pattern, arp_mask); 1856d91e8eeeSRaja Mani if (ret) { 1857d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1858d91e8eeeSRaja Mani return ret; 1859d91e8eeeSRaja Mani } 1860d91e8eeeSRaja Mani 1861d91e8eeeSRaja Mani /* 1862d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1863d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1864d91e8eeeSRaja Mani */ 1865d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1866d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1867d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1868d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1869d91e8eeeSRaja Mani if (ret) { 1870d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1871d91e8eeeSRaja Mani return ret; 1872d91e8eeeSRaja Mani } 1873d91e8eeeSRaja Mani 1874d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1875d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1876d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1877d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1878d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1879d91e8eeeSRaja Mani if (ret) { 1880d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1881d91e8eeeSRaja Mani return ret; 1882d91e8eeeSRaja Mani } 1883d91e8eeeSRaja Mani 1884d91e8eeeSRaja Mani return 0; 1885d91e8eeeSRaja Mani } 1886d91e8eeeSRaja Mani 1887d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1888d91e8eeeSRaja Mani { 1889d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1890d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1891d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1892d91e8eeeSRaja Mani u8 discvr_offset = 38; 1893d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1894d91e8eeeSRaja Mani int ret; 1895d91e8eeeSRaja Mani 1896d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1897d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1898d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1899d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1900d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1901d91e8eeeSRaja Mani mac_mask); 1902d91e8eeeSRaja Mani if (ret) { 1903d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1904d91e8eeeSRaja Mani return ret; 1905d91e8eeeSRaja Mani } 1906d91e8eeeSRaja Mani 1907d91e8eeeSRaja Mani /* 1908d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1909d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1910d91e8eeeSRaja Mani */ 1911d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1912d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1913d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1914d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1915d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1916d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1917d91e8eeeSRaja Mani if (ret) { 1918d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1919d91e8eeeSRaja Mani "pattern\n"); 1920d91e8eeeSRaja Mani return ret; 1921d91e8eeeSRaja Mani } 1922d91e8eeeSRaja Mani } 1923d91e8eeeSRaja Mani 1924d91e8eeeSRaja Mani return 0; 1925d91e8eeeSRaja Mani } 1926d91e8eeeSRaja Mani 1927d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1928d91e8eeeSRaja Mani { 1929d91e8eeeSRaja Mani struct in_device *in_dev; 1930d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1931d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1932d91e8eeeSRaja Mani int ret, left; 1933d91e8eeeSRaja Mani u32 filter = 0; 1934ce0dc0cfSRaja Mani u16 i, bmiss_time; 1935d91e8eeeSRaja Mani u8 index = 0; 1936d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1937d91e8eeeSRaja Mani 1938d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1939d91e8eeeSRaja Mani if (!vif) 1940d91e8eeeSRaja Mani return -EIO; 1941d91e8eeeSRaja Mani 1942d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1943d91e8eeeSRaja Mani return -EIO; 1944d91e8eeeSRaja Mani 1945d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19463c411a43SRaja Mani return -ENOTCONN; 1947d91e8eeeSRaja Mani 1948d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 1949d91e8eeeSRaja Mani return -EINVAL; 1950d91e8eeeSRaja Mani 1951d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 1952d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 1953d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 1954d91e8eeeSRaja Mani WOW_LIST_ID, i); 1955d91e8eeeSRaja Mani 1956d91e8eeeSRaja Mani /* 1957d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 1958d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 1959d91e8eeeSRaja Mani * the user. 1960d91e8eeeSRaja Mani */ 1961d91e8eeeSRaja Mani if (wow) 1962d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 1963d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 1964d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 1965d91e8eeeSRaja Mani else 1966d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 1967d91e8eeeSRaja Mani 1968d91e8eeeSRaja Mani if (ret) 1969d91e8eeeSRaja Mani return ret; 1970d91e8eeeSRaja Mani 1971390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 1972390a8c8fSRaja Mani 1973ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 1974ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 1975ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 1976ce0dc0cfSRaja Mani 0); 1977ce0dc0cfSRaja Mani if (ret) 1978ce0dc0cfSRaja Mani return ret; 1979ce0dc0cfSRaja Mani 1980ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 1981ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 1982ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 1983ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 1984ce0dc0cfSRaja Mani 1985ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 1986ce0dc0cfSRaja Mani bmiss_time, 0); 1987ce0dc0cfSRaja Mani if (ret) 1988ce0dc0cfSRaja Mani return ret; 1989ce0dc0cfSRaja Mani 1990ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 1991ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 1992ce0dc0cfSRaja Mani 0, 0, 0, 0); 1993ce0dc0cfSRaja Mani if (ret) 1994ce0dc0cfSRaja Mani return ret; 1995ce0dc0cfSRaja Mani } 1996ce0dc0cfSRaja Mani 1997390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 1998390a8c8fSRaja Mani 1999c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 2000c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 2001c08631c6SRaja Mani if (!in_dev) 2002c08631c6SRaja Mani goto skip_arp; 2003c08631c6SRaja Mani 2004c08631c6SRaja Mani ifa = in_dev->ifa_list; 2005c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2006c08631c6SRaja Mani 2007c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2008c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2009c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2010c08631c6SRaja Mani ifa = ifa->ifa_next; 2011c08631c6SRaja Mani index++; 2012c08631c6SRaja Mani } 2013c08631c6SRaja Mani 2014c08631c6SRaja Mani if (ifa) { 2015c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2016c08631c6SRaja Mani return -EINVAL; 2017c08631c6SRaja Mani } 2018c08631c6SRaja Mani 2019c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2020c08631c6SRaja Mani if (ret) { 2021c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2022c08631c6SRaja Mani return ret; 2023c08631c6SRaja Mani } 2024c08631c6SRaja Mani 2025c08631c6SRaja Mani skip_arp: 20266cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20276cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20286cb3c714SRaja Mani filter, 20296cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20306cb3c714SRaja Mani if (ret) 20316cb3c714SRaja Mani return ret; 20326cb3c714SRaja Mani 2033081c7a84SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2034081c7a84SRaja Mani 20356cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20366cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 20376cb3c714SRaja Mani if (ret) 20386cb3c714SRaja Mani return ret; 20396cb3c714SRaja Mani 2040081c7a84SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2041081c7a84SRaja Mani test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags), 2042081c7a84SRaja Mani WMI_TIMEOUT); 2043081c7a84SRaja Mani if (left == 0) { 2044081c7a84SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd " 2045081c7a84SRaja Mani "processed event\n"); 2046081c7a84SRaja Mani ret = -ETIMEDOUT; 2047081c7a84SRaja Mani } else if (left < 0) { 2048081c7a84SRaja Mani ath6kl_warn("error while waiting for host sleep cmd " 2049081c7a84SRaja Mani "processed event %d\n", left); 2050081c7a84SRaja Mani ret = left; 2051081c7a84SRaja Mani } 2052081c7a84SRaja Mani 20536cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 20546cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 20556cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 20566cb3c714SRaja Mani if (left == 0) { 20576cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 20586cb3c714SRaja Mani ret = -ETIMEDOUT; 20596cb3c714SRaja Mani } else if (left < 0) { 20606cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 20616cb3c714SRaja Mani ret = left; 20626cb3c714SRaja Mani } 20636cb3c714SRaja Mani } 20646cb3c714SRaja Mani 20656cb3c714SRaja Mani return ret; 20666cb3c714SRaja Mani } 20676cb3c714SRaja Mani 20686cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20696cb3c714SRaja Mani { 20706cb3c714SRaja Mani struct ath6kl_vif *vif; 20716cb3c714SRaja Mani int ret; 20726cb3c714SRaja Mani 20736cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20746cb3c714SRaja Mani if (!vif) 20756cb3c714SRaja Mani return -EIO; 20766cb3c714SRaja Mani 2077390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2078390a8c8fSRaja Mani 20796cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20806cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2081390a8c8fSRaja Mani if (ret) { 2082390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2083390a8c8fSRaja Mani "wow resume: %d\n", ret); 2084390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 20856cb3c714SRaja Mani return ret; 20866cb3c714SRaja Mani } 20876cb3c714SRaja Mani 2088ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2089ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2090ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2091ce0dc0cfSRaja Mani if (ret) 2092ce0dc0cfSRaja Mani return ret; 2093ce0dc0cfSRaja Mani 2094ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2095ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2096ce0dc0cfSRaja Mani if (ret) 2097ce0dc0cfSRaja Mani return ret; 2098ce0dc0cfSRaja Mani 2099ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2100ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2101ce0dc0cfSRaja Mani if (ret) 2102ce0dc0cfSRaja Mani return ret; 2103ce0dc0cfSRaja Mani } 2104ce0dc0cfSRaja Mani 2105390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2106390a8c8fSRaja Mani 2107390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2108390a8c8fSRaja Mani 2109390a8c8fSRaja Mani return 0; 2110390a8c8fSRaja Mani } 2111390a8c8fSRaja Mani 211252d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 21130f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 21140f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 211552d81a68SKalle Valo { 2116390a8c8fSRaja Mani enum ath6kl_state prev_state; 211752d81a68SKalle Valo int ret; 211852d81a68SKalle Valo 211952d81a68SKalle Valo switch (mode) { 2120d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2121d7c44e0bSRaja Mani 2122d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2123d7c44e0bSRaja Mani 2124d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2125d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2126d7c44e0bSRaja Mani 2127390a8c8fSRaja Mani prev_state = ar->state; 2128390a8c8fSRaja Mani 2129d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2130390a8c8fSRaja Mani if (ret) { 2131390a8c8fSRaja Mani ar->state = prev_state; 2132d7c44e0bSRaja Mani return ret; 2133390a8c8fSRaja Mani } 21341e9a905dSRaja Mani 2135d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2136d7c44e0bSRaja Mani break; 2137d7c44e0bSRaja Mani 213852d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2139524441e3SRaja Mani 21407125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2141524441e3SRaja Mani 214252d81a68SKalle Valo /* save the current power mode before enabling power save */ 214352d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 214452d81a68SKalle Valo 214552d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 214652d81a68SKalle Valo if (ret) { 214752d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 214852d81a68SKalle Valo ret); 214952d81a68SKalle Valo } 215052d81a68SKalle Valo 215176a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 215276a9fbe2SKalle Valo 215352d81a68SKalle Valo break; 2154b4b2a0b1SKalle Valo 2155b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2156524441e3SRaja Mani 21577125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2158524441e3SRaja Mani 2159b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2160b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2161b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2162b4b2a0b1SKalle Valo break; 2163b4b2a0b1SKalle Valo } 2164b4b2a0b1SKalle Valo 2165b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2166b4b2a0b1SKalle Valo 2167b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2168b4b2a0b1SKalle Valo if (ret) { 2169b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2170b4b2a0b1SKalle Valo ret); 2171b4b2a0b1SKalle Valo } 2172b4b2a0b1SKalle Valo 2173b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2174b4b2a0b1SKalle Valo 2175b4b2a0b1SKalle Valo break; 2176b4b2a0b1SKalle Valo 217710509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 217810509f90SKalle Valo /* 217910509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 218010509f90SKalle Valo * wow mode and sleeping most of the time. 218110509f90SKalle Valo */ 218210509f90SKalle Valo break; 218310509f90SKalle Valo 2184b4b2a0b1SKalle Valo default: 2185b4b2a0b1SKalle Valo break; 218652d81a68SKalle Valo } 218752d81a68SKalle Valo 218852d81a68SKalle Valo return 0; 218952d81a68SKalle Valo } 2190d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 219152d81a68SKalle Valo 219252d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 219352d81a68SKalle Valo { 219476a9fbe2SKalle Valo int ret; 219576a9fbe2SKalle Valo 219676a9fbe2SKalle Valo switch (ar->state) { 2197d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2198d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2199d7c44e0bSRaja Mani 2200d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2201d7c44e0bSRaja Mani if (ret) { 2202d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2203d7c44e0bSRaja Mani return ret; 2204d7c44e0bSRaja Mani } 2205d7c44e0bSRaja Mani 2206d7c44e0bSRaja Mani break; 2207d7c44e0bSRaja Mani 220876a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 220952d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 221076a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 221176a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 221276a9fbe2SKalle Valo if (ret) { 221376a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 221476a9fbe2SKalle Valo ret); 221576a9fbe2SKalle Valo } 221676a9fbe2SKalle Valo } 221776a9fbe2SKalle Valo 221876a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 221976a9fbe2SKalle Valo 222076a9fbe2SKalle Valo break; 222176a9fbe2SKalle Valo 2222b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2223b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2224b4b2a0b1SKalle Valo 2225b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2226b4b2a0b1SKalle Valo if (ret) { 2227b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2228b4b2a0b1SKalle Valo return ret; 2229b4b2a0b1SKalle Valo } 2230d7c44e0bSRaja Mani break; 2231b4b2a0b1SKalle Valo 223210509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 223310509f90SKalle Valo break; 223410509f90SKalle Valo 223576a9fbe2SKalle Valo default: 223676a9fbe2SKalle Valo break; 223752d81a68SKalle Valo } 223852d81a68SKalle Valo 223952d81a68SKalle Valo return 0; 224052d81a68SKalle Valo } 2241d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 224252d81a68SKalle Valo 2243abcb344bSKalle Valo #ifdef CONFIG_PM 224452d81a68SKalle Valo 224552d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 224652d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2247abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2248abcb344bSKalle Valo { 2249abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2250abcb344bSKalle Valo 22510f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2252abcb344bSKalle Valo } 2253aa6cffc1SChilam Ng 225452d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2255aa6cffc1SChilam Ng { 2256aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2257aa6cffc1SChilam Ng 2258aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2259aa6cffc1SChilam Ng } 2260a918fb3cSRaja Mani 2261a918fb3cSRaja Mani /* 2262a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2263a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2264a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2265a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2266a918fb3cSRaja Mani * 2267a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2268a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2269a918fb3cSRaja Mani * 2270a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2271a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2272a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2273a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2274a918fb3cSRaja Mani * 2275a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2276a918fb3cSRaja Mani */ 2277a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2278a918fb3cSRaja Mani { 2279390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2280390a8c8fSRaja Mani return; 2281390a8c8fSRaja Mani 2282a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2283a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2284a918fb3cSRaja Mani } 2285a918fb3cSRaja Mani 2286a918fb3cSRaja Mani #else 2287a918fb3cSRaja Mani 2288a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2289a918fb3cSRaja Mani { 2290a918fb3cSRaja Mani } 2291abcb344bSKalle Valo #endif 2292abcb344bSKalle Valo 22936a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 22946a7c9badSJouni Malinen struct ieee80211_channel *chan, 22956a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 22966a7c9badSJouni Malinen { 2297e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2298e68f6750SSujith Manoharan 2299e68f6750SSujith Manoharan /* 2300e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2301e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2302e68f6750SSujith Manoharan * 2303e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2304e68f6750SSujith Manoharan */ 2305e68f6750SSujith Manoharan if (!dev) 2306e68f6750SSujith Manoharan return -EBUSY; 2307e68f6750SSujith Manoharan 2308e68f6750SSujith Manoharan vif = netdev_priv(dev); 23096a7c9badSJouni Malinen 2310990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23116a7c9badSJouni Malinen return -EIO; 23126a7c9badSJouni Malinen 23136a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 23146a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2315cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 23166a7c9badSJouni Malinen 23176a7c9badSJouni Malinen return 0; 23186a7c9badSJouni Malinen } 23196a7c9badSJouni Malinen 23208bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 23218bdfbf40SJouni Malinen { 23228bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 23238bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 23248bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 23258bdfbf40SJouni Malinen } 23268bdfbf40SJouni Malinen 2327334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2328334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 23298bdfbf40SJouni Malinen { 2330334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23318bdfbf40SJouni Malinen const u8 *pos; 23328bdfbf40SJouni Malinen u8 *buf = NULL; 23338bdfbf40SJouni Malinen size_t len = 0; 23348bdfbf40SJouni Malinen int ret; 23358bdfbf40SJouni Malinen 23368bdfbf40SJouni Malinen /* 23378bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 23388bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 23398bdfbf40SJouni Malinen */ 23408bdfbf40SJouni Malinen 23418bdfbf40SJouni Malinen if (ies && ies_len) { 23428bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 23438bdfbf40SJouni Malinen if (buf == NULL) 23448bdfbf40SJouni Malinen return -ENOMEM; 23458bdfbf40SJouni Malinen pos = ies; 23468bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 23478bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 23488bdfbf40SJouni Malinen break; 23498bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 23508bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 23518bdfbf40SJouni Malinen len += 2 + pos[1]; 23528bdfbf40SJouni Malinen } 23538bdfbf40SJouni Malinen pos += 2 + pos[1]; 23548bdfbf40SJouni Malinen } 23558bdfbf40SJouni Malinen } 23568bdfbf40SJouni Malinen 2357334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2358334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 23598bdfbf40SJouni Malinen kfree(buf); 23608bdfbf40SJouni Malinen return ret; 23618bdfbf40SJouni Malinen } 23628bdfbf40SJouni Malinen 23638860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 23648860020eSJohannes Berg struct cfg80211_beacon_data *info) 23658860020eSJohannes Berg { 23668860020eSJohannes Berg struct ath6kl *ar = vif->ar; 23678860020eSJohannes Berg int res; 23688860020eSJohannes Berg 236917a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23708860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23718860020eSJohannes Berg WMI_FRAME_BEACON, 23728860020eSJohannes Berg info->beacon_ies, 23738860020eSJohannes Berg info->beacon_ies_len); 23748860020eSJohannes Berg if (res) 23758860020eSJohannes Berg return res; 23768860020eSJohannes Berg 237717a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23788860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 23798860020eSJohannes Berg info->proberesp_ies_len); 23808860020eSJohannes Berg if (res) 23818860020eSJohannes Berg return res; 23828860020eSJohannes Berg 238317a7b16dSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 23848860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23858860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 23868860020eSJohannes Berg info->assocresp_ies, 23878860020eSJohannes Berg info->assocresp_ies_len); 23888860020eSJohannes Berg if (res) 23898860020eSJohannes Berg return res; 23908860020eSJohannes Berg 23918860020eSJohannes Berg return 0; 23928860020eSJohannes Berg } 23938860020eSJohannes Berg 23948860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 23958860020eSJohannes Berg struct cfg80211_ap_settings *info) 23966a7c9badSJouni Malinen { 23976a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 23983450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23996a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 240067cd22e4SThomas Pedersen bool hidden = false; 24016a7c9badSJouni Malinen u8 *ies; 24026a7c9badSJouni Malinen int ies_len; 24036a7c9badSJouni Malinen struct wmi_connect_cmd p; 24046a7c9badSJouni Malinen int res; 2405be5abaafSVasanthakumar Thiagarajan int i, ret; 24066a7c9badSJouni Malinen 24078860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 24086a7c9badSJouni Malinen 2409990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24106a7c9badSJouni Malinen return -EIO; 24116a7c9badSJouni Malinen 2412f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 24136a7c9badSJouni Malinen return -EOPNOTSUPP; 24146a7c9badSJouni Malinen 24158860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 24166a7c9badSJouni Malinen 24179a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 24189a5b1318SJouni Malinen 24196a7c9badSJouni Malinen /* TODO: 24206a7c9badSJouni Malinen * info->interval 24216a7c9badSJouni Malinen * info->dtim_period 24226a7c9badSJouni Malinen */ 24236a7c9badSJouni Malinen 24248860020eSJohannes Berg if (info->beacon.head == NULL) 24256a7c9badSJouni Malinen return -EINVAL; 24268860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 24276a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 24288860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 24296a7c9badSJouni Malinen return -EINVAL; 24308860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 24316a7c9badSJouni Malinen 24326a7c9badSJouni Malinen if (info->ssid == NULL) 24336a7c9badSJouni Malinen return -EINVAL; 24343450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 24353450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 24366a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 243767cd22e4SThomas Pedersen hidden = true; 243867cd22e4SThomas Pedersen 243967cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 244067cd22e4SThomas Pedersen if (res) 244167cd22e4SThomas Pedersen return res; 24426a7c9badSJouni Malinen 2443be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2444be5abaafSVasanthakumar Thiagarajan if (ret) 2445be5abaafSVasanthakumar Thiagarajan return ret; 24466a7c9badSJouni Malinen 24476a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 24486a7c9badSJouni Malinen 24496a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 24506a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 24516a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 24526a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24536a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 24546a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24556a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 24566a7c9badSJouni Malinen break; 24576a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 24586a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24596a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 24606a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24616a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 24626a7c9badSJouni Malinen break; 24636a7c9badSJouni Malinen } 24646a7c9badSJouni Malinen } 24656a7c9badSJouni Malinen if (p.auth_mode == 0) 24666a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 24673450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 24686a7c9badSJouni Malinen 24696a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 24706a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 24716a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24726a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24736a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 24746a7c9badSJouni Malinen break; 24756a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24766a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 24776a7c9badSJouni Malinen break; 24786a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24796a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 24806a7c9badSJouni Malinen break; 2481b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2482b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2483b8214df1SDai Shuibing break; 24846a7c9badSJouni Malinen } 24856a7c9badSJouni Malinen } 2486229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 24876a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2488240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2489229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2490240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 24916a7c9badSJouni Malinen 24926a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 24936a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24946a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24956a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 24966a7c9badSJouni Malinen break; 24976a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24986a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 24996a7c9badSJouni Malinen break; 25006a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 25016a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 25026a7c9badSJouni Malinen break; 2503b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2504b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2505b8214df1SDai Shuibing break; 25066a7c9badSJouni Malinen default: 25076a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 25086a7c9badSJouni Malinen break; 25096a7c9badSJouni Malinen } 2510240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 25116a7c9badSJouni Malinen 25126a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2513f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 25146a7c9badSJouni Malinen 25153450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 25163450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 25173450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2518cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 25196a7c9badSJouni Malinen 2520c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2521c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2522c1762a3fSThirumalai Pachamuthu if (res < 0) 2523c1762a3fSThirumalai Pachamuthu return res; 2524c1762a3fSThirumalai Pachamuthu 25253ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 25263ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 25273ca9d1fcSAarthi Thiruvengadam } else { 25283ca9d1fcSAarthi Thiruvengadam /* 25293ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 25303ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 25313ca9d1fcSAarthi Thiruvengadam */ 25323ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 25333ca9d1fcSAarthi Thiruvengadam } 25343ca9d1fcSAarthi Thiruvengadam 2535334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 25369a5b1318SJouni Malinen if (res < 0) 25379a5b1318SJouni Malinen return res; 25389a5b1318SJouni Malinen 25399a5b1318SJouni Malinen return 0; 25406a7c9badSJouni Malinen } 25416a7c9badSJouni Malinen 25428860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 25438860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 25446a7c9badSJouni Malinen { 25458860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 25468860020eSJohannes Berg 25478860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 25488860020eSJohannes Berg return -EIO; 25498860020eSJohannes Berg 25508860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 25518860020eSJohannes Berg return -EOPNOTSUPP; 25528860020eSJohannes Berg 25538860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 25546a7c9badSJouni Malinen } 25556a7c9badSJouni Malinen 25568860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 25576a7c9badSJouni Malinen { 25586a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 255959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25606a7c9badSJouni Malinen 2561f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 25626a7c9badSJouni Malinen return -EOPNOTSUPP; 256359c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 25646a7c9badSJouni Malinen return -ENOTCONN; 25656a7c9badSJouni Malinen 2566334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 256759c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 25686a7c9badSJouni Malinen 25696a7c9badSJouni Malinen return 0; 25706a7c9badSJouni Malinen } 25716a7c9badSJouni Malinen 257233e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 257333e5308dSJouni Malinen 257433e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 257533e5308dSJouni Malinen u8 *mac) 257633e5308dSJouni Malinen { 257733e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 257833e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 257933e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 258033e5308dSJouni Malinen 258133e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 258233e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 258333e5308dSJouni Malinen } 258433e5308dSJouni Malinen 258523875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 258623875136SJouni Malinen u8 *mac, struct station_parameters *params) 258723875136SJouni Malinen { 258823875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2589f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 259023875136SJouni Malinen 2591f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 259223875136SJouni Malinen return -EOPNOTSUPP; 259323875136SJouni Malinen 259423875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 259523875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 259623875136SJouni Malinen return -EOPNOTSUPP; 259723875136SJouni Malinen 259823875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2599334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2600334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2601334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2602334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 260323875136SJouni Malinen } 260423875136SJouni Malinen 260563fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 260663fa1e0cSJouni Malinen struct net_device *dev, 260763fa1e0cSJouni Malinen struct ieee80211_channel *chan, 260863fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 260963fa1e0cSJouni Malinen unsigned int duration, 261063fa1e0cSJouni Malinen u64 *cookie) 261163fa1e0cSJouni Malinen { 261263fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2613334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26141052261eSJouni Malinen u32 id; 261563fa1e0cSJouni Malinen 261663fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 261763fa1e0cSJouni Malinen * return -EBUSY */ 26181052261eSJouni Malinen id = ++vif->last_roc_id; 26191052261eSJouni Malinen if (id == 0) { 26201052261eSJouni Malinen /* Do not use 0 as the cookie value */ 26211052261eSJouni Malinen id = ++vif->last_roc_id; 26221052261eSJouni Malinen } 26231052261eSJouni Malinen *cookie = id; 262463fa1e0cSJouni Malinen 2625334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2626334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 262763fa1e0cSJouni Malinen } 262863fa1e0cSJouni Malinen 262963fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 263063fa1e0cSJouni Malinen struct net_device *dev, 263163fa1e0cSJouni Malinen u64 cookie) 263263fa1e0cSJouni Malinen { 263363fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2634334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 263563fa1e0cSJouni Malinen 26361052261eSJouni Malinen if (cookie != vif->last_roc_id) 263763fa1e0cSJouni Malinen return -ENOENT; 26381052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 263963fa1e0cSJouni Malinen 2640334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 264163fa1e0cSJouni Malinen } 264263fa1e0cSJouni Malinen 2643334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2644334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2645334234b5SVasanthakumar Thiagarajan unsigned int freq) 26468bdfbf40SJouni Malinen { 2647334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26488bdfbf40SJouni Malinen const u8 *pos; 26498bdfbf40SJouni Malinen u8 *p2p; 26508bdfbf40SJouni Malinen int p2p_len; 26518bdfbf40SJouni Malinen int ret; 26528bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 26538bdfbf40SJouni Malinen 26548bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 26558bdfbf40SJouni Malinen 26568bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 26578bdfbf40SJouni Malinen 26588bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 26598bdfbf40SJouni Malinen if (p2p == NULL) 26608bdfbf40SJouni Malinen return -ENOMEM; 26618bdfbf40SJouni Malinen p2p_len = 0; 26628bdfbf40SJouni Malinen 26638bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 26648bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 26658bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 26668bdfbf40SJouni Malinen break; 26678bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 26688bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 26698bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 26708bdfbf40SJouni Malinen } 26718bdfbf40SJouni Malinen pos += 2 + pos[1]; 26728bdfbf40SJouni Malinen } 26738bdfbf40SJouni Malinen 2674334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2675334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 26768bdfbf40SJouni Malinen kfree(p2p); 26778bdfbf40SJouni Malinen return ret; 26788bdfbf40SJouni Malinen } 26798bdfbf40SJouni Malinen 2680d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2681d0ff7383SNaveen Gangadharan u32 id, 2682d0ff7383SNaveen Gangadharan u32 freq, 2683d0ff7383SNaveen Gangadharan u32 wait, 2684d0ff7383SNaveen Gangadharan const u8 *buf, 2685d0ff7383SNaveen Gangadharan size_t len, 2686d0ff7383SNaveen Gangadharan bool *more_data, 2687d0ff7383SNaveen Gangadharan bool no_cck) 2688d0ff7383SNaveen Gangadharan { 2689d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2690d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2691d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2692d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2693d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2694d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2695d0ff7383SNaveen Gangadharan 2696d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2697d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2698d0ff7383SNaveen Gangadharan return false; 2699d0ff7383SNaveen Gangadharan 2700d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2701d0ff7383SNaveen Gangadharan if (!conn) 2702d0ff7383SNaveen Gangadharan return false; 2703d0ff7383SNaveen Gangadharan 2704d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2705d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2706d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2707d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2708d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2709d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2710d0ff7383SNaveen Gangadharan return false; 2711d0ff7383SNaveen Gangadharan 2712d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2713d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2714d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2715d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2716d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2717d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2718d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2719d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2720d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2721d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2722d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2723d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2724d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2725d0ff7383SNaveen Gangadharan 2726d0ff7383SNaveen Gangadharan /* 2727d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2728d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2729d0ff7383SNaveen Gangadharan * STA. 2730d0ff7383SNaveen Gangadharan */ 2731d0ff7383SNaveen Gangadharan if (is_psq_empty) 2732d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2733d0ff7383SNaveen Gangadharan conn->aid, 1); 2734d0ff7383SNaveen Gangadharan return true; 2735d0ff7383SNaveen Gangadharan } 2736d0ff7383SNaveen Gangadharan 2737d0ff7383SNaveen Gangadharan /* 2738d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2739d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2740d0ff7383SNaveen Gangadharan */ 2741d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2742d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2743d0ff7383SNaveen Gangadharan *more_data = true; 2744d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2745d0ff7383SNaveen Gangadharan } 2746d0ff7383SNaveen Gangadharan 2747d0ff7383SNaveen Gangadharan return false; 2748d0ff7383SNaveen Gangadharan } 2749d0ff7383SNaveen Gangadharan 27508a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 27518a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 27528a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 27538a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2754e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2755e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 27568a6c8060SJouni Malinen { 27578a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 275859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27598a6c8060SJouni Malinen u32 id; 27608bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2761d0ff7383SNaveen Gangadharan bool more_data, queued; 27628bdfbf40SJouni Malinen 27638bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27648bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2765f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 27668bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 27678bdfbf40SJouni Malinen /* 27688bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 27698bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 27708bdfbf40SJouni Malinen */ 27718bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2772334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 27738bdfbf40SJouni Malinen chan->center_freq); 27748bdfbf40SJouni Malinen } 27758a6c8060SJouni Malinen 2776cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27778a6c8060SJouni Malinen if (id == 0) { 27788a6c8060SJouni Malinen /* 27798a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 27808a6c8060SJouni Malinen * used for the command. 27818a6c8060SJouni Malinen */ 2782cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27838a6c8060SJouni Malinen } 27848a6c8060SJouni Malinen 27858a6c8060SJouni Malinen *cookie = id; 27863ca9d1fcSAarthi Thiruvengadam 2787d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2788d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2789d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2790d0ff7383SNaveen Gangadharan id, chan->center_freq, 2791d0ff7383SNaveen Gangadharan wait, buf, 2792d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2793d0ff7383SNaveen Gangadharan if (queued) 2794d0ff7383SNaveen Gangadharan return 0; 2795d0ff7383SNaveen Gangadharan } 2796d0ff7383SNaveen Gangadharan 27973ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 27983ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 27993ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 28003ca9d1fcSAarthi Thiruvengadam } 28018a6c8060SJouni Malinen 2802ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2803ae32c30aSJouni Malinen struct net_device *dev, 2804ae32c30aSJouni Malinen u16 frame_type, bool reg) 2805ae32c30aSJouni Malinen { 2806cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2807ae32c30aSJouni Malinen 2808ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2809ae32c30aSJouni Malinen __func__, frame_type, reg); 2810ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2811ae32c30aSJouni Malinen /* 2812ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2813ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2814ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2815ae32c30aSJouni Malinen */ 2816cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2817ae32c30aSJouni Malinen } 2818ae32c30aSJouni Malinen } 2819ae32c30aSJouni Malinen 282010509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 282110509f90SKalle Valo struct net_device *dev, 282210509f90SKalle Valo struct cfg80211_sched_scan_request *request) 282310509f90SKalle Valo { 282410509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 282510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 282610509f90SKalle Valo u16 interval; 282710509f90SKalle Valo int ret; 282810509f90SKalle Valo u8 i; 282910509f90SKalle Valo 283010509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 283110509f90SKalle Valo return -EIO; 283210509f90SKalle Valo 283310509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 283410509f90SKalle Valo return -EBUSY; 283510509f90SKalle Valo 283610509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 283710509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 283810509f90SKalle Valo i, DISABLE_SSID_FLAG, 283910509f90SKalle Valo 0, NULL); 284010509f90SKalle Valo } 284110509f90SKalle Valo 284210509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 284310509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 284410509f90SKalle Valo 284510509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 284610509f90SKalle Valo interval, interval, 284710509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 284810509f90SKalle Valo 284910509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 285010509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 285110509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 285210509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 285310509f90SKalle Valo request->ssids[i].ssid_len, 285410509f90SKalle Valo request->ssids[i].ssid); 285510509f90SKalle Valo } 285610509f90SKalle Valo } 285710509f90SKalle Valo 285810509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 285910509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 286010509f90SKalle Valo WOW_FILTER_SSID, 286110509f90SKalle Valo WOW_HOST_REQ_DELAY); 286210509f90SKalle Valo if (ret) { 286310509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 286410509f90SKalle Valo return ret; 286510509f90SKalle Valo } 286610509f90SKalle Valo 286710509f90SKalle Valo /* this also clears IE in fw if it's not set */ 286810509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 286910509f90SKalle Valo WMI_FRAME_PROBE_REQ, 287010509f90SKalle Valo request->ie, request->ie_len); 287110509f90SKalle Valo if (ret) { 287210509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 287310509f90SKalle Valo ret); 287410509f90SKalle Valo return ret; 287510509f90SKalle Valo } 287610509f90SKalle Valo 287710509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 287810509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 287910509f90SKalle Valo if (ret) { 288010509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 288110509f90SKalle Valo ret); 288210509f90SKalle Valo return ret; 288310509f90SKalle Valo } 288410509f90SKalle Valo 288510509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 288610509f90SKalle Valo 288710509f90SKalle Valo return ret; 288810509f90SKalle Valo } 288910509f90SKalle Valo 289010509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 289110509f90SKalle Valo struct net_device *dev) 289210509f90SKalle Valo { 289310509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 289410509f90SKalle Valo bool stopped; 289510509f90SKalle Valo 289610509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 289710509f90SKalle Valo 289810509f90SKalle Valo if (!stopped) 289910509f90SKalle Valo return -EIO; 290010509f90SKalle Valo 290110509f90SKalle Valo return 0; 290210509f90SKalle Valo } 290310509f90SKalle Valo 2904f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2905f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2906f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2907f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2908f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2909f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2910f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2911f80574aeSJouni Malinen }, 2912ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2913ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2914ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2915ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2916ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2917ba1f6fe3SJouni Malinen }, 2918f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2919f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2920f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2921f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2922f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2923f80574aeSJouni Malinen }, 2924f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2925f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2926f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2927f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2928f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2929f80574aeSJouni Malinen }, 2930f80574aeSJouni Malinen }; 2931f80574aeSJouni Malinen 2932bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 293355055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 293455055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2935bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2936bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2937bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2938bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2939bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2940bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2941bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2942bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2943bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2944bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2945bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2946bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2947bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2948bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2949bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2950bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2951bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2952bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2953003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2954abcb344bSKalle Valo #ifdef CONFIG_PM 295552d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 295652d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2957abcb344bSKalle Valo #endif 29586a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 29598860020eSJohannes Berg .start_ap = ath6kl_start_ap, 29608860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 29618860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 296233e5308dSJouni Malinen .del_station = ath6kl_del_station, 296323875136SJouni Malinen .change_station = ath6kl_change_station, 296463fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 296563fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 29668a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2967ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 296810509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 296910509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2970bdcd8170SKalle Valo }; 2971bdcd8170SKalle Valo 29727125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2973ec4b7f60SKalle Valo { 297410509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 297510509f90SKalle Valo 2976ec4b7f60SKalle Valo switch (vif->sme_state) { 2977c97a31b0SKalle Valo case SME_DISCONNECTED: 2978c97a31b0SKalle Valo break; 2979ec4b7f60SKalle Valo case SME_CONNECTING: 2980ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2981ec4b7f60SKalle Valo NULL, 0, 2982ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2983ec4b7f60SKalle Valo GFP_KERNEL); 2984ec4b7f60SKalle Valo break; 2985ec4b7f60SKalle Valo case SME_CONNECTED: 2986ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2987ec4b7f60SKalle Valo break; 2988ec4b7f60SKalle Valo } 2989ec4b7f60SKalle Valo 2990ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2991ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 29927125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2993ec4b7f60SKalle Valo 2994ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 29951f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 29961f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2997ec4b7f60SKalle Valo 2998ec4b7f60SKalle Valo /* disable scanning */ 29997125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 30007125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 30017125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3002ec4b7f60SKalle Valo 3003ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3004ec4b7f60SKalle Valo } 3005ec4b7f60SKalle Valo 30067125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 30077125f01dSKalle Valo { 30087125f01dSKalle Valo struct ath6kl_vif *vif; 30097125f01dSKalle Valo 30107125f01dSKalle Valo vif = ath6kl_vif_first(ar); 30117125f01dSKalle Valo if (!vif) { 30127125f01dSKalle Valo /* save the current power mode before enabling power save */ 30137125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 30147125f01dSKalle Valo 30157125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 30167125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 30177125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 30187125f01dSKalle Valo return; 30197125f01dSKalle Valo } 30207125f01dSKalle Valo 30217125f01dSKalle Valo /* 30227125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 30237125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 30247125f01dSKalle Valo * sleeps. 30257125f01dSKalle Valo */ 30267125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 30277125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 30287125f01dSKalle Valo } 30297125f01dSKalle Valo 3030c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 30318dafb70eSVasanthakumar Thiagarajan { 30327baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 30332132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 30348dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 30358dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 30368dafb70eSVasanthakumar Thiagarajan } 30378dafb70eSVasanthakumar Thiagarajan 3038de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3039108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 304010509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 304110509f90SKalle Valo (unsigned long) vif); 304210509f90SKalle Valo 3043de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3044478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 30458dafb70eSVasanthakumar Thiagarajan 304680abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 304780abaf9bSVasanthakumar Thiagarajan 30488dafb70eSVasanthakumar Thiagarajan return 0; 30498dafb70eSVasanthakumar Thiagarajan } 30508dafb70eSVasanthakumar Thiagarajan 3051c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 30528dafb70eSVasanthakumar Thiagarajan { 305355055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 305480abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 305555055976SVasanthakumar Thiagarajan 30562132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3057108438bcSVasanthakumar Thiagarajan 305855055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 305955055976SVasanthakumar Thiagarajan 306055055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 306155055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 306255055976SVasanthakumar Thiagarajan 306380abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 306480abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 306580abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 306680abaf9bSVasanthakumar Thiagarajan } 306780abaf9bSVasanthakumar Thiagarajan 306827929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 306955055976SVasanthakumar Thiagarajan 307055055976SVasanthakumar Thiagarajan ar->num_vif--; 30718dafb70eSVasanthakumar Thiagarajan } 30728dafb70eSVasanthakumar Thiagarajan 30738dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 307455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 307555055976SVasanthakumar Thiagarajan u8 nw_type) 30768dafb70eSVasanthakumar Thiagarajan { 30778dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3078108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 30798dafb70eSVasanthakumar Thiagarajan 308055055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 30818dafb70eSVasanthakumar Thiagarajan if (!ndev) 30828dafb70eSVasanthakumar Thiagarajan return NULL; 30838dafb70eSVasanthakumar Thiagarajan 3084108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3085108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3086108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3087108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3088108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3089108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3090108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3091108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3092334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 3093d0d670abSKalle Valo vif->nw_type = nw_type; 3094d0d670abSKalle Valo vif->next_mode = nw_type; 30958f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3096ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 30978dafb70eSVasanthakumar Thiagarajan 309855055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 309955055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 310055055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 310155055976SVasanthakumar Thiagarajan 0x2; 310255055976SVasanthakumar Thiagarajan 31038dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 31048dafb70eSVasanthakumar Thiagarajan 3105e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 31068dafb70eSVasanthakumar Thiagarajan 3107c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 31088dafb70eSVasanthakumar Thiagarajan goto err; 31098dafb70eSVasanthakumar Thiagarajan 311027929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 31118dafb70eSVasanthakumar Thiagarajan goto err; 31128dafb70eSVasanthakumar Thiagarajan 311355055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 311414ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 311559c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 31168dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 311759c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 31188dafb70eSVasanthakumar Thiagarajan 311955055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 312055055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 312155055976SVasanthakumar Thiagarajan 312211f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3123990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 312411f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3125990bd915SVasanthakumar Thiagarajan 31268dafb70eSVasanthakumar Thiagarajan return ndev; 31278dafb70eSVasanthakumar Thiagarajan 31288dafb70eSVasanthakumar Thiagarajan err: 312927929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 313027929723SVasanthakumar Thiagarajan free_netdev(ndev); 3131bdcd8170SKalle Valo return NULL; 3132bdcd8170SKalle Valo } 3133bdcd8170SKalle Valo 313446d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 313546d33a21SKalle Valo { 313646d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 313746d33a21SKalle Valo int ret; 313846d33a21SKalle Valo 313946d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 314046d33a21SKalle Valo 314146d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 314246d33a21SKalle Valo 314346d33a21SKalle Valo /* set device pointer for wiphy */ 314446d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 314546d33a21SKalle Valo 314646d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 314746d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 314846d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 314946d33a21SKalle Valo if (ar->p2p) { 315046d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 315146d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 315246d33a21SKalle Valo } 315346d33a21SKalle Valo 315446d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 315546d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 315646d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 315746d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 315846d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 315946d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 316046d33a21SKalle Valo 316146d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 316246d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 316346d33a21SKalle Valo 316446d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 316546d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 316646d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 316746d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 316846d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 316946d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 317046d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 317146d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 317246d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 317346d33a21SKalle Valo 317446d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 317546d33a21SKalle Valo 3176f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3177f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3178f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3179f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3180f2afdac7SVasanthakumar Thiagarajan 3181f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3182f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3183f2afdac7SVasanthakumar Thiagarajan 3184f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3185f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3186f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3187f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3188f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3189f2afdac7SVasanthakumar Thiagarajan 319046d33a21SKalle Valo ret = wiphy_register(wiphy); 319146d33a21SKalle Valo if (ret < 0) { 319246d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 319346d33a21SKalle Valo return ret; 319446d33a21SKalle Valo } 319546d33a21SKalle Valo 3196e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3197e5348a1eSVasanthakumar Thiagarajan 319846d33a21SKalle Valo return 0; 319946d33a21SKalle Valo } 320046d33a21SKalle Valo 320146d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3202bdcd8170SKalle Valo { 3203be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3204e5348a1eSVasanthakumar Thiagarajan 3205e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 320645eaa78fSKalle Valo } 320746d33a21SKalle Valo 320845eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 320945eaa78fSKalle Valo { 321045eaa78fSKalle Valo struct ath6kl *ar; 321145eaa78fSKalle Valo struct wiphy *wiphy; 321245eaa78fSKalle Valo 321345eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 321445eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 321545eaa78fSKalle Valo 321645eaa78fSKalle Valo if (!wiphy) { 321745eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 321845eaa78fSKalle Valo return NULL; 321945eaa78fSKalle Valo } 322045eaa78fSKalle Valo 322145eaa78fSKalle Valo ar = wiphy_priv(wiphy); 322245eaa78fSKalle Valo ar->wiphy = wiphy; 322345eaa78fSKalle Valo 322445eaa78fSKalle Valo return ar; 322545eaa78fSKalle Valo } 322645eaa78fSKalle Valo 322745eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 322845eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 322945eaa78fSKalle Valo { 32301d2a4456SVasanthakumar Thiagarajan int i; 32311d2a4456SVasanthakumar Thiagarajan 32321d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 32331d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 32341d2a4456SVasanthakumar Thiagarajan 3235be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3236bdcd8170SKalle Valo } 323745eaa78fSKalle Valo 3238