1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 3bdcd8170SKalle Valo * 4bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 5bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 6bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 7bdcd8170SKalle Valo * 8bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15bdcd8170SKalle Valo */ 16bdcd8170SKalle Valo 176eb07cafSPaul Gortmaker #include <linux/moduleparam.h> 18c08631c6SRaja Mani #include <linux/inetdevice.h> 196eb07cafSPaul Gortmaker 20bdcd8170SKalle Valo #include "core.h" 21bdcd8170SKalle Valo #include "cfg80211.h" 22bdcd8170SKalle Valo #include "debug.h" 23abcb344bSKalle Valo #include "hif-ops.h" 24003353b0SKalle Valo #include "testmode.h" 25bdcd8170SKalle Valo 266bbc7c35SJouni Malinen static unsigned int ath6kl_p2p; 276bbc7c35SJouni Malinen 286bbc7c35SJouni Malinen module_param(ath6kl_p2p, uint, 0644); 296bbc7c35SJouni Malinen 30bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31bdcd8170SKalle Valo .bitrate = (_rate), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .hw_value = (_rateid), \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = (_freq), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 46bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 47bdcd8170SKalle Valo .hw_value = (_channel), \ 48bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 49bdcd8170SKalle Valo .flags = (_flags), \ 50bdcd8170SKalle Valo .max_antenna_gain = 0, \ 51bdcd8170SKalle Valo .max_power = 30, \ 52bdcd8170SKalle Valo } 53bdcd8170SKalle Valo 54bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 55bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 56bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 57bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 58bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 59bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 60bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 61bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 62bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 63bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 64bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 65bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 66bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 67bdcd8170SKalle Valo }; 68bdcd8170SKalle Valo 69bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 70bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 71bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 72bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 73bdcd8170SKalle Valo 74bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 75bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 76bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 77bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 78bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 79bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 80bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 81bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 82bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 83bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 84bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 85bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 86bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 87bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 88bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 89bdcd8170SKalle Valo }; 90bdcd8170SKalle Valo 91bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 92bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 93bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 94bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 95bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 96bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 97bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 98bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 99bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 100bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 101bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 102bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 103bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 104bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 105bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 106bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 107bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 108bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 109bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 110bdcd8170SKalle Valo CHAN5G(216, 0), 111bdcd8170SKalle Valo }; 112bdcd8170SKalle Valo 113bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 114bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 115bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 116bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 117bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 118bdcd8170SKalle Valo }; 119bdcd8170SKalle Valo 120bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 121bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 122bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 123bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 124bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 125bdcd8170SKalle Valo }; 126bdcd8170SKalle Valo 127837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 128837cb97eSJouni Malinen 12910509f90SKalle Valo /* returns true if scheduled scan was stopped */ 13010509f90SKalle Valo static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 13110509f90SKalle Valo { 13210509f90SKalle Valo struct ath6kl *ar = vif->ar; 13310509f90SKalle Valo 13410509f90SKalle Valo if (ar->state != ATH6KL_STATE_SCHED_SCAN) 13510509f90SKalle Valo return false; 13610509f90SKalle Valo 13710509f90SKalle Valo del_timer_sync(&vif->sched_scan_timer); 13810509f90SKalle Valo 13910509f90SKalle Valo ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 14010509f90SKalle Valo ATH6KL_HOST_MODE_AWAKE); 14110509f90SKalle Valo 14210509f90SKalle Valo ar->state = ATH6KL_STATE_ON; 14310509f90SKalle Valo 14410509f90SKalle Valo return true; 14510509f90SKalle Valo } 14610509f90SKalle Valo 14710509f90SKalle Valo static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 14810509f90SKalle Valo { 14910509f90SKalle Valo struct ath6kl *ar = vif->ar; 15010509f90SKalle Valo bool stopped; 15110509f90SKalle Valo 15210509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 15310509f90SKalle Valo 15410509f90SKalle Valo if (!stopped) 15510509f90SKalle Valo return; 15610509f90SKalle Valo 15710509f90SKalle Valo cfg80211_sched_scan_stopped(ar->wiphy); 15810509f90SKalle Valo } 15910509f90SKalle Valo 160240d2799SVasanthakumar Thiagarajan static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 161bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 162bdcd8170SKalle Valo { 163bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 164bdcd8170SKalle Valo 165bdcd8170SKalle Valo if (!wpa_version) { 1663450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 167bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1683450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 169bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1703450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 171bdcd8170SKalle Valo } else { 172bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 173bdcd8170SKalle Valo return -ENOTSUPP; 174bdcd8170SKalle Valo } 175bdcd8170SKalle Valo 176bdcd8170SKalle Valo return 0; 177bdcd8170SKalle Valo } 178bdcd8170SKalle Valo 179240d2799SVasanthakumar Thiagarajan static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 180bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 181bdcd8170SKalle Valo { 182bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 183bdcd8170SKalle Valo 184bdcd8170SKalle Valo switch (auth_type) { 185bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1863450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 187bdcd8170SKalle Valo break; 188bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1893450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 190bdcd8170SKalle Valo break; 191bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1923450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo 195bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 1963450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 197bdcd8170SKalle Valo break; 198bdcd8170SKalle Valo 199bdcd8170SKalle Valo default: 200bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 201bdcd8170SKalle Valo return -ENOTSUPP; 202bdcd8170SKalle Valo } 203bdcd8170SKalle Valo 204bdcd8170SKalle Valo return 0; 205bdcd8170SKalle Valo } 206bdcd8170SKalle Valo 207240d2799SVasanthakumar Thiagarajan static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 208bdcd8170SKalle Valo { 2093450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 2103450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 2113450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 212bdcd8170SKalle Valo 213bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 214bdcd8170SKalle Valo __func__, cipher, ucast); 215bdcd8170SKalle Valo 216bdcd8170SKalle Valo switch (cipher) { 217bdcd8170SKalle Valo case 0: 218bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 219bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 220bdcd8170SKalle Valo *ar_cipher_len = 0; 221bdcd8170SKalle Valo break; 222bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 223bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 224bdcd8170SKalle Valo *ar_cipher_len = 5; 225bdcd8170SKalle Valo break; 226bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 227bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 228bdcd8170SKalle Valo *ar_cipher_len = 13; 229bdcd8170SKalle Valo break; 230bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 231bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 232bdcd8170SKalle Valo *ar_cipher_len = 0; 233bdcd8170SKalle Valo break; 234bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 235bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 236bdcd8170SKalle Valo *ar_cipher_len = 0; 237bdcd8170SKalle Valo break; 2385e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2395e07021eSDai Shuibing *ar_cipher = WAPI_CRYPT; 2405e07021eSDai Shuibing *ar_cipher_len = 0; 2415e07021eSDai Shuibing break; 242bdcd8170SKalle Valo default: 243bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 244bdcd8170SKalle Valo return -ENOTSUPP; 245bdcd8170SKalle Valo } 246bdcd8170SKalle Valo 247bdcd8170SKalle Valo return 0; 248bdcd8170SKalle Valo } 249bdcd8170SKalle Valo 250240d2799SVasanthakumar Thiagarajan static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 251bdcd8170SKalle Valo { 252bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 253bdcd8170SKalle Valo 254bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2553450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2563450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2573450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2583450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 259837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2603450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2613450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2623450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2633450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 264bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2653450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 266bdcd8170SKalle Valo } 267bdcd8170SKalle Valo } 268bdcd8170SKalle Valo 269990bd915SVasanthakumar Thiagarajan static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 270bdcd8170SKalle Valo { 271990bd915SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 27259c98449SVasanthakumar Thiagarajan 273bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 274bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 275bdcd8170SKalle Valo return false; 276bdcd8170SKalle Valo } 277bdcd8170SKalle Valo 27859c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 279bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 280bdcd8170SKalle Valo return false; 281bdcd8170SKalle Valo } 282bdcd8170SKalle Valo 283bdcd8170SKalle Valo return true; 284bdcd8170SKalle Valo } 285bdcd8170SKalle Valo 2866981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2876981ffdcSKevin Fang { 2886981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2896981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2906981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2916981ffdcSKevin Fang } 2926981ffdcSKevin Fang 2936981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2946981ffdcSKevin Fang { 2956981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2966981ffdcSKevin Fang } 2976981ffdcSKevin Fang 29863541212SAarthi Thiruvengadam static bool ath6kl_is_wps_ie(const u8 *pos) 29963541212SAarthi Thiruvengadam { 30063541212SAarthi Thiruvengadam return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 30163541212SAarthi Thiruvengadam pos[1] >= 4 && 30263541212SAarthi Thiruvengadam pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 30363541212SAarthi Thiruvengadam pos[5] == 0x04); 30463541212SAarthi Thiruvengadam } 30563541212SAarthi Thiruvengadam 306334234b5SVasanthakumar Thiagarajan static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 3076981ffdcSKevin Fang size_t ies_len) 3086981ffdcSKevin Fang { 309334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 3106981ffdcSKevin Fang const u8 *pos; 3116981ffdcSKevin Fang u8 *buf = NULL; 3126981ffdcSKevin Fang size_t len = 0; 3136981ffdcSKevin Fang int ret; 3146981ffdcSKevin Fang 3156981ffdcSKevin Fang /* 31663541212SAarthi Thiruvengadam * Clear previously set flag 31763541212SAarthi Thiruvengadam */ 31863541212SAarthi Thiruvengadam 31963541212SAarthi Thiruvengadam ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 32063541212SAarthi Thiruvengadam 32163541212SAarthi Thiruvengadam /* 3226981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 3236981ffdcSKevin Fang */ 3246981ffdcSKevin Fang 3256981ffdcSKevin Fang if (ies && ies_len) { 3266981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 3276981ffdcSKevin Fang if (buf == NULL) 3286981ffdcSKevin Fang return -ENOMEM; 3296981ffdcSKevin Fang pos = ies; 3306981ffdcSKevin Fang 3316981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 3326981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 3336981ffdcSKevin Fang break; 3346981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 3356981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 3366981ffdcSKevin Fang len += 2 + pos[1]; 3376981ffdcSKevin Fang } 33863541212SAarthi Thiruvengadam 33963541212SAarthi Thiruvengadam if (ath6kl_is_wps_ie(pos)) 34063541212SAarthi Thiruvengadam ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 34163541212SAarthi Thiruvengadam 3426981ffdcSKevin Fang pos += 2 + pos[1]; 3436981ffdcSKevin Fang } 3446981ffdcSKevin Fang } 3456981ffdcSKevin Fang 346334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 347334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_REQ, buf, len); 3486981ffdcSKevin Fang kfree(buf); 3496981ffdcSKevin Fang return ret; 3506981ffdcSKevin Fang } 3516981ffdcSKevin Fang 35255055976SVasanthakumar Thiagarajan static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 35355055976SVasanthakumar Thiagarajan { 35455055976SVasanthakumar Thiagarajan switch (type) { 35555055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_STATION: 35655055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 35755055976SVasanthakumar Thiagarajan break; 35855055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_ADHOC: 35955055976SVasanthakumar Thiagarajan *nw_type = ADHOC_NETWORK; 36055055976SVasanthakumar Thiagarajan break; 36155055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_AP: 36255055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36355055976SVasanthakumar Thiagarajan break; 36455055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_CLIENT: 36555055976SVasanthakumar Thiagarajan *nw_type = INFRA_NETWORK; 36655055976SVasanthakumar Thiagarajan break; 36755055976SVasanthakumar Thiagarajan case NL80211_IFTYPE_P2P_GO: 36855055976SVasanthakumar Thiagarajan *nw_type = AP_NETWORK; 36955055976SVasanthakumar Thiagarajan break; 37055055976SVasanthakumar Thiagarajan default: 37155055976SVasanthakumar Thiagarajan ath6kl_err("invalid interface type %u\n", type); 37255055976SVasanthakumar Thiagarajan return -ENOTSUPP; 37355055976SVasanthakumar Thiagarajan } 37455055976SVasanthakumar Thiagarajan 37555055976SVasanthakumar Thiagarajan return 0; 37655055976SVasanthakumar Thiagarajan } 37755055976SVasanthakumar Thiagarajan 37855055976SVasanthakumar Thiagarajan static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 37955055976SVasanthakumar Thiagarajan u8 *if_idx, u8 *nw_type) 38055055976SVasanthakumar Thiagarajan { 38155055976SVasanthakumar Thiagarajan int i; 38255055976SVasanthakumar Thiagarajan 38355055976SVasanthakumar Thiagarajan if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 38455055976SVasanthakumar Thiagarajan return false; 38555055976SVasanthakumar Thiagarajan 38655055976SVasanthakumar Thiagarajan if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 38755055976SVasanthakumar Thiagarajan ar->num_vif)) 38855055976SVasanthakumar Thiagarajan return false; 38955055976SVasanthakumar Thiagarajan 39055055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_STATION || 39155055976SVasanthakumar Thiagarajan type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 39271f96ee6SKalle Valo for (i = 0; i < ar->vif_max; i++) { 39355055976SVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 39455055976SVasanthakumar Thiagarajan *if_idx = i; 39555055976SVasanthakumar Thiagarajan return true; 39655055976SVasanthakumar Thiagarajan } 39755055976SVasanthakumar Thiagarajan } 39855055976SVasanthakumar Thiagarajan } 39955055976SVasanthakumar Thiagarajan 4003226f68aSVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_P2P_CLIENT || 4013226f68aSVasanthakumar Thiagarajan type == NL80211_IFTYPE_P2P_GO) { 40271f96ee6SKalle Valo for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 4033226f68aSVasanthakumar Thiagarajan if ((ar->avail_idx_map >> i) & BIT(0)) { 4043226f68aSVasanthakumar Thiagarajan *if_idx = i; 4053226f68aSVasanthakumar Thiagarajan return true; 4063226f68aSVasanthakumar Thiagarajan } 4073226f68aSVasanthakumar Thiagarajan } 4083226f68aSVasanthakumar Thiagarajan } 4093226f68aSVasanthakumar Thiagarajan 41055055976SVasanthakumar Thiagarajan return false; 41155055976SVasanthakumar Thiagarajan } 41255055976SVasanthakumar Thiagarajan 413bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 414bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 415bdcd8170SKalle Valo { 416bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 41759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 418bdcd8170SKalle Valo int status; 4193ca9d1fcSAarthi Thiruvengadam u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 420bdcd8170SKalle Valo 42110509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 42210509f90SKalle Valo 42314ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTING; 424bdcd8170SKalle Valo 425990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 426bdcd8170SKalle Valo return -EIO; 427bdcd8170SKalle Valo 428bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 429bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 430bdcd8170SKalle Valo return -EBUSY; 431bdcd8170SKalle Valo } 432bdcd8170SKalle Valo 433bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 434bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 435bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 436bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 437bdcd8170SKalle Valo return -EINVAL; 438bdcd8170SKalle Valo } 439bdcd8170SKalle Valo 440bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 441bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 442bdcd8170SKalle Valo return -ERESTARTSYS; 443bdcd8170SKalle Valo } 444bdcd8170SKalle Valo 445bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 446bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 447bdcd8170SKalle Valo up(&ar->sem); 448bdcd8170SKalle Valo return -EBUSY; 449bdcd8170SKalle Valo } 450bdcd8170SKalle Valo 451bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 452bdcd8170SKalle Valo /* 453bdcd8170SKalle Valo * sleep until the command queue drains 454bdcd8170SKalle Valo */ 455bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 456bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 457bdcd8170SKalle Valo WMI_TIMEOUT); 458bdcd8170SKalle Valo if (signal_pending(current)) { 459bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 460bdcd8170SKalle Valo up(&ar->sem); 461bdcd8170SKalle Valo return -EINTR; 462bdcd8170SKalle Valo } 463bdcd8170SKalle Valo } 464bdcd8170SKalle Valo 465334234b5SVasanthakumar Thiagarajan status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 466743b4518SDan Carpenter if (status) { 467743b4518SDan Carpenter up(&ar->sem); 4686981ffdcSKevin Fang return status; 469743b4518SDan Carpenter } 4706e786cb1SJouni Malinen 4716e786cb1SJouni Malinen if (sme->ie == NULL || sme->ie_len == 0) 472542c519aSRaja Mani ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 4736981ffdcSKevin Fang 47459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 4753450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 4763450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 477cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = true; 478334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 479334234b5SVasanthakumar Thiagarajan vif->req_bssid, 480f74bac54SVasanthakumar Thiagarajan vif->ch_hint); 481bdcd8170SKalle Valo 482bdcd8170SKalle Valo up(&ar->sem); 483bdcd8170SKalle Valo if (status) { 484bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 485bdcd8170SKalle Valo return -EIO; 486bdcd8170SKalle Valo } 487bdcd8170SKalle Valo return 0; 4883450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 4893450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 490240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 491bdcd8170SKalle Valo } 492bdcd8170SKalle Valo 4933450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4943450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 4953450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 496bdcd8170SKalle Valo 497bdcd8170SKalle Valo if (sme->channel) 498f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 499bdcd8170SKalle Valo 5008c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 501bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 5028c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 503bdcd8170SKalle Valo 504240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 505bdcd8170SKalle Valo 506240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, sme->auth_type); 507bdcd8170SKalle Valo if (status) { 508bdcd8170SKalle Valo up(&ar->sem); 509bdcd8170SKalle Valo return status; 510bdcd8170SKalle Valo } 511bdcd8170SKalle Valo 512bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 513240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 514bdcd8170SKalle Valo else 515240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 516bdcd8170SKalle Valo 517240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 518bdcd8170SKalle Valo 519bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 520240d2799SVasanthakumar Thiagarajan ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 521bdcd8170SKalle Valo 522bdcd8170SKalle Valo if ((sme->key_len) && 5233450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 5243450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 525bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 526bdcd8170SKalle Valo 527792ecb33SVivek Natarajan if (sme->key_idx > WMI_MAX_KEY_INDEX) { 528bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 529bdcd8170SKalle Valo sme->key_idx); 530bdcd8170SKalle Valo up(&ar->sem); 531bdcd8170SKalle Valo return -ENOENT; 532bdcd8170SKalle Valo } 533bdcd8170SKalle Valo 5346f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 535bdcd8170SKalle Valo key->key_len = sme->key_len; 536bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5373450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5383450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 539bdcd8170SKalle Valo 540334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5413450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 542bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 543bdcd8170SKalle Valo key->key_len, 544f4bb9a6fSJouni Malinen NULL, 0, 545bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 546bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 547bdcd8170SKalle Valo } 548bdcd8170SKalle Valo 549bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 55059c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 551240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 552240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 553bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 554bdcd8170SKalle Valo up(&ar->sem); 555bdcd8170SKalle Valo return -EIO; 556bdcd8170SKalle Valo } 557bdcd8170SKalle Valo } 558bdcd8170SKalle Valo 559f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 560bdcd8170SKalle Valo 5613ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5623ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5633ca9d1fcSAarthi Thiruvengadam 564bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 565bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 566bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 567bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 568bdcd8170SKalle Valo __func__, 5693450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5703450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 571f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 572bdcd8170SKalle Valo 573cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 574334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5753450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5763450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5773450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5783450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5793450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 580f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 5813ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 582bdcd8170SKalle Valo 583bdcd8170SKalle Valo up(&ar->sem); 584bdcd8170SKalle Valo 585bdcd8170SKalle Valo if (status == -EINVAL) { 5863450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5873450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 588bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 589bdcd8170SKalle Valo return -ENOENT; 590bdcd8170SKalle Valo } else if (status) { 591bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 592bdcd8170SKalle Valo return -EIO; 593bdcd8170SKalle Valo } 594bdcd8170SKalle Valo 595bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5963450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5973450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 598de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 599bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 600bdcd8170SKalle Valo } 601bdcd8170SKalle Valo 602bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 60359c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 604bdcd8170SKalle Valo 605bdcd8170SKalle Valo return 0; 606bdcd8170SKalle Valo } 607bdcd8170SKalle Valo 6085e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6095e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6104eab6f4fSRaja Mani enum network_type nw_type, 6114eab6f4fSRaja Mani const u8 *bssid, 61201cac476SJouni Malinen struct ieee80211_channel *chan, 6135e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6145e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 61501cac476SJouni Malinen { 616240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 61701cac476SJouni Malinen struct cfg80211_bss *bss; 6184eab6f4fSRaja Mani u16 cap_mask, cap_val; 61901cac476SJouni Malinen u8 *ie; 62001cac476SJouni Malinen 6214eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6224eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6234eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6244eab6f4fSRaja Mani } else { 6254eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6264eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6274eab6f4fSRaja Mani } 6284eab6f4fSRaja Mani 629be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6304eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6314eab6f4fSRaja Mani cap_mask, cap_val); 63201cac476SJouni Malinen if (bss == NULL) { 63301cac476SJouni Malinen /* 63401cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 63501cac476SJouni Malinen * generate a partial entry until the first BSS info 63601cac476SJouni Malinen * event becomes available. 63701cac476SJouni Malinen * 63801cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 63901cac476SJouni Malinen * IEs from the target. 64001cac476SJouni Malinen */ 6413450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 64201cac476SJouni Malinen if (ie == NULL) 6435e13fd35SVasanthakumar Thiagarajan return NULL; 64401cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6453450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6463450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6473450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 648be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6494eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6503450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 65101cac476SJouni Malinen 0, GFP_KERNEL); 65201cac476SJouni Malinen if (bss) 6534eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6544eab6f4fSRaja Mani "cfg80211\n", bssid); 65501cac476SJouni Malinen kfree(ie); 65601cac476SJouni Malinen } else 6575e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 65801cac476SJouni Malinen 6595e13fd35SVasanthakumar Thiagarajan return bss; 66001cac476SJouni Malinen } 66101cac476SJouni Malinen 662240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 663bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 664bdcd8170SKalle Valo u16 beacon_intvl, 665bdcd8170SKalle Valo enum network_type nw_type, 666bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 667bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 668bdcd8170SKalle Valo { 66901cac476SJouni Malinen struct ieee80211_channel *chan; 670240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6715e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 672bdcd8170SKalle Valo 673bdcd8170SKalle Valo /* capinfo + listen interval */ 674bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 675bdcd8170SKalle Valo 676bdcd8170SKalle Valo /* capinfo + status code + associd */ 677bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 680bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 681bdcd8170SKalle Valo assoc_resp_ie_offset; 682bdcd8170SKalle Valo 683bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 684bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 685bdcd8170SKalle Valo 68632c10874SJouni Malinen /* 68732c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 68832c10874SJouni Malinen * a Beacon frame from the AP is seen. 68932c10874SJouni Malinen */ 690cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 69159c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 69232c10874SJouni Malinen 693bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 694551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 695bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 696bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 697bdcd8170SKalle Valo return; 698bdcd8170SKalle Valo } 699bdcd8170SKalle Valo } 700bdcd8170SKalle Valo 701bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 702551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 703551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 704bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 705bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 706bdcd8170SKalle Valo return; 707bdcd8170SKalle Valo } 708bdcd8170SKalle Valo } 709bdcd8170SKalle Valo 710be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 711bdcd8170SKalle Valo 7125e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7135e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7145e13fd35SVasanthakumar Thiagarajan if (!bss) { 7154eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 716bdcd8170SKalle Valo return; 717bdcd8170SKalle Valo } 718bdcd8170SKalle Valo 7194eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7204eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7214eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7224eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7235e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 72401cac476SJouni Malinen return; 72501cac476SJouni Malinen } 72601cac476SJouni Malinen 72714ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 728bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 72914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 730240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 731bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 732bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 733bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7345e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 73514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 736bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7375e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 738bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 739bdcd8170SKalle Valo } 740bdcd8170SKalle Valo } 741bdcd8170SKalle Valo 742bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 743bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 744bdcd8170SKalle Valo { 745d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7463450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 747bdcd8170SKalle Valo 748bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 749bdcd8170SKalle Valo reason_code); 750bdcd8170SKalle Valo 75110509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 75210509f90SKalle Valo 753990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 754bdcd8170SKalle Valo return -EIO; 755bdcd8170SKalle Valo 756bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 757bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 758bdcd8170SKalle Valo return -EBUSY; 759bdcd8170SKalle Valo } 760bdcd8170SKalle Valo 761bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 762bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 763bdcd8170SKalle Valo return -ERESTARTSYS; 764bdcd8170SKalle Valo } 765bdcd8170SKalle Valo 766cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 767240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7683450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7693450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 770bdcd8170SKalle Valo 771bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7728c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 773bdcd8170SKalle Valo 774bdcd8170SKalle Valo up(&ar->sem); 775bdcd8170SKalle Valo 77614ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 777170826ddSVasanthakumar Thiagarajan 778bdcd8170SKalle Valo return 0; 779bdcd8170SKalle Valo } 780bdcd8170SKalle Valo 781240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 782bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 783bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 784bdcd8170SKalle Valo { 785240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 78659c98449SVasanthakumar Thiagarajan 78714ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 78814ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 78914ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 790bdcd8170SKalle Valo } 791bdcd8170SKalle Valo 792f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 793551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 794bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 795bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 796bdcd8170SKalle Valo return; 797bdcd8170SKalle Valo } 798bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 799240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 800bdcd8170SKalle Valo return; 801bdcd8170SKalle Valo } 802bdcd8170SKalle Valo 803f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 804551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 805551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 806bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 807bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 808bdcd8170SKalle Valo return; 809bdcd8170SKalle Valo } 810bdcd8170SKalle Valo } 811bdcd8170SKalle Valo 8121de547d6SVasanthakumar Thiagarajan /* 8131de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8141de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8151de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8161de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8171de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8181de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8191de547d6SVasanthakumar Thiagarajan */ 820bdcd8170SKalle Valo 8211de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 822334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 823bdcd8170SKalle Valo return; 824bdcd8170SKalle Valo } 825bdcd8170SKalle Valo 82659c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 827bdcd8170SKalle Valo 82814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 829240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 830bdcd8170SKalle Valo bssid, NULL, 0, 831bdcd8170SKalle Valo NULL, 0, 832bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 833bdcd8170SKalle Valo GFP_KERNEL); 83414ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 835240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 836bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 837bdcd8170SKalle Valo } 838bdcd8170SKalle Valo 83914ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 840bdcd8170SKalle Valo } 841bdcd8170SKalle Valo 842bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 843bdcd8170SKalle Valo struct cfg80211_scan_request *request) 844bdcd8170SKalle Valo { 845d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 84659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8471276c9efSEdward Lu s8 n_channels = 0; 8481276c9efSEdward Lu u16 *channels = NULL; 849bdcd8170SKalle Valo int ret = 0; 850f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 851bdcd8170SKalle Valo 852990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 853bdcd8170SKalle Valo return -EIO; 854bdcd8170SKalle Valo 85510509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 85610509f90SKalle Valo 857bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 85859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8591b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 860240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 86159c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8621b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8631b1e6ee3SJouni Malinen if (ret) { 864bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8651b1e6ee3SJouni Malinen return ret; 866bdcd8170SKalle Valo } 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo 869bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 870bdcd8170SKalle Valo u8 i; 871bdcd8170SKalle Valo 872bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 873bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 874bdcd8170SKalle Valo 875bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 876334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 877334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 878bdcd8170SKalle Valo request->ssids[i].ssid_len, 879bdcd8170SKalle Valo request->ssids[i].ssid); 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 88210509f90SKalle Valo /* 88310509f90SKalle Valo * FIXME: we should clear the IE in fw if it's not set so just 88410509f90SKalle Valo * remove the check altogether 88510509f90SKalle Valo */ 886b84da8c7SJouni Malinen if (request->ie) { 887334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 888334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 889b84da8c7SJouni Malinen request->ie, request->ie_len); 890b84da8c7SJouni Malinen if (ret) { 891b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 892b84da8c7SJouni Malinen "scan"); 893b84da8c7SJouni Malinen return ret; 894b84da8c7SJouni Malinen } 895b84da8c7SJouni Malinen } 896b84da8c7SJouni Malinen 89711869befSJouni Malinen /* 89811869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 89911869befSJouni Malinen * channels. If the list is longer than the target supports, do not 90011869befSJouni Malinen * configure the list and instead, scan all available channels. 90111869befSJouni Malinen */ 90211869befSJouni Malinen if (request->n_channels > 0 && 90311869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9041276c9efSEdward Lu u8 i; 9051276c9efSEdward Lu 90611869befSJouni Malinen n_channels = request->n_channels; 9071276c9efSEdward Lu 9081276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9091276c9efSEdward Lu if (channels == NULL) { 9101276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9111276c9efSEdward Lu "scan all channels"); 9121276c9efSEdward Lu n_channels = 0; 9131276c9efSEdward Lu } 9141276c9efSEdward Lu 9151276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9161276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9171276c9efSEdward Lu } 9181276c9efSEdward Lu 91959c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 920f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 921f1f92179SVasanthakumar Thiagarajan 9223ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9233ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9243ca9d1fcSAarthi Thiruvengadam /* 9253ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9263ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9273ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9283ca9d1fcSAarthi Thiruvengadam * probe requests 9293ca9d1fcSAarthi Thiruvengadam */ 9303ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9313ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9323ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 9333ca9d1fcSAarthi Thiruvengadam channels, request->no_cck, 9343ca9d1fcSAarthi Thiruvengadam request->rates); 9353ca9d1fcSAarthi Thiruvengadam } else { 9363ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9373ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9383ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 939334234b5SVasanthakumar Thiagarajan channels); 9403ca9d1fcSAarthi Thiruvengadam } 9411b1e6ee3SJouni Malinen if (ret) 942bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 94311869befSJouni Malinen else 94414ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 945bdcd8170SKalle Valo 9461276c9efSEdward Lu kfree(channels); 9471276c9efSEdward Lu 948bdcd8170SKalle Valo return ret; 949bdcd8170SKalle Valo } 950bdcd8170SKalle Valo 9511c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 952bdcd8170SKalle Valo { 953240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9546fd1eaceSKalle Valo int i; 955bdcd8170SKalle Valo 9561c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9571c17d313SKalle Valo aborted ? " aborted" : ""); 958bdcd8170SKalle Valo 95914ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9606fd1eaceSKalle Valo return; 9616fd1eaceSKalle Valo 9621c17d313SKalle Valo if (aborted) 9636fd1eaceSKalle Valo goto out; 964bdcd8170SKalle Valo 96514ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 96614ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 967334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 968334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 969bdcd8170SKalle Valo 0, NULL); 970bdcd8170SKalle Valo } 971bdcd8170SKalle Valo } 9726fd1eaceSKalle Valo 9736fd1eaceSKalle Valo out: 974cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 97514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 976bdcd8170SKalle Valo } 977bdcd8170SKalle Valo 978bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 979bdcd8170SKalle Valo u8 key_index, bool pairwise, 980bdcd8170SKalle Valo const u8 *mac_addr, 981bdcd8170SKalle Valo struct key_params *params) 982bdcd8170SKalle Valo { 983d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 98459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 985bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 9864a8ce2fdSSujith Manoharan int seq_len; 987bdcd8170SKalle Valo u8 key_usage; 988bdcd8170SKalle Valo u8 key_type; 989bdcd8170SKalle Valo 990990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 991bdcd8170SKalle Valo return -EIO; 992bdcd8170SKalle Valo 993837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 994837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 995837cb97eSJouni Malinen return -EINVAL; 996240d2799SVasanthakumar Thiagarajan return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 997240d2799SVasanthakumar Thiagarajan params->key); 998837cb97eSJouni Malinen } 999837cb97eSJouni Malinen 1000792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1001bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1002bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1003bdcd8170SKalle Valo key_index); 1004bdcd8170SKalle Valo return -ENOENT; 1005bdcd8170SKalle Valo } 1006bdcd8170SKalle Valo 10076f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1008bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 1009bdcd8170SKalle Valo 1010bdcd8170SKalle Valo if (pairwise) 1011bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 1012bdcd8170SKalle Valo else 1013bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1014bdcd8170SKalle Valo 10154a8ce2fdSSujith Manoharan seq_len = params->seq_len; 10165e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10175e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10185e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10195e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10205e07021eSDai Shuibing } 1021bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10225e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1023bdcd8170SKalle Valo return -EINVAL; 1024bdcd8170SKalle Valo 1025bdcd8170SKalle Valo key->key_len = params->key_len; 1026bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10275e07021eSDai Shuibing key->seq_len = seq_len; 1028bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1029bdcd8170SKalle Valo key->cipher = params->cipher; 1030bdcd8170SKalle Valo 1031bdcd8170SKalle Valo switch (key->cipher) { 1032bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1033bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1034bdcd8170SKalle Valo key_type = WEP_CRYPT; 1035bdcd8170SKalle Valo break; 1036bdcd8170SKalle Valo 1037bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1038bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1039bdcd8170SKalle Valo break; 1040bdcd8170SKalle Valo 1041bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1042bdcd8170SKalle Valo key_type = AES_CRYPT; 1043bdcd8170SKalle Valo break; 10445e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10455e07021eSDai Shuibing key_type = WAPI_CRYPT; 10465e07021eSDai Shuibing break; 1047bdcd8170SKalle Valo 1048bdcd8170SKalle Valo default: 1049bdcd8170SKalle Valo return -ENOTSUPP; 1050bdcd8170SKalle Valo } 1051bdcd8170SKalle Valo 10523450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10533450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1054bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1055de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1056bdcd8170SKalle Valo 1057bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1058bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1059bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1060bdcd8170SKalle Valo key_usage, key->seq_len); 1061bdcd8170SKalle Valo 1062f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10634703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 10644703290aSJouni Malinen key_type == WAPI_CRYPT) && params) { 10659a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10669a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10679a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10689a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10699a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 107059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10719a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10729a5b1318SJouni Malinen "key configuration until AP mode has been " 10739a5b1318SJouni Malinen "started\n"); 10749a5b1318SJouni Malinen /* 10759a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10769a5b1318SJouni Malinen * the connected event is received from the target. 10779a5b1318SJouni Malinen */ 10789a5b1318SJouni Malinen return 0; 10799a5b1318SJouni Malinen } 10809a5b1318SJouni Malinen } 10819a5b1318SJouni Malinen 1082f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 108359c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1084151411e8SJouni Malinen /* 1085151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1086151411e8SJouni Malinen * the AP mode has properly started 1087151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1088151411e8SJouni Malinen */ 1089151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1090151411e8SJouni Malinen "until AP mode has been started\n"); 10916f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10926f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10936f2a73f9SVasanthakumar Thiagarajan key->key_len); 1094151411e8SJouni Malinen return 0; 1095151411e8SJouni Malinen } 1096151411e8SJouni Malinen 10977cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1098bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1099f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1100f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1101bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1102bdcd8170SKalle Valo } 1103bdcd8170SKalle Valo 1104bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1105bdcd8170SKalle Valo u8 key_index, bool pairwise, 1106bdcd8170SKalle Valo const u8 *mac_addr) 1107bdcd8170SKalle Valo { 1108d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11096f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1110bdcd8170SKalle Valo 1111bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1112bdcd8170SKalle Valo 1113990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1114bdcd8170SKalle Valo return -EIO; 1115bdcd8170SKalle Valo 1116792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1117bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1118bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1119bdcd8170SKalle Valo key_index); 1120bdcd8170SKalle Valo return -ENOENT; 1121bdcd8170SKalle Valo } 1122bdcd8170SKalle Valo 11236f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1124bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1125bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1126bdcd8170SKalle Valo return 0; 1127bdcd8170SKalle Valo } 1128bdcd8170SKalle Valo 11296f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1130bdcd8170SKalle Valo 1131334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1132bdcd8170SKalle Valo } 1133bdcd8170SKalle Valo 1134bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1135bdcd8170SKalle Valo u8 key_index, bool pairwise, 1136bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1137bdcd8170SKalle Valo void (*callback) (void *cookie, 1138bdcd8170SKalle Valo struct key_params *)) 1139bdcd8170SKalle Valo { 11406f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1141bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1142bdcd8170SKalle Valo struct key_params params; 1143bdcd8170SKalle Valo 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1145bdcd8170SKalle Valo 1146990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1147bdcd8170SKalle Valo return -EIO; 1148bdcd8170SKalle Valo 1149792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1150bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1151bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1152bdcd8170SKalle Valo key_index); 1153bdcd8170SKalle Valo return -ENOENT; 1154bdcd8170SKalle Valo } 1155bdcd8170SKalle Valo 11566f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1157bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1158bdcd8170SKalle Valo params.cipher = key->cipher; 1159bdcd8170SKalle Valo params.key_len = key->key_len; 1160bdcd8170SKalle Valo params.seq_len = key->seq_len; 1161bdcd8170SKalle Valo params.seq = key->seq; 1162bdcd8170SKalle Valo params.key = key->key; 1163bdcd8170SKalle Valo 1164bdcd8170SKalle Valo callback(cookie, ¶ms); 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1167bdcd8170SKalle Valo } 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1170bdcd8170SKalle Valo struct net_device *ndev, 1171bdcd8170SKalle Valo u8 key_index, bool unicast, 1172bdcd8170SKalle Valo bool multicast) 1173bdcd8170SKalle Valo { 1174d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 117559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1176bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1177bdcd8170SKalle Valo u8 key_usage; 1178229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1179bdcd8170SKalle Valo 1180bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1181bdcd8170SKalle Valo 1182990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1183bdcd8170SKalle Valo return -EIO; 1184bdcd8170SKalle Valo 1185792ecb33SVivek Natarajan if (key_index > WMI_MAX_KEY_INDEX) { 1186bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1187bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1188bdcd8170SKalle Valo __func__, key_index); 1189bdcd8170SKalle Valo return -ENOENT; 1190bdcd8170SKalle Valo } 1191bdcd8170SKalle Valo 11926f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1193bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1194bdcd8170SKalle Valo __func__, key_index); 1195bdcd8170SKalle Valo return -EINVAL; 1196bdcd8170SKalle Valo } 1197bdcd8170SKalle Valo 11983450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 11996f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1200bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12013450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1202bdcd8170SKalle Valo key_usage |= TX_USAGE; 1203229ed6b5SEdward Lu if (unicast) 12043450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1205229ed6b5SEdward Lu if (multicast) 12063450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1207bdcd8170SKalle Valo 1208f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12099a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12109a5b1318SJouni Malinen 1211f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1212334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1213229ed6b5SEdward Lu key_type, key_usage, 1214f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1215f4bb9a6fSJouni Malinen key->key, 1216bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1217bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1218bdcd8170SKalle Valo } 1219bdcd8170SKalle Valo 1220240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1221bdcd8170SKalle Valo bool ismcast) 1222bdcd8170SKalle Valo { 1223bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1224bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1225bdcd8170SKalle Valo 1226240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1227bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1228bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1229bdcd8170SKalle Valo GFP_KERNEL); 1230bdcd8170SKalle Valo } 1231bdcd8170SKalle Valo 1232bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1233bdcd8170SKalle Valo { 1234bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1235990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1236bdcd8170SKalle Valo int ret; 1237bdcd8170SKalle Valo 1238bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1239bdcd8170SKalle Valo changed); 1240bdcd8170SKalle Valo 1241990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1242990bd915SVasanthakumar Thiagarajan if (!vif) 1243990bd915SVasanthakumar Thiagarajan return -EIO; 1244990bd915SVasanthakumar Thiagarajan 1245990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1246bdcd8170SKalle Valo return -EIO; 1247bdcd8170SKalle Valo 1248bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1249bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1250bdcd8170SKalle Valo if (ret != 0) { 1251bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1252bdcd8170SKalle Valo return -EIO; 1253bdcd8170SKalle Valo } 1254bdcd8170SKalle Valo } 1255bdcd8170SKalle Valo 1256bdcd8170SKalle Valo return 0; 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo 1259bdcd8170SKalle Valo /* 1260bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1261bdcd8170SKalle Valo * data type from 2.6.36 onwards 1262bdcd8170SKalle Valo */ 1263bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1264bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1265b992a285SLuis R. Rodriguez int mbm) 1266bdcd8170SKalle Valo { 1267bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1268990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1269bdcd8170SKalle Valo u8 ath6kl_dbm; 1270b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1271bdcd8170SKalle Valo 1272bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1273bdcd8170SKalle Valo type, dbm); 1274bdcd8170SKalle Valo 1275990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1276990bd915SVasanthakumar Thiagarajan if (!vif) 1277990bd915SVasanthakumar Thiagarajan return -EIO; 1278990bd915SVasanthakumar Thiagarajan 1279990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1280bdcd8170SKalle Valo return -EIO; 1281bdcd8170SKalle Valo 1282bdcd8170SKalle Valo switch (type) { 1283bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1284bdcd8170SKalle Valo return 0; 1285bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1286bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1287bdcd8170SKalle Valo break; 1288bdcd8170SKalle Valo default: 1289bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1290bdcd8170SKalle Valo __func__, type); 1291bdcd8170SKalle Valo return -EOPNOTSUPP; 1292bdcd8170SKalle Valo } 1293bdcd8170SKalle Valo 1294990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo return 0; 1297bdcd8170SKalle Valo } 1298bdcd8170SKalle Valo 1299bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1300bdcd8170SKalle Valo { 1301bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1302990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1303bdcd8170SKalle Valo 1304990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1305990bd915SVasanthakumar Thiagarajan if (!vif) 1306990bd915SVasanthakumar Thiagarajan return -EIO; 1307990bd915SVasanthakumar Thiagarajan 1308990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1309bdcd8170SKalle Valo return -EIO; 1310bdcd8170SKalle Valo 131159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1312bdcd8170SKalle Valo ar->tx_pwr = 0; 1313bdcd8170SKalle Valo 1314990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1315bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1316bdcd8170SKalle Valo return -EIO; 1317bdcd8170SKalle Valo } 1318bdcd8170SKalle Valo 1319bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1320bdcd8170SKalle Valo 5 * HZ); 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo if (signal_pending(current)) { 1323bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1324bdcd8170SKalle Valo return -EINTR; 1325bdcd8170SKalle Valo } 1326bdcd8170SKalle Valo } 1327bdcd8170SKalle Valo 1328bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1329bdcd8170SKalle Valo return 0; 1330bdcd8170SKalle Valo } 1331bdcd8170SKalle Valo 1332bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1333bdcd8170SKalle Valo struct net_device *dev, 1334bdcd8170SKalle Valo bool pmgmt, int timeout) 1335bdcd8170SKalle Valo { 1336bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1337bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1338334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1339bdcd8170SKalle Valo 1340bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1341bdcd8170SKalle Valo __func__, pmgmt, timeout); 1342bdcd8170SKalle Valo 1343990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1344bdcd8170SKalle Valo return -EIO; 1345bdcd8170SKalle Valo 1346bdcd8170SKalle Valo if (pmgmt) { 1347bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1348bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1349bdcd8170SKalle Valo } else { 1350bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1351bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1352bdcd8170SKalle Valo } 1353bdcd8170SKalle Valo 1354334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1355334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1356bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1357bdcd8170SKalle Valo return -EIO; 1358bdcd8170SKalle Valo } 1359bdcd8170SKalle Valo 1360bdcd8170SKalle Valo return 0; 1361bdcd8170SKalle Valo } 1362bdcd8170SKalle Valo 136355055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 136455055976SVasanthakumar Thiagarajan char *name, 136555055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 136655055976SVasanthakumar Thiagarajan u32 *flags, 136755055976SVasanthakumar Thiagarajan struct vif_params *params) 136855055976SVasanthakumar Thiagarajan { 136955055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 137055055976SVasanthakumar Thiagarajan struct net_device *ndev; 137155055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 137255055976SVasanthakumar Thiagarajan 137371f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 137455055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 137555055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137655055976SVasanthakumar Thiagarajan } 137755055976SVasanthakumar Thiagarajan 137855055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 137955055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 138055055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 138155055976SVasanthakumar Thiagarajan } 138255055976SVasanthakumar Thiagarajan 138355055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 138455055976SVasanthakumar Thiagarajan if (!ndev) 138555055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 138655055976SVasanthakumar Thiagarajan 138755055976SVasanthakumar Thiagarajan ar->num_vif++; 138855055976SVasanthakumar Thiagarajan 138955055976SVasanthakumar Thiagarajan return ndev; 139055055976SVasanthakumar Thiagarajan } 139155055976SVasanthakumar Thiagarajan 139255055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 139355055976SVasanthakumar Thiagarajan struct net_device *ndev) 139455055976SVasanthakumar Thiagarajan { 139555055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139655055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 139755055976SVasanthakumar Thiagarajan 139811f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 139955055976SVasanthakumar Thiagarajan list_del(&vif->list); 140011f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 140155055976SVasanthakumar Thiagarajan 140255055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 140355055976SVasanthakumar Thiagarajan 1404c25889e8SKalle Valo ath6kl_cfg80211_vif_cleanup(vif); 140555055976SVasanthakumar Thiagarajan 140655055976SVasanthakumar Thiagarajan return 0; 140755055976SVasanthakumar Thiagarajan } 140855055976SVasanthakumar Thiagarajan 1409bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1410bdcd8170SKalle Valo struct net_device *ndev, 1411bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1412bdcd8170SKalle Valo struct vif_params *params) 1413bdcd8170SKalle Valo { 1414f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1415bdcd8170SKalle Valo 1416bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1417bdcd8170SKalle Valo 1418bdcd8170SKalle Valo switch (type) { 1419bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1420f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1421bdcd8170SKalle Valo break; 1422bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1423f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1424bdcd8170SKalle Valo break; 14256e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1426f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14276e4604c8SJouni Malinen break; 14286b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1429f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14306b5e5d25SJouni Malinen break; 14316b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1432f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14336b5e5d25SJouni Malinen break; 1434bdcd8170SKalle Valo default: 1435bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1436bdcd8170SKalle Valo return -EOPNOTSUPP; 1437bdcd8170SKalle Valo } 1438bdcd8170SKalle Valo 1439551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1440bdcd8170SKalle Valo 1441bdcd8170SKalle Valo return 0; 1442bdcd8170SKalle Valo } 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1445bdcd8170SKalle Valo struct net_device *dev, 1446bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1447bdcd8170SKalle Valo { 1448bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 144959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1450bdcd8170SKalle Valo int status; 1451bdcd8170SKalle Valo 1452990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1453bdcd8170SKalle Valo return -EIO; 1454bdcd8170SKalle Valo 14553450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14563450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1457bdcd8170SKalle Valo 1458bdcd8170SKalle Valo if (ibss_param->channel) 1459f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1460bdcd8170SKalle Valo 1461bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1462bdcd8170SKalle Valo /* 1463bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1464bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1465bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1466bdcd8170SKalle Valo * updated. 1467bdcd8170SKalle Valo */ 1468bdcd8170SKalle Valo return -EOPNOTSUPP; 1469bdcd8170SKalle Valo } 1470bdcd8170SKalle Valo 14718c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1472bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14738c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14748c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1475bdcd8170SKalle Valo 1476240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1477bdcd8170SKalle Valo 1478240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1479bdcd8170SKalle Valo if (status) 1480bdcd8170SKalle Valo return status; 1481bdcd8170SKalle Valo 1482bdcd8170SKalle Valo if (ibss_param->privacy) { 1483240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1484240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1485bdcd8170SKalle Valo } else { 1486240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1487240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1488bdcd8170SKalle Valo } 1489bdcd8170SKalle Valo 1490f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1491bdcd8170SKalle Valo 1492bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1493bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1494bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1495bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1496bdcd8170SKalle Valo __func__, 14973450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 14983450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1499f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1500bdcd8170SKalle Valo 1501334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15023450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15033450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15043450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15053450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15063450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1507f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15083ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 150959c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1510bdcd8170SKalle Valo 1511bdcd8170SKalle Valo return 0; 1512bdcd8170SKalle Valo } 1513bdcd8170SKalle Valo 1514bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1515bdcd8170SKalle Valo struct net_device *dev) 1516bdcd8170SKalle Valo { 15173450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1518bdcd8170SKalle Valo 1519990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1520bdcd8170SKalle Valo return -EIO; 1521bdcd8170SKalle Valo 1522240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15233450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15243450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1525bdcd8170SKalle Valo 1526bdcd8170SKalle Valo return 0; 1527bdcd8170SKalle Valo } 1528bdcd8170SKalle Valo 1529bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1530bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1531bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1532bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1533bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1534837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15355e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1536bdcd8170SKalle Valo }; 1537bdcd8170SKalle Valo 1538bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1539bdcd8170SKalle Valo { 1540bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1541bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1542bdcd8170SKalle Valo 36000, 48000, 54000 1543bdcd8170SKalle Valo }; 1544bdcd8170SKalle Valo u8 i; 1545bdcd8170SKalle Valo 1546bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1547bdcd8170SKalle Valo if (rate == legacy[i]) 1548bdcd8170SKalle Valo return true; 1549bdcd8170SKalle Valo 1550bdcd8170SKalle Valo return false; 1551bdcd8170SKalle Valo } 1552bdcd8170SKalle Valo 1553bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1554bdcd8170SKalle Valo { 1555bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1556bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1557bdcd8170SKalle Valo }; 1558bdcd8170SKalle Valo u8 i; 1559bdcd8170SKalle Valo 1560bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1561bdcd8170SKalle Valo if (rate == ht20[i]) { 1562bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1563bdcd8170SKalle Valo /* last rate uses sgi */ 1564bdcd8170SKalle Valo *sgi = true; 1565bdcd8170SKalle Valo else 1566bdcd8170SKalle Valo *sgi = false; 1567bdcd8170SKalle Valo 1568bdcd8170SKalle Valo *mcs = i; 1569bdcd8170SKalle Valo return true; 1570bdcd8170SKalle Valo } 1571bdcd8170SKalle Valo } 1572bdcd8170SKalle Valo return false; 1573bdcd8170SKalle Valo } 1574bdcd8170SKalle Valo 1575bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1576bdcd8170SKalle Valo { 1577bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1578bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1579bdcd8170SKalle Valo 150000 1580bdcd8170SKalle Valo }; 1581bdcd8170SKalle Valo u8 i; 1582bdcd8170SKalle Valo 1583bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1584bdcd8170SKalle Valo if (rate == ht40[i]) { 1585bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1586bdcd8170SKalle Valo /* last rate uses sgi */ 1587bdcd8170SKalle Valo *sgi = true; 1588bdcd8170SKalle Valo else 1589bdcd8170SKalle Valo *sgi = false; 1590bdcd8170SKalle Valo 1591bdcd8170SKalle Valo *mcs = i; 1592bdcd8170SKalle Valo return true; 1593bdcd8170SKalle Valo } 1594bdcd8170SKalle Valo } 1595bdcd8170SKalle Valo 1596bdcd8170SKalle Valo return false; 1597bdcd8170SKalle Valo } 1598bdcd8170SKalle Valo 1599bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1600bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1601bdcd8170SKalle Valo { 1602bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 160359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1604bdcd8170SKalle Valo long left; 1605bdcd8170SKalle Valo bool sgi; 1606bdcd8170SKalle Valo s32 rate; 1607bdcd8170SKalle Valo int ret; 1608bdcd8170SKalle Valo u8 mcs; 1609bdcd8170SKalle Valo 16108c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1611bdcd8170SKalle Valo return -ENOENT; 1612bdcd8170SKalle Valo 1613bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1614bdcd8170SKalle Valo return -EBUSY; 1615bdcd8170SKalle Valo 1616b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1617bdcd8170SKalle Valo 1618334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1619bdcd8170SKalle Valo 1620bdcd8170SKalle Valo if (ret != 0) { 1621bdcd8170SKalle Valo up(&ar->sem); 1622bdcd8170SKalle Valo return -EIO; 1623bdcd8170SKalle Valo } 1624bdcd8170SKalle Valo 1625bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1626bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1627b95907a7SVasanthakumar Thiagarajan &vif->flags), 1628bdcd8170SKalle Valo WMI_TIMEOUT); 1629bdcd8170SKalle Valo 1630bdcd8170SKalle Valo up(&ar->sem); 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo if (left == 0) 1633bdcd8170SKalle Valo return -ETIMEDOUT; 1634bdcd8170SKalle Valo else if (left < 0) 1635bdcd8170SKalle Valo return left; 1636bdcd8170SKalle Valo 1637b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1638b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1639bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1640b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1641bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1642bdcd8170SKalle Valo } 1643bdcd8170SKalle Valo 1644b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1645b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1646bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1647b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1648bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1649bdcd8170SKalle Valo } 1650bdcd8170SKalle Valo 1651b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1652bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1653bdcd8170SKalle Valo 1654b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1655bdcd8170SKalle Valo 1656bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1657bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1658bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1659bdcd8170SKalle Valo if (sgi) { 1660bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1661bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1662bdcd8170SKalle Valo } else { 1663bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1664bdcd8170SKalle Valo } 1665bdcd8170SKalle Valo 1666bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1667bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1668bdcd8170SKalle Valo if (sgi) { 1669bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1670bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1671bdcd8170SKalle Valo } else { 1672bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1673bdcd8170SKalle Valo } 1674bdcd8170SKalle Valo 1675bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1676bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1677bdcd8170SKalle Valo } else { 16789a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16799a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16809a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1681bdcd8170SKalle Valo return 0; 1682bdcd8170SKalle Valo } 1683bdcd8170SKalle Valo 1684bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1685bdcd8170SKalle Valo 168659c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 168759c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1688f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 168932c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 169032c10874SJouni Malinen sinfo->bss_param.flags = 0; 1691cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1692cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 169332c10874SJouni Malinen } 169432c10874SJouni Malinen 1695bdcd8170SKalle Valo return 0; 1696bdcd8170SKalle Valo } 1697bdcd8170SKalle Valo 1698bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1699bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1700bdcd8170SKalle Valo { 1701bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1702334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1703334234b5SVasanthakumar Thiagarajan 1704334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1705bdcd8170SKalle Valo pmksa->pmkid, true); 1706bdcd8170SKalle Valo } 1707bdcd8170SKalle Valo 1708bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1709bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1710bdcd8170SKalle Valo { 1711bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1712334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1713334234b5SVasanthakumar Thiagarajan 1714334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1715bdcd8170SKalle Valo pmksa->pmkid, false); 1716bdcd8170SKalle Valo } 1717bdcd8170SKalle Valo 1718bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1719bdcd8170SKalle Valo { 1720bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 172159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 172259c98449SVasanthakumar Thiagarajan 172359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1724334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1725334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1726bdcd8170SKalle Valo return 0; 1727bdcd8170SKalle Valo } 1728bdcd8170SKalle Valo 17296cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 17306cb3c714SRaja Mani { 1731c08631c6SRaja Mani struct in_device *in_dev; 1732c08631c6SRaja Mani struct in_ifaddr *ifa; 17336cb3c714SRaja Mani struct ath6kl_vif *vif; 17346cb3c714SRaja Mani int ret, pos, left; 17356cb3c714SRaja Mani u32 filter = 0; 17366cb3c714SRaja Mani u16 i; 1737c08631c6SRaja Mani u8 mask[WOW_MASK_SIZE], index = 0; 1738c08631c6SRaja Mani __be32 ips[MAX_IP_ADDRS]; 17396cb3c714SRaja Mani 17406cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 17416cb3c714SRaja Mani if (!vif) 17426cb3c714SRaja Mani return -EIO; 17436cb3c714SRaja Mani 17446cb3c714SRaja Mani if (!ath6kl_cfg80211_ready(vif)) 17456cb3c714SRaja Mani return -EIO; 17466cb3c714SRaja Mani 17476cb3c714SRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 17486cb3c714SRaja Mani return -EINVAL; 17496cb3c714SRaja Mani 17506cb3c714SRaja Mani /* Clear existing WOW patterns */ 17516cb3c714SRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 17526cb3c714SRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 17536cb3c714SRaja Mani WOW_LIST_ID, i); 17546cb3c714SRaja Mani /* Configure new WOW patterns */ 17556cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17566cb3c714SRaja Mani 17576cb3c714SRaja Mani /* 17586cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17596cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17606cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17616cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17626cb3c714SRaja Mani * then equivalent driver specific mask value is 17636cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17646cb3c714SRaja Mani */ 17656cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17666cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17676cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17686cb3c714SRaja Mani mask[pos] = 0xFF; 17696cb3c714SRaja Mani } 17706cb3c714SRaja Mani /* 17716cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17726cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17736cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17746cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17756cb3c714SRaja Mani */ 17766cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17776cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17786cb3c714SRaja Mani wow->patterns[i].pattern_len, 17796cb3c714SRaja Mani 0 /* pattern offset */, 17806cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17816cb3c714SRaja Mani if (ret) 17826cb3c714SRaja Mani return ret; 17836cb3c714SRaja Mani } 17846cb3c714SRaja Mani 1785c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1786c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1787c08631c6SRaja Mani if (!in_dev) 1788c08631c6SRaja Mani goto skip_arp; 1789c08631c6SRaja Mani 1790c08631c6SRaja Mani ifa = in_dev->ifa_list; 1791c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 1792c08631c6SRaja Mani 1793c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 1794c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 1795c08631c6SRaja Mani ips[index] = ifa->ifa_local; 1796c08631c6SRaja Mani ifa = ifa->ifa_next; 1797c08631c6SRaja Mani index++; 1798c08631c6SRaja Mani } 1799c08631c6SRaja Mani 1800c08631c6SRaja Mani if (ifa) { 1801c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 1802c08631c6SRaja Mani return -EINVAL; 1803c08631c6SRaja Mani } 1804c08631c6SRaja Mani 1805c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 1806c08631c6SRaja Mani if (ret) { 1807c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 1808c08631c6SRaja Mani return ret; 1809c08631c6SRaja Mani } 1810c08631c6SRaja Mani 1811c08631c6SRaja Mani skip_arp: 18126cb3c714SRaja Mani if (wow->disconnect) 18136cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 18146cb3c714SRaja Mani 18156cb3c714SRaja Mani if (wow->magic_pkt) 18166cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 18176cb3c714SRaja Mani 18186cb3c714SRaja Mani if (wow->gtk_rekey_failure) 18196cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_GTK_ERROR; 18206cb3c714SRaja Mani 18216cb3c714SRaja Mani if (wow->eap_identity_req) 18226cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_EAP_REQ; 18236cb3c714SRaja Mani 18246cb3c714SRaja Mani if (wow->four_way_handshake) 18256cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 18266cb3c714SRaja Mani 18276cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 18286cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 18296cb3c714SRaja Mani filter, 18306cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 18316cb3c714SRaja Mani if (ret) 18326cb3c714SRaja Mani return ret; 18336cb3c714SRaja Mani 18346cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18356cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 18366cb3c714SRaja Mani if (ret) 18376cb3c714SRaja Mani return ret; 18386cb3c714SRaja Mani 18396cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 18406cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 18416cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 18426cb3c714SRaja Mani if (left == 0) { 18436cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 18446cb3c714SRaja Mani ret = -ETIMEDOUT; 18456cb3c714SRaja Mani } else if (left < 0) { 18466cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 18476cb3c714SRaja Mani ret = left; 18486cb3c714SRaja Mani } 18496cb3c714SRaja Mani } 18506cb3c714SRaja Mani 18516cb3c714SRaja Mani return ret; 18526cb3c714SRaja Mani } 18536cb3c714SRaja Mani 18546cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 18556cb3c714SRaja Mani { 18566cb3c714SRaja Mani struct ath6kl_vif *vif; 18576cb3c714SRaja Mani int ret; 18586cb3c714SRaja Mani 18596cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 18606cb3c714SRaja Mani if (!vif) 18616cb3c714SRaja Mani return -EIO; 18626cb3c714SRaja Mani 18636cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18646cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 18656cb3c714SRaja Mani return ret; 18666cb3c714SRaja Mani } 18676cb3c714SRaja Mani 186852d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 18690f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 18700f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 187152d81a68SKalle Valo { 187252d81a68SKalle Valo int ret; 187352d81a68SKalle Valo 187452d81a68SKalle Valo switch (mode) { 1875d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 1876d7c44e0bSRaja Mani 1877d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 1878d7c44e0bSRaja Mani 1879d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 1880d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 1881d7c44e0bSRaja Mani 1882d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 1883d7c44e0bSRaja Mani if (ret) { 1884d7c44e0bSRaja Mani ath6kl_err("wow suspend failed: %d\n", ret); 1885d7c44e0bSRaja Mani return ret; 1886d7c44e0bSRaja Mani } 1887d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 1888d7c44e0bSRaja Mani break; 1889d7c44e0bSRaja Mani 189052d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 1891524441e3SRaja Mani 18927125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1893524441e3SRaja Mani 189452d81a68SKalle Valo /* save the current power mode before enabling power save */ 189552d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 189652d81a68SKalle Valo 189752d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 189852d81a68SKalle Valo if (ret) { 189952d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 190052d81a68SKalle Valo ret); 190152d81a68SKalle Valo } 190252d81a68SKalle Valo 190376a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 190476a9fbe2SKalle Valo 190552d81a68SKalle Valo break; 1906b4b2a0b1SKalle Valo 1907b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1908524441e3SRaja Mani 19097125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1910524441e3SRaja Mani 1911b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1912b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1913b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1914b4b2a0b1SKalle Valo break; 1915b4b2a0b1SKalle Valo } 1916b4b2a0b1SKalle Valo 1917b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1918b4b2a0b1SKalle Valo 1919b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1920b4b2a0b1SKalle Valo if (ret) { 1921b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1922b4b2a0b1SKalle Valo ret); 1923b4b2a0b1SKalle Valo } 1924b4b2a0b1SKalle Valo 1925b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1926b4b2a0b1SKalle Valo 1927b4b2a0b1SKalle Valo break; 1928b4b2a0b1SKalle Valo 192910509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 193010509f90SKalle Valo /* 193110509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 193210509f90SKalle Valo * wow mode and sleeping most of the time. 193310509f90SKalle Valo */ 193410509f90SKalle Valo break; 193510509f90SKalle Valo 1936b4b2a0b1SKalle Valo default: 1937b4b2a0b1SKalle Valo break; 193852d81a68SKalle Valo } 193952d81a68SKalle Valo 194052d81a68SKalle Valo return 0; 194152d81a68SKalle Valo } 194252d81a68SKalle Valo 194352d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 194452d81a68SKalle Valo { 194576a9fbe2SKalle Valo int ret; 194676a9fbe2SKalle Valo 194776a9fbe2SKalle Valo switch (ar->state) { 1948d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 1949d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 1950d7c44e0bSRaja Mani 1951d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 1952d7c44e0bSRaja Mani if (ret) { 1953d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 1954d7c44e0bSRaja Mani return ret; 1955d7c44e0bSRaja Mani } 1956d7c44e0bSRaja Mani 1957d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_ON; 1958d7c44e0bSRaja Mani break; 1959d7c44e0bSRaja Mani 196076a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 196152d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 196276a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 196376a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 196476a9fbe2SKalle Valo if (ret) { 196576a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 196676a9fbe2SKalle Valo ret); 196776a9fbe2SKalle Valo } 196876a9fbe2SKalle Valo } 196976a9fbe2SKalle Valo 197076a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 197176a9fbe2SKalle Valo 197276a9fbe2SKalle Valo break; 197376a9fbe2SKalle Valo 1974b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1975b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1976b4b2a0b1SKalle Valo 1977b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1978b4b2a0b1SKalle Valo if (ret) { 1979b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1980b4b2a0b1SKalle Valo return ret; 1981b4b2a0b1SKalle Valo } 1982d7c44e0bSRaja Mani break; 1983b4b2a0b1SKalle Valo 198410509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 198510509f90SKalle Valo break; 198610509f90SKalle Valo 198776a9fbe2SKalle Valo default: 198876a9fbe2SKalle Valo break; 198952d81a68SKalle Valo } 199052d81a68SKalle Valo 199152d81a68SKalle Valo return 0; 199252d81a68SKalle Valo } 199352d81a68SKalle Valo 1994abcb344bSKalle Valo #ifdef CONFIG_PM 199552d81a68SKalle Valo 199652d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 199752d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 1998abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1999abcb344bSKalle Valo { 2000abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2001abcb344bSKalle Valo 20020f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2003abcb344bSKalle Valo } 2004aa6cffc1SChilam Ng 200552d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2006aa6cffc1SChilam Ng { 2007aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2008aa6cffc1SChilam Ng 2009aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2010aa6cffc1SChilam Ng } 2011a918fb3cSRaja Mani 2012a918fb3cSRaja Mani /* 2013a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2014a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2015a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2016a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2017a918fb3cSRaja Mani * 2018a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2019a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2020a918fb3cSRaja Mani * 2021a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2022a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2023a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2024a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2025a918fb3cSRaja Mani * 2026a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2027a918fb3cSRaja Mani */ 2028a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2029a918fb3cSRaja Mani { 2030a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2031a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2032a918fb3cSRaja Mani } 2033a918fb3cSRaja Mani 2034a918fb3cSRaja Mani #else 2035a918fb3cSRaja Mani 2036a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2037a918fb3cSRaja Mani { 2038a918fb3cSRaja Mani } 2039abcb344bSKalle Valo #endif 2040abcb344bSKalle Valo 20416a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 20426a7c9badSJouni Malinen struct ieee80211_channel *chan, 20436a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 20446a7c9badSJouni Malinen { 2045e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2046e68f6750SSujith Manoharan 2047e68f6750SSujith Manoharan /* 2048e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2049e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2050e68f6750SSujith Manoharan * 2051e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2052e68f6750SSujith Manoharan */ 2053e68f6750SSujith Manoharan if (!dev) 2054e68f6750SSujith Manoharan return -EBUSY; 2055e68f6750SSujith Manoharan 2056e68f6750SSujith Manoharan vif = netdev_priv(dev); 20576a7c9badSJouni Malinen 2058990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 20596a7c9badSJouni Malinen return -EIO; 20606a7c9badSJouni Malinen 20616a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 20626a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2063cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 20646a7c9badSJouni Malinen 20656a7c9badSJouni Malinen return 0; 20666a7c9badSJouni Malinen } 20676a7c9badSJouni Malinen 20688bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 20698bdfbf40SJouni Malinen { 20708bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 20718bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 20728bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 20738bdfbf40SJouni Malinen } 20748bdfbf40SJouni Malinen 2075334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2076334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 20778bdfbf40SJouni Malinen { 2078334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 20798bdfbf40SJouni Malinen const u8 *pos; 20808bdfbf40SJouni Malinen u8 *buf = NULL; 20818bdfbf40SJouni Malinen size_t len = 0; 20828bdfbf40SJouni Malinen int ret; 20838bdfbf40SJouni Malinen 20848bdfbf40SJouni Malinen /* 20858bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 20868bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 20878bdfbf40SJouni Malinen */ 20888bdfbf40SJouni Malinen 20898bdfbf40SJouni Malinen if (ies && ies_len) { 20908bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 20918bdfbf40SJouni Malinen if (buf == NULL) 20928bdfbf40SJouni Malinen return -ENOMEM; 20938bdfbf40SJouni Malinen pos = ies; 20948bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 20958bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 20968bdfbf40SJouni Malinen break; 20978bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 20988bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 20998bdfbf40SJouni Malinen len += 2 + pos[1]; 21008bdfbf40SJouni Malinen } 21018bdfbf40SJouni Malinen pos += 2 + pos[1]; 21028bdfbf40SJouni Malinen } 21038bdfbf40SJouni Malinen } 21048bdfbf40SJouni Malinen 2105334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2106334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 21078bdfbf40SJouni Malinen kfree(buf); 21088bdfbf40SJouni Malinen return ret; 21098bdfbf40SJouni Malinen } 21108bdfbf40SJouni Malinen 21116a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 21126a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 21136a7c9badSJouni Malinen { 21146a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 21153450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 21166a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 21176a7c9badSJouni Malinen u8 *ies; 21186a7c9badSJouni Malinen int ies_len; 21196a7c9badSJouni Malinen struct wmi_connect_cmd p; 21206a7c9badSJouni Malinen int res; 2121be5abaafSVasanthakumar Thiagarajan int i, ret; 21226a7c9badSJouni Malinen 21236a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 21246a7c9badSJouni Malinen 2125990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 21266a7c9badSJouni Malinen return -EIO; 21276a7c9badSJouni Malinen 2128f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 21296a7c9badSJouni Malinen return -EOPNOTSUPP; 21306a7c9badSJouni Malinen 21316a7c9badSJouni Malinen if (info->beacon_ies) { 2132334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2133334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 21346a7c9badSJouni Malinen info->beacon_ies, 21356a7c9badSJouni Malinen info->beacon_ies_len); 21366a7c9badSJouni Malinen if (res) 21376a7c9badSJouni Malinen return res; 21386a7c9badSJouni Malinen } 21396a7c9badSJouni Malinen if (info->proberesp_ies) { 2140334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 21416a7c9badSJouni Malinen info->proberesp_ies_len); 21426a7c9badSJouni Malinen if (res) 21436a7c9badSJouni Malinen return res; 21446a7c9badSJouni Malinen } 21456a7c9badSJouni Malinen if (info->assocresp_ies) { 2146334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2147334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 21486a7c9badSJouni Malinen info->assocresp_ies, 21496a7c9badSJouni Malinen info->assocresp_ies_len); 21506a7c9badSJouni Malinen if (res) 21516a7c9badSJouni Malinen return res; 21526a7c9badSJouni Malinen } 21536a7c9badSJouni Malinen 21546a7c9badSJouni Malinen if (!add) 21556a7c9badSJouni Malinen return 0; 21566a7c9badSJouni Malinen 21579a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 21589a5b1318SJouni Malinen 21596a7c9badSJouni Malinen /* TODO: 21606a7c9badSJouni Malinen * info->interval 21616a7c9badSJouni Malinen * info->dtim_period 21626a7c9badSJouni Malinen */ 21636a7c9badSJouni Malinen 21646a7c9badSJouni Malinen if (info->head == NULL) 21656a7c9badSJouni Malinen return -EINVAL; 21666a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 21676a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 21686a7c9badSJouni Malinen if (ies > info->head + info->head_len) 21696a7c9badSJouni Malinen return -EINVAL; 21706a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 21716a7c9badSJouni Malinen 21726a7c9badSJouni Malinen if (info->ssid == NULL) 21736a7c9badSJouni Malinen return -EINVAL; 21743450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 21753450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 21766a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 21776a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 21786a7c9badSJouni Malinen 2179be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2180be5abaafSVasanthakumar Thiagarajan if (ret) 2181be5abaafSVasanthakumar Thiagarajan return ret; 21826a7c9badSJouni Malinen 21836a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 21846a7c9badSJouni Malinen 21856a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 21866a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 21876a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 21886a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21896a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 21906a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21916a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 21926a7c9badSJouni Malinen break; 21936a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 21946a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21956a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 21966a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21976a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 21986a7c9badSJouni Malinen break; 21996a7c9badSJouni Malinen } 22006a7c9badSJouni Malinen } 22016a7c9badSJouni Malinen if (p.auth_mode == 0) 22026a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 22033450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 22046a7c9badSJouni Malinen 22056a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 22066a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 22076a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22086a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22096a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 22106a7c9badSJouni Malinen break; 22116a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22126a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 22136a7c9badSJouni Malinen break; 22146a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22156a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 22166a7c9badSJouni Malinen break; 2217b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2218b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2219b8214df1SDai Shuibing break; 22206a7c9badSJouni Malinen } 22216a7c9badSJouni Malinen } 2222229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 22236a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2224240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2225229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2226240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 22276a7c9badSJouni Malinen 22286a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 22296a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22306a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22316a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 22326a7c9badSJouni Malinen break; 22336a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22346a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 22356a7c9badSJouni Malinen break; 22366a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22376a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 22386a7c9badSJouni Malinen break; 2239b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2240b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2241b8214df1SDai Shuibing break; 22426a7c9badSJouni Malinen default: 22436a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 22446a7c9badSJouni Malinen break; 22456a7c9badSJouni Malinen } 2246240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 22476a7c9badSJouni Malinen 22486a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2249f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 22506a7c9badSJouni Malinen 22513450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 22523450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 22533450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2254cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 22556a7c9badSJouni Malinen 2256c1762a3fSThirumalai Pachamuthu /* Enable uAPSD support by default */ 2257c1762a3fSThirumalai Pachamuthu res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2258c1762a3fSThirumalai Pachamuthu if (res < 0) 2259c1762a3fSThirumalai Pachamuthu return res; 2260c1762a3fSThirumalai Pachamuthu 22613ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 22623ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 22633ca9d1fcSAarthi Thiruvengadam } else { 22643ca9d1fcSAarthi Thiruvengadam /* 22653ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 22663ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 22673ca9d1fcSAarthi Thiruvengadam */ 22683ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 22693ca9d1fcSAarthi Thiruvengadam } 22703ca9d1fcSAarthi Thiruvengadam 2271334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 22729a5b1318SJouni Malinen if (res < 0) 22739a5b1318SJouni Malinen return res; 22749a5b1318SJouni Malinen 22759a5b1318SJouni Malinen return 0; 22766a7c9badSJouni Malinen } 22776a7c9badSJouni Malinen 22786a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 22796a7c9badSJouni Malinen struct beacon_parameters *info) 22806a7c9badSJouni Malinen { 22816a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 22826a7c9badSJouni Malinen } 22836a7c9badSJouni Malinen 22846a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 22856a7c9badSJouni Malinen struct beacon_parameters *info) 22866a7c9badSJouni Malinen { 22876a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 22886a7c9badSJouni Malinen } 22896a7c9badSJouni Malinen 22906a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 22916a7c9badSJouni Malinen { 22926a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 229359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22946a7c9badSJouni Malinen 2295f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 22966a7c9badSJouni Malinen return -EOPNOTSUPP; 229759c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 22986a7c9badSJouni Malinen return -ENOTCONN; 22996a7c9badSJouni Malinen 2300334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 230159c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 23026a7c9badSJouni Malinen 23036a7c9badSJouni Malinen return 0; 23046a7c9badSJouni Malinen } 23056a7c9badSJouni Malinen 230633e5308dSJouni Malinen static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 230733e5308dSJouni Malinen 230833e5308dSJouni Malinen static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 230933e5308dSJouni Malinen u8 *mac) 231033e5308dSJouni Malinen { 231133e5308dSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 231233e5308dSJouni Malinen struct ath6kl_vif *vif = netdev_priv(dev); 231333e5308dSJouni Malinen const u8 *addr = mac ? mac : bcast_addr; 231433e5308dSJouni Malinen 231533e5308dSJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 231633e5308dSJouni Malinen addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 231733e5308dSJouni Malinen } 231833e5308dSJouni Malinen 231923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 232023875136SJouni Malinen u8 *mac, struct station_parameters *params) 232123875136SJouni Malinen { 232223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2323f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 232423875136SJouni Malinen 2325f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 232623875136SJouni Malinen return -EOPNOTSUPP; 232723875136SJouni Malinen 232823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 232923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 233023875136SJouni Malinen return -EOPNOTSUPP; 233123875136SJouni Malinen 233223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2333334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2334334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2335334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2336334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 233723875136SJouni Malinen } 233823875136SJouni Malinen 233963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 234063fa1e0cSJouni Malinen struct net_device *dev, 234163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 234263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 234363fa1e0cSJouni Malinen unsigned int duration, 234463fa1e0cSJouni Malinen u64 *cookie) 234563fa1e0cSJouni Malinen { 234663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2347334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23481052261eSJouni Malinen u32 id; 234963fa1e0cSJouni Malinen 235063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 235163fa1e0cSJouni Malinen * return -EBUSY */ 23521052261eSJouni Malinen id = ++vif->last_roc_id; 23531052261eSJouni Malinen if (id == 0) { 23541052261eSJouni Malinen /* Do not use 0 as the cookie value */ 23551052261eSJouni Malinen id = ++vif->last_roc_id; 23561052261eSJouni Malinen } 23571052261eSJouni Malinen *cookie = id; 235863fa1e0cSJouni Malinen 2359334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2360334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 236163fa1e0cSJouni Malinen } 236263fa1e0cSJouni Malinen 236363fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 236463fa1e0cSJouni Malinen struct net_device *dev, 236563fa1e0cSJouni Malinen u64 cookie) 236663fa1e0cSJouni Malinen { 236763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2368334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 236963fa1e0cSJouni Malinen 23701052261eSJouni Malinen if (cookie != vif->last_roc_id) 237163fa1e0cSJouni Malinen return -ENOENT; 23721052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 237363fa1e0cSJouni Malinen 2374334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 237563fa1e0cSJouni Malinen } 237663fa1e0cSJouni Malinen 2377334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2378334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2379334234b5SVasanthakumar Thiagarajan unsigned int freq) 23808bdfbf40SJouni Malinen { 2381334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23828bdfbf40SJouni Malinen const u8 *pos; 23838bdfbf40SJouni Malinen u8 *p2p; 23848bdfbf40SJouni Malinen int p2p_len; 23858bdfbf40SJouni Malinen int ret; 23868bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 23878bdfbf40SJouni Malinen 23888bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 23898bdfbf40SJouni Malinen 23908bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 23918bdfbf40SJouni Malinen 23928bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 23938bdfbf40SJouni Malinen if (p2p == NULL) 23948bdfbf40SJouni Malinen return -ENOMEM; 23958bdfbf40SJouni Malinen p2p_len = 0; 23968bdfbf40SJouni Malinen 23978bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 23988bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 23998bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 24008bdfbf40SJouni Malinen break; 24018bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 24028bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 24038bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 24048bdfbf40SJouni Malinen } 24058bdfbf40SJouni Malinen pos += 2 + pos[1]; 24068bdfbf40SJouni Malinen } 24078bdfbf40SJouni Malinen 2408334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2409334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 24108bdfbf40SJouni Malinen kfree(p2p); 24118bdfbf40SJouni Malinen return ret; 24128bdfbf40SJouni Malinen } 24138bdfbf40SJouni Malinen 24148a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 24158a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 24168a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 24178a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2418e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2419e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 24208a6c8060SJouni Malinen { 24218a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 242259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24238a6c8060SJouni Malinen u32 id; 24248bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 24258bdfbf40SJouni Malinen 24268bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 24278bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2428f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 24298bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 24308bdfbf40SJouni Malinen /* 24318bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 24328bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 24338bdfbf40SJouni Malinen */ 24348bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2435334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 24368bdfbf40SJouni Malinen chan->center_freq); 24378bdfbf40SJouni Malinen } 24388a6c8060SJouni Malinen 2439cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24408a6c8060SJouni Malinen if (id == 0) { 24418a6c8060SJouni Malinen /* 24428a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 24438a6c8060SJouni Malinen * used for the command. 24448a6c8060SJouni Malinen */ 2445cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24468a6c8060SJouni Malinen } 24478a6c8060SJouni Malinen 24488a6c8060SJouni Malinen *cookie = id; 24493ca9d1fcSAarthi Thiruvengadam 24503ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 24513ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 24523ca9d1fcSAarthi Thiruvengadam /* 24533ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 24543ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 24553ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 24563ca9d1fcSAarthi Thiruvengadam * probe requests 24573ca9d1fcSAarthi Thiruvengadam */ 24583ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 24593ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 24603ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 24613ca9d1fcSAarthi Thiruvengadam } else { 2462334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2463334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 24648a6c8060SJouni Malinen buf, len); 24658a6c8060SJouni Malinen } 24663ca9d1fcSAarthi Thiruvengadam } 24678a6c8060SJouni Malinen 2468ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2469ae32c30aSJouni Malinen struct net_device *dev, 2470ae32c30aSJouni Malinen u16 frame_type, bool reg) 2471ae32c30aSJouni Malinen { 2472cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2473ae32c30aSJouni Malinen 2474ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2475ae32c30aSJouni Malinen __func__, frame_type, reg); 2476ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2477ae32c30aSJouni Malinen /* 2478ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2479ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2480ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2481ae32c30aSJouni Malinen */ 2482cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2483ae32c30aSJouni Malinen } 2484ae32c30aSJouni Malinen } 2485ae32c30aSJouni Malinen 248610509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 248710509f90SKalle Valo struct net_device *dev, 248810509f90SKalle Valo struct cfg80211_sched_scan_request *request) 248910509f90SKalle Valo { 249010509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 249110509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 249210509f90SKalle Valo u16 interval; 249310509f90SKalle Valo int ret; 249410509f90SKalle Valo u8 i; 249510509f90SKalle Valo 249610509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 249710509f90SKalle Valo return -EIO; 249810509f90SKalle Valo 249910509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 250010509f90SKalle Valo return -EBUSY; 250110509f90SKalle Valo 250210509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 250310509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 250410509f90SKalle Valo i, DISABLE_SSID_FLAG, 250510509f90SKalle Valo 0, NULL); 250610509f90SKalle Valo } 250710509f90SKalle Valo 250810509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 250910509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 251010509f90SKalle Valo 251110509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 251210509f90SKalle Valo interval, interval, 251310509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 251410509f90SKalle Valo 251510509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 251610509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 251710509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 251810509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 251910509f90SKalle Valo request->ssids[i].ssid_len, 252010509f90SKalle Valo request->ssids[i].ssid); 252110509f90SKalle Valo } 252210509f90SKalle Valo } 252310509f90SKalle Valo 252410509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 252510509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 252610509f90SKalle Valo WOW_FILTER_SSID, 252710509f90SKalle Valo WOW_HOST_REQ_DELAY); 252810509f90SKalle Valo if (ret) { 252910509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 253010509f90SKalle Valo return ret; 253110509f90SKalle Valo } 253210509f90SKalle Valo 253310509f90SKalle Valo /* this also clears IE in fw if it's not set */ 253410509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 253510509f90SKalle Valo WMI_FRAME_PROBE_REQ, 253610509f90SKalle Valo request->ie, request->ie_len); 253710509f90SKalle Valo if (ret) { 253810509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 253910509f90SKalle Valo ret); 254010509f90SKalle Valo return ret; 254110509f90SKalle Valo } 254210509f90SKalle Valo 254310509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 254410509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 254510509f90SKalle Valo if (ret) { 254610509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 254710509f90SKalle Valo ret); 254810509f90SKalle Valo return ret; 254910509f90SKalle Valo } 255010509f90SKalle Valo 255110509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 255210509f90SKalle Valo 255310509f90SKalle Valo return ret; 255410509f90SKalle Valo } 255510509f90SKalle Valo 255610509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 255710509f90SKalle Valo struct net_device *dev) 255810509f90SKalle Valo { 255910509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 256010509f90SKalle Valo bool stopped; 256110509f90SKalle Valo 256210509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 256310509f90SKalle Valo 256410509f90SKalle Valo if (!stopped) 256510509f90SKalle Valo return -EIO; 256610509f90SKalle Valo 256710509f90SKalle Valo return 0; 256810509f90SKalle Valo } 256910509f90SKalle Valo 2570f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2571f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2572f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2573f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2574f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2575f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2576f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2577f80574aeSJouni Malinen }, 2578ba1f6fe3SJouni Malinen [NL80211_IFTYPE_AP] = { 2579ba1f6fe3SJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2580ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2581ba1f6fe3SJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2582ba1f6fe3SJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2583ba1f6fe3SJouni Malinen }, 2584f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2585f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2586f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2587f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2588f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2589f80574aeSJouni Malinen }, 2590f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2591f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2592f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2593f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2594f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2595f80574aeSJouni Malinen }, 2596f80574aeSJouni Malinen }; 2597f80574aeSJouni Malinen 2598bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 259955055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 260055055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2601bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2602bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2603bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2604bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2605bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2606bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2607bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2608bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2609bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2610bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2611bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2612bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2613bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2614bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2615bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2616bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2617bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2618bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2619003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2620abcb344bSKalle Valo #ifdef CONFIG_PM 262152d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 262252d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2623abcb344bSKalle Valo #endif 26246a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 26256a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 26266a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 26276a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 262833e5308dSJouni Malinen .del_station = ath6kl_del_station, 262923875136SJouni Malinen .change_station = ath6kl_change_station, 263063fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 263163fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 26328a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2633ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 263410509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 263510509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2636bdcd8170SKalle Valo }; 2637bdcd8170SKalle Valo 26387125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2639ec4b7f60SKalle Valo { 264010509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 264110509f90SKalle Valo 2642ec4b7f60SKalle Valo switch (vif->sme_state) { 2643c97a31b0SKalle Valo case SME_DISCONNECTED: 2644c97a31b0SKalle Valo break; 2645ec4b7f60SKalle Valo case SME_CONNECTING: 2646ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2647ec4b7f60SKalle Valo NULL, 0, 2648ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2649ec4b7f60SKalle Valo GFP_KERNEL); 2650ec4b7f60SKalle Valo break; 2651ec4b7f60SKalle Valo case SME_CONNECTED: 2652ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2653ec4b7f60SKalle Valo break; 2654ec4b7f60SKalle Valo } 2655ec4b7f60SKalle Valo 2656ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2657ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 26587125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2659ec4b7f60SKalle Valo 2660ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 26611f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 26621f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2663ec4b7f60SKalle Valo 2664ec4b7f60SKalle Valo /* disable scanning */ 26657125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 26667125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 26677125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 2668ec4b7f60SKalle Valo 2669ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2670ec4b7f60SKalle Valo } 2671ec4b7f60SKalle Valo 26727125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 26737125f01dSKalle Valo { 26747125f01dSKalle Valo struct ath6kl_vif *vif; 26757125f01dSKalle Valo 26767125f01dSKalle Valo vif = ath6kl_vif_first(ar); 26777125f01dSKalle Valo if (!vif) { 26787125f01dSKalle Valo /* save the current power mode before enabling power save */ 26797125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 26807125f01dSKalle Valo 26817125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 26827125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 26837125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 26847125f01dSKalle Valo return; 26857125f01dSKalle Valo } 26867125f01dSKalle Valo 26877125f01dSKalle Valo /* 26887125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 26897125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 26907125f01dSKalle Valo * sleeps. 26917125f01dSKalle Valo */ 26927125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 26937125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 26947125f01dSKalle Valo } 26957125f01dSKalle Valo 26968dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 2697bdcd8170SKalle Valo { 26986bbc7c35SJouni Malinen struct ath6kl *ar; 2699be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 27008dafb70eSVasanthakumar Thiagarajan u8 ctr; 2701bdcd8170SKalle Valo 2702bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 2703be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 27048dafb70eSVasanthakumar Thiagarajan 2705be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 2706bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 2707bdcd8170SKalle Valo return NULL; 2708bdcd8170SKalle Valo } 2709bdcd8170SKalle Valo 2710be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 27116bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 2712be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 27138dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 27148dafb70eSVasanthakumar Thiagarajan 271571f96ee6SKalle Valo ar->vif_max = 1; 271671f96ee6SKalle Valo 27173226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 27183226f68aSVasanthakumar Thiagarajan 27198dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 27208dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 2721990bd915SVasanthakumar Thiagarajan spin_lock_init(&ar->list_lock); 27228dafb70eSVasanthakumar Thiagarajan 27238dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 27248dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 27258dafb70eSVasanthakumar Thiagarajan 27268dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 2727990bd915SVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->vif_list); 27288dafb70eSVasanthakumar Thiagarajan 27298dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 27308dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 27318dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 27328dafb70eSVasanthakumar Thiagarajan 27338232736dSSujith Manoharan ar->listen_intvl_b = A_DEFAULT_LISTEN_INTERVAL; 27348dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 27358dafb70eSVasanthakumar Thiagarajan 27368dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 27378dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 27388dafb70eSVasanthakumar Thiagarajan 273976a9fbe2SKalle Valo ar->state = ATH6KL_STATE_OFF; 274076a9fbe2SKalle Valo 27418dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 27428dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 27438dafb70eSVasanthakumar Thiagarajan 27448dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 27458dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 27468dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 27478dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 2748c1762a3fSThirumalai Pachamuthu skb_queue_head_init(&ar->sta_list[ctr].apsdq); 27498dafb70eSVasanthakumar Thiagarajan } 27508dafb70eSVasanthakumar Thiagarajan 27518dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 27528dafb70eSVasanthakumar Thiagarajan 27538dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 27548dafb70eSVasanthakumar Thiagarajan 27558dafb70eSVasanthakumar Thiagarajan return ar; 27568dafb70eSVasanthakumar Thiagarajan } 27578dafb70eSVasanthakumar Thiagarajan 27588dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 27598dafb70eSVasanthakumar Thiagarajan { 27608dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 27618dafb70eSVasanthakumar Thiagarajan int ret; 27626bbc7c35SJouni Malinen 2763be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2764f80574aeSJouni Malinen 2765be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 276663fa1e0cSJouni Malinen 2767bdcd8170SKalle Valo /* set device pointer for wiphy */ 27688dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2769bdcd8170SKalle Valo 2770be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 27718dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 27728dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 27736bbc7c35SJouni Malinen if (ar->p2p) { 2774be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 27756bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 27766bbc7c35SJouni Malinen } 27778dafb70eSVasanthakumar Thiagarajan 2778bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2779be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2780be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2781be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2782be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2783be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2784bdcd8170SKalle Valo 2785be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2786be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2787bdcd8170SKalle Valo 2788eae9e066SRaja Mani wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 2789eae9e066SRaja Mani WIPHY_WOWLAN_DISCONNECT | 2790eae9e066SRaja Mani WIPHY_WOWLAN_GTK_REKEY_FAILURE | 2791eae9e066SRaja Mani WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 2792eae9e066SRaja Mani WIPHY_WOWLAN_EAP_IDENTITY_REQ | 2793eae9e066SRaja Mani WIPHY_WOWLAN_4WAY_HANDSHAKE; 2794eae9e066SRaja Mani wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 2795eae9e066SRaja Mani wiphy->wowlan.pattern_min_len = 1; 2796eae9e066SRaja Mani wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 2797eae9e066SRaja Mani 279810509f90SKalle Valo wiphy->max_sched_scan_ssids = 10; 279910509f90SKalle Valo 2800be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2801bdcd8170SKalle Valo if (ret < 0) { 2802bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 28038dafb70eSVasanthakumar Thiagarajan return ret; 28048dafb70eSVasanthakumar Thiagarajan } 28058dafb70eSVasanthakumar Thiagarajan 28068dafb70eSVasanthakumar Thiagarajan return 0; 28078dafb70eSVasanthakumar Thiagarajan } 28088dafb70eSVasanthakumar Thiagarajan 2809c25889e8SKalle Valo static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 28108dafb70eSVasanthakumar Thiagarajan { 28112132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 28122132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 28138dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 28148dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 28158dafb70eSVasanthakumar Thiagarajan } 28168dafb70eSVasanthakumar Thiagarajan 2817de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2818108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 281910509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 282010509f90SKalle Valo (unsigned long) vif); 282110509f90SKalle Valo 2822de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2823478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 28248dafb70eSVasanthakumar Thiagarajan 282580abaf9bSVasanthakumar Thiagarajan INIT_LIST_HEAD(&vif->mc_filter); 282680abaf9bSVasanthakumar Thiagarajan 28278dafb70eSVasanthakumar Thiagarajan return 0; 28288dafb70eSVasanthakumar Thiagarajan } 28298dafb70eSVasanthakumar Thiagarajan 2830c25889e8SKalle Valo void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 28318dafb70eSVasanthakumar Thiagarajan { 283255055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 283380abaf9bSVasanthakumar Thiagarajan struct ath6kl_mc_filter *mc_filter, *tmp; 283455055976SVasanthakumar Thiagarajan 28352132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2836108438bcSVasanthakumar Thiagarajan 283755055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 283855055976SVasanthakumar Thiagarajan 283955055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 284055055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 284155055976SVasanthakumar Thiagarajan 284280abaf9bSVasanthakumar Thiagarajan list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 284380abaf9bSVasanthakumar Thiagarajan list_del(&mc_filter->list); 284480abaf9bSVasanthakumar Thiagarajan kfree(mc_filter); 284580abaf9bSVasanthakumar Thiagarajan } 284680abaf9bSVasanthakumar Thiagarajan 284727929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 284855055976SVasanthakumar Thiagarajan 284955055976SVasanthakumar Thiagarajan ar->num_vif--; 28508dafb70eSVasanthakumar Thiagarajan } 28518dafb70eSVasanthakumar Thiagarajan 28528dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 285355055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 285455055976SVasanthakumar Thiagarajan u8 nw_type) 28558dafb70eSVasanthakumar Thiagarajan { 28568dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2857108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 28588dafb70eSVasanthakumar Thiagarajan 285955055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 28608dafb70eSVasanthakumar Thiagarajan if (!ndev) 28618dafb70eSVasanthakumar Thiagarajan return NULL; 28628dafb70eSVasanthakumar Thiagarajan 2863108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2864108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2865108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2866108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2867108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2868108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2869108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2870108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2871334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 287255055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 28738dafb70eSVasanthakumar Thiagarajan 287455055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 287555055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 287655055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 287755055976SVasanthakumar Thiagarajan 0x2; 287855055976SVasanthakumar Thiagarajan 28798dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 28808dafb70eSVasanthakumar Thiagarajan 2881e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 28828dafb70eSVasanthakumar Thiagarajan 2883c25889e8SKalle Valo if (ath6kl_cfg80211_vif_init(vif)) 28848dafb70eSVasanthakumar Thiagarajan goto err; 28858dafb70eSVasanthakumar Thiagarajan 288627929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 28878dafb70eSVasanthakumar Thiagarajan goto err; 28888dafb70eSVasanthakumar Thiagarajan 288955055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 289014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 289159c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 28928dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 289359c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 28948dafb70eSVasanthakumar Thiagarajan 289555055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 289655055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 289755055976SVasanthakumar Thiagarajan 289811f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2899990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 290011f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2901990bd915SVasanthakumar Thiagarajan 29028dafb70eSVasanthakumar Thiagarajan return ndev; 29038dafb70eSVasanthakumar Thiagarajan 29048dafb70eSVasanthakumar Thiagarajan err: 290527929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 290627929723SVasanthakumar Thiagarajan free_netdev(ndev); 2907bdcd8170SKalle Valo return NULL; 2908bdcd8170SKalle Valo } 2909bdcd8170SKalle Valo 29108dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2911bdcd8170SKalle Valo { 2912be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2913be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2914bdcd8170SKalle Valo } 2915