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 527bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 528bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 529bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 530bdcd8170SKalle Valo sme->key_idx); 531bdcd8170SKalle Valo up(&ar->sem); 532bdcd8170SKalle Valo return -ENOENT; 533bdcd8170SKalle Valo } 534bdcd8170SKalle Valo 5356f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[sme->key_idx]; 536bdcd8170SKalle Valo key->key_len = sme->key_len; 537bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 5383450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 5393450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 540bdcd8170SKalle Valo 541334234b5SVasanthakumar Thiagarajan ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 5423450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 543bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 544bdcd8170SKalle Valo key->key_len, 545f4bb9a6fSJouni Malinen NULL, 0, 546bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 547bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 548bdcd8170SKalle Valo } 549bdcd8170SKalle Valo 550bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 55159c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 552240d2799SVasanthakumar Thiagarajan if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 553240d2799SVasanthakumar Thiagarajan ALL_BSS_FILTER, 0) != 0) { 554bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 555bdcd8170SKalle Valo up(&ar->sem); 556bdcd8170SKalle Valo return -EIO; 557bdcd8170SKalle Valo } 558bdcd8170SKalle Valo } 559bdcd8170SKalle Valo 560f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 561bdcd8170SKalle Valo 5623ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 5633ca9d1fcSAarthi Thiruvengadam nw_subtype = SUBTYPE_P2PCLIENT; 5643ca9d1fcSAarthi Thiruvengadam 565bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 566bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 567bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 568bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 569bdcd8170SKalle Valo __func__, 5703450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 5713450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 572f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 573bdcd8170SKalle Valo 574cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 575334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 5763450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 5773450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 5783450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 5793450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 5803450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 581f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 5823ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, nw_subtype); 583bdcd8170SKalle Valo 584bdcd8170SKalle Valo up(&ar->sem); 585bdcd8170SKalle Valo 586bdcd8170SKalle Valo if (status == -EINVAL) { 5873450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 5883450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 589bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 590bdcd8170SKalle Valo return -ENOENT; 591bdcd8170SKalle Valo } else if (status) { 592bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 593bdcd8170SKalle Valo return -EIO; 594bdcd8170SKalle Valo } 595bdcd8170SKalle Valo 596bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 5973450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 5983450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 599de3ad713SVasanthakumar Thiagarajan mod_timer(&vif->disconnect_timer, 600bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 601bdcd8170SKalle Valo } 602bdcd8170SKalle Valo 603bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 60459c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 605bdcd8170SKalle Valo 606bdcd8170SKalle Valo return 0; 607bdcd8170SKalle Valo } 608bdcd8170SKalle Valo 6095e13fd35SVasanthakumar Thiagarajan static struct cfg80211_bss * 6105e13fd35SVasanthakumar Thiagarajan ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 6114eab6f4fSRaja Mani enum network_type nw_type, 6124eab6f4fSRaja Mani const u8 *bssid, 61301cac476SJouni Malinen struct ieee80211_channel *chan, 6145e13fd35SVasanthakumar Thiagarajan const u8 *beacon_ie, 6155e13fd35SVasanthakumar Thiagarajan size_t beacon_ie_len) 61601cac476SJouni Malinen { 617240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 61801cac476SJouni Malinen struct cfg80211_bss *bss; 6194eab6f4fSRaja Mani u16 cap_mask, cap_val; 62001cac476SJouni Malinen u8 *ie; 62101cac476SJouni Malinen 6224eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 6234eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_IBSS; 6244eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_IBSS; 6254eab6f4fSRaja Mani } else { 6264eab6f4fSRaja Mani cap_mask = WLAN_CAPABILITY_ESS; 6274eab6f4fSRaja Mani cap_val = WLAN_CAPABILITY_ESS; 6284eab6f4fSRaja Mani } 6294eab6f4fSRaja Mani 630be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 6314eab6f4fSRaja Mani vif->ssid, vif->ssid_len, 6324eab6f4fSRaja Mani cap_mask, cap_val); 63301cac476SJouni Malinen if (bss == NULL) { 63401cac476SJouni Malinen /* 63501cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 63601cac476SJouni Malinen * generate a partial entry until the first BSS info 63701cac476SJouni Malinen * event becomes available. 63801cac476SJouni Malinen * 63901cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 64001cac476SJouni Malinen * IEs from the target. 64101cac476SJouni Malinen */ 6423450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 64301cac476SJouni Malinen if (ie == NULL) 6445e13fd35SVasanthakumar Thiagarajan return NULL; 64501cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 6463450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 6473450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 6483450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 649be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 6504eab6f4fSRaja Mani bssid, 0, cap_val, 100, 6513450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 65201cac476SJouni Malinen 0, GFP_KERNEL); 65301cac476SJouni Malinen if (bss) 6544eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added bss %pM to " 6554eab6f4fSRaja Mani "cfg80211\n", bssid); 65601cac476SJouni Malinen kfree(ie); 65701cac476SJouni Malinen } else 6585e13fd35SVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 65901cac476SJouni Malinen 6605e13fd35SVasanthakumar Thiagarajan return bss; 66101cac476SJouni Malinen } 66201cac476SJouni Malinen 663240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 664bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 665bdcd8170SKalle Valo u16 beacon_intvl, 666bdcd8170SKalle Valo enum network_type nw_type, 667bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 668bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 669bdcd8170SKalle Valo { 67001cac476SJouni Malinen struct ieee80211_channel *chan; 671240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 6725e13fd35SVasanthakumar Thiagarajan struct cfg80211_bss *bss; 673bdcd8170SKalle Valo 674bdcd8170SKalle Valo /* capinfo + listen interval */ 675bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 676bdcd8170SKalle Valo 677bdcd8170SKalle Valo /* capinfo + status code + associd */ 678bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 679bdcd8170SKalle Valo 680bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 681bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 682bdcd8170SKalle Valo assoc_resp_ie_offset; 683bdcd8170SKalle Valo 684bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 685bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 686bdcd8170SKalle Valo 68732c10874SJouni Malinen /* 68832c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 68932c10874SJouni Malinen * a Beacon frame from the AP is seen. 69032c10874SJouni Malinen */ 691cf5333d7SVasanthakumar Thiagarajan vif->assoc_bss_beacon_int = beacon_intvl; 69259c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 69332c10874SJouni Malinen 694bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 695551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 696bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 697bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 698bdcd8170SKalle Valo return; 699bdcd8170SKalle Valo } 700bdcd8170SKalle Valo } 701bdcd8170SKalle Valo 702bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 703551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 704551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 705bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 706bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 707bdcd8170SKalle Valo return; 708bdcd8170SKalle Valo } 709bdcd8170SKalle Valo } 710bdcd8170SKalle Valo 711be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 712bdcd8170SKalle Valo 7135e13fd35SVasanthakumar Thiagarajan bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 7145e13fd35SVasanthakumar Thiagarajan assoc_info, beacon_ie_len); 7155e13fd35SVasanthakumar Thiagarajan if (!bss) { 7164eab6f4fSRaja Mani ath6kl_err("could not add cfg80211 bss entry\n"); 717bdcd8170SKalle Valo return; 718bdcd8170SKalle Valo } 719bdcd8170SKalle Valo 7204eab6f4fSRaja Mani if (nw_type & ADHOC_NETWORK) { 7214eab6f4fSRaja Mani ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 7224eab6f4fSRaja Mani nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 7234eab6f4fSRaja Mani cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 7245e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 72501cac476SJouni Malinen return; 72601cac476SJouni Malinen } 72701cac476SJouni Malinen 72814ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 729bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 73014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_CONNECTED; 731240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, bssid, 732bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 733bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 734bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 7355e13fd35SVasanthakumar Thiagarajan cfg80211_put_bss(bss); 73614ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 737bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 7385e13fd35SVasanthakumar Thiagarajan cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 739bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 740bdcd8170SKalle Valo } 741bdcd8170SKalle Valo } 742bdcd8170SKalle Valo 743bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 744bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 745bdcd8170SKalle Valo { 746d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 7473450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 748bdcd8170SKalle Valo 749bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 750bdcd8170SKalle Valo reason_code); 751bdcd8170SKalle Valo 75210509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 75310509f90SKalle Valo 754990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 755bdcd8170SKalle Valo return -EIO; 756bdcd8170SKalle Valo 757bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 758bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 759bdcd8170SKalle Valo return -EBUSY; 760bdcd8170SKalle Valo } 761bdcd8170SKalle Valo 762bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 763bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 764bdcd8170SKalle Valo return -ERESTARTSYS; 765bdcd8170SKalle Valo } 766bdcd8170SKalle Valo 767cf5333d7SVasanthakumar Thiagarajan vif->reconnect_flag = 0; 768240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 7693450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 7703450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 771bdcd8170SKalle Valo 772bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 7738c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 774bdcd8170SKalle Valo 775bdcd8170SKalle Valo up(&ar->sem); 776bdcd8170SKalle Valo 77714ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 778170826ddSVasanthakumar Thiagarajan 779bdcd8170SKalle Valo return 0; 780bdcd8170SKalle Valo } 781bdcd8170SKalle Valo 782240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 783bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 784bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 785bdcd8170SKalle Valo { 786240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 78759c98449SVasanthakumar Thiagarajan 78814ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req) { 78914ee6f6bSVasanthakumar Thiagarajan cfg80211_scan_done(vif->scan_req, true); 79014ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 791bdcd8170SKalle Valo } 792bdcd8170SKalle Valo 793f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & ADHOC_NETWORK) { 794551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 795bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 796bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 797bdcd8170SKalle Valo return; 798bdcd8170SKalle Valo } 799bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 800240d2799SVasanthakumar Thiagarajan cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 801bdcd8170SKalle Valo return; 802bdcd8170SKalle Valo } 803bdcd8170SKalle Valo 804f5938f24SVasanthakumar Thiagarajan if (vif->nw_type & INFRA_NETWORK) { 805551959d8SVasanthakumar Thiagarajan if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 806551959d8SVasanthakumar Thiagarajan vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 807bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 808bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 809bdcd8170SKalle Valo return; 810bdcd8170SKalle Valo } 811bdcd8170SKalle Valo } 812bdcd8170SKalle Valo 8131de547d6SVasanthakumar Thiagarajan /* 8141de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 8151de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 8161de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 8171de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 8181de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 8191de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 8201de547d6SVasanthakumar Thiagarajan */ 821bdcd8170SKalle Valo 8221de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 823334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 824bdcd8170SKalle Valo return; 825bdcd8170SKalle Valo } 826bdcd8170SKalle Valo 82759c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 828bdcd8170SKalle Valo 82914ee6f6bSVasanthakumar Thiagarajan if (vif->sme_state == SME_CONNECTING) { 830240d2799SVasanthakumar Thiagarajan cfg80211_connect_result(vif->ndev, 831bdcd8170SKalle Valo bssid, NULL, 0, 832bdcd8170SKalle Valo NULL, 0, 833bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 834bdcd8170SKalle Valo GFP_KERNEL); 83514ee6f6bSVasanthakumar Thiagarajan } else if (vif->sme_state == SME_CONNECTED) { 836240d2799SVasanthakumar Thiagarajan cfg80211_disconnected(vif->ndev, reason, 837bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 838bdcd8170SKalle Valo } 839bdcd8170SKalle Valo 84014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 841bdcd8170SKalle Valo } 842bdcd8170SKalle Valo 843bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 844bdcd8170SKalle Valo struct cfg80211_scan_request *request) 845bdcd8170SKalle Valo { 846d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 84759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 8481276c9efSEdward Lu s8 n_channels = 0; 8491276c9efSEdward Lu u16 *channels = NULL; 850bdcd8170SKalle Valo int ret = 0; 851f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 852bdcd8170SKalle Valo 853990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 854bdcd8170SKalle Valo return -EIO; 855bdcd8170SKalle Valo 85610509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 85710509f90SKalle Valo 858bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 85959c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 8601b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 861240d2799SVasanthakumar Thiagarajan ar->wmi, vif->fw_vif_idx, 86259c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 8631b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 8641b1e6ee3SJouni Malinen if (ret) { 865bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 8661b1e6ee3SJouni Malinen return ret; 867bdcd8170SKalle Valo } 868bdcd8170SKalle Valo } 869bdcd8170SKalle Valo 870bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 871bdcd8170SKalle Valo u8 i; 872bdcd8170SKalle Valo 873bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 874bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 875bdcd8170SKalle Valo 876bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 877334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 878334234b5SVasanthakumar Thiagarajan i + 1, SPECIFIC_SSID_FLAG, 879bdcd8170SKalle Valo request->ssids[i].ssid_len, 880bdcd8170SKalle Valo request->ssids[i].ssid); 881bdcd8170SKalle Valo } 882bdcd8170SKalle Valo 88310509f90SKalle Valo /* 88410509f90SKalle Valo * FIXME: we should clear the IE in fw if it's not set so just 88510509f90SKalle Valo * remove the check altogether 88610509f90SKalle Valo */ 887b84da8c7SJouni Malinen if (request->ie) { 888334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 889334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_REQ, 890b84da8c7SJouni Malinen request->ie, request->ie_len); 891b84da8c7SJouni Malinen if (ret) { 892b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 893b84da8c7SJouni Malinen "scan"); 894b84da8c7SJouni Malinen return ret; 895b84da8c7SJouni Malinen } 896b84da8c7SJouni Malinen } 897b84da8c7SJouni Malinen 89811869befSJouni Malinen /* 89911869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 90011869befSJouni Malinen * channels. If the list is longer than the target supports, do not 90111869befSJouni Malinen * configure the list and instead, scan all available channels. 90211869befSJouni Malinen */ 90311869befSJouni Malinen if (request->n_channels > 0 && 90411869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 9051276c9efSEdward Lu u8 i; 9061276c9efSEdward Lu 90711869befSJouni Malinen n_channels = request->n_channels; 9081276c9efSEdward Lu 9091276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 9101276c9efSEdward Lu if (channels == NULL) { 9111276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 9121276c9efSEdward Lu "scan all channels"); 9131276c9efSEdward Lu n_channels = 0; 9141276c9efSEdward Lu } 9151276c9efSEdward Lu 9161276c9efSEdward Lu for (i = 0; i < n_channels; i++) 9171276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 9181276c9efSEdward Lu } 9191276c9efSEdward Lu 92059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 921f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 922f1f92179SVasanthakumar Thiagarajan 9233ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 9243ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 9253ca9d1fcSAarthi Thiruvengadam /* 9263ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 9273ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 9283ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 9293ca9d1fcSAarthi Thiruvengadam * probe requests 9303ca9d1fcSAarthi Thiruvengadam */ 9313ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 9323ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9333ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 9343ca9d1fcSAarthi Thiruvengadam channels, request->no_cck, 9353ca9d1fcSAarthi Thiruvengadam request->rates); 9363ca9d1fcSAarthi Thiruvengadam } else { 9373ca9d1fcSAarthi Thiruvengadam ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 9383ca9d1fcSAarthi Thiruvengadam WMI_LONG_SCAN, force_fg_scan, 9393ca9d1fcSAarthi Thiruvengadam false, 0, 0, n_channels, 940334234b5SVasanthakumar Thiagarajan channels); 9413ca9d1fcSAarthi Thiruvengadam } 9421b1e6ee3SJouni Malinen if (ret) 943bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 94411869befSJouni Malinen else 94514ee6f6bSVasanthakumar Thiagarajan vif->scan_req = request; 946bdcd8170SKalle Valo 9471276c9efSEdward Lu kfree(channels); 9481276c9efSEdward Lu 949bdcd8170SKalle Valo return ret; 950bdcd8170SKalle Valo } 951bdcd8170SKalle Valo 9521c17d313SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 953bdcd8170SKalle Valo { 954240d2799SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 9556fd1eaceSKalle Valo int i; 956bdcd8170SKalle Valo 9571c17d313SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 9581c17d313SKalle Valo aborted ? " aborted" : ""); 959bdcd8170SKalle Valo 96014ee6f6bSVasanthakumar Thiagarajan if (!vif->scan_req) 9616fd1eaceSKalle Valo return; 9626fd1eaceSKalle Valo 9631c17d313SKalle Valo if (aborted) 9646fd1eaceSKalle Valo goto out; 965bdcd8170SKalle Valo 96614ee6f6bSVasanthakumar Thiagarajan if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 96714ee6f6bSVasanthakumar Thiagarajan for (i = 0; i < vif->scan_req->n_ssids; i++) { 968334234b5SVasanthakumar Thiagarajan ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 969334234b5SVasanthakumar Thiagarajan i + 1, DISABLE_SSID_FLAG, 970bdcd8170SKalle Valo 0, NULL); 971bdcd8170SKalle Valo } 972bdcd8170SKalle Valo } 9736fd1eaceSKalle Valo 9746fd1eaceSKalle Valo out: 975cb93821aSKalle Valo cfg80211_scan_done(vif->scan_req, aborted); 97614ee6f6bSVasanthakumar Thiagarajan vif->scan_req = NULL; 977bdcd8170SKalle Valo } 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 980bdcd8170SKalle Valo u8 key_index, bool pairwise, 981bdcd8170SKalle Valo const u8 *mac_addr, 982bdcd8170SKalle Valo struct key_params *params) 983bdcd8170SKalle Valo { 984d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 98559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 986bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 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 1000bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || 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 1015bdcd8170SKalle Valo if (params) { 10165e07021eSDai Shuibing int seq_len = params->seq_len; 10175e07021eSDai Shuibing if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 10185e07021eSDai Shuibing seq_len > ATH6KL_KEY_SEQ_LEN) { 10195e07021eSDai Shuibing /* Only first half of the WPI PN is configured */ 10205e07021eSDai Shuibing seq_len = ATH6KL_KEY_SEQ_LEN; 10215e07021eSDai Shuibing } 1022bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 10235e07021eSDai Shuibing seq_len > sizeof(key->seq)) 1024bdcd8170SKalle Valo return -EINVAL; 1025bdcd8170SKalle Valo 1026bdcd8170SKalle Valo key->key_len = params->key_len; 1027bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 10285e07021eSDai Shuibing key->seq_len = seq_len; 1029bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 1030bdcd8170SKalle Valo key->cipher = params->cipher; 1031bdcd8170SKalle Valo } 1032bdcd8170SKalle Valo 1033bdcd8170SKalle Valo switch (key->cipher) { 1034bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 1035bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 1036bdcd8170SKalle Valo key_type = WEP_CRYPT; 1037bdcd8170SKalle Valo break; 1038bdcd8170SKalle Valo 1039bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 1040bdcd8170SKalle Valo key_type = TKIP_CRYPT; 1041bdcd8170SKalle Valo break; 1042bdcd8170SKalle Valo 1043bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 1044bdcd8170SKalle Valo key_type = AES_CRYPT; 1045bdcd8170SKalle Valo break; 10465e07021eSDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 10475e07021eSDai Shuibing key_type = WAPI_CRYPT; 10485e07021eSDai Shuibing break; 1049bdcd8170SKalle Valo 1050bdcd8170SKalle Valo default: 1051bdcd8170SKalle Valo return -ENOTSUPP; 1052bdcd8170SKalle Valo } 1053bdcd8170SKalle Valo 10543450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 10553450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 1056bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 1057de3ad713SVasanthakumar Thiagarajan del_timer(&vif->disconnect_timer); 1058bdcd8170SKalle Valo 1059bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1060bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1061bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 1062bdcd8170SKalle Valo key_usage, key->seq_len); 1063bdcd8170SKalle Valo 1064f5938f24SVasanthakumar Thiagarajan if (vif->nw_type == AP_NETWORK && !pairwise && 10654703290aSJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 10664703290aSJouni Malinen key_type == WAPI_CRYPT) && params) { 10679a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 10689a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 10699a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 10709a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 10719a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 107259c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 10739a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 10749a5b1318SJouni Malinen "key configuration until AP mode has been " 10759a5b1318SJouni Malinen "started\n"); 10769a5b1318SJouni Malinen /* 10779a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 10789a5b1318SJouni Malinen * the connected event is received from the target. 10799a5b1318SJouni Malinen */ 10809a5b1318SJouni Malinen return 0; 10819a5b1318SJouni Malinen } 10829a5b1318SJouni Malinen } 10839a5b1318SJouni Malinen 1084f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 108559c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 1086151411e8SJouni Malinen /* 1087151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 1088151411e8SJouni Malinen * the AP mode has properly started 1089151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 1090151411e8SJouni Malinen */ 1091151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 1092151411e8SJouni Malinen "until AP mode has been started\n"); 10936f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 10946f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 10956f2a73f9SVasanthakumar Thiagarajan key->key_len); 1096151411e8SJouni Malinen return 0; 1097151411e8SJouni Malinen } 1098151411e8SJouni Malinen 10997cefa44fSVasanthakumar Thiagarajan return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1100bdcd8170SKalle Valo key_type, key_usage, key->key_len, 1101f4bb9a6fSJouni Malinen key->seq, key->seq_len, key->key, 1102f4bb9a6fSJouni Malinen KEY_OP_INIT_VAL, 1103bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1104bdcd8170SKalle Valo } 1105bdcd8170SKalle Valo 1106bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1107bdcd8170SKalle Valo u8 key_index, bool pairwise, 1108bdcd8170SKalle Valo const u8 *mac_addr) 1109bdcd8170SKalle Valo { 1110d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 11116f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1112bdcd8170SKalle Valo 1113bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1114bdcd8170SKalle Valo 1115990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1116bdcd8170SKalle Valo return -EIO; 1117bdcd8170SKalle Valo 1118bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1119bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1120bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1121bdcd8170SKalle Valo key_index); 1122bdcd8170SKalle Valo return -ENOENT; 1123bdcd8170SKalle Valo } 1124bdcd8170SKalle Valo 11256f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1126bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1127bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 1128bdcd8170SKalle Valo return 0; 1129bdcd8170SKalle Valo } 1130bdcd8170SKalle Valo 11316f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 1132bdcd8170SKalle Valo 1133334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1134bdcd8170SKalle Valo } 1135bdcd8170SKalle Valo 1136bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1137bdcd8170SKalle Valo u8 key_index, bool pairwise, 1138bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 1139bdcd8170SKalle Valo void (*callback) (void *cookie, 1140bdcd8170SKalle Valo struct key_params *)) 1141bdcd8170SKalle Valo { 11426f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1143bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1144bdcd8170SKalle Valo struct key_params params; 1145bdcd8170SKalle Valo 1146bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1147bdcd8170SKalle Valo 1148990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1149bdcd8170SKalle Valo return -EIO; 1150bdcd8170SKalle Valo 1151bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1152bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1153bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1154bdcd8170SKalle Valo key_index); 1155bdcd8170SKalle Valo return -ENOENT; 1156bdcd8170SKalle Valo } 1157bdcd8170SKalle Valo 11586f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1159bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1160bdcd8170SKalle Valo params.cipher = key->cipher; 1161bdcd8170SKalle Valo params.key_len = key->key_len; 1162bdcd8170SKalle Valo params.seq_len = key->seq_len; 1163bdcd8170SKalle Valo params.seq = key->seq; 1164bdcd8170SKalle Valo params.key = key->key; 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo callback(cookie, ¶ms); 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1169bdcd8170SKalle Valo } 1170bdcd8170SKalle Valo 1171bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1172bdcd8170SKalle Valo struct net_device *ndev, 1173bdcd8170SKalle Valo u8 key_index, bool unicast, 1174bdcd8170SKalle Valo bool multicast) 1175bdcd8170SKalle Valo { 1176d6d5c06cSKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 117759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1178bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1179bdcd8170SKalle Valo u8 key_usage; 1180229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1181bdcd8170SKalle Valo 1182bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1183bdcd8170SKalle Valo 1184990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1185bdcd8170SKalle Valo return -EIO; 1186bdcd8170SKalle Valo 1187bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1188bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1189bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1190bdcd8170SKalle Valo __func__, key_index); 1191bdcd8170SKalle Valo return -ENOENT; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 11946f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1195bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1196bdcd8170SKalle Valo __func__, key_index); 1197bdcd8170SKalle Valo return -EINVAL; 1198bdcd8170SKalle Valo } 1199bdcd8170SKalle Valo 12003450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 12016f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1202bdcd8170SKalle Valo key_usage = GROUP_USAGE; 12033450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1204bdcd8170SKalle Valo key_usage |= TX_USAGE; 1205229ed6b5SEdward Lu if (unicast) 12063450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1207229ed6b5SEdward Lu if (multicast) 12083450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1209bdcd8170SKalle Valo 1210f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 12119a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 12129a5b1318SJouni Malinen 1213f3e61eceSJouni Malinen return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1214334234b5SVasanthakumar Thiagarajan vif->def_txkey_index, 1215229ed6b5SEdward Lu key_type, key_usage, 1216f4bb9a6fSJouni Malinen key->key_len, key->seq, key->seq_len, 1217f4bb9a6fSJouni Malinen key->key, 1218bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1219bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1220bdcd8170SKalle Valo } 1221bdcd8170SKalle Valo 1222240d2799SVasanthakumar Thiagarajan void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1223bdcd8170SKalle Valo bool ismcast) 1224bdcd8170SKalle Valo { 1225bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1226bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1227bdcd8170SKalle Valo 1228240d2799SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1229bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1230bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1231bdcd8170SKalle Valo GFP_KERNEL); 1232bdcd8170SKalle Valo } 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1235bdcd8170SKalle Valo { 1236bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1237990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1238bdcd8170SKalle Valo int ret; 1239bdcd8170SKalle Valo 1240bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1241bdcd8170SKalle Valo changed); 1242bdcd8170SKalle Valo 1243990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1244990bd915SVasanthakumar Thiagarajan if (!vif) 1245990bd915SVasanthakumar Thiagarajan return -EIO; 1246990bd915SVasanthakumar Thiagarajan 1247990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1248bdcd8170SKalle Valo return -EIO; 1249bdcd8170SKalle Valo 1250bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1251bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1252bdcd8170SKalle Valo if (ret != 0) { 1253bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1254bdcd8170SKalle Valo return -EIO; 1255bdcd8170SKalle Valo } 1256bdcd8170SKalle Valo } 1257bdcd8170SKalle Valo 1258bdcd8170SKalle Valo return 0; 1259bdcd8170SKalle Valo } 1260bdcd8170SKalle Valo 1261bdcd8170SKalle Valo /* 1262bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1263bdcd8170SKalle Valo * data type from 2.6.36 onwards 1264bdcd8170SKalle Valo */ 1265bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1266bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1267b992a285SLuis R. Rodriguez int mbm) 1268bdcd8170SKalle Valo { 1269bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1270990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1271bdcd8170SKalle Valo u8 ath6kl_dbm; 1272b992a285SLuis R. Rodriguez int dbm = MBM_TO_DBM(mbm); 1273bdcd8170SKalle Valo 1274bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1275bdcd8170SKalle Valo type, dbm); 1276bdcd8170SKalle Valo 1277990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1278990bd915SVasanthakumar Thiagarajan if (!vif) 1279990bd915SVasanthakumar Thiagarajan return -EIO; 1280990bd915SVasanthakumar Thiagarajan 1281990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1282bdcd8170SKalle Valo return -EIO; 1283bdcd8170SKalle Valo 1284bdcd8170SKalle Valo switch (type) { 1285bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1286bdcd8170SKalle Valo return 0; 1287bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1288bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1289bdcd8170SKalle Valo break; 1290bdcd8170SKalle Valo default: 1291bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1292bdcd8170SKalle Valo __func__, type); 1293bdcd8170SKalle Valo return -EOPNOTSUPP; 1294bdcd8170SKalle Valo } 1295bdcd8170SKalle Valo 1296990bd915SVasanthakumar Thiagarajan ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, ath6kl_dbm); 1297bdcd8170SKalle Valo 1298bdcd8170SKalle Valo return 0; 1299bdcd8170SKalle Valo } 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1302bdcd8170SKalle Valo { 1303bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1304990bd915SVasanthakumar Thiagarajan struct ath6kl_vif *vif; 1305bdcd8170SKalle Valo 1306990bd915SVasanthakumar Thiagarajan vif = ath6kl_vif_first(ar); 1307990bd915SVasanthakumar Thiagarajan if (!vif) 1308990bd915SVasanthakumar Thiagarajan return -EIO; 1309990bd915SVasanthakumar Thiagarajan 1310990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1311bdcd8170SKalle Valo return -EIO; 1312bdcd8170SKalle Valo 131359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1314bdcd8170SKalle Valo ar->tx_pwr = 0; 1315bdcd8170SKalle Valo 1316990bd915SVasanthakumar Thiagarajan if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1317bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1318bdcd8170SKalle Valo return -EIO; 1319bdcd8170SKalle Valo } 1320bdcd8170SKalle Valo 1321bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1322bdcd8170SKalle Valo 5 * HZ); 1323bdcd8170SKalle Valo 1324bdcd8170SKalle Valo if (signal_pending(current)) { 1325bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1326bdcd8170SKalle Valo return -EINTR; 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo } 1329bdcd8170SKalle Valo 1330bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1331bdcd8170SKalle Valo return 0; 1332bdcd8170SKalle Valo } 1333bdcd8170SKalle Valo 1334bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1335bdcd8170SKalle Valo struct net_device *dev, 1336bdcd8170SKalle Valo bool pmgmt, int timeout) 1337bdcd8170SKalle Valo { 1338bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1339bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1340334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1341bdcd8170SKalle Valo 1342bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1343bdcd8170SKalle Valo __func__, pmgmt, timeout); 1344bdcd8170SKalle Valo 1345990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1346bdcd8170SKalle Valo return -EIO; 1347bdcd8170SKalle Valo 1348bdcd8170SKalle Valo if (pmgmt) { 1349bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1350bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1351bdcd8170SKalle Valo } else { 1352bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1353bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1354bdcd8170SKalle Valo } 1355bdcd8170SKalle Valo 1356334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1357334234b5SVasanthakumar Thiagarajan mode.pwr_mode) != 0) { 1358bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1359bdcd8170SKalle Valo return -EIO; 1360bdcd8170SKalle Valo } 1361bdcd8170SKalle Valo 1362bdcd8170SKalle Valo return 0; 1363bdcd8170SKalle Valo } 1364bdcd8170SKalle Valo 136555055976SVasanthakumar Thiagarajan static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 136655055976SVasanthakumar Thiagarajan char *name, 136755055976SVasanthakumar Thiagarajan enum nl80211_iftype type, 136855055976SVasanthakumar Thiagarajan u32 *flags, 136955055976SVasanthakumar Thiagarajan struct vif_params *params) 137055055976SVasanthakumar Thiagarajan { 137155055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 137255055976SVasanthakumar Thiagarajan struct net_device *ndev; 137355055976SVasanthakumar Thiagarajan u8 if_idx, nw_type; 137455055976SVasanthakumar Thiagarajan 137571f96ee6SKalle Valo if (ar->num_vif == ar->vif_max) { 137655055976SVasanthakumar Thiagarajan ath6kl_err("Reached maximum number of supported vif\n"); 137755055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 137855055976SVasanthakumar Thiagarajan } 137955055976SVasanthakumar Thiagarajan 138055055976SVasanthakumar Thiagarajan if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 138155055976SVasanthakumar Thiagarajan ath6kl_err("Not a supported interface type\n"); 138255055976SVasanthakumar Thiagarajan return ERR_PTR(-EINVAL); 138355055976SVasanthakumar Thiagarajan } 138455055976SVasanthakumar Thiagarajan 138555055976SVasanthakumar Thiagarajan ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 138655055976SVasanthakumar Thiagarajan if (!ndev) 138755055976SVasanthakumar Thiagarajan return ERR_PTR(-ENOMEM); 138855055976SVasanthakumar Thiagarajan 138955055976SVasanthakumar Thiagarajan ar->num_vif++; 139055055976SVasanthakumar Thiagarajan 139155055976SVasanthakumar Thiagarajan return ndev; 139255055976SVasanthakumar Thiagarajan } 139355055976SVasanthakumar Thiagarajan 139455055976SVasanthakumar Thiagarajan static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 139555055976SVasanthakumar Thiagarajan struct net_device *ndev) 139655055976SVasanthakumar Thiagarajan { 139755055976SVasanthakumar Thiagarajan struct ath6kl *ar = wiphy_priv(wiphy); 139855055976SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 139955055976SVasanthakumar Thiagarajan 140011f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 140155055976SVasanthakumar Thiagarajan list_del(&vif->list); 140211f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 140355055976SVasanthakumar Thiagarajan 140455055976SVasanthakumar Thiagarajan ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 140555055976SVasanthakumar Thiagarajan 140655055976SVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 140755055976SVasanthakumar Thiagarajan 140855055976SVasanthakumar Thiagarajan return 0; 140955055976SVasanthakumar Thiagarajan } 141055055976SVasanthakumar Thiagarajan 1411bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1412bdcd8170SKalle Valo struct net_device *ndev, 1413bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1414bdcd8170SKalle Valo struct vif_params *params) 1415bdcd8170SKalle Valo { 1416f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1417bdcd8170SKalle Valo 1418bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1419bdcd8170SKalle Valo 1420bdcd8170SKalle Valo switch (type) { 1421bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1422f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1423bdcd8170SKalle Valo break; 1424bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1425f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1426bdcd8170SKalle Valo break; 14276e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1428f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14296e4604c8SJouni Malinen break; 14306b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1431f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 14326b5e5d25SJouni Malinen break; 14336b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1434f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 14356b5e5d25SJouni Malinen break; 1436bdcd8170SKalle Valo default: 1437bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1438bdcd8170SKalle Valo return -EOPNOTSUPP; 1439bdcd8170SKalle Valo } 1440bdcd8170SKalle Valo 1441551959d8SVasanthakumar Thiagarajan vif->wdev.iftype = type; 1442bdcd8170SKalle Valo 1443bdcd8170SKalle Valo return 0; 1444bdcd8170SKalle Valo } 1445bdcd8170SKalle Valo 1446bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1447bdcd8170SKalle Valo struct net_device *dev, 1448bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1449bdcd8170SKalle Valo { 1450bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 145159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1452bdcd8170SKalle Valo int status; 1453bdcd8170SKalle Valo 1454990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1455bdcd8170SKalle Valo return -EIO; 1456bdcd8170SKalle Valo 14573450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 14583450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1459bdcd8170SKalle Valo 1460bdcd8170SKalle Valo if (ibss_param->channel) 1461f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1462bdcd8170SKalle Valo 1463bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1464bdcd8170SKalle Valo /* 1465bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1466bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1467bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1468bdcd8170SKalle Valo * updated. 1469bdcd8170SKalle Valo */ 1470bdcd8170SKalle Valo return -EOPNOTSUPP; 1471bdcd8170SKalle Valo } 1472bdcd8170SKalle Valo 14738c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1474bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 14758c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 14768c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1477bdcd8170SKalle Valo 1478240d2799SVasanthakumar Thiagarajan ath6kl_set_wpa_version(vif, 0); 1479bdcd8170SKalle Valo 1480240d2799SVasanthakumar Thiagarajan status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1481bdcd8170SKalle Valo if (status) 1482bdcd8170SKalle Valo return status; 1483bdcd8170SKalle Valo 1484bdcd8170SKalle Valo if (ibss_param->privacy) { 1485240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1486240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1487bdcd8170SKalle Valo } else { 1488240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 1489240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, false); 1490bdcd8170SKalle Valo } 1491bdcd8170SKalle Valo 1492f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1493bdcd8170SKalle Valo 1494bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1495bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1496bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1497bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1498bdcd8170SKalle Valo __func__, 14993450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 15003450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1501f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1502bdcd8170SKalle Valo 1503334234b5SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 15043450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 15053450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 15063450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 15073450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 15083450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1509f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 15103ca9d1fcSAarthi Thiruvengadam ar->connect_ctrl_flags, SUBTYPE_NONE); 151159c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1512bdcd8170SKalle Valo 1513bdcd8170SKalle Valo return 0; 1514bdcd8170SKalle Valo } 1515bdcd8170SKalle Valo 1516bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1517bdcd8170SKalle Valo struct net_device *dev) 1518bdcd8170SKalle Valo { 15193450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1520bdcd8170SKalle Valo 1521990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 1522bdcd8170SKalle Valo return -EIO; 1523bdcd8170SKalle Valo 1524240d2799SVasanthakumar Thiagarajan ath6kl_disconnect(vif); 15253450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 15263450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1527bdcd8170SKalle Valo 1528bdcd8170SKalle Valo return 0; 1529bdcd8170SKalle Valo } 1530bdcd8170SKalle Valo 1531bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1532bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1533bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1534bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1535bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1536837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 15375e07021eSDai Shuibing WLAN_CIPHER_SUITE_SMS4, 1538bdcd8170SKalle Valo }; 1539bdcd8170SKalle Valo 1540bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1541bdcd8170SKalle Valo { 1542bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1543bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1544bdcd8170SKalle Valo 36000, 48000, 54000 1545bdcd8170SKalle Valo }; 1546bdcd8170SKalle Valo u8 i; 1547bdcd8170SKalle Valo 1548bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1549bdcd8170SKalle Valo if (rate == legacy[i]) 1550bdcd8170SKalle Valo return true; 1551bdcd8170SKalle Valo 1552bdcd8170SKalle Valo return false; 1553bdcd8170SKalle Valo } 1554bdcd8170SKalle Valo 1555bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1556bdcd8170SKalle Valo { 1557bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1558bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1559bdcd8170SKalle Valo }; 1560bdcd8170SKalle Valo u8 i; 1561bdcd8170SKalle Valo 1562bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1563bdcd8170SKalle Valo if (rate == ht20[i]) { 1564bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1565bdcd8170SKalle Valo /* last rate uses sgi */ 1566bdcd8170SKalle Valo *sgi = true; 1567bdcd8170SKalle Valo else 1568bdcd8170SKalle Valo *sgi = false; 1569bdcd8170SKalle Valo 1570bdcd8170SKalle Valo *mcs = i; 1571bdcd8170SKalle Valo return true; 1572bdcd8170SKalle Valo } 1573bdcd8170SKalle Valo } 1574bdcd8170SKalle Valo return false; 1575bdcd8170SKalle Valo } 1576bdcd8170SKalle Valo 1577bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1578bdcd8170SKalle Valo { 1579bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1580bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1581bdcd8170SKalle Valo 150000 1582bdcd8170SKalle Valo }; 1583bdcd8170SKalle Valo u8 i; 1584bdcd8170SKalle Valo 1585bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1586bdcd8170SKalle Valo if (rate == ht40[i]) { 1587bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1588bdcd8170SKalle Valo /* last rate uses sgi */ 1589bdcd8170SKalle Valo *sgi = true; 1590bdcd8170SKalle Valo else 1591bdcd8170SKalle Valo *sgi = false; 1592bdcd8170SKalle Valo 1593bdcd8170SKalle Valo *mcs = i; 1594bdcd8170SKalle Valo return true; 1595bdcd8170SKalle Valo } 1596bdcd8170SKalle Valo } 1597bdcd8170SKalle Valo 1598bdcd8170SKalle Valo return false; 1599bdcd8170SKalle Valo } 1600bdcd8170SKalle Valo 1601bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1602bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1603bdcd8170SKalle Valo { 1604bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 160559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1606bdcd8170SKalle Valo long left; 1607bdcd8170SKalle Valo bool sgi; 1608bdcd8170SKalle Valo s32 rate; 1609bdcd8170SKalle Valo int ret; 1610bdcd8170SKalle Valo u8 mcs; 1611bdcd8170SKalle Valo 16128c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1613bdcd8170SKalle Valo return -ENOENT; 1614bdcd8170SKalle Valo 1615bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1616bdcd8170SKalle Valo return -EBUSY; 1617bdcd8170SKalle Valo 1618b95907a7SVasanthakumar Thiagarajan set_bit(STATS_UPDATE_PEND, &vif->flags); 1619bdcd8170SKalle Valo 1620334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1621bdcd8170SKalle Valo 1622bdcd8170SKalle Valo if (ret != 0) { 1623bdcd8170SKalle Valo up(&ar->sem); 1624bdcd8170SKalle Valo return -EIO; 1625bdcd8170SKalle Valo } 1626bdcd8170SKalle Valo 1627bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1628bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1629b95907a7SVasanthakumar Thiagarajan &vif->flags), 1630bdcd8170SKalle Valo WMI_TIMEOUT); 1631bdcd8170SKalle Valo 1632bdcd8170SKalle Valo up(&ar->sem); 1633bdcd8170SKalle Valo 1634bdcd8170SKalle Valo if (left == 0) 1635bdcd8170SKalle Valo return -ETIMEDOUT; 1636bdcd8170SKalle Valo else if (left < 0) 1637bdcd8170SKalle Valo return left; 1638bdcd8170SKalle Valo 1639b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.rx_byte) { 1640b95907a7SVasanthakumar Thiagarajan sinfo->rx_bytes = vif->target_stats.rx_byte; 1641bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1642b95907a7SVasanthakumar Thiagarajan sinfo->rx_packets = vif->target_stats.rx_pkt; 1643bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1644bdcd8170SKalle Valo } 1645bdcd8170SKalle Valo 1646b95907a7SVasanthakumar Thiagarajan if (vif->target_stats.tx_byte) { 1647b95907a7SVasanthakumar Thiagarajan sinfo->tx_bytes = vif->target_stats.tx_byte; 1648bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1649b95907a7SVasanthakumar Thiagarajan sinfo->tx_packets = vif->target_stats.tx_pkt; 1650bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1651bdcd8170SKalle Valo } 1652bdcd8170SKalle Valo 1653b95907a7SVasanthakumar Thiagarajan sinfo->signal = vif->target_stats.cs_rssi; 1654bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1655bdcd8170SKalle Valo 1656b95907a7SVasanthakumar Thiagarajan rate = vif->target_stats.tx_ucast_rate; 1657bdcd8170SKalle Valo 1658bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1659bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1660bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1661bdcd8170SKalle Valo if (sgi) { 1662bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1663bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1664bdcd8170SKalle Valo } else { 1665bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1666bdcd8170SKalle Valo } 1667bdcd8170SKalle Valo 1668bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1669bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1670bdcd8170SKalle Valo if (sgi) { 1671bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1672bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1673bdcd8170SKalle Valo } else { 1674bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1675bdcd8170SKalle Valo } 1676bdcd8170SKalle Valo 1677bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1678bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1679bdcd8170SKalle Valo } else { 16809a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 16819a730834SKalle Valo "invalid rate from stats: %d\n", rate); 16829a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1683bdcd8170SKalle Valo return 0; 1684bdcd8170SKalle Valo } 1685bdcd8170SKalle Valo 1686bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1687bdcd8170SKalle Valo 168859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 168959c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1690f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 169132c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 169232c10874SJouni Malinen sinfo->bss_param.flags = 0; 1693cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1694cf5333d7SVasanthakumar Thiagarajan sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 169532c10874SJouni Malinen } 169632c10874SJouni Malinen 1697bdcd8170SKalle Valo return 0; 1698bdcd8170SKalle Valo } 1699bdcd8170SKalle Valo 1700bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1701bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1702bdcd8170SKalle Valo { 1703bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1704334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1705334234b5SVasanthakumar Thiagarajan 1706334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1707bdcd8170SKalle Valo pmksa->pmkid, true); 1708bdcd8170SKalle Valo } 1709bdcd8170SKalle Valo 1710bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1711bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1712bdcd8170SKalle Valo { 1713bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1714334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 1715334234b5SVasanthakumar Thiagarajan 1716334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1717bdcd8170SKalle Valo pmksa->pmkid, false); 1718bdcd8170SKalle Valo } 1719bdcd8170SKalle Valo 1720bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1721bdcd8170SKalle Valo { 1722bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 172359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 172459c98449SVasanthakumar Thiagarajan 172559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1726334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1727334234b5SVasanthakumar Thiagarajan vif->bssid, NULL, false); 1728bdcd8170SKalle Valo return 0; 1729bdcd8170SKalle Valo } 1730bdcd8170SKalle Valo 17316cb3c714SRaja Mani static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 17326cb3c714SRaja Mani { 1733c08631c6SRaja Mani struct in_device *in_dev; 1734c08631c6SRaja Mani struct in_ifaddr *ifa; 17356cb3c714SRaja Mani struct ath6kl_vif *vif; 17366cb3c714SRaja Mani int ret, pos, left; 17376cb3c714SRaja Mani u32 filter = 0; 17386cb3c714SRaja Mani u16 i; 1739c08631c6SRaja Mani u8 mask[WOW_MASK_SIZE], index = 0; 1740c08631c6SRaja Mani __be32 ips[MAX_IP_ADDRS]; 17416cb3c714SRaja Mani 17426cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 17436cb3c714SRaja Mani if (!vif) 17446cb3c714SRaja Mani return -EIO; 17456cb3c714SRaja Mani 17466cb3c714SRaja Mani if (!ath6kl_cfg80211_ready(vif)) 17476cb3c714SRaja Mani return -EIO; 17486cb3c714SRaja Mani 17496cb3c714SRaja Mani if (!test_bit(CONNECTED, &vif->flags)) 17506cb3c714SRaja Mani return -EINVAL; 17516cb3c714SRaja Mani 17526cb3c714SRaja Mani /* Clear existing WOW patterns */ 17536cb3c714SRaja Mani for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 17546cb3c714SRaja Mani ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 17556cb3c714SRaja Mani WOW_LIST_ID, i); 17566cb3c714SRaja Mani /* Configure new WOW patterns */ 17576cb3c714SRaja Mani for (i = 0; i < wow->n_patterns; i++) { 17586cb3c714SRaja Mani 17596cb3c714SRaja Mani /* 17606cb3c714SRaja Mani * Convert given nl80211 specific mask value to equivalent 17616cb3c714SRaja Mani * driver specific mask value and send it to the chip along 17626cb3c714SRaja Mani * with patterns. For example, If the mask value defined in 17636cb3c714SRaja Mani * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 17646cb3c714SRaja Mani * then equivalent driver specific mask value is 17656cb3c714SRaja Mani * "0xFF 0x00 0xFF 0x00". 17666cb3c714SRaja Mani */ 17676cb3c714SRaja Mani memset(&mask, 0, sizeof(mask)); 17686cb3c714SRaja Mani for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 17696cb3c714SRaja Mani if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 17706cb3c714SRaja Mani mask[pos] = 0xFF; 17716cb3c714SRaja Mani } 17726cb3c714SRaja Mani /* 17736cb3c714SRaja Mani * Note: Pattern's offset is not passed as part of wowlan 17746cb3c714SRaja Mani * parameter from CFG layer. So it's always passed as ZERO 17756cb3c714SRaja Mani * to the firmware. It means, given WOW patterns are always 17766cb3c714SRaja Mani * matched from the first byte of received pkt in the firmware. 17776cb3c714SRaja Mani */ 17786cb3c714SRaja Mani ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 17796cb3c714SRaja Mani vif->fw_vif_idx, WOW_LIST_ID, 17806cb3c714SRaja Mani wow->patterns[i].pattern_len, 17816cb3c714SRaja Mani 0 /* pattern offset */, 17826cb3c714SRaja Mani wow->patterns[i].pattern, mask); 17836cb3c714SRaja Mani if (ret) 17846cb3c714SRaja Mani return ret; 17856cb3c714SRaja Mani } 17866cb3c714SRaja Mani 1787c08631c6SRaja Mani /* Setup own IP addr for ARP agent. */ 1788c08631c6SRaja Mani in_dev = __in_dev_get_rtnl(vif->ndev); 1789c08631c6SRaja Mani if (!in_dev) 1790c08631c6SRaja Mani goto skip_arp; 1791c08631c6SRaja Mani 1792c08631c6SRaja Mani ifa = in_dev->ifa_list; 1793c08631c6SRaja Mani memset(&ips, 0, sizeof(ips)); 1794c08631c6SRaja Mani 1795c08631c6SRaja Mani /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 1796c08631c6SRaja Mani while (index < MAX_IP_ADDRS && ifa) { 1797c08631c6SRaja Mani ips[index] = ifa->ifa_local; 1798c08631c6SRaja Mani ifa = ifa->ifa_next; 1799c08631c6SRaja Mani index++; 1800c08631c6SRaja Mani } 1801c08631c6SRaja Mani 1802c08631c6SRaja Mani if (ifa) { 1803c08631c6SRaja Mani ath6kl_err("total IP addr count is exceeding fw limit\n"); 1804c08631c6SRaja Mani return -EINVAL; 1805c08631c6SRaja Mani } 1806c08631c6SRaja Mani 1807c08631c6SRaja Mani ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 1808c08631c6SRaja Mani if (ret) { 1809c08631c6SRaja Mani ath6kl_err("fail to setup ip for arp agent\n"); 1810c08631c6SRaja Mani return ret; 1811c08631c6SRaja Mani } 1812c08631c6SRaja Mani 1813c08631c6SRaja Mani skip_arp: 18146cb3c714SRaja Mani if (wow->disconnect) 18156cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 18166cb3c714SRaja Mani 18176cb3c714SRaja Mani if (wow->magic_pkt) 18186cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 18196cb3c714SRaja Mani 18206cb3c714SRaja Mani if (wow->gtk_rekey_failure) 18216cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_GTK_ERROR; 18226cb3c714SRaja Mani 18236cb3c714SRaja Mani if (wow->eap_identity_req) 18246cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_EAP_REQ; 18256cb3c714SRaja Mani 18266cb3c714SRaja Mani if (wow->four_way_handshake) 18276cb3c714SRaja Mani filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 18286cb3c714SRaja Mani 18296cb3c714SRaja Mani ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 18306cb3c714SRaja Mani ATH6KL_WOW_MODE_ENABLE, 18316cb3c714SRaja Mani filter, 18326cb3c714SRaja Mani WOW_HOST_REQ_DELAY); 18336cb3c714SRaja Mani if (ret) 18346cb3c714SRaja Mani return ret; 18356cb3c714SRaja Mani 18366cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18376cb3c714SRaja Mani ATH6KL_HOST_MODE_ASLEEP); 18386cb3c714SRaja Mani if (ret) 18396cb3c714SRaja Mani return ret; 18406cb3c714SRaja Mani 18416cb3c714SRaja Mani if (ar->tx_pending[ar->ctrl_ep]) { 18426cb3c714SRaja Mani left = wait_event_interruptible_timeout(ar->event_wq, 18436cb3c714SRaja Mani ar->tx_pending[ar->ctrl_ep] == 0, WMI_TIMEOUT); 18446cb3c714SRaja Mani if (left == 0) { 18456cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data timeout\n"); 18466cb3c714SRaja Mani ret = -ETIMEDOUT; 18476cb3c714SRaja Mani } else if (left < 0) { 18486cb3c714SRaja Mani ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 18496cb3c714SRaja Mani ret = left; 18506cb3c714SRaja Mani } 18516cb3c714SRaja Mani } 18526cb3c714SRaja Mani 18536cb3c714SRaja Mani return ret; 18546cb3c714SRaja Mani } 18556cb3c714SRaja Mani 18566cb3c714SRaja Mani static int ath6kl_wow_resume(struct ath6kl *ar) 18576cb3c714SRaja Mani { 18586cb3c714SRaja Mani struct ath6kl_vif *vif; 18596cb3c714SRaja Mani int ret; 18606cb3c714SRaja Mani 18616cb3c714SRaja Mani vif = ath6kl_vif_first(ar); 18626cb3c714SRaja Mani if (!vif) 18636cb3c714SRaja Mani return -EIO; 18646cb3c714SRaja Mani 18656cb3c714SRaja Mani ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 18666cb3c714SRaja Mani ATH6KL_HOST_MODE_AWAKE); 18676cb3c714SRaja Mani return ret; 18686cb3c714SRaja Mani } 18696cb3c714SRaja Mani 187052d81a68SKalle Valo int ath6kl_cfg80211_suspend(struct ath6kl *ar, 18710f60e9f4SRaja Mani enum ath6kl_cfg_suspend_mode mode, 18720f60e9f4SRaja Mani struct cfg80211_wowlan *wow) 187352d81a68SKalle Valo { 187452d81a68SKalle Valo int ret; 187552d81a68SKalle Valo 187652d81a68SKalle Valo switch (mode) { 1877d7c44e0bSRaja Mani case ATH6KL_CFG_SUSPEND_WOW: 1878d7c44e0bSRaja Mani 1879d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 1880d7c44e0bSRaja Mani 1881d7c44e0bSRaja Mani /* Flush all non control pkts in TX path */ 1882d7c44e0bSRaja Mani ath6kl_tx_data_cleanup(ar); 1883d7c44e0bSRaja Mani 1884d7c44e0bSRaja Mani ret = ath6kl_wow_suspend(ar, wow); 1885d7c44e0bSRaja Mani if (ret) { 1886d7c44e0bSRaja Mani ath6kl_err("wow suspend failed: %d\n", ret); 1887d7c44e0bSRaja Mani return ret; 1888d7c44e0bSRaja Mani } 1889d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_WOW; 1890d7c44e0bSRaja Mani break; 1891d7c44e0bSRaja Mani 189252d81a68SKalle Valo case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 1893524441e3SRaja Mani 18947125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1895524441e3SRaja Mani 189652d81a68SKalle Valo /* save the current power mode before enabling power save */ 189752d81a68SKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 189852d81a68SKalle Valo 189952d81a68SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 190052d81a68SKalle Valo if (ret) { 190152d81a68SKalle Valo ath6kl_warn("wmi powermode command failed during suspend: %d\n", 190252d81a68SKalle Valo ret); 190352d81a68SKalle Valo } 190452d81a68SKalle Valo 190576a9fbe2SKalle Valo ar->state = ATH6KL_STATE_DEEPSLEEP; 190676a9fbe2SKalle Valo 190752d81a68SKalle Valo break; 1908b4b2a0b1SKalle Valo 1909b4b2a0b1SKalle Valo case ATH6KL_CFG_SUSPEND_CUTPOWER: 1910524441e3SRaja Mani 19117125f01dSKalle Valo ath6kl_cfg80211_stop_all(ar); 1912524441e3SRaja Mani 1913b4b2a0b1SKalle Valo if (ar->state == ATH6KL_STATE_OFF) { 1914b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, 1915b4b2a0b1SKalle Valo "suspend hw off, no action for cutpower\n"); 1916b4b2a0b1SKalle Valo break; 1917b4b2a0b1SKalle Valo } 1918b4b2a0b1SKalle Valo 1919b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 1920b4b2a0b1SKalle Valo 1921b4b2a0b1SKalle Valo ret = ath6kl_init_hw_stop(ar); 1922b4b2a0b1SKalle Valo if (ret) { 1923b4b2a0b1SKalle Valo ath6kl_warn("failed to stop hw during suspend: %d\n", 1924b4b2a0b1SKalle Valo ret); 1925b4b2a0b1SKalle Valo } 1926b4b2a0b1SKalle Valo 1927b4b2a0b1SKalle Valo ar->state = ATH6KL_STATE_CUTPOWER; 1928b4b2a0b1SKalle Valo 1929b4b2a0b1SKalle Valo break; 1930b4b2a0b1SKalle Valo 193110509f90SKalle Valo case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 193210509f90SKalle Valo /* 193310509f90SKalle Valo * Nothing needed for schedule scan, firmware is already in 193410509f90SKalle Valo * wow mode and sleeping most of the time. 193510509f90SKalle Valo */ 193610509f90SKalle Valo break; 193710509f90SKalle Valo 1938b4b2a0b1SKalle Valo default: 1939b4b2a0b1SKalle Valo break; 194052d81a68SKalle Valo } 194152d81a68SKalle Valo 194252d81a68SKalle Valo return 0; 194352d81a68SKalle Valo } 194452d81a68SKalle Valo 194552d81a68SKalle Valo int ath6kl_cfg80211_resume(struct ath6kl *ar) 194652d81a68SKalle Valo { 194776a9fbe2SKalle Valo int ret; 194876a9fbe2SKalle Valo 194976a9fbe2SKalle Valo switch (ar->state) { 1950d7c44e0bSRaja Mani case ATH6KL_STATE_WOW: 1951d7c44e0bSRaja Mani ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 1952d7c44e0bSRaja Mani 1953d7c44e0bSRaja Mani ret = ath6kl_wow_resume(ar); 1954d7c44e0bSRaja Mani if (ret) { 1955d7c44e0bSRaja Mani ath6kl_warn("wow mode resume failed: %d\n", ret); 1956d7c44e0bSRaja Mani return ret; 1957d7c44e0bSRaja Mani } 1958d7c44e0bSRaja Mani 1959d7c44e0bSRaja Mani ar->state = ATH6KL_STATE_ON; 1960d7c44e0bSRaja Mani break; 1961d7c44e0bSRaja Mani 196276a9fbe2SKalle Valo case ATH6KL_STATE_DEEPSLEEP: 196352d81a68SKalle Valo if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 196476a9fbe2SKalle Valo ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 196576a9fbe2SKalle Valo ar->wmi->saved_pwr_mode); 196676a9fbe2SKalle Valo if (ret) { 196776a9fbe2SKalle Valo ath6kl_warn("wmi powermode command failed during resume: %d\n", 196876a9fbe2SKalle Valo ret); 196976a9fbe2SKalle Valo } 197076a9fbe2SKalle Valo } 197176a9fbe2SKalle Valo 197276a9fbe2SKalle Valo ar->state = ATH6KL_STATE_ON; 197376a9fbe2SKalle Valo 197476a9fbe2SKalle Valo break; 197576a9fbe2SKalle Valo 1976b4b2a0b1SKalle Valo case ATH6KL_STATE_CUTPOWER: 1977b4b2a0b1SKalle Valo ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 1978b4b2a0b1SKalle Valo 1979b4b2a0b1SKalle Valo ret = ath6kl_init_hw_start(ar); 1980b4b2a0b1SKalle Valo if (ret) { 1981b4b2a0b1SKalle Valo ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 1982b4b2a0b1SKalle Valo return ret; 1983b4b2a0b1SKalle Valo } 1984d7c44e0bSRaja Mani break; 1985b4b2a0b1SKalle Valo 198610509f90SKalle Valo case ATH6KL_STATE_SCHED_SCAN: 198710509f90SKalle Valo break; 198810509f90SKalle Valo 198976a9fbe2SKalle Valo default: 199076a9fbe2SKalle Valo break; 199152d81a68SKalle Valo } 199252d81a68SKalle Valo 199352d81a68SKalle Valo return 0; 199452d81a68SKalle Valo } 199552d81a68SKalle Valo 1996abcb344bSKalle Valo #ifdef CONFIG_PM 199752d81a68SKalle Valo 199852d81a68SKalle Valo /* hif layer decides what suspend mode to use */ 199952d81a68SKalle Valo static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2000abcb344bSKalle Valo struct cfg80211_wowlan *wow) 2001abcb344bSKalle Valo { 2002abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 2003abcb344bSKalle Valo 20040f60e9f4SRaja Mani return ath6kl_hif_suspend(ar, wow); 2005abcb344bSKalle Valo } 2006aa6cffc1SChilam Ng 200752d81a68SKalle Valo static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2008aa6cffc1SChilam Ng { 2009aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 2010aa6cffc1SChilam Ng 2011aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 2012aa6cffc1SChilam Ng } 2013a918fb3cSRaja Mani 2014a918fb3cSRaja Mani /* 2015a918fb3cSRaja Mani * FIXME: WOW suspend mode is selected if the host sdio controller supports 2016a918fb3cSRaja Mani * both sdio irq wake up and keep power. The target pulls sdio data line to 2017a918fb3cSRaja Mani * wake up the host when WOW pattern matches. This causes sdio irq handler 2018a918fb3cSRaja Mani * is being called in the host side which internally hits ath6kl's RX path. 2019a918fb3cSRaja Mani * 2020a918fb3cSRaja Mani * Since sdio interrupt is not disabled, RX path executes even before 2021a918fb3cSRaja Mani * the host executes the actual resume operation from PM module. 2022a918fb3cSRaja Mani * 2023a918fb3cSRaja Mani * In the current scenario, WOW resume should happen before start processing 2024a918fb3cSRaja Mani * any data from the target. So It's required to perform WOW resume in RX path. 2025a918fb3cSRaja Mani * Ideally we should perform WOW resume only in the actual platform 2026a918fb3cSRaja Mani * resume path. This area needs bit rework to avoid WOW resume in RX path. 2027a918fb3cSRaja Mani * 2028a918fb3cSRaja Mani * ath6kl_check_wow_status() is called from ath6kl_rx(). 2029a918fb3cSRaja Mani */ 2030a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2031a918fb3cSRaja Mani { 2032a918fb3cSRaja Mani if (ar->state == ATH6KL_STATE_WOW) 2033a918fb3cSRaja Mani ath6kl_cfg80211_resume(ar); 2034a918fb3cSRaja Mani } 2035a918fb3cSRaja Mani 2036a918fb3cSRaja Mani #else 2037a918fb3cSRaja Mani 2038a918fb3cSRaja Mani void ath6kl_check_wow_status(struct ath6kl *ar) 2039a918fb3cSRaja Mani { 2040a918fb3cSRaja Mani } 2041abcb344bSKalle Valo #endif 2042abcb344bSKalle Valo 20436a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 20446a7c9badSJouni Malinen struct ieee80211_channel *chan, 20456a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 20466a7c9badSJouni Malinen { 2047e68f6750SSujith Manoharan struct ath6kl_vif *vif; 2048e68f6750SSujith Manoharan 2049e68f6750SSujith Manoharan /* 2050e68f6750SSujith Manoharan * 'dev' could be NULL if a channel change is required for the hardware 2051e68f6750SSujith Manoharan * device itself, instead of a particular VIF. 2052e68f6750SSujith Manoharan * 2053e68f6750SSujith Manoharan * FIXME: To be handled properly when monitor mode is supported. 2054e68f6750SSujith Manoharan */ 2055e68f6750SSujith Manoharan if (!dev) 2056e68f6750SSujith Manoharan return -EBUSY; 2057e68f6750SSujith Manoharan 2058e68f6750SSujith Manoharan vif = netdev_priv(dev); 20596a7c9badSJouni Malinen 2060990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 20616a7c9badSJouni Malinen return -EIO; 20626a7c9badSJouni Malinen 20636a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 20646a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 2065cf5333d7SVasanthakumar Thiagarajan vif->next_chan = chan->center_freq; 20666a7c9badSJouni Malinen 20676a7c9badSJouni Malinen return 0; 20686a7c9badSJouni Malinen } 20696a7c9badSJouni Malinen 20708bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 20718bdfbf40SJouni Malinen { 20728bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 20738bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 20748bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 20758bdfbf40SJouni Malinen } 20768bdfbf40SJouni Malinen 2077334234b5SVasanthakumar Thiagarajan static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2078334234b5SVasanthakumar Thiagarajan const u8 *ies, size_t ies_len) 20798bdfbf40SJouni Malinen { 2080334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 20818bdfbf40SJouni Malinen const u8 *pos; 20828bdfbf40SJouni Malinen u8 *buf = NULL; 20838bdfbf40SJouni Malinen size_t len = 0; 20848bdfbf40SJouni Malinen int ret; 20858bdfbf40SJouni Malinen 20868bdfbf40SJouni Malinen /* 20878bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 20888bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 20898bdfbf40SJouni Malinen */ 20908bdfbf40SJouni Malinen 20918bdfbf40SJouni Malinen if (ies && ies_len) { 20928bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 20938bdfbf40SJouni Malinen if (buf == NULL) 20948bdfbf40SJouni Malinen return -ENOMEM; 20958bdfbf40SJouni Malinen pos = ies; 20968bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 20978bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 20988bdfbf40SJouni Malinen break; 20998bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 21008bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 21018bdfbf40SJouni Malinen len += 2 + pos[1]; 21028bdfbf40SJouni Malinen } 21038bdfbf40SJouni Malinen pos += 2 + pos[1]; 21048bdfbf40SJouni Malinen } 21058bdfbf40SJouni Malinen } 21068bdfbf40SJouni Malinen 2107334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2108334234b5SVasanthakumar Thiagarajan WMI_FRAME_PROBE_RESP, buf, len); 21098bdfbf40SJouni Malinen kfree(buf); 21108bdfbf40SJouni Malinen return ret; 21118bdfbf40SJouni Malinen } 21128bdfbf40SJouni Malinen 21136a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 21146a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 21156a7c9badSJouni Malinen { 21166a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 21173450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 21186a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 21196a7c9badSJouni Malinen u8 *ies; 21206a7c9badSJouni Malinen int ies_len; 21216a7c9badSJouni Malinen struct wmi_connect_cmd p; 21226a7c9badSJouni Malinen int res; 2123be5abaafSVasanthakumar Thiagarajan int i, ret; 21246a7c9badSJouni Malinen 21256a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 21266a7c9badSJouni Malinen 2127990bd915SVasanthakumar Thiagarajan if (!ath6kl_cfg80211_ready(vif)) 21286a7c9badSJouni Malinen return -EIO; 21296a7c9badSJouni Malinen 2130f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 21316a7c9badSJouni Malinen return -EOPNOTSUPP; 21326a7c9badSJouni Malinen 21336a7c9badSJouni Malinen if (info->beacon_ies) { 2134334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2135334234b5SVasanthakumar Thiagarajan WMI_FRAME_BEACON, 21366a7c9badSJouni Malinen info->beacon_ies, 21376a7c9badSJouni Malinen info->beacon_ies_len); 21386a7c9badSJouni Malinen if (res) 21396a7c9badSJouni Malinen return res; 21406a7c9badSJouni Malinen } 21416a7c9badSJouni Malinen if (info->proberesp_ies) { 2142334234b5SVasanthakumar Thiagarajan res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 21436a7c9badSJouni Malinen info->proberesp_ies_len); 21446a7c9badSJouni Malinen if (res) 21456a7c9badSJouni Malinen return res; 21466a7c9badSJouni Malinen } 21476a7c9badSJouni Malinen if (info->assocresp_ies) { 2148334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2149334234b5SVasanthakumar Thiagarajan WMI_FRAME_ASSOC_RESP, 21506a7c9badSJouni Malinen info->assocresp_ies, 21516a7c9badSJouni Malinen info->assocresp_ies_len); 21526a7c9badSJouni Malinen if (res) 21536a7c9badSJouni Malinen return res; 21546a7c9badSJouni Malinen } 21556a7c9badSJouni Malinen 21566a7c9badSJouni Malinen if (!add) 21576a7c9badSJouni Malinen return 0; 21586a7c9badSJouni Malinen 21599a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 21609a5b1318SJouni Malinen 21616a7c9badSJouni Malinen /* TODO: 21626a7c9badSJouni Malinen * info->interval 21636a7c9badSJouni Malinen * info->dtim_period 21646a7c9badSJouni Malinen */ 21656a7c9badSJouni Malinen 21666a7c9badSJouni Malinen if (info->head == NULL) 21676a7c9badSJouni Malinen return -EINVAL; 21686a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 21696a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 21706a7c9badSJouni Malinen if (ies > info->head + info->head_len) 21716a7c9badSJouni Malinen return -EINVAL; 21726a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 21736a7c9badSJouni Malinen 21746a7c9badSJouni Malinen if (info->ssid == NULL) 21756a7c9badSJouni Malinen return -EINVAL; 21763450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 21773450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 21786a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 21796a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 21806a7c9badSJouni Malinen 2181be5abaafSVasanthakumar Thiagarajan ret = ath6kl_set_auth_type(vif, info->auth_type); 2182be5abaafSVasanthakumar Thiagarajan if (ret) 2183be5abaafSVasanthakumar Thiagarajan return ret; 21846a7c9badSJouni Malinen 21856a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 21866a7c9badSJouni Malinen 21876a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 21886a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 21896a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 21906a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21916a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 21926a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21936a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 21946a7c9badSJouni Malinen break; 21956a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 21966a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 21976a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 21986a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 21996a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 22006a7c9badSJouni Malinen break; 22016a7c9badSJouni Malinen } 22026a7c9badSJouni Malinen } 22036a7c9badSJouni Malinen if (p.auth_mode == 0) 22046a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 22053450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 22066a7c9badSJouni Malinen 22076a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 22086a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 22096a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22106a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22116a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 22126a7c9badSJouni Malinen break; 22136a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22146a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 22156a7c9badSJouni Malinen break; 22166a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22176a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 22186a7c9badSJouni Malinen break; 2219b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2220b8214df1SDai Shuibing p.prwise_crypto_type |= WAPI_CRYPT; 2221b8214df1SDai Shuibing break; 22226a7c9badSJouni Malinen } 22236a7c9badSJouni Malinen } 2224229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 22256a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 2226240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, 0, true); 2227229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 2228240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 22296a7c9badSJouni Malinen 22306a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 22316a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 22326a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 22336a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 22346a7c9badSJouni Malinen break; 22356a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 22366a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 22376a7c9badSJouni Malinen break; 22386a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 22396a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 22406a7c9badSJouni Malinen break; 2241b8214df1SDai Shuibing case WLAN_CIPHER_SUITE_SMS4: 2242b8214df1SDai Shuibing p.grp_crypto_type = WAPI_CRYPT; 2243b8214df1SDai Shuibing break; 22446a7c9badSJouni Malinen default: 22456a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 22466a7c9badSJouni Malinen break; 22476a7c9badSJouni Malinen } 2248240d2799SVasanthakumar Thiagarajan ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 22496a7c9badSJouni Malinen 22506a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 2251f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 22526a7c9badSJouni Malinen 22533450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 22543450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 22553450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 2256cf5333d7SVasanthakumar Thiagarajan p.ch = cpu_to_le16(vif->next_chan); 22576a7c9badSJouni Malinen 22583ca9d1fcSAarthi Thiruvengadam if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 22593ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_P2PGO; 22603ca9d1fcSAarthi Thiruvengadam } else { 22613ca9d1fcSAarthi Thiruvengadam /* 22623ca9d1fcSAarthi Thiruvengadam * Due to firmware limitation, it is not possible to 22633ca9d1fcSAarthi Thiruvengadam * do P2P mgmt operations in AP mode 22643ca9d1fcSAarthi Thiruvengadam */ 22653ca9d1fcSAarthi Thiruvengadam p.nw_subtype = SUBTYPE_NONE; 22663ca9d1fcSAarthi Thiruvengadam } 22673ca9d1fcSAarthi Thiruvengadam 2268334234b5SVasanthakumar Thiagarajan res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 22699a5b1318SJouni Malinen if (res < 0) 22709a5b1318SJouni Malinen return res; 22719a5b1318SJouni Malinen 22729a5b1318SJouni Malinen return 0; 22736a7c9badSJouni Malinen } 22746a7c9badSJouni Malinen 22756a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 22766a7c9badSJouni Malinen struct beacon_parameters *info) 22776a7c9badSJouni Malinen { 22786a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 22796a7c9badSJouni Malinen } 22806a7c9badSJouni Malinen 22816a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 22826a7c9badSJouni Malinen struct beacon_parameters *info) 22836a7c9badSJouni Malinen { 22846a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 22856a7c9badSJouni Malinen } 22866a7c9badSJouni Malinen 22876a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 22886a7c9badSJouni Malinen { 22896a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 229059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 22916a7c9badSJouni Malinen 2292f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 22936a7c9badSJouni Malinen return -EOPNOTSUPP; 229459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 22956a7c9badSJouni Malinen return -ENOTCONN; 22966a7c9badSJouni Malinen 2297334234b5SVasanthakumar Thiagarajan ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 229859c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 22996a7c9badSJouni Malinen 23006a7c9badSJouni Malinen return 0; 23016a7c9badSJouni Malinen } 23026a7c9badSJouni Malinen 230323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 230423875136SJouni Malinen u8 *mac, struct station_parameters *params) 230523875136SJouni Malinen { 230623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2307f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 230823875136SJouni Malinen 2309f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 231023875136SJouni Malinen return -EOPNOTSUPP; 231123875136SJouni Malinen 231223875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 231323875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 231423875136SJouni Malinen return -EOPNOTSUPP; 231523875136SJouni Malinen 231623875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2317334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2318334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_AUTHORIZE, mac, 0); 2319334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2320334234b5SVasanthakumar Thiagarajan WMI_AP_MLME_UNAUTHORIZE, mac, 0); 232123875136SJouni Malinen } 232223875136SJouni Malinen 232363fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 232463fa1e0cSJouni Malinen struct net_device *dev, 232563fa1e0cSJouni Malinen struct ieee80211_channel *chan, 232663fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 232763fa1e0cSJouni Malinen unsigned int duration, 232863fa1e0cSJouni Malinen u64 *cookie) 232963fa1e0cSJouni Malinen { 233063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2331334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 23321052261eSJouni Malinen u32 id; 233363fa1e0cSJouni Malinen 233463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 233563fa1e0cSJouni Malinen * return -EBUSY */ 23361052261eSJouni Malinen id = ++vif->last_roc_id; 23371052261eSJouni Malinen if (id == 0) { 23381052261eSJouni Malinen /* Do not use 0 as the cookie value */ 23391052261eSJouni Malinen id = ++vif->last_roc_id; 23401052261eSJouni Malinen } 23411052261eSJouni Malinen *cookie = id; 234263fa1e0cSJouni Malinen 2343334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2344334234b5SVasanthakumar Thiagarajan chan->center_freq, duration); 234563fa1e0cSJouni Malinen } 234663fa1e0cSJouni Malinen 234763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 234863fa1e0cSJouni Malinen struct net_device *dev, 234963fa1e0cSJouni Malinen u64 cookie) 235063fa1e0cSJouni Malinen { 235163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 2352334234b5SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 235363fa1e0cSJouni Malinen 23541052261eSJouni Malinen if (cookie != vif->last_roc_id) 235563fa1e0cSJouni Malinen return -ENOENT; 23561052261eSJouni Malinen vif->last_cancel_roc_id = cookie; 235763fa1e0cSJouni Malinen 2358334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 235963fa1e0cSJouni Malinen } 236063fa1e0cSJouni Malinen 2361334234b5SVasanthakumar Thiagarajan static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2362334234b5SVasanthakumar Thiagarajan const u8 *buf, size_t len, 2363334234b5SVasanthakumar Thiagarajan unsigned int freq) 23648bdfbf40SJouni Malinen { 2365334234b5SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 23668bdfbf40SJouni Malinen const u8 *pos; 23678bdfbf40SJouni Malinen u8 *p2p; 23688bdfbf40SJouni Malinen int p2p_len; 23698bdfbf40SJouni Malinen int ret; 23708bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 23718bdfbf40SJouni Malinen 23728bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 23738bdfbf40SJouni Malinen 23748bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 23758bdfbf40SJouni Malinen 23768bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 23778bdfbf40SJouni Malinen if (p2p == NULL) 23788bdfbf40SJouni Malinen return -ENOMEM; 23798bdfbf40SJouni Malinen p2p_len = 0; 23808bdfbf40SJouni Malinen 23818bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 23828bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 23838bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 23848bdfbf40SJouni Malinen break; 23858bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 23868bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 23878bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 23888bdfbf40SJouni Malinen } 23898bdfbf40SJouni Malinen pos += 2 + pos[1]; 23908bdfbf40SJouni Malinen } 23918bdfbf40SJouni Malinen 2392334234b5SVasanthakumar Thiagarajan ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2393334234b5SVasanthakumar Thiagarajan mgmt->da, p2p, p2p_len); 23948bdfbf40SJouni Malinen kfree(p2p); 23958bdfbf40SJouni Malinen return ret; 23968bdfbf40SJouni Malinen } 23978bdfbf40SJouni Malinen 23988a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 23998a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 24008a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 24018a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 2402e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 2403e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 24048a6c8060SJouni Malinen { 24058a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 240659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 24078a6c8060SJouni Malinen u32 id; 24088bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 24098bdfbf40SJouni Malinen 24108bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 24118bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 2412f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 24138bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 24148bdfbf40SJouni Malinen /* 24158bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 24168bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 24178bdfbf40SJouni Malinen */ 24188bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 2419334234b5SVasanthakumar Thiagarajan return ath6kl_send_go_probe_resp(vif, buf, len, 24208bdfbf40SJouni Malinen chan->center_freq); 24218bdfbf40SJouni Malinen } 24228a6c8060SJouni Malinen 2423cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24248a6c8060SJouni Malinen if (id == 0) { 24258a6c8060SJouni Malinen /* 24268a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 24278a6c8060SJouni Malinen * used for the command. 24288a6c8060SJouni Malinen */ 2429cf5333d7SVasanthakumar Thiagarajan id = vif->send_action_id++; 24308a6c8060SJouni Malinen } 24318a6c8060SJouni Malinen 24328a6c8060SJouni Malinen *cookie = id; 24333ca9d1fcSAarthi Thiruvengadam 24343ca9d1fcSAarthi Thiruvengadam if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 24353ca9d1fcSAarthi Thiruvengadam ar->fw_capabilities)) { 24363ca9d1fcSAarthi Thiruvengadam /* 24373ca9d1fcSAarthi Thiruvengadam * If capable of doing P2P mgmt operations using 24383ca9d1fcSAarthi Thiruvengadam * station interface, send additional information like 24393ca9d1fcSAarthi Thiruvengadam * supported rates to advertise and xmit rates for 24403ca9d1fcSAarthi Thiruvengadam * probe requests 24413ca9d1fcSAarthi Thiruvengadam */ 24423ca9d1fcSAarthi Thiruvengadam return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 24433ca9d1fcSAarthi Thiruvengadam chan->center_freq, wait, 24443ca9d1fcSAarthi Thiruvengadam buf, len, no_cck); 24453ca9d1fcSAarthi Thiruvengadam } else { 2446334234b5SVasanthakumar Thiagarajan return ath6kl_wmi_send_action_cmd(ar->wmi, vif->fw_vif_idx, id, 2447334234b5SVasanthakumar Thiagarajan chan->center_freq, wait, 24488a6c8060SJouni Malinen buf, len); 24498a6c8060SJouni Malinen } 24503ca9d1fcSAarthi Thiruvengadam } 24518a6c8060SJouni Malinen 2452ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 2453ae32c30aSJouni Malinen struct net_device *dev, 2454ae32c30aSJouni Malinen u16 frame_type, bool reg) 2455ae32c30aSJouni Malinen { 2456cf5333d7SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 2457ae32c30aSJouni Malinen 2458ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 2459ae32c30aSJouni Malinen __func__, frame_type, reg); 2460ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 2461ae32c30aSJouni Malinen /* 2462ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 2463ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 2464ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 2465ae32c30aSJouni Malinen */ 2466cf5333d7SVasanthakumar Thiagarajan vif->probe_req_report = reg; 2467ae32c30aSJouni Malinen } 2468ae32c30aSJouni Malinen } 2469ae32c30aSJouni Malinen 247010509f90SKalle Valo static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 247110509f90SKalle Valo struct net_device *dev, 247210509f90SKalle Valo struct cfg80211_sched_scan_request *request) 247310509f90SKalle Valo { 247410509f90SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 247510509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 247610509f90SKalle Valo u16 interval; 247710509f90SKalle Valo int ret; 247810509f90SKalle Valo u8 i; 247910509f90SKalle Valo 248010509f90SKalle Valo if (ar->state != ATH6KL_STATE_ON) 248110509f90SKalle Valo return -EIO; 248210509f90SKalle Valo 248310509f90SKalle Valo if (vif->sme_state != SME_DISCONNECTED) 248410509f90SKalle Valo return -EBUSY; 248510509f90SKalle Valo 248610509f90SKalle Valo for (i = 0; i < ar->wiphy->max_sched_scan_ssids; i++) { 248710509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 248810509f90SKalle Valo i, DISABLE_SSID_FLAG, 248910509f90SKalle Valo 0, NULL); 249010509f90SKalle Valo } 249110509f90SKalle Valo 249210509f90SKalle Valo /* fw uses seconds, also make sure that it's >0 */ 249310509f90SKalle Valo interval = max_t(u16, 1, request->interval / 1000); 249410509f90SKalle Valo 249510509f90SKalle Valo ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 249610509f90SKalle Valo interval, interval, 249710509f90SKalle Valo 10, 0, 0, 0, 3, 0, 0, 0); 249810509f90SKalle Valo 249910509f90SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 250010509f90SKalle Valo for (i = 0; i < request->n_ssids; i++) { 250110509f90SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 250210509f90SKalle Valo i, SPECIFIC_SSID_FLAG, 250310509f90SKalle Valo request->ssids[i].ssid_len, 250410509f90SKalle Valo request->ssids[i].ssid); 250510509f90SKalle Valo } 250610509f90SKalle Valo } 250710509f90SKalle Valo 250810509f90SKalle Valo ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 250910509f90SKalle Valo ATH6KL_WOW_MODE_ENABLE, 251010509f90SKalle Valo WOW_FILTER_SSID, 251110509f90SKalle Valo WOW_HOST_REQ_DELAY); 251210509f90SKalle Valo if (ret) { 251310509f90SKalle Valo ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 251410509f90SKalle Valo return ret; 251510509f90SKalle Valo } 251610509f90SKalle Valo 251710509f90SKalle Valo /* this also clears IE in fw if it's not set */ 251810509f90SKalle Valo ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 251910509f90SKalle Valo WMI_FRAME_PROBE_REQ, 252010509f90SKalle Valo request->ie, request->ie_len); 252110509f90SKalle Valo if (ret) { 252210509f90SKalle Valo ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 252310509f90SKalle Valo ret); 252410509f90SKalle Valo return ret; 252510509f90SKalle Valo } 252610509f90SKalle Valo 252710509f90SKalle Valo ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 252810509f90SKalle Valo ATH6KL_HOST_MODE_ASLEEP); 252910509f90SKalle Valo if (ret) { 253010509f90SKalle Valo ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 253110509f90SKalle Valo ret); 253210509f90SKalle Valo return ret; 253310509f90SKalle Valo } 253410509f90SKalle Valo 253510509f90SKalle Valo ar->state = ATH6KL_STATE_SCHED_SCAN; 253610509f90SKalle Valo 253710509f90SKalle Valo return ret; 253810509f90SKalle Valo } 253910509f90SKalle Valo 254010509f90SKalle Valo static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 254110509f90SKalle Valo struct net_device *dev) 254210509f90SKalle Valo { 254310509f90SKalle Valo struct ath6kl_vif *vif = netdev_priv(dev); 254410509f90SKalle Valo bool stopped; 254510509f90SKalle Valo 254610509f90SKalle Valo stopped = __ath6kl_cfg80211_sscan_stop(vif); 254710509f90SKalle Valo 254810509f90SKalle Valo if (!stopped) 254910509f90SKalle Valo return -EIO; 255010509f90SKalle Valo 255110509f90SKalle Valo return 0; 255210509f90SKalle Valo } 255310509f90SKalle Valo 2554f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 2555f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 2556f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 2557f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2558f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2559f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2560f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2561f80574aeSJouni Malinen }, 2562f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 2563f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2564f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2565f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2566f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2567f80574aeSJouni Malinen }, 2568f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 2569f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2570f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 2571f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 2572f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 2573f80574aeSJouni Malinen }, 2574f80574aeSJouni Malinen }; 2575f80574aeSJouni Malinen 2576bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 257755055976SVasanthakumar Thiagarajan .add_virtual_intf = ath6kl_cfg80211_add_iface, 257855055976SVasanthakumar Thiagarajan .del_virtual_intf = ath6kl_cfg80211_del_iface, 2579bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 2580bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 2581bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 2582bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 2583bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 2584bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 2585bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 2586bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 2587bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 2588bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 2589bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 2590bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 2591bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 2592bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 2593bdcd8170SKalle Valo .get_station = ath6kl_get_station, 2594bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 2595bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 2596bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 2597003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 2598abcb344bSKalle Valo #ifdef CONFIG_PM 259952d81a68SKalle Valo .suspend = __ath6kl_cfg80211_suspend, 260052d81a68SKalle Valo .resume = __ath6kl_cfg80211_resume, 2601abcb344bSKalle Valo #endif 26026a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 26036a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 26046a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 26056a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 260623875136SJouni Malinen .change_station = ath6kl_change_station, 260763fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 260863fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 26098a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 2610ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 261110509f90SKalle Valo .sched_scan_start = ath6kl_cfg80211_sscan_start, 261210509f90SKalle Valo .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 2613bdcd8170SKalle Valo }; 2614bdcd8170SKalle Valo 26157125f01dSKalle Valo void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 2616ec4b7f60SKalle Valo { 261710509f90SKalle Valo ath6kl_cfg80211_sscan_disable(vif); 261810509f90SKalle Valo 2619ec4b7f60SKalle Valo switch (vif->sme_state) { 2620c97a31b0SKalle Valo case SME_DISCONNECTED: 2621c97a31b0SKalle Valo break; 2622ec4b7f60SKalle Valo case SME_CONNECTING: 2623ec4b7f60SKalle Valo cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 2624ec4b7f60SKalle Valo NULL, 0, 2625ec4b7f60SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 2626ec4b7f60SKalle Valo GFP_KERNEL); 2627ec4b7f60SKalle Valo break; 2628ec4b7f60SKalle Valo case SME_CONNECTED: 2629ec4b7f60SKalle Valo cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 2630ec4b7f60SKalle Valo break; 2631ec4b7f60SKalle Valo } 2632ec4b7f60SKalle Valo 2633ec4b7f60SKalle Valo if (test_bit(CONNECTED, &vif->flags) || 2634ec4b7f60SKalle Valo test_bit(CONNECT_PEND, &vif->flags)) 26357125f01dSKalle Valo ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 2636ec4b7f60SKalle Valo 2637ec4b7f60SKalle Valo vif->sme_state = SME_DISCONNECTED; 26381f405255SKalle Valo clear_bit(CONNECTED, &vif->flags); 26391f405255SKalle Valo clear_bit(CONNECT_PEND, &vif->flags); 2640ec4b7f60SKalle Valo 2641ec4b7f60SKalle Valo /* disable scanning */ 26427125f01dSKalle Valo if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 26437125f01dSKalle Valo 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 26447125f01dSKalle Valo ath6kl_warn("failed to disable scan during stop\n"); 2645ec4b7f60SKalle Valo 2646ec4b7f60SKalle Valo ath6kl_cfg80211_scan_complete_event(vif, true); 2647ec4b7f60SKalle Valo } 2648ec4b7f60SKalle Valo 26497125f01dSKalle Valo void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 26507125f01dSKalle Valo { 26517125f01dSKalle Valo struct ath6kl_vif *vif; 26527125f01dSKalle Valo 26537125f01dSKalle Valo vif = ath6kl_vif_first(ar); 26547125f01dSKalle Valo if (!vif) { 26557125f01dSKalle Valo /* save the current power mode before enabling power save */ 26567125f01dSKalle Valo ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 26577125f01dSKalle Valo 26587125f01dSKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 26597125f01dSKalle Valo ath6kl_warn("ath6kl_deep_sleep_enable: " 26607125f01dSKalle Valo "wmi_powermode_cmd failed\n"); 26617125f01dSKalle Valo return; 26627125f01dSKalle Valo } 26637125f01dSKalle Valo 26647125f01dSKalle Valo /* 26657125f01dSKalle Valo * FIXME: we should take ar->list_lock to protect changes in the 26667125f01dSKalle Valo * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 26677125f01dSKalle Valo * sleeps. 26687125f01dSKalle Valo */ 26697125f01dSKalle Valo list_for_each_entry(vif, &ar->vif_list, list) 26707125f01dSKalle Valo ath6kl_cfg80211_stop(vif); 26717125f01dSKalle Valo } 26727125f01dSKalle Valo 26738dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 2674bdcd8170SKalle Valo { 26756bbc7c35SJouni Malinen struct ath6kl *ar; 2676be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 26778dafb70eSVasanthakumar Thiagarajan u8 ctr; 2678bdcd8170SKalle Valo 2679bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 2680be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 26818dafb70eSVasanthakumar Thiagarajan 2682be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 2683bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 2684bdcd8170SKalle Valo return NULL; 2685bdcd8170SKalle Valo } 2686bdcd8170SKalle Valo 2687be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 26886bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 2689be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 26908dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 26918dafb70eSVasanthakumar Thiagarajan 269271f96ee6SKalle Valo ar->vif_max = 1; 269371f96ee6SKalle Valo 26943226f68aSVasanthakumar Thiagarajan ar->max_norm_iface = 1; 26953226f68aSVasanthakumar Thiagarajan 26968dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 26978dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 2698990bd915SVasanthakumar Thiagarajan spin_lock_init(&ar->list_lock); 26998dafb70eSVasanthakumar Thiagarajan 27008dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 27018dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 27028dafb70eSVasanthakumar Thiagarajan 27038dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 2704990bd915SVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->vif_list); 27058dafb70eSVasanthakumar Thiagarajan 27068dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 27078dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 27088dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 27098dafb70eSVasanthakumar Thiagarajan 27108dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 27118dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 27128dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 27138dafb70eSVasanthakumar Thiagarajan 27148dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 27158dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 27168dafb70eSVasanthakumar Thiagarajan 271776a9fbe2SKalle Valo ar->state = ATH6KL_STATE_OFF; 271876a9fbe2SKalle Valo 27198dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 27208dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 27218dafb70eSVasanthakumar Thiagarajan 27228dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 27238dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 27248dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 27258dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 27268dafb70eSVasanthakumar Thiagarajan } 27278dafb70eSVasanthakumar Thiagarajan 27288dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 27298dafb70eSVasanthakumar Thiagarajan 27308dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 27318dafb70eSVasanthakumar Thiagarajan 27328dafb70eSVasanthakumar Thiagarajan return ar; 27338dafb70eSVasanthakumar Thiagarajan } 27348dafb70eSVasanthakumar Thiagarajan 27358dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 27368dafb70eSVasanthakumar Thiagarajan { 27378dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 27388dafb70eSVasanthakumar Thiagarajan int ret; 27396bbc7c35SJouni Malinen 2740be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2741f80574aeSJouni Malinen 2742be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 274363fa1e0cSJouni Malinen 2744bdcd8170SKalle Valo /* set device pointer for wiphy */ 27458dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2746bdcd8170SKalle Valo 2747be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 27488dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 27498dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 27506bbc7c35SJouni Malinen if (ar->p2p) { 2751be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 27526bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 27536bbc7c35SJouni Malinen } 27548dafb70eSVasanthakumar Thiagarajan 2755bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2756be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2757be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2758be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2759be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2760be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2761bdcd8170SKalle Valo 2762be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2763be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2764bdcd8170SKalle Valo 2765eae9e066SRaja Mani wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 2766eae9e066SRaja Mani WIPHY_WOWLAN_DISCONNECT | 2767eae9e066SRaja Mani WIPHY_WOWLAN_GTK_REKEY_FAILURE | 2768eae9e066SRaja Mani WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 2769eae9e066SRaja Mani WIPHY_WOWLAN_EAP_IDENTITY_REQ | 2770eae9e066SRaja Mani WIPHY_WOWLAN_4WAY_HANDSHAKE; 2771eae9e066SRaja Mani wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 2772eae9e066SRaja Mani wiphy->wowlan.pattern_min_len = 1; 2773eae9e066SRaja Mani wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 2774eae9e066SRaja Mani 277510509f90SKalle Valo wiphy->max_sched_scan_ssids = 10; 277610509f90SKalle Valo 2777be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2778bdcd8170SKalle Valo if (ret < 0) { 2779bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 27808dafb70eSVasanthakumar Thiagarajan return ret; 27818dafb70eSVasanthakumar Thiagarajan } 27828dafb70eSVasanthakumar Thiagarajan 27838dafb70eSVasanthakumar Thiagarajan return 0; 27848dafb70eSVasanthakumar Thiagarajan } 27858dafb70eSVasanthakumar Thiagarajan 2786108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 27878dafb70eSVasanthakumar Thiagarajan { 27882132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 27892132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 27908dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 27918dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 27928dafb70eSVasanthakumar Thiagarajan } 27938dafb70eSVasanthakumar Thiagarajan 2794de3ad713SVasanthakumar Thiagarajan setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 2795108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 279610509f90SKalle Valo setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 279710509f90SKalle Valo (unsigned long) vif); 279810509f90SKalle Valo 2799de3ad713SVasanthakumar Thiagarajan set_bit(WMM_ENABLED, &vif->flags); 2800478ac027SVasanthakumar Thiagarajan spin_lock_init(&vif->if_lock); 28018dafb70eSVasanthakumar Thiagarajan 28028dafb70eSVasanthakumar Thiagarajan return 0; 28038dafb70eSVasanthakumar Thiagarajan } 28048dafb70eSVasanthakumar Thiagarajan 2805108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 28068dafb70eSVasanthakumar Thiagarajan { 280755055976SVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 280855055976SVasanthakumar Thiagarajan 28092132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2810108438bcSVasanthakumar Thiagarajan 281155055976SVasanthakumar Thiagarajan ar->avail_idx_map |= BIT(vif->fw_vif_idx); 281255055976SVasanthakumar Thiagarajan 281355055976SVasanthakumar Thiagarajan if (vif->nw_type == ADHOC_NETWORK) 281455055976SVasanthakumar Thiagarajan ar->ibss_if_active = false; 281555055976SVasanthakumar Thiagarajan 281627929723SVasanthakumar Thiagarajan unregister_netdevice(vif->ndev); 281755055976SVasanthakumar Thiagarajan 281855055976SVasanthakumar Thiagarajan ar->num_vif--; 28198dafb70eSVasanthakumar Thiagarajan } 28208dafb70eSVasanthakumar Thiagarajan 28218dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 282255055976SVasanthakumar Thiagarajan enum nl80211_iftype type, u8 fw_vif_idx, 282355055976SVasanthakumar Thiagarajan u8 nw_type) 28248dafb70eSVasanthakumar Thiagarajan { 28258dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2826108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 28278dafb70eSVasanthakumar Thiagarajan 282855055976SVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 28298dafb70eSVasanthakumar Thiagarajan if (!ndev) 28308dafb70eSVasanthakumar Thiagarajan return NULL; 28318dafb70eSVasanthakumar Thiagarajan 2832108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2833108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2834108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2835108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2836108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2837108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2838108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2839108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2840334234b5SVasanthakumar Thiagarajan vif->fw_vif_idx = fw_vif_idx; 284155055976SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode = nw_type; 28428dafb70eSVasanthakumar Thiagarajan 284355055976SVasanthakumar Thiagarajan memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 284455055976SVasanthakumar Thiagarajan if (fw_vif_idx != 0) 284555055976SVasanthakumar Thiagarajan ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 284655055976SVasanthakumar Thiagarajan 0x2; 284755055976SVasanthakumar Thiagarajan 28488dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 28498dafb70eSVasanthakumar Thiagarajan 2850e29f25f5SVasanthakumar Thiagarajan ath6kl_init_control_info(vif); 28518dafb70eSVasanthakumar Thiagarajan 28528dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2853108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 28548dafb70eSVasanthakumar Thiagarajan goto err; 28558dafb70eSVasanthakumar Thiagarajan 285627929723SVasanthakumar Thiagarajan if (register_netdevice(ndev)) 28578dafb70eSVasanthakumar Thiagarajan goto err; 28588dafb70eSVasanthakumar Thiagarajan 285955055976SVasanthakumar Thiagarajan ar->avail_idx_map &= ~BIT(fw_vif_idx); 286014ee6f6bSVasanthakumar Thiagarajan vif->sme_state = SME_DISCONNECTED; 286159c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 28628dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 286359c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 28648dafb70eSVasanthakumar Thiagarajan 286555055976SVasanthakumar Thiagarajan if (type == NL80211_IFTYPE_ADHOC) 286655055976SVasanthakumar Thiagarajan ar->ibss_if_active = true; 286755055976SVasanthakumar Thiagarajan 286811f6e40dSVasanthakumar Thiagarajan spin_lock_bh(&ar->list_lock); 2869990bd915SVasanthakumar Thiagarajan list_add_tail(&vif->list, &ar->vif_list); 287011f6e40dSVasanthakumar Thiagarajan spin_unlock_bh(&ar->list_lock); 2871990bd915SVasanthakumar Thiagarajan 28728dafb70eSVasanthakumar Thiagarajan return ndev; 28738dafb70eSVasanthakumar Thiagarajan 28748dafb70eSVasanthakumar Thiagarajan err: 287527929723SVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 287627929723SVasanthakumar Thiagarajan free_netdev(ndev); 2877bdcd8170SKalle Valo return NULL; 2878bdcd8170SKalle Valo } 2879bdcd8170SKalle Valo 28808dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2881bdcd8170SKalle Valo { 2882be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2883be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2884bdcd8170SKalle Valo } 2885