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 419bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 420bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 421bdcd8170SKalle Valo { 422bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 42359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 424bdcd8170SKalle Valo int status; 4253ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 426ce0dc0cfSRaja Mani u16 interval; 427bdcd8170SKalle Valo 42810509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 42910509f90SKalle Valo 43014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 431bdcd8170SKalle Valo 432990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 433bdcd8170SKalle Valo return -EIO; 434bdcd8170SKalle Valo 435bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 436bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 437bdcd8170SKalle Valo return -EBUSY; 438bdcd8170SKalle Valo } 439bdcd8170SKalle Valo 440bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 441bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 442bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 443bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 444bdcd8170SKalle Valo return -EINVAL; 445bdcd8170SKalle Valo } 446bdcd8170SKalle Valo 447bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 448bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 449bdcd8170SKalle Valo return -ERESTARTSYS; 450bdcd8170SKalle Valo } 451bdcd8170SKalle Valo 452bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 453bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 454bdcd8170SKalle Valo up(&ar->sem); 455bdcd8170SKalle Valo return -EBUSY; 456bdcd8170SKalle Valo } 457bdcd8170SKalle Valo 458bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 459bdcd8170SKalle Valo /* 460bdcd8170SKalle Valo * sleep until the command queue drains 461bdcd8170SKalle Valo */ 462bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 463bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 464bdcd8170SKalle Valo WMI_TIMEOUT); 465bdcd8170SKalle Valo if (signal_pending(current)) { 466bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 467bdcd8170SKalle Valo up(&ar->sem); 468bdcd8170SKalle Valo return -EINTR; 469bdcd8170SKalle Valo } 470bdcd8170SKalle Valo } 471bdcd8170SKalle Valo 472334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 473743b4518SDan Carpenter if (status) { 474743b4518SDan Carpenter up(&ar->sem); 4756981ffdcSKevin Fang return status; 476743b4518SDan Carpenter } 4776e786cb1SJouni Malinen 4786e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 479542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4806981ffdcSKevin Fang 48159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4823450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4833450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 484cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 485334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 486334234b5SVasanthakumar Thiagarajan vif->req_bssid, 487f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 488bdcd8170SKalle Valo 489bdcd8170SKalle Valo up(&ar->sem); 490bdcd8170SKalle Valo if (status) { 491bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 492bdcd8170SKalle Valo return -EIO; 493bdcd8170SKalle Valo } 494bdcd8170SKalle Valo return 0; 4953450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4963450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 497240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 498bdcd8170SKalle Valo } 499bdcd8170SKalle Valo 5003450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5013450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 5023450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 503bdcd8170SKalle Valo 504bdcd8170SKalle Valo if (sme->channel) 505f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 506bdcd8170SKalle Valo 5078c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 508bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5098c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 510bdcd8170SKalle Valo 511240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 512bdcd8170SKalle Valo 513240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 514bdcd8170SKalle Valo if (status) { 515bdcd8170SKalle Valo up(&ar->sem); 516bdcd8170SKalle Valo return status; 517bdcd8170SKalle Valo } 518bdcd8170SKalle Valo 519bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 520240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 521bdcd8170SKalle Valo else 522240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 523bdcd8170SKalle Valo 524240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 525bdcd8170SKalle Valo 526bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 527240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 528bdcd8170SKalle Valo 529bdcd8170SKalle Valo if ((sme->key_len) && 5303450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5313450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 532bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 533bdcd8170SKalle Valo 534792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 535bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 536bdcd8170SKalle Valo sme->key_idx); 537bdcd8170SKalle Valo up(&ar->sem); 538bdcd8170SKalle Valo return -ENOENT; 539bdcd8170SKalle Valo } 540bdcd8170SKalle Valo 5416f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 542bdcd8170SKalle Valo key->key_len = sme->key_len; 543bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5443450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5453450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 546bdcd8170SKalle Valo 547334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5483450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 549bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 550bdcd8170SKalle Valo key->key_len, 551f4bb9a6fSJouni Malinen NULL, 0, 552bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 553bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 554bdcd8170SKalle Valo } 555bdcd8170SKalle Valo 556bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 55759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 558240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 559240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 560bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 561bdcd8170SKalle Valo up(&ar->sem); 562bdcd8170SKalle Valo return -EIO; 563bdcd8170SKalle Valo } 564bdcd8170SKalle Valo } 565bdcd8170SKalle Valo 566f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 567bdcd8170SKalle Valo 5683ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5693ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5703ca9d1fcSAarthi Thiruvengadam 571bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 572bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 573bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 574bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 575bdcd8170SKalle Valo __func__, 5763450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5773450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 578f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 579bdcd8170SKalle Valo 580cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 581ce0dc0cfSRaja Mani 582ce0dc0cfSRaja Mani if (vif->nw_type == INFRA_NETWORK) { 583ce0dc0cfSRaja Mani interval = max(vif->listen_intvl_t, 584ce0dc0cfSRaja Mani (u16) ATH6KL_MAX_WOW_LISTEN_INTL); 585ce0dc0cfSRaja Mani status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 586ce0dc0cfSRaja Mani interval, 587ce0dc0cfSRaja Mani 0); 588ce0dc0cfSRaja Mani if (status) { 589ce0dc0cfSRaja Mani ath6kl_err("couldn't set listen intervel\n"); 590ce0dc0cfSRaja Mani up(&ar->sem); 591ce0dc0cfSRaja Mani return status; 592ce0dc0cfSRaja Mani } 593ce0dc0cfSRaja Mani } 594ce0dc0cfSRaja Mani 595334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5963450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5973450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5983450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5993450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 6003450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 601f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 6023ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 603bdcd8170SKalle Valo 604bdcd8170SKalle Valo up(&ar->sem); 605bdcd8170SKalle Valo 606bdcd8170SKalle Valo if (status == -EINVAL) { 6073450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6083450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 609bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 610bdcd8170SKalle Valo return -ENOENT; 611bdcd8170SKalle Valo } else if (status) { 612bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 613bdcd8170SKalle Valo return -EIO; 614bdcd8170SKalle Valo } 615bdcd8170SKalle Valo 616bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 6173450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 6183450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 619de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 620bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 621bdcd8170SKalle Valo } 622bdcd8170SKalle Valo 623bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 62459c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 625bdcd8170SKalle Valo 626bdcd8170SKalle Valo return 0; 627bdcd8170SKalle Valo } 628bdcd8170SKalle Valo 6295e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6305e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6314eab6f4fSRaja Mani enum network_type nw_type, 6324eab6f4fSRaja Mani const u8 *bssid, 63301cac476SJouni Malinen struct ieee80211_channel *chan, 6345e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6355e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 63601cac476SJouni Malinen { 637240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 63801cac476SJouni Malinen struct cfg80211_bss *bss; 6394eab6f4fSRaja Mani u16 cap_mask, cap_val; 64001cac476SJouni Malinen u8 *ie; 64101cac476SJouni Malinen 6424eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6434eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6444eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6454eab6f4fSRaja Mani } else { 6464eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6474eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6484eab6f4fSRaja Mani } 6494eab6f4fSRaja Mani 650be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6514eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6524eab6f4fSRaja Mani cap_mask, cap_val); 65301cac476SJouni Malinen if (bss == NULL) { 65401cac476SJouni Malinen /* 65501cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 65601cac476SJouni Malinen * generate a partial entry until the first BSS info 65701cac476SJouni Malinen * event becomes available. 65801cac476SJouni Malinen * 65901cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 66001cac476SJouni Malinen * IEs from the target. 66101cac476SJouni Malinen */ 6623450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 66301cac476SJouni Malinen if (ie == NULL) 6645e13fd35SVasanthakumar Thiagarajan return NULL; 66501cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6663450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6673450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6683450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 669be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6704eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6713450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 67201cac476SJouni Malinen 0, GFP_KERNEL); 67301cac476SJouni Malinen if (bss) 6744eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6754eab6f4fSRaja Mani "cfg80211\n", bssid); 67601cac476SJouni Malinen kfree(ie); 67701cac476SJouni Malinen } else 6785e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 67901cac476SJouni Malinen 6805e13fd35SVasanthakumar Thiagarajan return bss; 68101cac476SJouni Malinen } 68201cac476SJouni Malinen 683240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 684bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 685bdcd8170SKalle Valo u16 beacon_intvl, 686bdcd8170SKalle Valo enum network_type nw_type, 687bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 688bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 689bdcd8170SKalle Valo { 69001cac476SJouni Malinen struct ieee80211_channel *chan; 691240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6925e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 693bdcd8170SKalle Valo 694bdcd8170SKalle Valo /* capinfo + listen interval */ 695bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 696bdcd8170SKalle Valo 697bdcd8170SKalle Valo /* capinfo + status code + associd */ 698bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 699bdcd8170SKalle Valo 700bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 701bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 702bdcd8170SKalle Valo assoc_resp_ie_offset; 703bdcd8170SKalle Valo 704bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 705bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 706bdcd8170SKalle Valo 70732c10874SJouni Malinen /* 70832c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 70932c10874SJouni Malinen * a Beacon frame from the AP is seen. 71032c10874SJouni Malinen */ 711cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 71259c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 71332c10874SJouni Malinen 714bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 715551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 716bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 717bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 718bdcd8170SKalle Valo return; 719bdcd8170SKalle Valo } 720bdcd8170SKalle Valo } 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 723551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 724551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 725bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 726bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 727bdcd8170SKalle Valo return; 728bdcd8170SKalle Valo } 729bdcd8170SKalle Valo } 730bdcd8170SKalle Valo 731be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 732bdcd8170SKalle Valo 7335e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7345e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7355e13fd35SVasanthakumar Thiagarajan if (!bss) { 7364eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 737bdcd8170SKalle Valo return; 738bdcd8170SKalle Valo } 739bdcd8170SKalle Valo 7404eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7414eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7424eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7434eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7445e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 74501cac476SJouni Malinen return; 74601cac476SJouni Malinen } 74701cac476SJouni Malinen 74814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 749bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 75014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 751240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 752bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 753bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 754bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7555e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 75614ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 757bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7585e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 759bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo } 762bdcd8170SKalle Valo 763bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 764bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 765bdcd8170SKalle Valo { 766d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7673450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 770bdcd8170SKalle Valo reason_code); 771bdcd8170SKalle Valo 77210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 77310509f90SKalle Valo 774990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 775bdcd8170SKalle Valo return -EIO; 776bdcd8170SKalle Valo 777bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 778bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 779bdcd8170SKalle Valo return -EBUSY; 780bdcd8170SKalle Valo } 781bdcd8170SKalle Valo 782bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 783bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 784bdcd8170SKalle Valo return -ERESTARTSYS; 785bdcd8170SKalle Valo } 786bdcd8170SKalle Valo 787cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 788240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7893450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7903450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 791bdcd8170SKalle Valo 792bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7938c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 794bdcd8170SKalle Valo 795bdcd8170SKalle Valo up(&ar->sem); 796bdcd8170SKalle Valo 79714ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 798170826ddSVasanthakumar Thiagarajan 799bdcd8170SKalle Valo return 0; 800bdcd8170SKalle Valo } 801bdcd8170SKalle Valo 802240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 803bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 804bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 805bdcd8170SKalle Valo { 806240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 80759c98449SVasanthakumar Thiagarajan 80814ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 80914ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 81014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 811bdcd8170SKalle Valo } 812bdcd8170SKalle Valo 813f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 814551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 815bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 816bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 817bdcd8170SKalle Valo return; 818bdcd8170SKalle Valo } 819bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 820240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 821bdcd8170SKalle Valo return; 822bdcd8170SKalle Valo } 823bdcd8170SKalle Valo 824f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 825551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 826551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 827bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 828bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 829bdcd8170SKalle Valo return; 830bdcd8170SKalle Valo } 831bdcd8170SKalle Valo } 832bdcd8170SKalle Valo 8331de547d6SVasanthakumar Thiagarajan /* 8341de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8351de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8361de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8371de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8381de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8391de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8401de547d6SVasanthakumar Thiagarajan */ 841bdcd8170SKalle Valo 8421de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 843334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 844bdcd8170SKalle Valo return; 845bdcd8170SKalle Valo } 846bdcd8170SKalle Valo 84759c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 848bdcd8170SKalle Valo 84914ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 850240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 851bdcd8170SKalle Valo bssid, NULL, 0, 852bdcd8170SKalle Valo NULL, 0, 853bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 854bdcd8170SKalle Valo GFP_KERNEL); 85514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 856240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 857bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 858bdcd8170SKalle Valo } 859bdcd8170SKalle Valo 86014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 861bdcd8170SKalle Valo } 862bdcd8170SKalle Valo 863bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 864bdcd8170SKalle Valo struct cfg80211_scan_request *request) 865bdcd8170SKalle Valo { 866d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 86759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8681276c9efSEdward Lu s8 n_channels = 0; 8691276c9efSEdward Lu u16 *channels = NULL; 870bdcd8170SKalle Valo int ret = 0; 871f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 872bdcd8170SKalle Valo 873990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 874bdcd8170SKalle Valo return -EIO; 875bdcd8170SKalle Valo 87610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 87710509f90SKalle Valo 878bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 87959c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8801b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 881240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 88259c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8831b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8841b1e6ee3SJouni Malinen if (ret) { 885bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8861b1e6ee3SJouni Malinen return ret; 887bdcd8170SKalle Valo } 888bdcd8170SKalle Valo } 889bdcd8170SKalle Valo 890bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 891bdcd8170SKalle Valo u8 i; 892bdcd8170SKalle Valo 893bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 894bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 895bdcd8170SKalle Valo 896bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 897334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 898334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 899bdcd8170SKalle Valo request->ssids[i].ssid_len, 900bdcd8170SKalle Valo request->ssids[i].ssid); 901bdcd8170SKalle Valo } 902bdcd8170SKalle Valo 903080eec4fSAarthi Thiruvengadam /* this also clears IE in fw if it's not set */ 904334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 905334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 906b84da8c7SJouni Malinen request->ie, request->ie_len); 907b84da8c7SJouni Malinen if (ret) { 908b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 909b84da8c7SJouni Malinen "scan"); 910b84da8c7SJouni Malinen return ret; 911b84da8c7SJouni Malinen } 912b84da8c7SJouni Malinen 91311869befSJouni Malinen /* 91411869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 91511869befSJouni Malinen * channels. If the list is longer than the target supports, do not 91611869befSJouni Malinen * configure the list and instead, scan all available channels. 91711869befSJouni Malinen */ 91811869befSJouni Malinen if (request->n_channels > 0 && 91911869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9201276c9efSEdward Lu u8 i; 9211276c9efSEdward Lu 92211869befSJouni Malinen n_channels = request->n_channels; 9231276c9efSEdward Lu 9241276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9251276c9efSEdward Lu if (channels == NULL) { 9261276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9271276c9efSEdward Lu "scan all channels"); 9281276c9efSEdward Lu n_channels = 0; 9291276c9efSEdward Lu } 9301276c9efSEdward Lu 9311276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9321276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9331276c9efSEdward Lu } 9341276c9efSEdward Lu 93559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 936f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 937f1f92179SVasanthakumar Thiagarajan 9383ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9393ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9403ca9d1fcSAarthi Thiruvengadam /* 9413ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9423ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9433ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9443ca9d1fcSAarthi Thiruvengadam * probe requests 9453ca9d1fcSAarthi Thiruvengadam */ 9463ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9473ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 94813423c31SVasanthakumar Thiagarajan false, 0, 94913423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95013423c31SVasanthakumar Thiagarajan n_channels, channels, 95113423c31SVasanthakumar Thiagarajan request->no_cck, 9523ca9d1fcSAarthi Thiruvengadam request->rates); 9533ca9d1fcSAarthi Thiruvengadam } else { 9543ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9553ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 95613423c31SVasanthakumar Thiagarajan false, 0, 95713423c31SVasanthakumar Thiagarajan ATH6KL_FG_SCAN_INTERVAL, 95813423c31SVasanthakumar Thiagarajan n_channels, channels); 9593ca9d1fcSAarthi Thiruvengadam } 9601b1e6ee3SJouni Malinen if (ret) 961bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 96211869befSJouni Malinen else 96314ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 964bdcd8170SKalle Valo 9651276c9efSEdward Lu kfree(channels); 9661276c9efSEdward Lu 967bdcd8170SKalle Valo return ret; 968bdcd8170SKalle Valo } 969bdcd8170SKalle Valo 9701c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 971bdcd8170SKalle Valo { 972240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9736fd1eaceSKalle Valo int i; 974bdcd8170SKalle Valo 9751c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9761c17d313SKalle Valo aborted ? " aborted" : ""); 977bdcd8170SKalle Valo 97814ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9796fd1eaceSKalle Valo return; 9806fd1eaceSKalle Valo 9811c17d313SKalle Valo if (aborted) 9826fd1eaceSKalle Valo goto out; 983bdcd8170SKalle Valo 98414ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 98514ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 986334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 987334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 988bdcd8170SKalle Valo 0, NULL); 989bdcd8170SKalle Valo } 990bdcd8170SKalle Valo } 9916fd1eaceSKalle Valo 9926fd1eaceSKalle Valo out: 993cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 99414ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 995bdcd8170SKalle Valo } 996bdcd8170SKalle Valo 997bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 998bdcd8170SKalle Valo u8 key_index, bool pairwise, 999bdcd8170SKalle Valo const u8 *mac_addr, 1000bdcd8170SKalle Valo struct key_params *params) 1001bdcd8170SKalle Valo { 1002d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 100359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1004bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 10054a8ce2fdSSujith Manoharan int seq_len; 1006bdcd8170SKalle Valo u8 key_usage; 1007bdcd8170SKalle Valo u8 key_type; 1008bdcd8170SKalle Valo 1009990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1010bdcd8170SKalle Valo return -EIO; 1011bdcd8170SKalle Valo 1012837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1013837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 1014837cb97eSJouni Malinen return -EINVAL; 1015240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1016240d2799SVasanthakumar Thiagarajan params->key); 1017837cb97eSJouni Malinen } 1018837cb97eSJouni Malinen 1019792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1020bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1021bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1022bdcd8170SKalle Valo key_index); 1023bdcd8170SKalle Valo return -ENOENT; 1024bdcd8170SKalle Valo } 1025bdcd8170SKalle Valo 10266f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1027bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1028bdcd8170SKalle Valo 1029bdcd8170SKalle Valo if (pairwise) 1030bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1031bdcd8170SKalle Valo else 1032bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1033bdcd8170SKalle Valo 10344a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10355e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10365e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10375e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10385e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10395e07021eSDai Shuibing } 1040bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10415e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1042bdcd8170SKalle Valo return -EINVAL; 1043bdcd8170SKalle Valo 1044bdcd8170SKalle Valo key->key_len = params->key_len; 1045bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10465e07021eSDai Shuibing key->seq_len = seq_len; 1047bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1048bdcd8170SKalle Valo key->cipher = params->cipher; 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo switch (key->cipher) { 1051bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1052bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1053bdcd8170SKalle Valo key_type = WEP_CRYPT; 1054bdcd8170SKalle Valo break; 1055bdcd8170SKalle Valo 1056bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1057bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1058bdcd8170SKalle Valo break; 1059bdcd8170SKalle Valo 1060bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1061bdcd8170SKalle Valo key_type = AES_CRYPT; 1062bdcd8170SKalle Valo break; 10635e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10645e07021eSDai Shuibing key_type = WAPI_CRYPT; 10655e07021eSDai Shuibing break; 1066bdcd8170SKalle Valo 1067bdcd8170SKalle Valo default: 1068bdcd8170SKalle Valo return -ENOTSUPP; 1069bdcd8170SKalle Valo } 1070bdcd8170SKalle Valo 10713450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10723450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1073bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1074de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1075bdcd8170SKalle Valo 1076bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1077bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1078bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1079bdcd8170SKalle Valo key_usage, key->seq_len); 1080bdcd8170SKalle Valo 1081f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10824703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1083cc4d623dSVasanthakumar Thiagarajan key_type == WAPI_CRYPT)) { 10849a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10859a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10869a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10879a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10889a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 108959c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10909a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10919a5b1318SJouni Malinen "key configuration until AP mode has been " 10929a5b1318SJouni Malinen "started\n"); 10939a5b1318SJouni Malinen /* 10949a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10959a5b1318SJouni Malinen * the connected event is received from the target. 10969a5b1318SJouni Malinen */ 10979a5b1318SJouni Malinen return 0; 10989a5b1318SJouni Malinen } 10999a5b1318SJouni Malinen } 11009a5b1318SJouni Malinen 1101f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 110259c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1103151411e8SJouni Malinen /* 1104151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1105151411e8SJouni Malinen * the AP mode has properly started 1106151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1107151411e8SJouni Malinen */ 1108151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1109151411e8SJouni Malinen "until AP mode has been started\n"); 11106f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 11116f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 11126f2a73f9SVasanthakumar Thiagarajan key->key_len); 1113151411e8SJouni Malinen return 0; 1114151411e8SJouni Malinen } 1115151411e8SJouni Malinen 11167cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1117bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1118f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1119f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1120bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1121bdcd8170SKalle Valo } 1122bdcd8170SKalle Valo 1123bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1124bdcd8170SKalle Valo u8 key_index, bool pairwise, 1125bdcd8170SKalle Valo const u8 *mac_addr) 1126bdcd8170SKalle Valo { 1127d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11286f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1129bdcd8170SKalle Valo 1130bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1131bdcd8170SKalle Valo 1132990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1133bdcd8170SKalle Valo return -EIO; 1134bdcd8170SKalle Valo 1135792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1136bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1137bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1138bdcd8170SKalle Valo key_index); 1139bdcd8170SKalle Valo return -ENOENT; 1140bdcd8170SKalle Valo } 1141bdcd8170SKalle Valo 11426f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1143bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1144bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1145bdcd8170SKalle Valo return 0; 1146bdcd8170SKalle Valo } 1147bdcd8170SKalle Valo 11486f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1149bdcd8170SKalle Valo 1150334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1151bdcd8170SKalle Valo } 1152bdcd8170SKalle Valo 1153bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1154bdcd8170SKalle Valo u8 key_index, bool pairwise, 1155bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1156bdcd8170SKalle Valo void (*callback) (void *cookie, 1157bdcd8170SKalle Valo struct key_params *)) 1158bdcd8170SKalle Valo { 11596f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1160bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1161bdcd8170SKalle Valo struct key_params params; 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1164bdcd8170SKalle Valo 1165990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1166bdcd8170SKalle Valo return -EIO; 1167bdcd8170SKalle Valo 1168792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1169bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1170bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1171bdcd8170SKalle Valo key_index); 1172bdcd8170SKalle Valo return -ENOENT; 1173bdcd8170SKalle Valo } 1174bdcd8170SKalle Valo 11756f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1176bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1177bdcd8170SKalle Valo params.cipher = key->cipher; 1178bdcd8170SKalle Valo params.key_len = key->key_len; 1179bdcd8170SKalle Valo params.seq_len = key->seq_len; 1180bdcd8170SKalle Valo params.seq = key->seq; 1181bdcd8170SKalle Valo params.key = key->key; 1182bdcd8170SKalle Valo 1183bdcd8170SKalle Valo callback(cookie, ¶ms); 1184bdcd8170SKalle Valo 1185bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1186bdcd8170SKalle Valo } 1187bdcd8170SKalle Valo 1188bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1189bdcd8170SKalle Valo struct net_device *ndev, 1190bdcd8170SKalle Valo u8 key_index, bool unicast, 1191bdcd8170SKalle Valo bool multicast) 1192bdcd8170SKalle Valo { 1193d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 119459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1195bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1196bdcd8170SKalle Valo u8 key_usage; 1197229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1198bdcd8170SKalle Valo 1199bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1200bdcd8170SKalle Valo 1201990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1202bdcd8170SKalle Valo return -EIO; 1203bdcd8170SKalle Valo 1204792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1206bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1207bdcd8170SKalle Valo __func__, key_index); 1208bdcd8170SKalle Valo return -ENOENT; 1209bdcd8170SKalle Valo } 1210bdcd8170SKalle Valo 12116f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1212bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1213bdcd8170SKalle Valo __func__, key_index); 1214bdcd8170SKalle Valo return -EINVAL; 1215bdcd8170SKalle Valo } 1216bdcd8170SKalle Valo 12173450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12186f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1219bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12203450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1221bdcd8170SKalle Valo key_usage |= TX_USAGE; 1222229ed6b5SEdward Lu if (unicast) 12233450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1224229ed6b5SEdward Lu if (multicast) 12253450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1226bdcd8170SKalle Valo 1227f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12289a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12299a5b1318SJouni Malinen 1230f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1231334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1232229ed6b5SEdward Lu key_type, key_usage, 1233f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1234f4bb9a6fSJouni Malinen key->key, 1235bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1236bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1237bdcd8170SKalle Valo } 1238bdcd8170SKalle Valo 1239240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1240bdcd8170SKalle Valo bool ismcast) 1241bdcd8170SKalle Valo { 1242bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1243bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1244bdcd8170SKalle Valo 1245240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1246bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1247bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1248bdcd8170SKalle Valo GFP_KERNEL); 1249bdcd8170SKalle Valo } 1250bdcd8170SKalle Valo 1251bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1252bdcd8170SKalle Valo { 1253bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1254990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1255bdcd8170SKalle Valo int ret; 1256bdcd8170SKalle Valo 1257bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1258bdcd8170SKalle Valo changed); 1259bdcd8170SKalle Valo 1260990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1261990bd915SVasanthakumar Thiagarajan if (!vif) 1262990bd915SVasanthakumar Thiagarajan return -EIO; 1263990bd915SVasanthakumar Thiagarajan 1264990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1265bdcd8170SKalle Valo return -EIO; 1266bdcd8170SKalle Valo 1267bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1268bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1269bdcd8170SKalle Valo if (ret != 0) { 1270bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1271bdcd8170SKalle Valo return -EIO; 1272bdcd8170SKalle Valo } 1273bdcd8170SKalle Valo } 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo return 0; 1276bdcd8170SKalle Valo } 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo /* 1279bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1280bdcd8170SKalle Valo * data type from 2.6.36 onwards 1281bdcd8170SKalle Valo */ 1282bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1283bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1284b992a285SLuis R. Rodriguez int mbm) 1285bdcd8170SKalle Valo { 1286bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1287990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1288bdcd8170SKalle Valo u8 ath6kl_dbm; 1289b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1290bdcd8170SKalle Valo 1291bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1292bdcd8170SKalle Valo type, dbm); 1293bdcd8170SKalle Valo 1294990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1295990bd915SVasanthakumar Thiagarajan if (!vif) 1296990bd915SVasanthakumar Thiagarajan return -EIO; 1297990bd915SVasanthakumar Thiagarajan 1298990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1299bdcd8170SKalle Valo return -EIO; 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo switch (type) { 1302bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1303bdcd8170SKalle Valo return 0; 1304bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1305bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1306bdcd8170SKalle Valo break; 1307bdcd8170SKalle Valo default: 1308bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1309bdcd8170SKalle Valo __func__, type); 1310bdcd8170SKalle Valo return -EOPNOTSUPP; 1311bdcd8170SKalle Valo } 1312bdcd8170SKalle Valo 1313990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1314bdcd8170SKalle Valo 1315bdcd8170SKalle Valo return 0; 1316bdcd8170SKalle Valo } 1317bdcd8170SKalle Valo 1318bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1319bdcd8170SKalle Valo { 1320bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1321990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1322bdcd8170SKalle Valo 1323990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1324990bd915SVasanthakumar Thiagarajan if (!vif) 1325990bd915SVasanthakumar Thiagarajan return -EIO; 1326990bd915SVasanthakumar Thiagarajan 1327990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1328bdcd8170SKalle Valo return -EIO; 1329bdcd8170SKalle Valo 133059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1331bdcd8170SKalle Valo ar->tx_pwr = 0; 1332bdcd8170SKalle Valo 1333990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1334bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1335bdcd8170SKalle Valo return -EIO; 1336bdcd8170SKalle Valo } 1337bdcd8170SKalle Valo 1338bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1339bdcd8170SKalle Valo 5 * HZ); 1340bdcd8170SKalle Valo 1341bdcd8170SKalle Valo if (signal_pending(current)) { 1342bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1343bdcd8170SKalle Valo return -EINTR; 1344bdcd8170SKalle Valo } 1345bdcd8170SKalle Valo } 1346bdcd8170SKalle Valo 1347bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1348bdcd8170SKalle Valo return 0; 1349bdcd8170SKalle Valo } 1350bdcd8170SKalle Valo 1351bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1352bdcd8170SKalle Valo struct net_device *dev, 1353bdcd8170SKalle Valo bool pmgmt, int timeout) 1354bdcd8170SKalle Valo { 1355bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1356bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1357334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1358bdcd8170SKalle Valo 1359bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1360bdcd8170SKalle Valo __func__, pmgmt, timeout); 1361bdcd8170SKalle Valo 1362990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1363bdcd8170SKalle Valo return -EIO; 1364bdcd8170SKalle Valo 1365bdcd8170SKalle Valo if (pmgmt) { 1366bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1367bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1368bdcd8170SKalle Valo } else { 1369bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1370bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1371bdcd8170SKalle Valo } 1372bdcd8170SKalle Valo 1373334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1374334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1375bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1376bdcd8170SKalle Valo return -EIO; 1377bdcd8170SKalle Valo } 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo return 0; 1380bdcd8170SKalle Valo } 1381bdcd8170SKalle Valo 138255055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 138355055976SVasanthakumar Thiagarajan char *name, 138455055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 138555055976SVasanthakumar Thiagarajan u32 *flags, 138655055976SVasanthakumar Thiagarajan struct vif_params *params) 138755055976SVasanthakumar Thiagarajan { 138855055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 138955055976SVasanthakumar Thiagarajan struct net_device *ndev; 139055055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 139155055976SVasanthakumar Thiagarajan 139271f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 139355055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 139455055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 139555055976SVasanthakumar Thiagarajan } 139655055976SVasanthakumar Thiagarajan 139755055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 139855055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 139955055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 140055055976SVasanthakumar Thiagarajan } 140155055976SVasanthakumar Thiagarajan 140255055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 140355055976SVasanthakumar Thiagarajan if (!ndev) 140455055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 140555055976SVasanthakumar Thiagarajan 140655055976SVasanthakumar Thiagarajan ar->num_vif++; 140755055976SVasanthakumar Thiagarajan 140855055976SVasanthakumar Thiagarajan return ndev; 140955055976SVasanthakumar Thiagarajan } 141055055976SVasanthakumar Thiagarajan 141155055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 141255055976SVasanthakumar Thiagarajan struct net_device *ndev) 141355055976SVasanthakumar Thiagarajan { 141455055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 141555055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 141655055976SVasanthakumar Thiagarajan 141711f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 141855055976SVasanthakumar Thiagarajan list_del(&vif->list); 141911f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 142055055976SVasanthakumar Thiagarajan 142155055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 142255055976SVasanthakumar Thiagarajan 1423c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 142455055976SVasanthakumar Thiagarajan 142555055976SVasanthakumar Thiagarajan return 0; 142655055976SVasanthakumar Thiagarajan } 142755055976SVasanthakumar Thiagarajan 1428bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1429bdcd8170SKalle Valo struct net_device *ndev, 1430bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1431bdcd8170SKalle Valo struct vif_params *params) 1432bdcd8170SKalle Valo { 1433f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1434bdcd8170SKalle Valo 1435bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1436bdcd8170SKalle Valo 1437bdcd8170SKalle Valo switch (type) { 1438bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1439f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1440bdcd8170SKalle Valo break; 1441bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1442f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1443bdcd8170SKalle Valo break; 14446e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1445f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14466e4604c8SJouni Malinen break; 14476b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1448f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14496b5e5d25SJouni Malinen break; 14506b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1451f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14526b5e5d25SJouni Malinen break; 1453bdcd8170SKalle Valo default: 1454bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1455bdcd8170SKalle Valo return -EOPNOTSUPP; 1456bdcd8170SKalle Valo } 1457bdcd8170SKalle Valo 1458551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1459bdcd8170SKalle Valo 1460bdcd8170SKalle Valo return 0; 1461bdcd8170SKalle Valo } 1462bdcd8170SKalle Valo 1463bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1464bdcd8170SKalle Valo struct net_device *dev, 1465bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1466bdcd8170SKalle Valo { 1467bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 146859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1469bdcd8170SKalle Valo int status; 1470bdcd8170SKalle Valo 1471990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1472bdcd8170SKalle Valo return -EIO; 1473bdcd8170SKalle Valo 14743450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14753450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1476bdcd8170SKalle Valo 1477bdcd8170SKalle Valo if (ibss_param->channel) 1478f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1479bdcd8170SKalle Valo 1480bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1481bdcd8170SKalle Valo /* 1482bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1483bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1484bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1485bdcd8170SKalle Valo * updated. 1486bdcd8170SKalle Valo */ 1487bdcd8170SKalle Valo return -EOPNOTSUPP; 1488bdcd8170SKalle Valo } 1489bdcd8170SKalle Valo 14908c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1491bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14928c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14938c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1494bdcd8170SKalle Valo 1495240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1496bdcd8170SKalle Valo 1497240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1498bdcd8170SKalle Valo if (status) 1499bdcd8170SKalle Valo return status; 1500bdcd8170SKalle Valo 1501bdcd8170SKalle Valo if (ibss_param->privacy) { 1502240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1503240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1504bdcd8170SKalle Valo } else { 1505240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1506240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1507bdcd8170SKalle Valo } 1508bdcd8170SKalle Valo 1509f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1510bdcd8170SKalle Valo 1511bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1512bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1513bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1514bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1515bdcd8170SKalle Valo __func__, 15163450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15173450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1518f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1519bdcd8170SKalle Valo 1520334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15213450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15223450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15233450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15243450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15253450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1526f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15273ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 152859c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1529bdcd8170SKalle Valo 1530bdcd8170SKalle Valo return 0; 1531bdcd8170SKalle Valo } 1532bdcd8170SKalle Valo 1533bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1534bdcd8170SKalle Valo struct net_device *dev) 1535bdcd8170SKalle Valo { 15363450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1537bdcd8170SKalle Valo 1538990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1539bdcd8170SKalle Valo return -EIO; 1540bdcd8170SKalle Valo 1541240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15423450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15433450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1544bdcd8170SKalle Valo 1545bdcd8170SKalle Valo return 0; 1546bdcd8170SKalle Valo } 1547bdcd8170SKalle Valo 1548bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1549bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1550bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1551bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1552bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1553837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15545e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1555bdcd8170SKalle Valo }; 1556bdcd8170SKalle Valo 1557bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1558bdcd8170SKalle Valo { 1559bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1560bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1561bdcd8170SKalle Valo 36000, 48000, 54000 1562bdcd8170SKalle Valo }; 1563bdcd8170SKalle Valo u8 i; 1564bdcd8170SKalle Valo 1565bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1566bdcd8170SKalle Valo if (rate == legacy[i]) 1567bdcd8170SKalle Valo return true; 1568bdcd8170SKalle Valo 1569bdcd8170SKalle Valo return false; 1570bdcd8170SKalle Valo } 1571bdcd8170SKalle Valo 1572bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1573bdcd8170SKalle Valo { 1574bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1575bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1576bdcd8170SKalle Valo }; 1577bdcd8170SKalle Valo u8 i; 1578bdcd8170SKalle Valo 1579bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1580bdcd8170SKalle Valo if (rate == ht20[i]) { 1581bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1582bdcd8170SKalle Valo /* last rate uses sgi */ 1583bdcd8170SKalle Valo *sgi = true; 1584bdcd8170SKalle Valo else 1585bdcd8170SKalle Valo *sgi = false; 1586bdcd8170SKalle Valo 1587bdcd8170SKalle Valo *mcs = i; 1588bdcd8170SKalle Valo return true; 1589bdcd8170SKalle Valo } 1590bdcd8170SKalle Valo } 1591bdcd8170SKalle Valo return false; 1592bdcd8170SKalle Valo } 1593bdcd8170SKalle Valo 1594bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1595bdcd8170SKalle Valo { 1596bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1597bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1598bdcd8170SKalle Valo 150000 1599bdcd8170SKalle Valo }; 1600bdcd8170SKalle Valo u8 i; 1601bdcd8170SKalle Valo 1602bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1603bdcd8170SKalle Valo if (rate == ht40[i]) { 1604bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1605bdcd8170SKalle Valo /* last rate uses sgi */ 1606bdcd8170SKalle Valo *sgi = true; 1607bdcd8170SKalle Valo else 1608bdcd8170SKalle Valo *sgi = false; 1609bdcd8170SKalle Valo 1610bdcd8170SKalle Valo *mcs = i; 1611bdcd8170SKalle Valo return true; 1612bdcd8170SKalle Valo } 1613bdcd8170SKalle Valo } 1614bdcd8170SKalle Valo 1615bdcd8170SKalle Valo return false; 1616bdcd8170SKalle Valo } 1617bdcd8170SKalle Valo 1618bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1619bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1620bdcd8170SKalle Valo { 1621bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 162259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1623bdcd8170SKalle Valo long left; 1624bdcd8170SKalle Valo bool sgi; 1625bdcd8170SKalle Valo s32 rate; 1626bdcd8170SKalle Valo int ret; 1627bdcd8170SKalle Valo u8 mcs; 1628bdcd8170SKalle Valo 16298c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1630bdcd8170SKalle Valo return -ENOENT; 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1633bdcd8170SKalle Valo return -EBUSY; 1634bdcd8170SKalle Valo 1635b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1636bdcd8170SKalle Valo 1637334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1638bdcd8170SKalle Valo 1639bdcd8170SKalle Valo if (ret != 0) { 1640bdcd8170SKalle Valo up(&ar->sem); 1641bdcd8170SKalle Valo return -EIO; 1642bdcd8170SKalle Valo } 1643bdcd8170SKalle Valo 1644bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1645bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1646b95907a7SVasanthakumar Thiagarajan &vif->flags), 1647bdcd8170SKalle Valo WMI_TIMEOUT); 1648bdcd8170SKalle Valo 1649bdcd8170SKalle Valo up(&ar->sem); 1650bdcd8170SKalle Valo 1651bdcd8170SKalle Valo if (left == 0) 1652bdcd8170SKalle Valo return -ETIMEDOUT; 1653bdcd8170SKalle Valo else if (left < 0) 1654bdcd8170SKalle Valo return left; 1655bdcd8170SKalle Valo 1656b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1657b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1658bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1659b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1660bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1661bdcd8170SKalle Valo } 1662bdcd8170SKalle Valo 1663b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1664b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1665bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1666b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1667bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1668bdcd8170SKalle Valo } 1669bdcd8170SKalle Valo 1670b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1671bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1672bdcd8170SKalle Valo 1673b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1674bdcd8170SKalle Valo 1675bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1676bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1677bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1678bdcd8170SKalle Valo if (sgi) { 1679bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1680bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1681bdcd8170SKalle Valo } else { 1682bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1683bdcd8170SKalle Valo } 1684bdcd8170SKalle Valo 1685bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1686bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1687bdcd8170SKalle Valo if (sgi) { 1688bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1689bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1690bdcd8170SKalle Valo } else { 1691bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1692bdcd8170SKalle Valo } 1693bdcd8170SKalle Valo 1694bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1695bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1696bdcd8170SKalle Valo } else { 16979a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16989a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16999a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1700bdcd8170SKalle Valo return 0; 1701bdcd8170SKalle Valo } 1702bdcd8170SKalle Valo 1703bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1704bdcd8170SKalle Valo 170559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 170659c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1707f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 170832c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 170932c10874SJouni Malinen sinfo->bss_param.flags = 0; 1710cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1711cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 171232c10874SJouni Malinen } 171332c10874SJouni Malinen 1714bdcd8170SKalle Valo return 0; 1715bdcd8170SKalle Valo } 1716bdcd8170SKalle Valo 1717bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1718bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1719bdcd8170SKalle Valo { 1720bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1721334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1722334234b5SVasanthakumar Thiagarajan 1723334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1724bdcd8170SKalle Valo pmksa->pmkid, true); 1725bdcd8170SKalle Valo } 1726bdcd8170SKalle Valo 1727bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1728bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1729bdcd8170SKalle Valo { 1730bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1731334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1732334234b5SVasanthakumar Thiagarajan 1733334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1734bdcd8170SKalle Valo pmksa->pmkid, false); 1735bdcd8170SKalle Valo } 1736bdcd8170SKalle Valo 1737bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1738bdcd8170SKalle Valo { 1739bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 174059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 174159c98449SVasanthakumar Thiagarajan 174259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1743334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1744334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1745bdcd8170SKalle Valo return 0; 1746bdcd8170SKalle Valo } 1747bdcd8170SKalle Valo 1748d91e8eeeSRaja Mani static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1749d91e8eeeSRaja Mani struct cfg80211_wowlan *wow, u32 *filter) 17506cb3c714SRaja Mani { 1751d91e8eeeSRaja Mani int ret, pos; 1752d91e8eeeSRaja Mani u8 mask[WOW_MASK_SIZE]; 17536cb3c714SRaja Mani u16 i; 17546cb3c714SRaja Mani 1755d91e8eeeSRaja Mani /* Configure the patterns that we received from the user. */ 17566cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17576cb3c714SRaja Mani 17586cb3c714SRaja Mani /* 17596cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17606cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17616cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17626cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17636cb3c714SRaja Mani * then equivalent driver specific mask value is 17646cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17656cb3c714SRaja Mani */ 17666cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17676cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17686cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17696cb3c714SRaja Mani mask[pos] = 0xFF; 17706cb3c714SRaja Mani } 17716cb3c714SRaja Mani /* 17726cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17736cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17746cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17756cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17766cb3c714SRaja Mani */ 17776cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17786cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17796cb3c714SRaja Mani wow->patterns[i].pattern_len, 17806cb3c714SRaja Mani 0 /* pattern offset */, 17816cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17826cb3c714SRaja Mani if (ret) 17836cb3c714SRaja Mani return ret; 17846cb3c714SRaja Mani } 17856cb3c714SRaja Mani 1786d91e8eeeSRaja Mani if (wow->disconnect) 1787d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1788d91e8eeeSRaja Mani 1789d91e8eeeSRaja Mani if (wow->magic_pkt) 1790d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1791d91e8eeeSRaja Mani 1792d91e8eeeSRaja Mani if (wow->gtk_rekey_failure) 1793d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1794d91e8eeeSRaja Mani 1795d91e8eeeSRaja Mani if (wow->eap_identity_req) 1796d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_EAP_REQ; 1797d91e8eeeSRaja Mani 1798d91e8eeeSRaja Mani if (wow->four_way_handshake) 1799d91e8eeeSRaja Mani *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1800d91e8eeeSRaja Mani 1801d91e8eeeSRaja Mani return 0; 1802d91e8eeeSRaja Mani } 1803d91e8eeeSRaja Mani 1804d91e8eeeSRaja Mani static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1805d91e8eeeSRaja Mani { 1806d91e8eeeSRaja Mani static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1807d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1808d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1809d91e8eeeSRaja Mani 0x00, 0x08 }; 1810d91e8eeeSRaja Mani static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1811d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1812d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1813d91e8eeeSRaja Mani 0x00, 0x7f }; 1814d91e8eeeSRaja Mani u8 unicst_offset = 0; 1815d91e8eeeSRaja Mani static const u8 arp_pattern[] = { 0x08, 0x06 }; 1816d91e8eeeSRaja Mani static const u8 arp_mask[] = { 0xff, 0xff }; 1817d91e8eeeSRaja Mani u8 arp_offset = 20; 1818d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1819d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1820d91e8eeeSRaja Mani u8 discvr_offset = 38; 1821d91e8eeeSRaja Mani static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1822d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1823d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1824d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1825d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1826d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1827d91e8eeeSRaja Mani static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1828d91e8eeeSRaja Mani 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1829d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1830d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1831d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1832d91e8eeeSRaja Mani 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1833d91e8eeeSRaja Mani u8 dhcp_offset = 0; 1834d91e8eeeSRaja Mani int ret; 1835d91e8eeeSRaja Mani 1836d91e8eeeSRaja Mani /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1837d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1838d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1839d91e8eeeSRaja Mani sizeof(unicst_pattern), unicst_offset, 1840d91e8eeeSRaja Mani unicst_pattern, unicst_mask); 1841d91e8eeeSRaja Mani if (ret) { 1842d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast IP pattern\n"); 1843d91e8eeeSRaja Mani return ret; 1844d91e8eeeSRaja Mani } 1845d91e8eeeSRaja Mani 1846d91e8eeeSRaja Mani /* Setup all ARP pkt pattern */ 1847d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1848d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1849d91e8eeeSRaja Mani sizeof(arp_pattern), arp_offset, 1850d91e8eeeSRaja Mani arp_pattern, arp_mask); 1851d91e8eeeSRaja Mani if (ret) { 1852d91e8eeeSRaja Mani ath6kl_err("failed to add WOW ARP pattern\n"); 1853d91e8eeeSRaja Mani return ret; 1854d91e8eeeSRaja Mani } 1855d91e8eeeSRaja Mani 1856d91e8eeeSRaja Mani /* 1857d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1858d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1859d91e8eeeSRaja Mani */ 1860d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1861d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1862d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1863d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1864d91e8eeeSRaja Mani if (ret) { 1865d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1866d91e8eeeSRaja Mani return ret; 1867d91e8eeeSRaja Mani } 1868d91e8eeeSRaja Mani 1869d91e8eeeSRaja Mani /* Setup all DHCP broadcast pkt pattern */ 1870d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1871d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1872d91e8eeeSRaja Mani sizeof(dhcp_pattern), dhcp_offset, 1873d91e8eeeSRaja Mani dhcp_pattern, dhcp_mask); 1874d91e8eeeSRaja Mani if (ret) { 1875d91e8eeeSRaja Mani ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1876d91e8eeeSRaja Mani return ret; 1877d91e8eeeSRaja Mani } 1878d91e8eeeSRaja Mani 1879d91e8eeeSRaja Mani return 0; 1880d91e8eeeSRaja Mani } 1881d91e8eeeSRaja Mani 1882d91e8eeeSRaja Mani static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1883d91e8eeeSRaja Mani { 1884d91e8eeeSRaja Mani struct net_device *ndev = vif->ndev; 1885d91e8eeeSRaja Mani static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1886d91e8eeeSRaja Mani static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1887d91e8eeeSRaja Mani u8 discvr_offset = 38; 1888d91e8eeeSRaja Mani u8 mac_mask[ETH_ALEN]; 1889d91e8eeeSRaja Mani int ret; 1890d91e8eeeSRaja Mani 1891d91e8eeeSRaja Mani /* Setup unicast pkt pattern */ 1892d91e8eeeSRaja Mani memset(mac_mask, 0xff, ETH_ALEN); 1893d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1894d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1895d91e8eeeSRaja Mani ETH_ALEN, 0, ndev->dev_addr, 1896d91e8eeeSRaja Mani mac_mask); 1897d91e8eeeSRaja Mani if (ret) { 1898d91e8eeeSRaja Mani ath6kl_err("failed to add WOW unicast pattern\n"); 1899d91e8eeeSRaja Mani return ret; 1900d91e8eeeSRaja Mani } 1901d91e8eeeSRaja Mani 1902d91e8eeeSRaja Mani /* 1903d91e8eeeSRaja Mani * Setup multicast pattern for mDNS 224.0.0.251, 1904d91e8eeeSRaja Mani * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1905d91e8eeeSRaja Mani */ 1906d91e8eeeSRaja Mani if ((ndev->flags & IFF_ALLMULTI) || 1907d91e8eeeSRaja Mani (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1908d91e8eeeSRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1909d91e8eeeSRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 1910d91e8eeeSRaja Mani sizeof(discvr_pattern), discvr_offset, 1911d91e8eeeSRaja Mani discvr_pattern, discvr_mask); 1912d91e8eeeSRaja Mani if (ret) { 1913d91e8eeeSRaja Mani ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR " 1914d91e8eeeSRaja Mani "pattern\n"); 1915d91e8eeeSRaja Mani return ret; 1916d91e8eeeSRaja Mani } 1917d91e8eeeSRaja Mani } 1918d91e8eeeSRaja Mani 1919d91e8eeeSRaja Mani return 0; 1920d91e8eeeSRaja Mani } 1921d91e8eeeSRaja Mani 1922d91e8eeeSRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 1923d91e8eeeSRaja Mani { 1924d91e8eeeSRaja Mani struct in_device *in_dev; 1925d91e8eeeSRaja Mani struct in_ifaddr *ifa; 1926d91e8eeeSRaja Mani struct ath6kl_vif *vif; 1927d91e8eeeSRaja Mani int ret, left; 1928d91e8eeeSRaja Mani u32 filter = 0; 1929ce0dc0cfSRaja Mani u16 i, bmiss_time; 1930d91e8eeeSRaja Mani u8 index = 0; 1931d91e8eeeSRaja Mani __be32 ips[MAX_IP_ADDRS]; 1932d91e8eeeSRaja Mani 1933d91e8eeeSRaja Mani vif = ath6kl_vif_first(ar); 1934d91e8eeeSRaja Mani if (!vif) 1935d91e8eeeSRaja Mani return -EIO; 1936d91e8eeeSRaja Mani 1937d91e8eeeSRaja Mani if (!ath6kl_cfg80211_ready(vif)) 1938d91e8eeeSRaja Mani return -EIO; 1939d91e8eeeSRaja Mani 1940d91e8eeeSRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 19413c411a43SRaja Mani return -ENOTCONN; 1942d91e8eeeSRaja Mani 1943d91e8eeeSRaja Mani if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 1944d91e8eeeSRaja Mani return -EINVAL; 1945d91e8eeeSRaja Mani 1946d91e8eeeSRaja Mani /* Clear existing WOW patterns */ 1947d91e8eeeSRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 1948d91e8eeeSRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 1949d91e8eeeSRaja Mani WOW_LIST_ID, i); 1950d91e8eeeSRaja Mani 1951d91e8eeeSRaja Mani /* 1952d91e8eeeSRaja Mani * Skip the default WOW pattern configuration 1953d91e8eeeSRaja Mani * if the driver receives any WOW patterns from 1954d91e8eeeSRaja Mani * the user. 1955d91e8eeeSRaja Mani */ 1956d91e8eeeSRaja Mani if (wow) 1957d91e8eeeSRaja Mani ret = ath6kl_wow_usr(ar, vif, wow, &filter); 1958d91e8eeeSRaja Mani else if (vif->nw_type == AP_NETWORK) 1959d91e8eeeSRaja Mani ret = ath6kl_wow_ap(ar, vif); 1960d91e8eeeSRaja Mani else 1961d91e8eeeSRaja Mani ret = ath6kl_wow_sta(ar, vif); 1962d91e8eeeSRaja Mani 1963d91e8eeeSRaja Mani if (ret) 1964d91e8eeeSRaja Mani return ret; 1965d91e8eeeSRaja Mani 1966390a8c8fSRaja Mani netif_stop_queue(vif->ndev); 1967390a8c8fSRaja Mani 1968ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 1969ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 1970ce0dc0cfSRaja Mani ATH6KL_MAX_WOW_LISTEN_INTL, 1971ce0dc0cfSRaja Mani 0); 1972ce0dc0cfSRaja Mani if (ret) 1973ce0dc0cfSRaja Mani return ret; 1974ce0dc0cfSRaja Mani 1975ce0dc0cfSRaja Mani /* Set listen interval x 15 times as bmiss time */ 1976ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 1977ce0dc0cfSRaja Mani if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 1978ce0dc0cfSRaja Mani bmiss_time = ATH6KL_MAX_BMISS_TIME; 1979ce0dc0cfSRaja Mani 1980ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 1981ce0dc0cfSRaja Mani bmiss_time, 0); 1982ce0dc0cfSRaja Mani if (ret) 1983ce0dc0cfSRaja Mani return ret; 1984ce0dc0cfSRaja Mani 1985ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 1986ce0dc0cfSRaja Mani 0xFFFF, 0, 0xFFFF, 0, 0, 0, 1987ce0dc0cfSRaja Mani 0, 0, 0, 0); 1988ce0dc0cfSRaja Mani if (ret) 1989ce0dc0cfSRaja Mani return ret; 1990ce0dc0cfSRaja Mani } 1991ce0dc0cfSRaja Mani 1992390a8c8fSRaja Mani ar->state = ATH6KL_STATE_SUSPENDING; 1993390a8c8fSRaja Mani 1994c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1995c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1996c08631c6SRaja Mani if (!in_dev) 1997c08631c6SRaja Mani goto skip_arp; 1998c08631c6SRaja Mani 1999c08631c6SRaja Mani ifa = in_dev->ifa_list; 2000c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 2001c08631c6SRaja Mani 2002c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2003c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 2004c08631c6SRaja Mani ips[index] = ifa->ifa_local; 2005c08631c6SRaja Mani ifa = ifa->ifa_next; 2006c08631c6SRaja Mani index++; 2007c08631c6SRaja Mani } 2008c08631c6SRaja Mani 2009c08631c6SRaja Mani if (ifa) { 2010c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 2011c08631c6SRaja Mani return -EINVAL; 2012c08631c6SRaja Mani } 2013c08631c6SRaja Mani 2014c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2015c08631c6SRaja Mani if (ret) { 2016c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 2017c08631c6SRaja Mani return ret; 2018c08631c6SRaja Mani } 2019c08631c6SRaja Mani 2020c08631c6SRaja Mani skip_arp: 20216cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 20226cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 20236cb3c714SRaja Mani filter, 20246cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 20256cb3c714SRaja Mani if (ret) 20266cb3c714SRaja Mani return ret; 20276cb3c714SRaja Mani 2028081c7a84SRaja Mani clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2029081c7a84SRaja Mani 20306cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20316cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 20326cb3c714SRaja Mani if (ret) 20336cb3c714SRaja Mani return ret; 20346cb3c714SRaja Mani 2035081c7a84SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 2036081c7a84SRaja Mani test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags), 2037081c7a84SRaja Mani WMI_TIMEOUT); 2038081c7a84SRaja Mani if (left == 0) { 2039081c7a84SRaja Mani ath6kl_warn("timeout, didn't get host sleep cmd " 2040081c7a84SRaja Mani "processed event\n"); 2041081c7a84SRaja Mani ret = -ETIMEDOUT; 2042081c7a84SRaja Mani } else if (left < 0) { 2043081c7a84SRaja Mani ath6kl_warn("error while waiting for host sleep cmd " 2044081c7a84SRaja Mani "processed event %d\n", left); 2045081c7a84SRaja Mani ret = left; 2046081c7a84SRaja Mani } 2047081c7a84SRaja Mani 20486cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 20496cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 20506cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 20516cb3c714SRaja Mani if (left == 0) { 20526cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 20536cb3c714SRaja Mani ret = -ETIMEDOUT; 20546cb3c714SRaja Mani } else if (left < 0) { 20556cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 20566cb3c714SRaja Mani ret = left; 20576cb3c714SRaja Mani } 20586cb3c714SRaja Mani } 20596cb3c714SRaja Mani 20606cb3c714SRaja Mani return ret; 20616cb3c714SRaja Mani } 20626cb3c714SRaja Mani 20636cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 20646cb3c714SRaja Mani { 20656cb3c714SRaja Mani struct ath6kl_vif *vif; 20666cb3c714SRaja Mani int ret; 20676cb3c714SRaja Mani 20686cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 20696cb3c714SRaja Mani if (!vif) 20706cb3c714SRaja Mani return -EIO; 20716cb3c714SRaja Mani 2072390a8c8fSRaja Mani ar->state = ATH6KL_STATE_RESUMING; 2073390a8c8fSRaja Mani 20746cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 20756cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 2076390a8c8fSRaja Mani if (ret) { 2077390a8c8fSRaja Mani ath6kl_warn("Failed to configure host sleep mode for " 2078390a8c8fSRaja Mani "wow resume: %d\n", ret); 2079390a8c8fSRaja Mani ar->state = ATH6KL_STATE_WOW; 20806cb3c714SRaja Mani return ret; 20816cb3c714SRaja Mani } 20826cb3c714SRaja Mani 2083ce0dc0cfSRaja Mani if (vif->nw_type != AP_NETWORK) { 2084ce0dc0cfSRaja Mani ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2085ce0dc0cfSRaja Mani 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2086ce0dc0cfSRaja Mani if (ret) 2087ce0dc0cfSRaja Mani return ret; 2088ce0dc0cfSRaja Mani 2089ce0dc0cfSRaja Mani ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2090ce0dc0cfSRaja Mani vif->listen_intvl_t, 0); 2091ce0dc0cfSRaja Mani if (ret) 2092ce0dc0cfSRaja Mani return ret; 2093ce0dc0cfSRaja Mani 2094ce0dc0cfSRaja Mani ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2095ce0dc0cfSRaja Mani vif->bmiss_time_t, 0); 2096ce0dc0cfSRaja Mani if (ret) 2097ce0dc0cfSRaja Mani return ret; 2098ce0dc0cfSRaja Mani } 2099ce0dc0cfSRaja Mani 2100390a8c8fSRaja Mani ar->state = ATH6KL_STATE_ON; 2101390a8c8fSRaja Mani 2102390a8c8fSRaja Mani netif_wake_queue(vif->ndev); 2103390a8c8fSRaja Mani 2104390a8c8fSRaja Mani return 0; 2105390a8c8fSRaja Mani } 2106390a8c8fSRaja Mani 210752d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 21080f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 21090f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 211052d81a68SKalle Valo { 2111390a8c8fSRaja Mani enum ath6kl_state prev_state; 211252d81a68SKalle Valo int ret; 211352d81a68SKalle Valo 211452d81a68SKalle Valo switch (mode) { 2115d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 2116d7c44e0bSRaja Mani 2117d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2118d7c44e0bSRaja Mani 2119d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 2120d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 2121d7c44e0bSRaja Mani 2122390a8c8fSRaja Mani prev_state = ar->state; 2123390a8c8fSRaja Mani 2124d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 2125390a8c8fSRaja Mani if (ret) { 2126390a8c8fSRaja Mani ar->state = prev_state; 2127d7c44e0bSRaja Mani return ret; 2128390a8c8fSRaja Mani } 21291e9a905dSRaja Mani 2130d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 2131d7c44e0bSRaja Mani break; 2132d7c44e0bSRaja Mani 213352d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2134524441e3SRaja Mani 21357125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2136524441e3SRaja Mani 213752d81a68SKalle Valo /* save the current power mode before enabling power save */ 213852d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 213952d81a68SKalle Valo 214052d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 214152d81a68SKalle Valo if (ret) { 214252d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 214352d81a68SKalle Valo ret); 214452d81a68SKalle Valo } 214552d81a68SKalle Valo 214676a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 214776a9fbe2SKalle Valo 214852d81a68SKalle Valo break; 2149b4b2a0b1SKalle Valo 2150b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 2151524441e3SRaja Mani 21527125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 2153524441e3SRaja Mani 2154b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 2155b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2156b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 2157b4b2a0b1SKalle Valo break; 2158b4b2a0b1SKalle Valo } 2159b4b2a0b1SKalle Valo 2160b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2161b4b2a0b1SKalle Valo 2162b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 2163b4b2a0b1SKalle Valo if (ret) { 2164b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 2165b4b2a0b1SKalle Valo ret); 2166b4b2a0b1SKalle Valo } 2167b4b2a0b1SKalle Valo 2168b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 2169b4b2a0b1SKalle Valo 2170b4b2a0b1SKalle Valo break; 2171b4b2a0b1SKalle Valo 217210509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 217310509f90SKalle Valo /* 217410509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 217510509f90SKalle Valo * wow mode and sleeping most of the time. 217610509f90SKalle Valo */ 217710509f90SKalle Valo break; 217810509f90SKalle Valo 2179b4b2a0b1SKalle Valo default: 2180b4b2a0b1SKalle Valo break; 218152d81a68SKalle Valo } 218252d81a68SKalle Valo 218352d81a68SKalle Valo return 0; 218452d81a68SKalle Valo } 2185d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 218652d81a68SKalle Valo 218752d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 218852d81a68SKalle Valo { 218976a9fbe2SKalle Valo int ret; 219076a9fbe2SKalle Valo 219176a9fbe2SKalle Valo switch (ar->state) { 2192d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 2193d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2194d7c44e0bSRaja Mani 2195d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 2196d7c44e0bSRaja Mani if (ret) { 2197d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 2198d7c44e0bSRaja Mani return ret; 2199d7c44e0bSRaja Mani } 2200d7c44e0bSRaja Mani 2201d7c44e0bSRaja Mani break; 2202d7c44e0bSRaja Mani 220376a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 220452d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 220576a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 220676a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 220776a9fbe2SKalle Valo if (ret) { 220876a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 220976a9fbe2SKalle Valo ret); 221076a9fbe2SKalle Valo } 221176a9fbe2SKalle Valo } 221276a9fbe2SKalle Valo 221376a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 221476a9fbe2SKalle Valo 221576a9fbe2SKalle Valo break; 221676a9fbe2SKalle Valo 2217b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 2218b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2219b4b2a0b1SKalle Valo 2220b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 2221b4b2a0b1SKalle Valo if (ret) { 2222b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2223b4b2a0b1SKalle Valo return ret; 2224b4b2a0b1SKalle Valo } 2225d7c44e0bSRaja Mani break; 2226b4b2a0b1SKalle Valo 222710509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 222810509f90SKalle Valo break; 222910509f90SKalle Valo 223076a9fbe2SKalle Valo default: 223176a9fbe2SKalle Valo break; 223252d81a68SKalle Valo } 223352d81a68SKalle Valo 223452d81a68SKalle Valo return 0; 223552d81a68SKalle Valo } 2236d6a434d6SKalle Valo EXPORT_SYMBOL(ath6kl_cfg80211_resume); 223752d81a68SKalle Valo 2238abcb344bSKalle Valo #ifdef CONFIG_PM 223952d81a68SKalle Valo 224052d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 224152d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2242abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2243abcb344bSKalle Valo { 2244abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2245abcb344bSKalle Valo 22460f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2247abcb344bSKalle Valo } 2248aa6cffc1SChilam Ng 224952d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2250aa6cffc1SChilam Ng { 2251aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2252aa6cffc1SChilam Ng 2253aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2254aa6cffc1SChilam Ng } 2255a918fb3cSRaja Mani 2256a918fb3cSRaja Mani /* 2257a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2258a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2259a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2260a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2261a918fb3cSRaja Mani * 2262a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2263a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2264a918fb3cSRaja Mani * 2265a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2266a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2267a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2268a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2269a918fb3cSRaja Mani * 2270a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2271a918fb3cSRaja Mani */ 2272a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2273a918fb3cSRaja Mani { 2274390a8c8fSRaja Mani if (ar->state == ATH6KL_STATE_SUSPENDING) 2275390a8c8fSRaja Mani return; 2276390a8c8fSRaja Mani 2277a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2278a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2279a918fb3cSRaja Mani } 2280a918fb3cSRaja Mani 2281a918fb3cSRaja Mani #else 2282a918fb3cSRaja Mani 2283a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2284a918fb3cSRaja Mani { 2285a918fb3cSRaja Mani } 2286abcb344bSKalle Valo #endif 2287abcb344bSKalle Valo 22886a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 22896a7c9badSJouni Malinen struct ieee80211_channel *chan, 22906a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 22916a7c9badSJouni Malinen { 2292e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2293e68f6750SSujith Manoharan 2294e68f6750SSujith Manoharan /* 2295e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2296e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2297e68f6750SSujith Manoharan * 2298e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2299e68f6750SSujith Manoharan */ 2300e68f6750SSujith Manoharan if (!dev) 2301e68f6750SSujith Manoharan return -EBUSY; 2302e68f6750SSujith Manoharan 2303e68f6750SSujith Manoharan vif = netdev_priv(dev); 23046a7c9badSJouni Malinen 2305990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 23066a7c9badSJouni Malinen return -EIO; 23076a7c9badSJouni Malinen 23086a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 23096a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2310cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 23116a7c9badSJouni Malinen 23126a7c9badSJouni Malinen return 0; 23136a7c9badSJouni Malinen } 23146a7c9badSJouni Malinen 23158bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 23168bdfbf40SJouni Malinen { 23178bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 23188bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 23198bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 23208bdfbf40SJouni Malinen } 23218bdfbf40SJouni Malinen 2322334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2323334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 23248bdfbf40SJouni Malinen { 2325334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23268bdfbf40SJouni Malinen const u8 *pos; 23278bdfbf40SJouni Malinen u8 *buf = NULL; 23288bdfbf40SJouni Malinen size_t len = 0; 23298bdfbf40SJouni Malinen int ret; 23308bdfbf40SJouni Malinen 23318bdfbf40SJouni Malinen /* 23328bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 23338bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 23348bdfbf40SJouni Malinen */ 23358bdfbf40SJouni Malinen 23368bdfbf40SJouni Malinen if (ies && ies_len) { 23378bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 23388bdfbf40SJouni Malinen if (buf == NULL) 23398bdfbf40SJouni Malinen return -ENOMEM; 23408bdfbf40SJouni Malinen pos = ies; 23418bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 23428bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 23438bdfbf40SJouni Malinen break; 23448bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 23458bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 23468bdfbf40SJouni Malinen len += 2 + pos[1]; 23478bdfbf40SJouni Malinen } 23488bdfbf40SJouni Malinen pos += 2 + pos[1]; 23498bdfbf40SJouni Malinen } 23508bdfbf40SJouni Malinen } 23518bdfbf40SJouni Malinen 2352334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2353334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 23548bdfbf40SJouni Malinen kfree(buf); 23558bdfbf40SJouni Malinen return ret; 23568bdfbf40SJouni Malinen } 23578bdfbf40SJouni Malinen 23588860020eSJohannes Berg static int ath6kl_set_ies(struct ath6kl_vif *vif, 23598860020eSJohannes Berg struct cfg80211_beacon_data *info) 23608860020eSJohannes Berg { 23618860020eSJohannes Berg struct ath6kl *ar = vif->ar; 23628860020eSJohannes Berg int res; 23638860020eSJohannes Berg 23648860020eSJohannes Berg if (info->beacon_ies) { 23658860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23668860020eSJohannes Berg WMI_FRAME_BEACON, 23678860020eSJohannes Berg info->beacon_ies, 23688860020eSJohannes Berg info->beacon_ies_len); 23698860020eSJohannes Berg if (res) 23708860020eSJohannes Berg return res; 23718860020eSJohannes Berg } 23728860020eSJohannes Berg 23738860020eSJohannes Berg if (info->proberesp_ies) { 23748860020eSJohannes Berg res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 23758860020eSJohannes Berg info->proberesp_ies_len); 23768860020eSJohannes Berg if (res) 23778860020eSJohannes Berg return res; 23788860020eSJohannes Berg } 23798860020eSJohannes Berg 23808860020eSJohannes Berg if (info->assocresp_ies) { 23818860020eSJohannes Berg res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 23828860020eSJohannes Berg WMI_FRAME_ASSOC_RESP, 23838860020eSJohannes Berg info->assocresp_ies, 23848860020eSJohannes Berg info->assocresp_ies_len); 23858860020eSJohannes Berg if (res) 23868860020eSJohannes Berg return res; 23878860020eSJohannes Berg } 23888860020eSJohannes Berg 23898860020eSJohannes Berg return 0; 23908860020eSJohannes Berg } 23918860020eSJohannes Berg 23928860020eSJohannes Berg static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 23938860020eSJohannes Berg struct cfg80211_ap_settings *info) 23946a7c9badSJouni Malinen { 23956a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 23963450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23976a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 239867cd22e4SThomas Pedersen bool hidden = false; 23996a7c9badSJouni Malinen u8 *ies; 24006a7c9badSJouni Malinen int ies_len; 24016a7c9badSJouni Malinen struct wmi_connect_cmd p; 24026a7c9badSJouni Malinen int res; 2403be5abaafSVasanthakumar Thiagarajan int i, ret; 24046a7c9badSJouni Malinen 24058860020eSJohannes Berg ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 24066a7c9badSJouni Malinen 2407990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 24086a7c9badSJouni Malinen return -EIO; 24096a7c9badSJouni Malinen 2410f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 24116a7c9badSJouni Malinen return -EOPNOTSUPP; 24126a7c9badSJouni Malinen 24138860020eSJohannes Berg res = ath6kl_set_ies(vif, &info->beacon); 24146a7c9badSJouni Malinen 24159a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 24169a5b1318SJouni Malinen 24176a7c9badSJouni Malinen /* TODO: 24186a7c9badSJouni Malinen * info->interval 24196a7c9badSJouni Malinen * info->dtim_period 24206a7c9badSJouni Malinen */ 24216a7c9badSJouni Malinen 24228860020eSJohannes Berg if (info->beacon.head == NULL) 24236a7c9badSJouni Malinen return -EINVAL; 24248860020eSJohannes Berg mgmt = (struct ieee80211_mgmt *) info->beacon.head; 24256a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 24268860020eSJohannes Berg if (ies > info->beacon.head + info->beacon.head_len) 24276a7c9badSJouni Malinen return -EINVAL; 24288860020eSJohannes Berg ies_len = info->beacon.head + info->beacon.head_len - ies; 24296a7c9badSJouni Malinen 24306a7c9badSJouni Malinen if (info->ssid == NULL) 24316a7c9badSJouni Malinen return -EINVAL; 24323450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 24333450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 24346a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 243567cd22e4SThomas Pedersen hidden = true; 243667cd22e4SThomas Pedersen 243767cd22e4SThomas Pedersen res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 243867cd22e4SThomas Pedersen if (res) 243967cd22e4SThomas Pedersen return res; 24406a7c9badSJouni Malinen 2441be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2442be5abaafSVasanthakumar Thiagarajan if (ret) 2443be5abaafSVasanthakumar Thiagarajan return ret; 24446a7c9badSJouni Malinen 24456a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 24466a7c9badSJouni Malinen 24476a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 24486a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 24496a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 24506a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24516a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 24526a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24536a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 24546a7c9badSJouni Malinen break; 24556a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 24566a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 24576a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 24586a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 24596a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 24606a7c9badSJouni Malinen break; 24616a7c9badSJouni Malinen } 24626a7c9badSJouni Malinen } 24636a7c9badSJouni Malinen if (p.auth_mode == 0) 24646a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 24653450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 24666a7c9badSJouni Malinen 24676a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 24686a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 24696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24706a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24716a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 24726a7c9badSJouni Malinen break; 24736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24746a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 24756a7c9badSJouni Malinen break; 24766a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24776a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 24786a7c9badSJouni Malinen break; 2479b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2480b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2481b8214df1SDai Shuibing break; 24826a7c9badSJouni Malinen } 24836a7c9badSJouni Malinen } 2484229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 24856a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2486240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2487229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2488240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 24896a7c9badSJouni Malinen 24906a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 24916a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 24926a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 24936a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 24946a7c9badSJouni Malinen break; 24956a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 24966a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 24976a7c9badSJouni Malinen break; 24986a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 24996a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 25006a7c9badSJouni Malinen break; 2501b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2502b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2503b8214df1SDai Shuibing break; 25046a7c9badSJouni Malinen default: 25056a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 25066a7c9badSJouni Malinen break; 25076a7c9badSJouni Malinen } 2508240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 25096a7c9badSJouni Malinen 25106a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2511f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 25126a7c9badSJouni Malinen 25133450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 25143450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 25153450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2516cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 25176a7c9badSJouni Malinen 2518c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2519c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2520c1762a3fSThirumalai Pachamuthu if (res < 0) 2521c1762a3fSThirumalai Pachamuthu return res; 2522c1762a3fSThirumalai Pachamuthu 25233ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 25243ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 25253ca9d1fcSAarthi Thiruvengadam } else { 25263ca9d1fcSAarthi Thiruvengadam /* 25273ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 25283ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 25293ca9d1fcSAarthi Thiruvengadam */ 25303ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 25313ca9d1fcSAarthi Thiruvengadam } 25323ca9d1fcSAarthi Thiruvengadam 2533334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 25349a5b1318SJouni Malinen if (res < 0) 25359a5b1318SJouni Malinen return res; 25369a5b1318SJouni Malinen 25379a5b1318SJouni Malinen return 0; 25386a7c9badSJouni Malinen } 25396a7c9badSJouni Malinen 25408860020eSJohannes Berg static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 25418860020eSJohannes Berg struct cfg80211_beacon_data *beacon) 25426a7c9badSJouni Malinen { 25438860020eSJohannes Berg struct ath6kl_vif *vif = netdev_priv(dev); 25448860020eSJohannes Berg 25458860020eSJohannes Berg if (!ath6kl_cfg80211_ready(vif)) 25468860020eSJohannes Berg return -EIO; 25478860020eSJohannes Berg 25488860020eSJohannes Berg if (vif->next_mode != AP_NETWORK) 25498860020eSJohannes Berg return -EOPNOTSUPP; 25508860020eSJohannes Berg 25518860020eSJohannes Berg return ath6kl_set_ies(vif, beacon); 25526a7c9badSJouni Malinen } 25536a7c9badSJouni Malinen 25548860020eSJohannes Berg static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 25556a7c9badSJouni Malinen { 25566a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 255759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 25586a7c9badSJouni Malinen 2559f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 25606a7c9badSJouni Malinen return -EOPNOTSUPP; 256159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 25626a7c9badSJouni Malinen return -ENOTCONN; 25636a7c9badSJouni Malinen 2564334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 256559c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 25666a7c9badSJouni Malinen 25676a7c9badSJouni Malinen return 0; 25686a7c9badSJouni Malinen } 25696a7c9badSJouni Malinen 257033e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 257133e5308dSJouni Malinen 257233e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 257333e5308dSJouni Malinen u8 *mac) 257433e5308dSJouni Malinen { 257533e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 257633e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 257733e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 257833e5308dSJouni Malinen 257933e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 258033e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 258133e5308dSJouni Malinen } 258233e5308dSJouni Malinen 258323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 258423875136SJouni Malinen u8 *mac, struct station_parameters *params) 258523875136SJouni Malinen { 258623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2587f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 258823875136SJouni Malinen 2589f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 259023875136SJouni Malinen return -EOPNOTSUPP; 259123875136SJouni Malinen 259223875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 259323875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 259423875136SJouni Malinen return -EOPNOTSUPP; 259523875136SJouni Malinen 259623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2597334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2598334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2599334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2600334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 260123875136SJouni Malinen } 260223875136SJouni Malinen 260363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 260463fa1e0cSJouni Malinen struct net_device *dev, 260563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 260663fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 260763fa1e0cSJouni Malinen unsigned int duration, 260863fa1e0cSJouni Malinen u64 *cookie) 260963fa1e0cSJouni Malinen { 261063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2611334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 26121052261eSJouni Malinen u32 id; 261363fa1e0cSJouni Malinen 261463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 261563fa1e0cSJouni Malinen * return -EBUSY */ 26161052261eSJouni Malinen id = ++vif->last_roc_id; 26171052261eSJouni Malinen if (id == 0) { 26181052261eSJouni Malinen /* Do not use 0 as the cookie value */ 26191052261eSJouni Malinen id = ++vif->last_roc_id; 26201052261eSJouni Malinen } 26211052261eSJouni Malinen *cookie = id; 262263fa1e0cSJouni Malinen 2623334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2624334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 262563fa1e0cSJouni Malinen } 262663fa1e0cSJouni Malinen 262763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 262863fa1e0cSJouni Malinen struct net_device *dev, 262963fa1e0cSJouni Malinen u64 cookie) 263063fa1e0cSJouni Malinen { 263163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2632334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 263363fa1e0cSJouni Malinen 26341052261eSJouni Malinen if (cookie != vif->last_roc_id) 263563fa1e0cSJouni Malinen return -ENOENT; 26361052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 263763fa1e0cSJouni Malinen 2638334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 263963fa1e0cSJouni Malinen } 264063fa1e0cSJouni Malinen 2641334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2642334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2643334234b5SVasanthakumar Thiagarajan unsigned int freq) 26448bdfbf40SJouni Malinen { 2645334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 26468bdfbf40SJouni Malinen const u8 *pos; 26478bdfbf40SJouni Malinen u8 *p2p; 26488bdfbf40SJouni Malinen int p2p_len; 26498bdfbf40SJouni Malinen int ret; 26508bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 26518bdfbf40SJouni Malinen 26528bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 26538bdfbf40SJouni Malinen 26548bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 26558bdfbf40SJouni Malinen 26568bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 26578bdfbf40SJouni Malinen if (p2p == NULL) 26588bdfbf40SJouni Malinen return -ENOMEM; 26598bdfbf40SJouni Malinen p2p_len = 0; 26608bdfbf40SJouni Malinen 26618bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 26628bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 26638bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 26648bdfbf40SJouni Malinen break; 26658bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 26668bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 26678bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 26688bdfbf40SJouni Malinen } 26698bdfbf40SJouni Malinen pos += 2 + pos[1]; 26708bdfbf40SJouni Malinen } 26718bdfbf40SJouni Malinen 2672334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2673334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 26748bdfbf40SJouni Malinen kfree(p2p); 26758bdfbf40SJouni Malinen return ret; 26768bdfbf40SJouni Malinen } 26778bdfbf40SJouni Malinen 2678d0ff7383SNaveen Gangadharan static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2679d0ff7383SNaveen Gangadharan u32 id, 2680d0ff7383SNaveen Gangadharan u32 freq, 2681d0ff7383SNaveen Gangadharan u32 wait, 2682d0ff7383SNaveen Gangadharan const u8 *buf, 2683d0ff7383SNaveen Gangadharan size_t len, 2684d0ff7383SNaveen Gangadharan bool *more_data, 2685d0ff7383SNaveen Gangadharan bool no_cck) 2686d0ff7383SNaveen Gangadharan { 2687d0ff7383SNaveen Gangadharan struct ieee80211_mgmt *mgmt; 2688d0ff7383SNaveen Gangadharan struct ath6kl_sta *conn; 2689d0ff7383SNaveen Gangadharan bool is_psq_empty = false; 2690d0ff7383SNaveen Gangadharan struct ath6kl_mgmt_buff *mgmt_buf; 2691d0ff7383SNaveen Gangadharan size_t mgmt_buf_size; 2692d0ff7383SNaveen Gangadharan struct ath6kl *ar = vif->ar; 2693d0ff7383SNaveen Gangadharan 2694d0ff7383SNaveen Gangadharan mgmt = (struct ieee80211_mgmt *) buf; 2695d0ff7383SNaveen Gangadharan if (is_multicast_ether_addr(mgmt->da)) 2696d0ff7383SNaveen Gangadharan return false; 2697d0ff7383SNaveen Gangadharan 2698d0ff7383SNaveen Gangadharan conn = ath6kl_find_sta(vif, mgmt->da); 2699d0ff7383SNaveen Gangadharan if (!conn) 2700d0ff7383SNaveen Gangadharan return false; 2701d0ff7383SNaveen Gangadharan 2702d0ff7383SNaveen Gangadharan if (conn->sta_flags & STA_PS_SLEEP) { 2703d0ff7383SNaveen Gangadharan if (!(conn->sta_flags & STA_PS_POLLED)) { 2704d0ff7383SNaveen Gangadharan /* Queue the frames if the STA is sleeping */ 2705d0ff7383SNaveen Gangadharan mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2706d0ff7383SNaveen Gangadharan mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2707d0ff7383SNaveen Gangadharan if (!mgmt_buf) 2708d0ff7383SNaveen Gangadharan return false; 2709d0ff7383SNaveen Gangadharan 2710d0ff7383SNaveen Gangadharan INIT_LIST_HEAD(&mgmt_buf->list); 2711d0ff7383SNaveen Gangadharan mgmt_buf->id = id; 2712d0ff7383SNaveen Gangadharan mgmt_buf->freq = freq; 2713d0ff7383SNaveen Gangadharan mgmt_buf->wait = wait; 2714d0ff7383SNaveen Gangadharan mgmt_buf->len = len; 2715d0ff7383SNaveen Gangadharan mgmt_buf->no_cck = no_cck; 2716d0ff7383SNaveen Gangadharan memcpy(mgmt_buf->buf, buf, len); 2717d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2718d0ff7383SNaveen Gangadharan is_psq_empty = skb_queue_empty(&conn->psq) && 2719d0ff7383SNaveen Gangadharan (conn->mgmt_psq_len == 0); 2720d0ff7383SNaveen Gangadharan list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 2721d0ff7383SNaveen Gangadharan conn->mgmt_psq_len++; 2722d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2723d0ff7383SNaveen Gangadharan 2724d0ff7383SNaveen Gangadharan /* 2725d0ff7383SNaveen Gangadharan * If this is the first pkt getting queued 2726d0ff7383SNaveen Gangadharan * for this STA, update the PVB for this 2727d0ff7383SNaveen Gangadharan * STA. 2728d0ff7383SNaveen Gangadharan */ 2729d0ff7383SNaveen Gangadharan if (is_psq_empty) 2730d0ff7383SNaveen Gangadharan ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 2731d0ff7383SNaveen Gangadharan conn->aid, 1); 2732d0ff7383SNaveen Gangadharan return true; 2733d0ff7383SNaveen Gangadharan } 2734d0ff7383SNaveen Gangadharan 2735d0ff7383SNaveen Gangadharan /* 2736d0ff7383SNaveen Gangadharan * This tx is because of a PsPoll. 2737d0ff7383SNaveen Gangadharan * Determine if MoreData bit has to be set. 2738d0ff7383SNaveen Gangadharan */ 2739d0ff7383SNaveen Gangadharan spin_lock_bh(&conn->psq_lock); 2740d0ff7383SNaveen Gangadharan if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 2741d0ff7383SNaveen Gangadharan *more_data = true; 2742d0ff7383SNaveen Gangadharan spin_unlock_bh(&conn->psq_lock); 2743d0ff7383SNaveen Gangadharan } 2744d0ff7383SNaveen Gangadharan 2745d0ff7383SNaveen Gangadharan return false; 2746d0ff7383SNaveen Gangadharan } 2747d0ff7383SNaveen Gangadharan 27488a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 27498a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 27508a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 27518a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2752e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2753e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 27548a6c8060SJouni Malinen { 27558a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 275659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 27578a6c8060SJouni Malinen u32 id; 27588bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 2759d0ff7383SNaveen Gangadharan bool more_data, queued; 27608bdfbf40SJouni Malinen 27618bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 27628bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2763f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 27648bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 27658bdfbf40SJouni Malinen /* 27668bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 27678bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 27688bdfbf40SJouni Malinen */ 27698bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2770334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 27718bdfbf40SJouni Malinen chan->center_freq); 27728bdfbf40SJouni Malinen } 27738a6c8060SJouni Malinen 2774cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27758a6c8060SJouni Malinen if (id == 0) { 27768a6c8060SJouni Malinen /* 27778a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 27788a6c8060SJouni Malinen * used for the command. 27798a6c8060SJouni Malinen */ 2780cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 27818a6c8060SJouni Malinen } 27828a6c8060SJouni Malinen 27838a6c8060SJouni Malinen *cookie = id; 27843ca9d1fcSAarthi Thiruvengadam 2785d0ff7383SNaveen Gangadharan /* AP mode Power saving processing */ 2786d0ff7383SNaveen Gangadharan if (vif->nw_type == AP_NETWORK) { 2787d0ff7383SNaveen Gangadharan queued = ath6kl_mgmt_powersave_ap(vif, 2788d0ff7383SNaveen Gangadharan id, chan->center_freq, 2789d0ff7383SNaveen Gangadharan wait, buf, 2790d0ff7383SNaveen Gangadharan len, &more_data, no_cck); 2791d0ff7383SNaveen Gangadharan if (queued) 2792d0ff7383SNaveen Gangadharan return 0; 2793d0ff7383SNaveen Gangadharan } 2794d0ff7383SNaveen Gangadharan 27953ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 27963ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 27973ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 27983ca9d1fcSAarthi Thiruvengadam } 27998a6c8060SJouni Malinen 2800ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2801ae32c30aSJouni Malinen struct net_device *dev, 2802ae32c30aSJouni Malinen u16 frame_type, bool reg) 2803ae32c30aSJouni Malinen { 2804cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2805ae32c30aSJouni Malinen 2806ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2807ae32c30aSJouni Malinen __func__, frame_type, reg); 2808ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2809ae32c30aSJouni Malinen /* 2810ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2811ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2812ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2813ae32c30aSJouni Malinen */ 2814cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2815ae32c30aSJouni Malinen } 2816ae32c30aSJouni Malinen } 2817ae32c30aSJouni Malinen 281810509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 281910509f90SKalle Valo struct net_device *dev, 282010509f90SKalle Valo struct cfg80211_sched_scan_request *request) 282110509f90SKalle Valo { 282210509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 282310509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 282410509f90SKalle Valo u16 interval; 282510509f90SKalle Valo int ret; 282610509f90SKalle Valo u8 i; 282710509f90SKalle Valo 282810509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 282910509f90SKalle Valo return -EIO; 283010509f90SKalle Valo 283110509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 283210509f90SKalle Valo return -EBUSY; 283310509f90SKalle Valo 283410509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 283510509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 283610509f90SKalle Valo i, DISABLE_SSID_FLAG, 283710509f90SKalle Valo 0, NULL); 283810509f90SKalle Valo } 283910509f90SKalle Valo 284010509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 284110509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 284210509f90SKalle Valo 284310509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 284410509f90SKalle Valo interval, interval, 284510509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 284610509f90SKalle Valo 284710509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 284810509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 284910509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 285010509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 285110509f90SKalle Valo request->ssids[i].ssid_len, 285210509f90SKalle Valo request->ssids[i].ssid); 285310509f90SKalle Valo } 285410509f90SKalle Valo } 285510509f90SKalle Valo 285610509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 285710509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 285810509f90SKalle Valo WOW_FILTER_SSID, 285910509f90SKalle Valo WOW_HOST_REQ_DELAY); 286010509f90SKalle Valo if (ret) { 286110509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 286210509f90SKalle Valo return ret; 286310509f90SKalle Valo } 286410509f90SKalle Valo 286510509f90SKalle Valo /* this also clears IE in fw if it's not set */ 286610509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 286710509f90SKalle Valo WMI_FRAME_PROBE_REQ, 286810509f90SKalle Valo request->ie, request->ie_len); 286910509f90SKalle Valo if (ret) { 287010509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 287110509f90SKalle Valo ret); 287210509f90SKalle Valo return ret; 287310509f90SKalle Valo } 287410509f90SKalle Valo 287510509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 287610509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 287710509f90SKalle Valo if (ret) { 287810509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 287910509f90SKalle Valo ret); 288010509f90SKalle Valo return ret; 288110509f90SKalle Valo } 288210509f90SKalle Valo 288310509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 288410509f90SKalle Valo 288510509f90SKalle Valo return ret; 288610509f90SKalle Valo } 288710509f90SKalle Valo 288810509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 288910509f90SKalle Valo struct net_device *dev) 289010509f90SKalle Valo { 289110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 289210509f90SKalle Valo bool stopped; 289310509f90SKalle Valo 289410509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 289510509f90SKalle Valo 289610509f90SKalle Valo if (!stopped) 289710509f90SKalle Valo return -EIO; 289810509f90SKalle Valo 289910509f90SKalle Valo return 0; 290010509f90SKalle Valo } 290110509f90SKalle Valo 2902f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2903f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2904f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2905f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2906f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2907f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2908f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2909f80574aeSJouni Malinen }, 2910ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2911ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2912ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2913ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2914ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2915ba1f6fe3SJouni Malinen }, 2916f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2917f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2918f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2919f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2920f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2921f80574aeSJouni Malinen }, 2922f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2923f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2924f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2925f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2926f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2927f80574aeSJouni Malinen }, 2928f80574aeSJouni Malinen }; 2929f80574aeSJouni Malinen 2930bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 293155055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 293255055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2933bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2934bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2935bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2936bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2937bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2938bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2939bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2940bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2941bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2942bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2943bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2944bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2945bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2946bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2947bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2948bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2949bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2950bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2951003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2952abcb344bSKalle Valo #ifdef CONFIG_PM 295352d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 295452d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2955abcb344bSKalle Valo #endif 29566a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 29578860020eSJohannes Berg .start_ap = ath6kl_start_ap, 29588860020eSJohannes Berg .change_beacon = ath6kl_change_beacon, 29598860020eSJohannes Berg .stop_ap = ath6kl_stop_ap, 296033e5308dSJouni Malinen .del_station = ath6kl_del_station, 296123875136SJouni Malinen .change_station = ath6kl_change_station, 296263fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 296363fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 29648a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2965ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 296610509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 296710509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2968bdcd8170SKalle Valo }; 2969bdcd8170SKalle Valo 29707125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2971ec4b7f60SKalle Valo { 297210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 297310509f90SKalle Valo 2974ec4b7f60SKalle Valo switch (vif->sme_state) { 2975c97a31b0SKalle Valo case SME_DISCONNECTED: 2976c97a31b0SKalle Valo break; 2977ec4b7f60SKalle Valo case SME_CONNECTING: 2978ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2979ec4b7f60SKalle Valo NULL, 0, 2980ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2981ec4b7f60SKalle Valo GFP_KERNEL); 2982ec4b7f60SKalle Valo break; 2983ec4b7f60SKalle Valo case SME_CONNECTED: 2984ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2985ec4b7f60SKalle Valo break; 2986ec4b7f60SKalle Valo } 2987ec4b7f60SKalle Valo 2988ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2989ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 29907125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2991ec4b7f60SKalle Valo 2992ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 29931f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 29941f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2995ec4b7f60SKalle Valo 2996ec4b7f60SKalle Valo /* disable scanning */ 29977125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 29987125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 29997125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 3000ec4b7f60SKalle Valo 3001ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 3002ec4b7f60SKalle Valo } 3003ec4b7f60SKalle Valo 30047125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 30057125f01dSKalle Valo { 30067125f01dSKalle Valo struct ath6kl_vif *vif; 30077125f01dSKalle Valo 30087125f01dSKalle Valo vif = ath6kl_vif_first(ar); 30097125f01dSKalle Valo if (!vif) { 30107125f01dSKalle Valo /* save the current power mode before enabling power save */ 30117125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 30127125f01dSKalle Valo 30137125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 30147125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 30157125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 30167125f01dSKalle Valo return; 30177125f01dSKalle Valo } 30187125f01dSKalle Valo 30197125f01dSKalle Valo /* 30207125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 30217125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 30227125f01dSKalle Valo * sleeps. 30237125f01dSKalle Valo */ 30247125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 30257125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 30267125f01dSKalle Valo } 30277125f01dSKalle Valo 3028c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 30298dafb70eSVasanthakumar Thiagarajan { 30307baef812SVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif); 30312132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 30328dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 30338dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 30348dafb70eSVasanthakumar Thiagarajan } 30358dafb70eSVasanthakumar Thiagarajan 3036de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3037108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 303810509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 303910509f90SKalle Valo (unsigned long) vif); 304010509f90SKalle Valo 3041de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 3042478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 30438dafb70eSVasanthakumar Thiagarajan 304480abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 304580abaf9bSVasanthakumar Thiagarajan 30468dafb70eSVasanthakumar Thiagarajan return 0; 30478dafb70eSVasanthakumar Thiagarajan } 30488dafb70eSVasanthakumar Thiagarajan 3049c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 30508dafb70eSVasanthakumar Thiagarajan { 305155055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 305280abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 305355055976SVasanthakumar Thiagarajan 30542132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 3055108438bcSVasanthakumar Thiagarajan 305655055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 305755055976SVasanthakumar Thiagarajan 305855055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 305955055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 306055055976SVasanthakumar Thiagarajan 306180abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 306280abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 306380abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 306480abaf9bSVasanthakumar Thiagarajan } 306580abaf9bSVasanthakumar Thiagarajan 306627929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 306755055976SVasanthakumar Thiagarajan 306855055976SVasanthakumar Thiagarajan ar->num_vif--; 30698dafb70eSVasanthakumar Thiagarajan } 30708dafb70eSVasanthakumar Thiagarajan 30718dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 307255055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 307355055976SVasanthakumar Thiagarajan u8 nw_type) 30748dafb70eSVasanthakumar Thiagarajan { 30758dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 3076108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 30778dafb70eSVasanthakumar Thiagarajan 307855055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 30798dafb70eSVasanthakumar Thiagarajan if (!ndev) 30808dafb70eSVasanthakumar Thiagarajan return NULL; 30818dafb70eSVasanthakumar Thiagarajan 3082108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 3083108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 3084108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 3085108438bcSVasanthakumar Thiagarajan vif->ar = ar; 3086108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 3087108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3088108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 3089108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 3090334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 309155055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 30928f46fccdSRaja Mani vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3093ce0dc0cfSRaja Mani vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 30948dafb70eSVasanthakumar Thiagarajan 309555055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 309655055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 309755055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 309855055976SVasanthakumar Thiagarajan 0x2; 309955055976SVasanthakumar Thiagarajan 31008dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 31018dafb70eSVasanthakumar Thiagarajan 3102e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 31038dafb70eSVasanthakumar Thiagarajan 3104c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 31058dafb70eSVasanthakumar Thiagarajan goto err; 31068dafb70eSVasanthakumar Thiagarajan 310727929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 31088dafb70eSVasanthakumar Thiagarajan goto err; 31098dafb70eSVasanthakumar Thiagarajan 311055055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 311114ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 311259c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 31138dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 311459c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 31158dafb70eSVasanthakumar Thiagarajan 311655055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 311755055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 311855055976SVasanthakumar Thiagarajan 311911f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 3120990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 312111f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 3122990bd915SVasanthakumar Thiagarajan 31238dafb70eSVasanthakumar Thiagarajan return ndev; 31248dafb70eSVasanthakumar Thiagarajan 31258dafb70eSVasanthakumar Thiagarajan err: 312627929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 312727929723SVasanthakumar Thiagarajan free_netdev(ndev); 3128bdcd8170SKalle Valo return NULL; 3129bdcd8170SKalle Valo } 3130bdcd8170SKalle Valo 313146d33a21SKalle Valo int ath6kl_cfg80211_init(struct ath6kl *ar) 313246d33a21SKalle Valo { 313346d33a21SKalle Valo struct wiphy *wiphy = ar->wiphy; 313446d33a21SKalle Valo int ret; 313546d33a21SKalle Valo 313646d33a21SKalle Valo wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 313746d33a21SKalle Valo 313846d33a21SKalle Valo wiphy->max_remain_on_channel_duration = 5000; 313946d33a21SKalle Valo 314046d33a21SKalle Valo /* set device pointer for wiphy */ 314146d33a21SKalle Valo set_wiphy_dev(wiphy, ar->dev); 314246d33a21SKalle Valo 314346d33a21SKalle Valo wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 314446d33a21SKalle Valo BIT(NL80211_IFTYPE_ADHOC) | 314546d33a21SKalle Valo BIT(NL80211_IFTYPE_AP); 314646d33a21SKalle Valo if (ar->p2p) { 314746d33a21SKalle Valo wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 314846d33a21SKalle Valo BIT(NL80211_IFTYPE_P2P_CLIENT); 314946d33a21SKalle Valo } 315046d33a21SKalle Valo 315146d33a21SKalle Valo /* max num of ssids that can be probed during scanning */ 315246d33a21SKalle Valo wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 315346d33a21SKalle Valo wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 315446d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 315546d33a21SKalle Valo wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 315646d33a21SKalle Valo wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 315746d33a21SKalle Valo 315846d33a21SKalle Valo wiphy->cipher_suites = cipher_suites; 315946d33a21SKalle Valo wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 316046d33a21SKalle Valo 316146d33a21SKalle Valo wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 316246d33a21SKalle Valo WIPHY_WOWLAN_DISCONNECT | 316346d33a21SKalle Valo WIPHY_WOWLAN_GTK_REKEY_FAILURE | 316446d33a21SKalle Valo WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 316546d33a21SKalle Valo WIPHY_WOWLAN_EAP_IDENTITY_REQ | 316646d33a21SKalle Valo WIPHY_WOWLAN_4WAY_HANDSHAKE; 316746d33a21SKalle Valo wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 316846d33a21SKalle Valo wiphy->wowlan.pattern_min_len = 1; 316946d33a21SKalle Valo wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 317046d33a21SKalle Valo 317146d33a21SKalle Valo wiphy->max_sched_scan_ssids = 10; 317246d33a21SKalle Valo 3173f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3174f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAVE_AP_SME | 3175f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3176f2afdac7SVasanthakumar Thiagarajan WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3177f2afdac7SVasanthakumar Thiagarajan 3178f2afdac7SVasanthakumar Thiagarajan if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3179f2afdac7SVasanthakumar Thiagarajan ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3180f2afdac7SVasanthakumar Thiagarajan 3181f2afdac7SVasanthakumar Thiagarajan ar->wiphy->probe_resp_offload = 3182f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3183f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3184f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P | 3185f2afdac7SVasanthakumar Thiagarajan NL80211_PROBE_RESP_OFFLOAD_SUPPORT_80211U; 3186f2afdac7SVasanthakumar Thiagarajan 318746d33a21SKalle Valo ret = wiphy_register(wiphy); 318846d33a21SKalle Valo if (ret < 0) { 318946d33a21SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 319046d33a21SKalle Valo return ret; 319146d33a21SKalle Valo } 319246d33a21SKalle Valo 3193e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = true; 3194e5348a1eSVasanthakumar Thiagarajan 319546d33a21SKalle Valo return 0; 319646d33a21SKalle Valo } 319746d33a21SKalle Valo 319846d33a21SKalle Valo void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3199bdcd8170SKalle Valo { 3200be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 3201e5348a1eSVasanthakumar Thiagarajan 3202e5348a1eSVasanthakumar Thiagarajan ar->wiphy_registered = false; 320345eaa78fSKalle Valo } 320446d33a21SKalle Valo 320545eaa78fSKalle Valo struct ath6kl *ath6kl_cfg80211_create(void) 320645eaa78fSKalle Valo { 320745eaa78fSKalle Valo struct ath6kl *ar; 320845eaa78fSKalle Valo struct wiphy *wiphy; 320945eaa78fSKalle Valo 321045eaa78fSKalle Valo /* create a new wiphy for use with cfg80211 */ 321145eaa78fSKalle Valo wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 321245eaa78fSKalle Valo 321345eaa78fSKalle Valo if (!wiphy) { 321445eaa78fSKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 321545eaa78fSKalle Valo return NULL; 321645eaa78fSKalle Valo } 321745eaa78fSKalle Valo 321845eaa78fSKalle Valo ar = wiphy_priv(wiphy); 321945eaa78fSKalle Valo ar->wiphy = wiphy; 322045eaa78fSKalle Valo 322145eaa78fSKalle Valo return ar; 322245eaa78fSKalle Valo } 322345eaa78fSKalle Valo 322445eaa78fSKalle Valo /* Note: ar variable must not be accessed after calling this! */ 322545eaa78fSKalle Valo void ath6kl_cfg80211_destroy(struct ath6kl *ar) 322645eaa78fSKalle Valo { 32271d2a4456SVasanthakumar Thiagarajan int i; 32281d2a4456SVasanthakumar Thiagarajan 32291d2a4456SVasanthakumar Thiagarajan for (i = 0; i < AP_MAX_NUM_STA; i++) 32301d2a4456SVasanthakumar Thiagarajan kfree(ar->sta_list[i].aggr_conn); 32311d2a4456SVasanthakumar Thiagarajan 3232be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 3233bdcd8170SKalle Valo } 323445eaa78fSKalle Valo 3235