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 17bdcd8170SKalle Valo #include "core.h" 18bdcd8170SKalle Valo #include "cfg80211.h" 19bdcd8170SKalle Valo #include "debug.h" 20abcb344bSKalle Valo #include "hif-ops.h" 21003353b0SKalle Valo #include "testmode.h" 22bdcd8170SKalle Valo 236bbc7c35SJouni Malinen static unsigned int ath6kl_p2p; 246bbc7c35SJouni Malinen 256bbc7c35SJouni Malinen module_param(ath6kl_p2p, uint, 0644); 266bbc7c35SJouni Malinen 27bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 28bdcd8170SKalle Valo .bitrate = (_rate), \ 29bdcd8170SKalle Valo .flags = (_flags), \ 30bdcd8170SKalle Valo .hw_value = (_rateid), \ 31bdcd8170SKalle Valo } 32bdcd8170SKalle Valo 33bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 34bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 35bdcd8170SKalle Valo .hw_value = (_channel), \ 36bdcd8170SKalle Valo .center_freq = (_freq), \ 37bdcd8170SKalle Valo .flags = (_flags), \ 38bdcd8170SKalle Valo .max_antenna_gain = 0, \ 39bdcd8170SKalle Valo .max_power = 30, \ 40bdcd8170SKalle Valo } 41bdcd8170SKalle Valo 42bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 43bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 44bdcd8170SKalle Valo .hw_value = (_channel), \ 45bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 46bdcd8170SKalle Valo .flags = (_flags), \ 47bdcd8170SKalle Valo .max_antenna_gain = 0, \ 48bdcd8170SKalle Valo .max_power = 30, \ 49bdcd8170SKalle Valo } 50bdcd8170SKalle Valo 51bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 52bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 53bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 54bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 55bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 56bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 57bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 58bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 59bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 60bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 61bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 62bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 63bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 64bdcd8170SKalle Valo }; 65bdcd8170SKalle Valo 66bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 67bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 68bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 69bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 70bdcd8170SKalle Valo 71bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 72bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 73bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 74bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 75bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 76bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 77bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 78bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 79bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 80bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 81bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 82bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 83bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 84bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 85bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 86bdcd8170SKalle Valo }; 87bdcd8170SKalle Valo 88bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 89bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 90bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 91bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 92bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 93bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 94bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 95bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 96bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 97bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 98bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 99bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 100bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 101bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 102bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 103bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 104bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 105bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 106bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 107bdcd8170SKalle Valo CHAN5G(216, 0), 108bdcd8170SKalle Valo }; 109bdcd8170SKalle Valo 110bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 111bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 112bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 113bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 114bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 115bdcd8170SKalle Valo }; 116bdcd8170SKalle Valo 117bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 118bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 119bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 120bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 121bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 122bdcd8170SKalle Valo }; 123bdcd8170SKalle Valo 124837cb97eSJouni Malinen #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 125837cb97eSJouni Malinen 126bdcd8170SKalle Valo static int ath6kl_set_wpa_version(struct ath6kl *ar, 127bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 128bdcd8170SKalle Valo { 1293450334fSVasanthakumar Thiagarajan /* TODO: Findout vif */ 1303450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 1313450334fSVasanthakumar Thiagarajan 132bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 133bdcd8170SKalle Valo 134bdcd8170SKalle Valo if (!wpa_version) { 1353450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 136bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 1373450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH; 138bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 1393450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH; 140bdcd8170SKalle Valo } else { 141bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 142bdcd8170SKalle Valo return -ENOTSUPP; 143bdcd8170SKalle Valo } 144bdcd8170SKalle Valo 145bdcd8170SKalle Valo return 0; 146bdcd8170SKalle Valo } 147bdcd8170SKalle Valo 148bdcd8170SKalle Valo static int ath6kl_set_auth_type(struct ath6kl *ar, 149bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 150bdcd8170SKalle Valo { 1513450334fSVasanthakumar Thiagarajan /* TODO: Findout vif */ 1523450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 153bdcd8170SKalle Valo 154bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 155bdcd8170SKalle Valo 156bdcd8170SKalle Valo switch (auth_type) { 157bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 1583450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 159bdcd8170SKalle Valo break; 160bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 1613450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = SHARED_AUTH; 162bdcd8170SKalle Valo break; 163bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 1643450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = LEAP_AUTH; 165bdcd8170SKalle Valo break; 166bdcd8170SKalle Valo 167bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 1683450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 169bdcd8170SKalle Valo break; 170bdcd8170SKalle Valo 171bdcd8170SKalle Valo default: 172bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 173bdcd8170SKalle Valo return -ENOTSUPP; 174bdcd8170SKalle Valo } 175bdcd8170SKalle Valo 176bdcd8170SKalle Valo return 0; 177bdcd8170SKalle Valo } 178bdcd8170SKalle Valo 179bdcd8170SKalle Valo static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast) 180bdcd8170SKalle Valo { 1813450334fSVasanthakumar Thiagarajan /* TODO: Findout vif */ 1823450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 1833450334fSVasanthakumar Thiagarajan 1843450334fSVasanthakumar Thiagarajan u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 1853450334fSVasanthakumar Thiagarajan u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 1863450334fSVasanthakumar Thiagarajan &vif->grp_crypto_len; 187bdcd8170SKalle Valo 188bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 189bdcd8170SKalle Valo __func__, cipher, ucast); 190bdcd8170SKalle Valo 191bdcd8170SKalle Valo switch (cipher) { 192bdcd8170SKalle Valo case 0: 193bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 194bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 195bdcd8170SKalle Valo *ar_cipher_len = 0; 196bdcd8170SKalle Valo break; 197bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 198bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 199bdcd8170SKalle Valo *ar_cipher_len = 5; 200bdcd8170SKalle Valo break; 201bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 202bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 203bdcd8170SKalle Valo *ar_cipher_len = 13; 204bdcd8170SKalle Valo break; 205bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 206bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 207bdcd8170SKalle Valo *ar_cipher_len = 0; 208bdcd8170SKalle Valo break; 209bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 210bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 211bdcd8170SKalle Valo *ar_cipher_len = 0; 212bdcd8170SKalle Valo break; 213bdcd8170SKalle Valo default: 214bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 215bdcd8170SKalle Valo return -ENOTSUPP; 216bdcd8170SKalle Valo } 217bdcd8170SKalle Valo 218bdcd8170SKalle Valo return 0; 219bdcd8170SKalle Valo } 220bdcd8170SKalle Valo 221bdcd8170SKalle Valo static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt) 222bdcd8170SKalle Valo { 2233450334fSVasanthakumar Thiagarajan /* TODO: Findout vif */ 2243450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 2253450334fSVasanthakumar Thiagarajan 226bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 227bdcd8170SKalle Valo 228bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 2293450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2303450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_PSK_AUTH; 2313450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2323450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_PSK_AUTH; 233837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 2343450334fSVasanthakumar Thiagarajan if (vif->auth_mode == WPA_AUTH) 2353450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA_AUTH_CCKM; 2363450334fSVasanthakumar Thiagarajan else if (vif->auth_mode == WPA2_AUTH) 2373450334fSVasanthakumar Thiagarajan vif->auth_mode = WPA2_AUTH_CCKM; 238bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 2393450334fSVasanthakumar Thiagarajan vif->auth_mode = NONE_AUTH; 240bdcd8170SKalle Valo } 241bdcd8170SKalle Valo } 242bdcd8170SKalle Valo 243bdcd8170SKalle Valo static bool ath6kl_cfg80211_ready(struct ath6kl *ar) 244bdcd8170SKalle Valo { 24559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 24659c98449SVasanthakumar Thiagarajan 247bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 248bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 249bdcd8170SKalle Valo return false; 250bdcd8170SKalle Valo } 251bdcd8170SKalle Valo 25259c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 253bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 254bdcd8170SKalle Valo return false; 255bdcd8170SKalle Valo } 256bdcd8170SKalle Valo 257bdcd8170SKalle Valo return true; 258bdcd8170SKalle Valo } 259bdcd8170SKalle Valo 2606981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2616981ffdcSKevin Fang { 2626981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2636981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2646981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2656981ffdcSKevin Fang } 2666981ffdcSKevin Fang 2676981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2686981ffdcSKevin Fang { 2696981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2706981ffdcSKevin Fang } 2716981ffdcSKevin Fang 2726981ffdcSKevin Fang static int ath6kl_set_assoc_req_ies(struct ath6kl *ar, const u8 *ies, 2736981ffdcSKevin Fang size_t ies_len) 2746981ffdcSKevin Fang { 2756981ffdcSKevin Fang const u8 *pos; 2766981ffdcSKevin Fang u8 *buf = NULL; 2776981ffdcSKevin Fang size_t len = 0; 2786981ffdcSKevin Fang int ret; 2796981ffdcSKevin Fang 2806981ffdcSKevin Fang /* 2816981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2826981ffdcSKevin Fang */ 2836981ffdcSKevin Fang 2846981ffdcSKevin Fang if (ies && ies_len) { 2856981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2866981ffdcSKevin Fang if (buf == NULL) 2876981ffdcSKevin Fang return -ENOMEM; 2886981ffdcSKevin Fang pos = ies; 2896981ffdcSKevin Fang 2906981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 2916981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 2926981ffdcSKevin Fang break; 2936981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 2946981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 2956981ffdcSKevin Fang len += 2 + pos[1]; 2966981ffdcSKevin Fang } 2976981ffdcSKevin Fang pos += 2 + pos[1]; 2986981ffdcSKevin Fang } 2996981ffdcSKevin Fang } 3006981ffdcSKevin Fang 3016981ffdcSKevin Fang ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_REQ, 3026981ffdcSKevin Fang buf, len); 3036981ffdcSKevin Fang kfree(buf); 3046981ffdcSKevin Fang return ret; 3056981ffdcSKevin Fang } 3066981ffdcSKevin Fang 307bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 308bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 309bdcd8170SKalle Valo { 310bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 31159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 312bdcd8170SKalle Valo int status; 313bdcd8170SKalle Valo 314bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 315bdcd8170SKalle Valo 316bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 317bdcd8170SKalle Valo return -EIO; 318bdcd8170SKalle Valo 319bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 320bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 321bdcd8170SKalle Valo return -EBUSY; 322bdcd8170SKalle Valo } 323bdcd8170SKalle Valo 324bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 325bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 326bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 327bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 328bdcd8170SKalle Valo return -EINVAL; 329bdcd8170SKalle Valo } 330bdcd8170SKalle Valo 331bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 332bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 333bdcd8170SKalle Valo return -ERESTARTSYS; 334bdcd8170SKalle Valo } 335bdcd8170SKalle Valo 336bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 337bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 338bdcd8170SKalle Valo up(&ar->sem); 339bdcd8170SKalle Valo return -EBUSY; 340bdcd8170SKalle Valo } 341bdcd8170SKalle Valo 342bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 343bdcd8170SKalle Valo /* 344bdcd8170SKalle Valo * sleep until the command queue drains 345bdcd8170SKalle Valo */ 346bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 347bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 348bdcd8170SKalle Valo WMI_TIMEOUT); 349bdcd8170SKalle Valo if (signal_pending(current)) { 350bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 351bdcd8170SKalle Valo up(&ar->sem); 352bdcd8170SKalle Valo return -EINTR; 353bdcd8170SKalle Valo } 354bdcd8170SKalle Valo } 355bdcd8170SKalle Valo 3566981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 3576981ffdcSKevin Fang status = ath6kl_set_assoc_req_ies(ar, sme->ie, sme->ie_len); 3586981ffdcSKevin Fang if (status) 3596981ffdcSKevin Fang return status; 3606981ffdcSKevin Fang } 3616981ffdcSKevin Fang 36259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 3633450334fSVasanthakumar Thiagarajan vif->ssid_len == sme->ssid_len && 3643450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 365bdcd8170SKalle Valo ar->reconnect_flag = true; 366bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 367bdcd8170SKalle Valo ar->ch_hint); 368bdcd8170SKalle Valo 369bdcd8170SKalle Valo up(&ar->sem); 370bdcd8170SKalle Valo if (status) { 371bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 372bdcd8170SKalle Valo return -EIO; 373bdcd8170SKalle Valo } 374bdcd8170SKalle Valo return 0; 3753450334fSVasanthakumar Thiagarajan } else if (vif->ssid_len == sme->ssid_len && 3763450334fSVasanthakumar Thiagarajan !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 377bdcd8170SKalle Valo ath6kl_disconnect(ar); 378bdcd8170SKalle Valo } 379bdcd8170SKalle Valo 3803450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 3813450334fSVasanthakumar Thiagarajan vif->ssid_len = sme->ssid_len; 3823450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, sme->ssid, sme->ssid_len); 383bdcd8170SKalle Valo 384bdcd8170SKalle Valo if (sme->channel) 385bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 386bdcd8170SKalle Valo 387bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 388bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 389bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 390bdcd8170SKalle Valo 391bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 392bdcd8170SKalle Valo 393bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 394bdcd8170SKalle Valo if (status) { 395bdcd8170SKalle Valo up(&ar->sem); 396bdcd8170SKalle Valo return status; 397bdcd8170SKalle Valo } 398bdcd8170SKalle Valo 399bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 400bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 401bdcd8170SKalle Valo else 402bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 403bdcd8170SKalle Valo 404bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 405bdcd8170SKalle Valo 406bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 407bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 408bdcd8170SKalle Valo 409bdcd8170SKalle Valo if ((sme->key_len) && 4103450334fSVasanthakumar Thiagarajan (vif->auth_mode == NONE_AUTH) && 4113450334fSVasanthakumar Thiagarajan (vif->prwise_crypto == WEP_CRYPT)) { 412bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 413bdcd8170SKalle Valo 414bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 415bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 416bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 417bdcd8170SKalle Valo sme->key_idx); 418bdcd8170SKalle Valo up(&ar->sem); 419bdcd8170SKalle Valo return -ENOENT; 420bdcd8170SKalle Valo } 421bdcd8170SKalle Valo 422bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 423bdcd8170SKalle Valo key->key_len = sme->key_len; 424bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 4253450334fSVasanthakumar Thiagarajan key->cipher = vif->prwise_crypto; 4263450334fSVasanthakumar Thiagarajan vif->def_txkey_index = sme->key_idx; 427bdcd8170SKalle Valo 428bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 4293450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 430bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 431bdcd8170SKalle Valo key->key_len, 432bdcd8170SKalle Valo NULL, 433bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 434bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 435bdcd8170SKalle Valo } 436bdcd8170SKalle Valo 437bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 43859c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 439bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 440bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 441bdcd8170SKalle Valo up(&ar->sem); 442bdcd8170SKalle Valo return -EIO; 443bdcd8170SKalle Valo } 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 447bdcd8170SKalle Valo 448bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 449bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 450bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 451bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 452bdcd8170SKalle Valo __func__, 4533450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 4543450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 4553450334fSVasanthakumar Thiagarajan vif->grp_crypto_len, ar->ch_hint); 456bdcd8170SKalle Valo 457bdcd8170SKalle Valo ar->reconnect_flag = 0; 458bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 4593450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 4603450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 4613450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 4623450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 4633450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 464bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 465bdcd8170SKalle Valo ar->connect_ctrl_flags); 466bdcd8170SKalle Valo 467bdcd8170SKalle Valo up(&ar->sem); 468bdcd8170SKalle Valo 469bdcd8170SKalle Valo if (status == -EINVAL) { 4703450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 4713450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 472bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 473bdcd8170SKalle Valo return -ENOENT; 474bdcd8170SKalle Valo } else if (status) { 475bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 476bdcd8170SKalle Valo return -EIO; 477bdcd8170SKalle Valo } 478bdcd8170SKalle Valo 479bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 4803450334fSVasanthakumar Thiagarajan ((vif->auth_mode == WPA_PSK_AUTH) 4813450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH))) { 482bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 483bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 484bdcd8170SKalle Valo } 485bdcd8170SKalle Valo 486bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 48759c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 488bdcd8170SKalle Valo 489bdcd8170SKalle Valo return 0; 490bdcd8170SKalle Valo } 491bdcd8170SKalle Valo 49201cac476SJouni Malinen static int ath6kl_add_bss_if_needed(struct ath6kl *ar, const u8 *bssid, 49301cac476SJouni Malinen struct ieee80211_channel *chan, 49401cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 49501cac476SJouni Malinen { 4963450334fSVasanthakumar Thiagarajan /* TODO: Findout vif */ 4973450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 49801cac476SJouni Malinen struct cfg80211_bss *bss; 49901cac476SJouni Malinen u8 *ie; 50001cac476SJouni Malinen 501be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 5023450334fSVasanthakumar Thiagarajan vif->ssid, vif->ssid_len, WLAN_CAPABILITY_ESS, 50301cac476SJouni Malinen WLAN_CAPABILITY_ESS); 50401cac476SJouni Malinen if (bss == NULL) { 50501cac476SJouni Malinen /* 50601cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 50701cac476SJouni Malinen * generate a partial entry until the first BSS info 50801cac476SJouni Malinen * event becomes available. 50901cac476SJouni Malinen * 51001cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 51101cac476SJouni Malinen * IEs from the target. 51201cac476SJouni Malinen */ 5133450334fSVasanthakumar Thiagarajan ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 51401cac476SJouni Malinen if (ie == NULL) 51501cac476SJouni Malinen return -ENOMEM; 51601cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 5173450334fSVasanthakumar Thiagarajan ie[1] = vif->ssid_len; 5183450334fSVasanthakumar Thiagarajan memcpy(ie + 2, vif->ssid, vif->ssid_len); 5193450334fSVasanthakumar Thiagarajan memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 520be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 52101cac476SJouni Malinen bssid, 0, WLAN_CAPABILITY_ESS, 100, 5223450334fSVasanthakumar Thiagarajan ie, 2 + vif->ssid_len + beacon_ie_len, 52301cac476SJouni Malinen 0, GFP_KERNEL); 52401cac476SJouni Malinen if (bss) 52501cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for " 52601cac476SJouni Malinen "%pM prior to indicating connect/roamed " 52701cac476SJouni Malinen "event\n", bssid); 52801cac476SJouni Malinen kfree(ie); 52901cac476SJouni Malinen } else 53001cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 53101cac476SJouni Malinen "entry\n"); 53201cac476SJouni Malinen 53301cac476SJouni Malinen if (bss == NULL) 53401cac476SJouni Malinen return -ENOMEM; 53501cac476SJouni Malinen 53601cac476SJouni Malinen cfg80211_put_bss(bss); 53701cac476SJouni Malinen 53801cac476SJouni Malinen return 0; 53901cac476SJouni Malinen } 54001cac476SJouni Malinen 541bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 542bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 543bdcd8170SKalle Valo u16 beacon_intvl, 544bdcd8170SKalle Valo enum network_type nw_type, 545bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 546bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 547bdcd8170SKalle Valo { 54801cac476SJouni Malinen struct ieee80211_channel *chan; 54959c98449SVasanthakumar Thiagarajan /* TODO: Findout vif */ 55059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 551bdcd8170SKalle Valo 552bdcd8170SKalle Valo /* capinfo + listen interval */ 553bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 554bdcd8170SKalle Valo 555bdcd8170SKalle Valo /* capinfo + status code + associd */ 556bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 557bdcd8170SKalle Valo 558bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 559bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 560bdcd8170SKalle Valo assoc_resp_ie_offset; 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 563bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 564bdcd8170SKalle Valo 56532c10874SJouni Malinen /* 56632c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 56732c10874SJouni Malinen * a Beacon frame from the AP is seen. 56832c10874SJouni Malinen */ 56932c10874SJouni Malinen ar->assoc_bss_beacon_int = beacon_intvl; 57059c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 57132c10874SJouni Malinen 572bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 573bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 574bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 575bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 576bdcd8170SKalle Valo return; 577bdcd8170SKalle Valo } 578bdcd8170SKalle Valo } 579bdcd8170SKalle Valo 580bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 5816b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 5826b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 583bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 584bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 585bdcd8170SKalle Valo return; 586bdcd8170SKalle Valo } 587bdcd8170SKalle Valo } 588bdcd8170SKalle Valo 589be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 590bdcd8170SKalle Valo 591bdcd8170SKalle Valo 592bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 593bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 594bdcd8170SKalle Valo return; 595bdcd8170SKalle Valo } 596bdcd8170SKalle Valo 59701cac476SJouni Malinen if (ath6kl_add_bss_if_needed(ar, bssid, chan, assoc_info, 59801cac476SJouni Malinen beacon_ie_len) < 0) { 59901cac476SJouni Malinen ath6kl_err("could not add cfg80211 bss entry for " 60001cac476SJouni Malinen "connect/roamed notification\n"); 60101cac476SJouni Malinen return; 60201cac476SJouni Malinen } 60301cac476SJouni Malinen 6049aa60357SRaja Mani if (ar->sme_state == SME_CONNECTING) { 605bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 6069aa60357SRaja Mani ar->sme_state = SME_CONNECTED; 607bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 608bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 609bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 610bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 6119aa60357SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 612bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 61301cac476SJouni Malinen cfg80211_roamed(ar->net_dev, chan, bssid, 614bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 615bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 616bdcd8170SKalle Valo } 617bdcd8170SKalle Valo } 618bdcd8170SKalle Valo 619bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 620bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 621bdcd8170SKalle Valo { 622bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 6233450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 624bdcd8170SKalle Valo 625bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 626bdcd8170SKalle Valo reason_code); 627bdcd8170SKalle Valo 628bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 629bdcd8170SKalle Valo return -EIO; 630bdcd8170SKalle Valo 631bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 632bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 633bdcd8170SKalle Valo return -EBUSY; 634bdcd8170SKalle Valo } 635bdcd8170SKalle Valo 636bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 637bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 638bdcd8170SKalle Valo return -ERESTARTSYS; 639bdcd8170SKalle Valo } 640bdcd8170SKalle Valo 641bdcd8170SKalle Valo ar->reconnect_flag = 0; 642bdcd8170SKalle Valo ath6kl_disconnect(ar); 6433450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 6443450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 645bdcd8170SKalle Valo 646bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 647bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 648bdcd8170SKalle Valo 649bdcd8170SKalle Valo up(&ar->sem); 650bdcd8170SKalle Valo 651170826ddSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 652170826ddSVasanthakumar Thiagarajan 653bdcd8170SKalle Valo return 0; 654bdcd8170SKalle Valo } 655bdcd8170SKalle Valo 656bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 657bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 658bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 659bdcd8170SKalle Valo { 66059c98449SVasanthakumar Thiagarajan /* TODO: Findout vif */ 66159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 66259c98449SVasanthakumar Thiagarajan 663bdcd8170SKalle Valo if (ar->scan_req) { 664bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 665bdcd8170SKalle Valo ar->scan_req = NULL; 666bdcd8170SKalle Valo } 667bdcd8170SKalle Valo 668bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 669bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 670bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 671bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 672bdcd8170SKalle Valo return; 673bdcd8170SKalle Valo } 674bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 675bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 676bdcd8170SKalle Valo return; 677bdcd8170SKalle Valo } 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 6806b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 6816b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 682bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 683bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 684bdcd8170SKalle Valo return; 685bdcd8170SKalle Valo } 686bdcd8170SKalle Valo } 687bdcd8170SKalle Valo 6881de547d6SVasanthakumar Thiagarajan /* 6891de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 6901de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 6911de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 6921de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 6931de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 6941de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 6951de547d6SVasanthakumar Thiagarajan */ 696bdcd8170SKalle Valo 6971de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 698bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 699bdcd8170SKalle Valo return; 700bdcd8170SKalle Valo } 701bdcd8170SKalle Valo 70259c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 703bdcd8170SKalle Valo 704bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 705bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 706bdcd8170SKalle Valo bssid, NULL, 0, 707bdcd8170SKalle Valo NULL, 0, 708bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 709bdcd8170SKalle Valo GFP_KERNEL); 7100e5cc8e6SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 711bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 712bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 713bdcd8170SKalle Valo } 714bdcd8170SKalle Valo 715bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 716bdcd8170SKalle Valo } 717bdcd8170SKalle Valo 718bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 719bdcd8170SKalle Valo struct cfg80211_scan_request *request) 720bdcd8170SKalle Valo { 721bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 72259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 7231276c9efSEdward Lu s8 n_channels = 0; 7241276c9efSEdward Lu u16 *channels = NULL; 725bdcd8170SKalle Valo int ret = 0; 726f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 727bdcd8170SKalle Valo 728bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 729bdcd8170SKalle Valo return -EIO; 730bdcd8170SKalle Valo 731bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 73259c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 7331b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 7341b1e6ee3SJouni Malinen ar->wmi, 73559c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 7361b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 7371b1e6ee3SJouni Malinen if (ret) { 738bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 7391b1e6ee3SJouni Malinen return ret; 740bdcd8170SKalle Valo } 741bdcd8170SKalle Valo } 742bdcd8170SKalle Valo 743bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 744bdcd8170SKalle Valo u8 i; 745bdcd8170SKalle Valo 746bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 747bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 748bdcd8170SKalle Valo 749bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 750bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 751bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 752bdcd8170SKalle Valo request->ssids[i].ssid_len, 753bdcd8170SKalle Valo request->ssids[i].ssid); 754bdcd8170SKalle Valo } 755bdcd8170SKalle Valo 756b84da8c7SJouni Malinen if (request->ie) { 757b84da8c7SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_REQ, 758b84da8c7SJouni Malinen request->ie, request->ie_len); 759b84da8c7SJouni Malinen if (ret) { 760b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 761b84da8c7SJouni Malinen "scan"); 762b84da8c7SJouni Malinen return ret; 763b84da8c7SJouni Malinen } 764b84da8c7SJouni Malinen } 765b84da8c7SJouni Malinen 76611869befSJouni Malinen /* 76711869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 76811869befSJouni Malinen * channels. If the list is longer than the target supports, do not 76911869befSJouni Malinen * configure the list and instead, scan all available channels. 77011869befSJouni Malinen */ 77111869befSJouni Malinen if (request->n_channels > 0 && 77211869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 7731276c9efSEdward Lu u8 i; 7741276c9efSEdward Lu 77511869befSJouni Malinen n_channels = request->n_channels; 7761276c9efSEdward Lu 7771276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 7781276c9efSEdward Lu if (channels == NULL) { 7791276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 7801276c9efSEdward Lu "scan all channels"); 7811276c9efSEdward Lu n_channels = 0; 7821276c9efSEdward Lu } 7831276c9efSEdward Lu 7841276c9efSEdward Lu for (i = 0; i < n_channels; i++) 7851276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 7861276c9efSEdward Lu } 7871276c9efSEdward Lu 78859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 789f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 790f1f92179SVasanthakumar Thiagarajan 791f1f92179SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, force_fg_scan, 7921b1e6ee3SJouni Malinen false, 0, 0, n_channels, channels); 7931b1e6ee3SJouni Malinen if (ret) 794bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 79511869befSJouni Malinen else 796bdcd8170SKalle Valo ar->scan_req = request; 797bdcd8170SKalle Valo 7981276c9efSEdward Lu kfree(channels); 7991276c9efSEdward Lu 800bdcd8170SKalle Valo return ret; 801bdcd8170SKalle Valo } 802bdcd8170SKalle Valo 803bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 804bdcd8170SKalle Valo { 8056fd1eaceSKalle Valo int i; 806bdcd8170SKalle Valo 807bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 808bdcd8170SKalle Valo 8096fd1eaceSKalle Valo if (!ar->scan_req) 8106fd1eaceSKalle Valo return; 8116fd1eaceSKalle Valo 8126fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 8136fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 8146fd1eaceSKalle Valo goto out; 8156fd1eaceSKalle Valo } 8166fd1eaceSKalle Valo 8176fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 818bdcd8170SKalle Valo 819bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 820bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 821bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 822bdcd8170SKalle Valo DISABLE_SSID_FLAG, 823bdcd8170SKalle Valo 0, NULL); 824bdcd8170SKalle Valo } 825bdcd8170SKalle Valo } 8266fd1eaceSKalle Valo 8276fd1eaceSKalle Valo out: 828bdcd8170SKalle Valo ar->scan_req = NULL; 829bdcd8170SKalle Valo } 830bdcd8170SKalle Valo 831bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 832bdcd8170SKalle Valo u8 key_index, bool pairwise, 833bdcd8170SKalle Valo const u8 *mac_addr, 834bdcd8170SKalle Valo struct key_params *params) 835bdcd8170SKalle Valo { 836bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 83759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 838bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 839bdcd8170SKalle Valo u8 key_usage; 840bdcd8170SKalle Valo u8 key_type; 841bdcd8170SKalle Valo int status = 0; 842bdcd8170SKalle Valo 843bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 844bdcd8170SKalle Valo return -EIO; 845bdcd8170SKalle Valo 846837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 847837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 848837cb97eSJouni Malinen return -EINVAL; 849837cb97eSJouni Malinen return ath6kl_wmi_add_krk_cmd(ar->wmi, params->key); 850837cb97eSJouni Malinen } 851837cb97eSJouni Malinen 852bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 853bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 854bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 855bdcd8170SKalle Valo key_index); 856bdcd8170SKalle Valo return -ENOENT; 857bdcd8170SKalle Valo } 858bdcd8170SKalle Valo 859bdcd8170SKalle Valo key = &ar->keys[key_index]; 860bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 861bdcd8170SKalle Valo 862bdcd8170SKalle Valo if (pairwise) 863bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 864bdcd8170SKalle Valo else 865bdcd8170SKalle Valo key_usage = GROUP_USAGE; 866bdcd8170SKalle Valo 867bdcd8170SKalle Valo if (params) { 868bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 869bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 870bdcd8170SKalle Valo return -EINVAL; 871bdcd8170SKalle Valo 872bdcd8170SKalle Valo key->key_len = params->key_len; 873bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 874bdcd8170SKalle Valo key->seq_len = params->seq_len; 875bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 876bdcd8170SKalle Valo key->cipher = params->cipher; 877bdcd8170SKalle Valo } 878bdcd8170SKalle Valo 879bdcd8170SKalle Valo switch (key->cipher) { 880bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 881bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 882bdcd8170SKalle Valo key_type = WEP_CRYPT; 883bdcd8170SKalle Valo break; 884bdcd8170SKalle Valo 885bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 886bdcd8170SKalle Valo key_type = TKIP_CRYPT; 887bdcd8170SKalle Valo break; 888bdcd8170SKalle Valo 889bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 890bdcd8170SKalle Valo key_type = AES_CRYPT; 891bdcd8170SKalle Valo break; 892bdcd8170SKalle Valo 893bdcd8170SKalle Valo default: 894bdcd8170SKalle Valo return -ENOTSUPP; 895bdcd8170SKalle Valo } 896bdcd8170SKalle Valo 8973450334fSVasanthakumar Thiagarajan if (((vif->auth_mode == WPA_PSK_AUTH) 8983450334fSVasanthakumar Thiagarajan || (vif->auth_mode == WPA2_PSK_AUTH)) 899bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 900bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 901bdcd8170SKalle Valo 902bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 903bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 904bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 905bdcd8170SKalle Valo key_usage, key->seq_len); 906bdcd8170SKalle Valo 9073450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 9089a5b1318SJouni Malinen 9099a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !pairwise && 9109a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 9119a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 9129a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 9139a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 9149a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 9159a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 91659c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 9179a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9189a5b1318SJouni Malinen "key configuration until AP mode has been " 9199a5b1318SJouni Malinen "started\n"); 9209a5b1318SJouni Malinen /* 9219a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9229a5b1318SJouni Malinen * the connected event is received from the target. 9239a5b1318SJouni Malinen */ 9249a5b1318SJouni Malinen return 0; 9259a5b1318SJouni Malinen } 9269a5b1318SJouni Malinen } 9279a5b1318SJouni Malinen 928151411e8SJouni Malinen if (ar->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 92959c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 930151411e8SJouni Malinen /* 931151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 932151411e8SJouni Malinen * the AP mode has properly started 933151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 934151411e8SJouni Malinen */ 935151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 936151411e8SJouni Malinen "until AP mode has been started\n"); 937151411e8SJouni Malinen ar->wep_key_list[key_index].key_len = key->key_len; 938151411e8SJouni Malinen memcpy(ar->wep_key_list[key_index].key, key->key, key->key_len); 939151411e8SJouni Malinen return 0; 940151411e8SJouni Malinen } 941151411e8SJouni Malinen 9423450334fSVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->def_txkey_index, 943bdcd8170SKalle Valo key_type, key_usage, key->key_len, 944bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 945bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 946bdcd8170SKalle Valo 947bdcd8170SKalle Valo if (status) 948bdcd8170SKalle Valo return -EIO; 949bdcd8170SKalle Valo 950bdcd8170SKalle Valo return 0; 951bdcd8170SKalle Valo } 952bdcd8170SKalle Valo 953bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 954bdcd8170SKalle Valo u8 key_index, bool pairwise, 955bdcd8170SKalle Valo const u8 *mac_addr) 956bdcd8170SKalle Valo { 957bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 958bdcd8170SKalle Valo 959bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 962bdcd8170SKalle Valo return -EIO; 963bdcd8170SKalle Valo 964bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 965bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 966bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 967bdcd8170SKalle Valo key_index); 968bdcd8170SKalle Valo return -ENOENT; 969bdcd8170SKalle Valo } 970bdcd8170SKalle Valo 971bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 972bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 973bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 974bdcd8170SKalle Valo return 0; 975bdcd8170SKalle Valo } 976bdcd8170SKalle Valo 977bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 980bdcd8170SKalle Valo } 981bdcd8170SKalle Valo 982bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 983bdcd8170SKalle Valo u8 key_index, bool pairwise, 984bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 985bdcd8170SKalle Valo void (*callback) (void *cookie, 986bdcd8170SKalle Valo struct key_params *)) 987bdcd8170SKalle Valo { 988bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 989bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 990bdcd8170SKalle Valo struct key_params params; 991bdcd8170SKalle Valo 992bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 993bdcd8170SKalle Valo 994bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 995bdcd8170SKalle Valo return -EIO; 996bdcd8170SKalle Valo 997bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 998bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 999bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1000bdcd8170SKalle Valo key_index); 1001bdcd8170SKalle Valo return -ENOENT; 1002bdcd8170SKalle Valo } 1003bdcd8170SKalle Valo 1004bdcd8170SKalle Valo key = &ar->keys[key_index]; 1005bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1006bdcd8170SKalle Valo params.cipher = key->cipher; 1007bdcd8170SKalle Valo params.key_len = key->key_len; 1008bdcd8170SKalle Valo params.seq_len = key->seq_len; 1009bdcd8170SKalle Valo params.seq = key->seq; 1010bdcd8170SKalle Valo params.key = key->key; 1011bdcd8170SKalle Valo 1012bdcd8170SKalle Valo callback(cookie, ¶ms); 1013bdcd8170SKalle Valo 1014bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1015bdcd8170SKalle Valo } 1016bdcd8170SKalle Valo 1017bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1018bdcd8170SKalle Valo struct net_device *ndev, 1019bdcd8170SKalle Valo u8 key_index, bool unicast, 1020bdcd8170SKalle Valo bool multicast) 1021bdcd8170SKalle Valo { 1022bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 102359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1024bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1025bdcd8170SKalle Valo int status = 0; 1026bdcd8170SKalle Valo u8 key_usage; 1027229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1028bdcd8170SKalle Valo 1029bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1030bdcd8170SKalle Valo 1031bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1032bdcd8170SKalle Valo return -EIO; 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1035bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1036bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1037bdcd8170SKalle Valo __func__, key_index); 1038bdcd8170SKalle Valo return -ENOENT; 1039bdcd8170SKalle Valo } 1040bdcd8170SKalle Valo 1041bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1042bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1043bdcd8170SKalle Valo __func__, key_index); 1044bdcd8170SKalle Valo return -EINVAL; 1045bdcd8170SKalle Valo } 1046bdcd8170SKalle Valo 10473450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 10483450334fSVasanthakumar Thiagarajan key = &ar->keys[vif->def_txkey_index]; 1049bdcd8170SKalle Valo key_usage = GROUP_USAGE; 10503450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1051bdcd8170SKalle Valo key_usage |= TX_USAGE; 1052229ed6b5SEdward Lu if (unicast) 10533450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1054229ed6b5SEdward Lu if (multicast) 10553450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1056bdcd8170SKalle Valo 105759c98449SVasanthakumar Thiagarajan if (ar->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 10589a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10599a5b1318SJouni Malinen 10603450334fSVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->def_txkey_index, 1061229ed6b5SEdward Lu key_type, key_usage, 1062bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1063bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1064bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1065bdcd8170SKalle Valo if (status) 1066bdcd8170SKalle Valo return -EIO; 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo return 0; 1069bdcd8170SKalle Valo } 1070bdcd8170SKalle Valo 1071bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1072bdcd8170SKalle Valo bool ismcast) 1073bdcd8170SKalle Valo { 1074bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1075bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1076bdcd8170SKalle Valo 1077bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1078bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1079bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1080bdcd8170SKalle Valo GFP_KERNEL); 1081bdcd8170SKalle Valo } 1082bdcd8170SKalle Valo 1083bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1084bdcd8170SKalle Valo { 1085bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1086bdcd8170SKalle Valo int ret; 1087bdcd8170SKalle Valo 1088bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1089bdcd8170SKalle Valo changed); 1090bdcd8170SKalle Valo 1091bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1092bdcd8170SKalle Valo return -EIO; 1093bdcd8170SKalle Valo 1094bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1095bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1096bdcd8170SKalle Valo if (ret != 0) { 1097bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1098bdcd8170SKalle Valo return -EIO; 1099bdcd8170SKalle Valo } 1100bdcd8170SKalle Valo } 1101bdcd8170SKalle Valo 1102bdcd8170SKalle Valo return 0; 1103bdcd8170SKalle Valo } 1104bdcd8170SKalle Valo 1105bdcd8170SKalle Valo /* 1106bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1107bdcd8170SKalle Valo * data type from 2.6.36 onwards 1108bdcd8170SKalle Valo */ 1109bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1110bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1111bdcd8170SKalle Valo int dbm) 1112bdcd8170SKalle Valo { 1113bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1114bdcd8170SKalle Valo u8 ath6kl_dbm; 1115bdcd8170SKalle Valo 1116bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1117bdcd8170SKalle Valo type, dbm); 1118bdcd8170SKalle Valo 1119bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1120bdcd8170SKalle Valo return -EIO; 1121bdcd8170SKalle Valo 1122bdcd8170SKalle Valo switch (type) { 1123bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1124bdcd8170SKalle Valo return 0; 1125bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1126bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1127bdcd8170SKalle Valo break; 1128bdcd8170SKalle Valo default: 1129bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1130bdcd8170SKalle Valo __func__, type); 1131bdcd8170SKalle Valo return -EOPNOTSUPP; 1132bdcd8170SKalle Valo } 1133bdcd8170SKalle Valo 1134bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1135bdcd8170SKalle Valo 1136bdcd8170SKalle Valo return 0; 1137bdcd8170SKalle Valo } 1138bdcd8170SKalle Valo 1139bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1140bdcd8170SKalle Valo { 1141bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 114259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 1143bdcd8170SKalle Valo 1144bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1145bdcd8170SKalle Valo return -EIO; 1146bdcd8170SKalle Valo 114759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1148bdcd8170SKalle Valo ar->tx_pwr = 0; 1149bdcd8170SKalle Valo 1150bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1151bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1152bdcd8170SKalle Valo return -EIO; 1153bdcd8170SKalle Valo } 1154bdcd8170SKalle Valo 1155bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1156bdcd8170SKalle Valo 5 * HZ); 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo if (signal_pending(current)) { 1159bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1160bdcd8170SKalle Valo return -EINTR; 1161bdcd8170SKalle Valo } 1162bdcd8170SKalle Valo } 1163bdcd8170SKalle Valo 1164bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1165bdcd8170SKalle Valo return 0; 1166bdcd8170SKalle Valo } 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1169bdcd8170SKalle Valo struct net_device *dev, 1170bdcd8170SKalle Valo bool pmgmt, int timeout) 1171bdcd8170SKalle Valo { 1172bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1173bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1174bdcd8170SKalle Valo 1175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1176bdcd8170SKalle Valo __func__, pmgmt, timeout); 1177bdcd8170SKalle Valo 1178bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1179bdcd8170SKalle Valo return -EIO; 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo if (pmgmt) { 1182bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1183bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1184bdcd8170SKalle Valo } else { 1185bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1186bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1187bdcd8170SKalle Valo } 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1190bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1191bdcd8170SKalle Valo return -EIO; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 1194bdcd8170SKalle Valo return 0; 1195bdcd8170SKalle Valo } 1196bdcd8170SKalle Valo 1197bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1198bdcd8170SKalle Valo struct net_device *ndev, 1199bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1200bdcd8170SKalle Valo struct vif_params *params) 1201bdcd8170SKalle Valo { 1202bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1203bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1206bdcd8170SKalle Valo 1207bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1208bdcd8170SKalle Valo return -EIO; 1209bdcd8170SKalle Valo 1210bdcd8170SKalle Valo switch (type) { 1211bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1212bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1213bdcd8170SKalle Valo break; 1214bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1215bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1216bdcd8170SKalle Valo break; 12176e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 12186e4604c8SJouni Malinen ar->next_mode = AP_NETWORK; 12196e4604c8SJouni Malinen break; 12206b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 12216b5e5d25SJouni Malinen ar->next_mode = INFRA_NETWORK; 12226b5e5d25SJouni Malinen break; 12236b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 12246b5e5d25SJouni Malinen ar->next_mode = AP_NETWORK; 12256b5e5d25SJouni Malinen break; 1226bdcd8170SKalle Valo default: 1227bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1228bdcd8170SKalle Valo return -EOPNOTSUPP; 1229bdcd8170SKalle Valo } 1230bdcd8170SKalle Valo 1231bdcd8170SKalle Valo wdev->iftype = type; 1232bdcd8170SKalle Valo 1233bdcd8170SKalle Valo return 0; 1234bdcd8170SKalle Valo } 1235bdcd8170SKalle Valo 1236bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1237bdcd8170SKalle Valo struct net_device *dev, 1238bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1239bdcd8170SKalle Valo { 1240bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 124159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1242bdcd8170SKalle Valo int status; 1243bdcd8170SKalle Valo 1244bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1245bdcd8170SKalle Valo return -EIO; 1246bdcd8170SKalle Valo 12473450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 12483450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1249bdcd8170SKalle Valo 1250bdcd8170SKalle Valo if (ibss_param->channel) 1251bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1254bdcd8170SKalle Valo /* 1255bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1256bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1257bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1258bdcd8170SKalle Valo * updated. 1259bdcd8170SKalle Valo */ 1260bdcd8170SKalle Valo return -EOPNOTSUPP; 1261bdcd8170SKalle Valo } 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1264bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1265bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1266bdcd8170SKalle Valo 1267bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1270bdcd8170SKalle Valo if (status) 1271bdcd8170SKalle Valo return status; 1272bdcd8170SKalle Valo 1273bdcd8170SKalle Valo if (ibss_param->privacy) { 1274bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1275bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1276bdcd8170SKalle Valo } else { 1277bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1278bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1282bdcd8170SKalle Valo 1283bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1284bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1285bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1286bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1287bdcd8170SKalle Valo __func__, 12883450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 12893450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 12903450334fSVasanthakumar Thiagarajan vif->grp_crypto_len, ar->ch_hint); 1291bdcd8170SKalle Valo 1292bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 12933450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 12943450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 12953450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 12963450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 12973450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1298bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1299bdcd8170SKalle Valo ar->connect_ctrl_flags); 130059c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1301bdcd8170SKalle Valo 1302bdcd8170SKalle Valo return 0; 1303bdcd8170SKalle Valo } 1304bdcd8170SKalle Valo 1305bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1306bdcd8170SKalle Valo struct net_device *dev) 1307bdcd8170SKalle Valo { 1308bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 13093450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1310bdcd8170SKalle Valo 1311bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1312bdcd8170SKalle Valo return -EIO; 1313bdcd8170SKalle Valo 1314bdcd8170SKalle Valo ath6kl_disconnect(ar); 13153450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 13163450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1317bdcd8170SKalle Valo 1318bdcd8170SKalle Valo return 0; 1319bdcd8170SKalle Valo } 1320bdcd8170SKalle Valo 1321bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1322bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1323bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1324bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1325bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1326837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1327bdcd8170SKalle Valo }; 1328bdcd8170SKalle Valo 1329bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1330bdcd8170SKalle Valo { 1331bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1332bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1333bdcd8170SKalle Valo 36000, 48000, 54000 1334bdcd8170SKalle Valo }; 1335bdcd8170SKalle Valo u8 i; 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1338bdcd8170SKalle Valo if (rate == legacy[i]) 1339bdcd8170SKalle Valo return true; 1340bdcd8170SKalle Valo 1341bdcd8170SKalle Valo return false; 1342bdcd8170SKalle Valo } 1343bdcd8170SKalle Valo 1344bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1345bdcd8170SKalle Valo { 1346bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1347bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1348bdcd8170SKalle Valo }; 1349bdcd8170SKalle Valo u8 i; 1350bdcd8170SKalle Valo 1351bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1352bdcd8170SKalle Valo if (rate == ht20[i]) { 1353bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1354bdcd8170SKalle Valo /* last rate uses sgi */ 1355bdcd8170SKalle Valo *sgi = true; 1356bdcd8170SKalle Valo else 1357bdcd8170SKalle Valo *sgi = false; 1358bdcd8170SKalle Valo 1359bdcd8170SKalle Valo *mcs = i; 1360bdcd8170SKalle Valo return true; 1361bdcd8170SKalle Valo } 1362bdcd8170SKalle Valo } 1363bdcd8170SKalle Valo return false; 1364bdcd8170SKalle Valo } 1365bdcd8170SKalle Valo 1366bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1367bdcd8170SKalle Valo { 1368bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1369bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1370bdcd8170SKalle Valo 150000 1371bdcd8170SKalle Valo }; 1372bdcd8170SKalle Valo u8 i; 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1375bdcd8170SKalle Valo if (rate == ht40[i]) { 1376bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1377bdcd8170SKalle Valo /* last rate uses sgi */ 1378bdcd8170SKalle Valo *sgi = true; 1379bdcd8170SKalle Valo else 1380bdcd8170SKalle Valo *sgi = false; 1381bdcd8170SKalle Valo 1382bdcd8170SKalle Valo *mcs = i; 1383bdcd8170SKalle Valo return true; 1384bdcd8170SKalle Valo } 1385bdcd8170SKalle Valo } 1386bdcd8170SKalle Valo 1387bdcd8170SKalle Valo return false; 1388bdcd8170SKalle Valo } 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1391bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1392bdcd8170SKalle Valo { 1393bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 139459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1395bdcd8170SKalle Valo long left; 1396bdcd8170SKalle Valo bool sgi; 1397bdcd8170SKalle Valo s32 rate; 1398bdcd8170SKalle Valo int ret; 1399bdcd8170SKalle Valo u8 mcs; 1400bdcd8170SKalle Valo 1401bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1402bdcd8170SKalle Valo return -ENOENT; 1403bdcd8170SKalle Valo 1404bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1405bdcd8170SKalle Valo return -EBUSY; 1406bdcd8170SKalle Valo 1407bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1408bdcd8170SKalle Valo 1409bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1410bdcd8170SKalle Valo 1411bdcd8170SKalle Valo if (ret != 0) { 1412bdcd8170SKalle Valo up(&ar->sem); 1413bdcd8170SKalle Valo return -EIO; 1414bdcd8170SKalle Valo } 1415bdcd8170SKalle Valo 1416bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1417bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1418bdcd8170SKalle Valo &ar->flag), 1419bdcd8170SKalle Valo WMI_TIMEOUT); 1420bdcd8170SKalle Valo 1421bdcd8170SKalle Valo up(&ar->sem); 1422bdcd8170SKalle Valo 1423bdcd8170SKalle Valo if (left == 0) 1424bdcd8170SKalle Valo return -ETIMEDOUT; 1425bdcd8170SKalle Valo else if (left < 0) 1426bdcd8170SKalle Valo return left; 1427bdcd8170SKalle Valo 1428bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1429bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1430bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1431bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1432bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1433bdcd8170SKalle Valo } 1434bdcd8170SKalle Valo 1435bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1436bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1437bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1438bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1439bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1440bdcd8170SKalle Valo } 1441bdcd8170SKalle Valo 1442bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1443bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1444bdcd8170SKalle Valo 1445bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1446bdcd8170SKalle Valo 1447bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1448bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1449bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1450bdcd8170SKalle Valo if (sgi) { 1451bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1452bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1453bdcd8170SKalle Valo } else { 1454bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1455bdcd8170SKalle Valo } 1456bdcd8170SKalle Valo 1457bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1458bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1459bdcd8170SKalle Valo if (sgi) { 1460bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1461bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1462bdcd8170SKalle Valo } else { 1463bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1464bdcd8170SKalle Valo } 1465bdcd8170SKalle Valo 1466bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1467bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1468bdcd8170SKalle Valo } else { 14699a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 14709a730834SKalle Valo "invalid rate from stats: %d\n", rate); 14719a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1472bdcd8170SKalle Valo return 0; 1473bdcd8170SKalle Valo } 1474bdcd8170SKalle Valo 1475bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1476bdcd8170SKalle Valo 147759c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 147859c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 147932c10874SJouni Malinen ar->nw_type == INFRA_NETWORK) { 148032c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 148132c10874SJouni Malinen sinfo->bss_param.flags = 0; 148232c10874SJouni Malinen sinfo->bss_param.dtim_period = ar->assoc_bss_dtim_period; 148332c10874SJouni Malinen sinfo->bss_param.beacon_interval = ar->assoc_bss_beacon_int; 148432c10874SJouni Malinen } 148532c10874SJouni Malinen 1486bdcd8170SKalle Valo return 0; 1487bdcd8170SKalle Valo } 1488bdcd8170SKalle Valo 1489bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1490bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1491bdcd8170SKalle Valo { 1492bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1493bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1494bdcd8170SKalle Valo pmksa->pmkid, true); 1495bdcd8170SKalle Valo } 1496bdcd8170SKalle Valo 1497bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1498bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1499bdcd8170SKalle Valo { 1500bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1501bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1502bdcd8170SKalle Valo pmksa->pmkid, false); 1503bdcd8170SKalle Valo } 1504bdcd8170SKalle Valo 1505bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1506bdcd8170SKalle Valo { 1507bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 150859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 150959c98449SVasanthakumar Thiagarajan 151059c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1511bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1512bdcd8170SKalle Valo return 0; 1513bdcd8170SKalle Valo } 1514bdcd8170SKalle Valo 1515abcb344bSKalle Valo #ifdef CONFIG_PM 1516abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1517abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1518abcb344bSKalle Valo { 1519abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1520abcb344bSKalle Valo 1521abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1522abcb344bSKalle Valo } 1523aa6cffc1SChilam Ng 1524aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1525aa6cffc1SChilam Ng { 1526aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1527aa6cffc1SChilam Ng 1528aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1529aa6cffc1SChilam Ng } 1530abcb344bSKalle Valo #endif 1531abcb344bSKalle Valo 15326a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15336a7c9badSJouni Malinen struct ieee80211_channel *chan, 15346a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15356a7c9badSJouni Malinen { 15366a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15376a7c9badSJouni Malinen 15386a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15396a7c9badSJouni Malinen return -EIO; 15406a7c9badSJouni Malinen 15416a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15426a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15436a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15446a7c9badSJouni Malinen 15456a7c9badSJouni Malinen return 0; 15466a7c9badSJouni Malinen } 15476a7c9badSJouni Malinen 15488bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15498bdfbf40SJouni Malinen { 15508bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15518bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15528bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15538bdfbf40SJouni Malinen } 15548bdfbf40SJouni Malinen 15558bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15568bdfbf40SJouni Malinen size_t ies_len) 15578bdfbf40SJouni Malinen { 15588bdfbf40SJouni Malinen const u8 *pos; 15598bdfbf40SJouni Malinen u8 *buf = NULL; 15608bdfbf40SJouni Malinen size_t len = 0; 15618bdfbf40SJouni Malinen int ret; 15628bdfbf40SJouni Malinen 15638bdfbf40SJouni Malinen /* 15648bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15658bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15668bdfbf40SJouni Malinen */ 15678bdfbf40SJouni Malinen 15688bdfbf40SJouni Malinen if (ies && ies_len) { 15698bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15708bdfbf40SJouni Malinen if (buf == NULL) 15718bdfbf40SJouni Malinen return -ENOMEM; 15728bdfbf40SJouni Malinen pos = ies; 15738bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15748bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15758bdfbf40SJouni Malinen break; 15768bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15778bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15788bdfbf40SJouni Malinen len += 2 + pos[1]; 15798bdfbf40SJouni Malinen } 15808bdfbf40SJouni Malinen pos += 2 + pos[1]; 15818bdfbf40SJouni Malinen } 15828bdfbf40SJouni Malinen } 15838bdfbf40SJouni Malinen 15848bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15858bdfbf40SJouni Malinen buf, len); 15868bdfbf40SJouni Malinen kfree(buf); 15878bdfbf40SJouni Malinen return ret; 15888bdfbf40SJouni Malinen } 15898bdfbf40SJouni Malinen 15906a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 15916a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 15926a7c9badSJouni Malinen { 15936a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15943450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 15956a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 15966a7c9badSJouni Malinen u8 *ies; 15976a7c9badSJouni Malinen int ies_len; 15986a7c9badSJouni Malinen struct wmi_connect_cmd p; 15996a7c9badSJouni Malinen int res; 16006a7c9badSJouni Malinen int i; 16016a7c9badSJouni Malinen 16026a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 16036a7c9badSJouni Malinen 16046a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 16056a7c9badSJouni Malinen return -EIO; 16066a7c9badSJouni Malinen 16076a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 16086a7c9badSJouni Malinen return -EOPNOTSUPP; 16096a7c9badSJouni Malinen 16106a7c9badSJouni Malinen if (info->beacon_ies) { 16116a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 16126a7c9badSJouni Malinen info->beacon_ies, 16136a7c9badSJouni Malinen info->beacon_ies_len); 16146a7c9badSJouni Malinen if (res) 16156a7c9badSJouni Malinen return res; 16166a7c9badSJouni Malinen } 16176a7c9badSJouni Malinen if (info->proberesp_ies) { 16188bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 16196a7c9badSJouni Malinen info->proberesp_ies_len); 16206a7c9badSJouni Malinen if (res) 16216a7c9badSJouni Malinen return res; 16226a7c9badSJouni Malinen } 16236a7c9badSJouni Malinen if (info->assocresp_ies) { 16246a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 16256a7c9badSJouni Malinen info->assocresp_ies, 16266a7c9badSJouni Malinen info->assocresp_ies_len); 16276a7c9badSJouni Malinen if (res) 16286a7c9badSJouni Malinen return res; 16296a7c9badSJouni Malinen } 16306a7c9badSJouni Malinen 16316a7c9badSJouni Malinen if (!add) 16326a7c9badSJouni Malinen return 0; 16336a7c9badSJouni Malinen 16349a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16359a5b1318SJouni Malinen 16366a7c9badSJouni Malinen /* TODO: 16376a7c9badSJouni Malinen * info->interval 16386a7c9badSJouni Malinen * info->dtim_period 16396a7c9badSJouni Malinen */ 16406a7c9badSJouni Malinen 16416a7c9badSJouni Malinen if (info->head == NULL) 16426a7c9badSJouni Malinen return -EINVAL; 16436a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16446a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16456a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16466a7c9badSJouni Malinen return -EINVAL; 16476a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16486a7c9badSJouni Malinen 16496a7c9badSJouni Malinen if (info->ssid == NULL) 16506a7c9badSJouni Malinen return -EINVAL; 16513450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 16523450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 16536a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16546a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16556a7c9badSJouni Malinen 16563450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 16576a7c9badSJouni Malinen 16586a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16596a7c9badSJouni Malinen 16606a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16616a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16626a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16636a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16646a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16656a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16666a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16676a7c9badSJouni Malinen break; 16686a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16696a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16706a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16716a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16726a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16736a7c9badSJouni Malinen break; 16746a7c9badSJouni Malinen } 16756a7c9badSJouni Malinen } 16766a7c9badSJouni Malinen if (p.auth_mode == 0) 16776a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16783450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 16796a7c9badSJouni Malinen 16806a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16816a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16826a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16836a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16846a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16856a7c9badSJouni Malinen break; 16866a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16876a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16886a7c9badSJouni Malinen break; 16896a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16906a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 16916a7c9badSJouni Malinen break; 16926a7c9badSJouni Malinen } 16936a7c9badSJouni Malinen } 1694229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 16956a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1696229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1697229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1698229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 16996a7c9badSJouni Malinen 17006a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 17016a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 17026a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 17036a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 17046a7c9badSJouni Malinen break; 17056a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 17066a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 17076a7c9badSJouni Malinen break; 17086a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 17096a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 17106a7c9badSJouni Malinen break; 17116a7c9badSJouni Malinen default: 17126a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 17136a7c9badSJouni Malinen break; 17146a7c9badSJouni Malinen } 1715229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 17166a7c9badSJouni Malinen 17176a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 17186a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 17196a7c9badSJouni Malinen 17203450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 17213450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 17223450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 17236a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 17246a7c9badSJouni Malinen 17259a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 17269a5b1318SJouni Malinen if (res < 0) 17279a5b1318SJouni Malinen return res; 17289a5b1318SJouni Malinen 17299a5b1318SJouni Malinen return 0; 17306a7c9badSJouni Malinen } 17316a7c9badSJouni Malinen 17326a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17336a7c9badSJouni Malinen struct beacon_parameters *info) 17346a7c9badSJouni Malinen { 17356a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17366a7c9badSJouni Malinen } 17376a7c9badSJouni Malinen 17386a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17396a7c9badSJouni Malinen struct beacon_parameters *info) 17406a7c9badSJouni Malinen { 17416a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17426a7c9badSJouni Malinen } 17436a7c9badSJouni Malinen 17446a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17456a7c9badSJouni Malinen { 17466a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 174759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17486a7c9badSJouni Malinen 17496a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 17506a7c9badSJouni Malinen return -EOPNOTSUPP; 175159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 17526a7c9badSJouni Malinen return -ENOTCONN; 17536a7c9badSJouni Malinen 17546a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 175559c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 17566a7c9badSJouni Malinen 17576a7c9badSJouni Malinen return 0; 17586a7c9badSJouni Malinen } 17596a7c9badSJouni Malinen 176023875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 176123875136SJouni Malinen u8 *mac, struct station_parameters *params) 176223875136SJouni Malinen { 176323875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 176423875136SJouni Malinen 176523875136SJouni Malinen if (ar->nw_type != AP_NETWORK) 176623875136SJouni Malinen return -EOPNOTSUPP; 176723875136SJouni Malinen 176823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 176923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 177023875136SJouni Malinen return -EOPNOTSUPP; 177123875136SJouni Malinen 177223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 177323875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 177423875136SJouni Malinen mac, 0); 177523875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 177623875136SJouni Malinen 0); 177723875136SJouni Malinen } 177823875136SJouni Malinen 177963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 178063fa1e0cSJouni Malinen struct net_device *dev, 178163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 178263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 178363fa1e0cSJouni Malinen unsigned int duration, 178463fa1e0cSJouni Malinen u64 *cookie) 178563fa1e0cSJouni Malinen { 178663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 178763fa1e0cSJouni Malinen 178863fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 178963fa1e0cSJouni Malinen * return -EBUSY */ 179063fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 179163fa1e0cSJouni Malinen 179263fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 179363fa1e0cSJouni Malinen duration); 179463fa1e0cSJouni Malinen } 179563fa1e0cSJouni Malinen 179663fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 179763fa1e0cSJouni Malinen struct net_device *dev, 179863fa1e0cSJouni Malinen u64 cookie) 179963fa1e0cSJouni Malinen { 180063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 180163fa1e0cSJouni Malinen 180263fa1e0cSJouni Malinen if (cookie != 1) 180363fa1e0cSJouni Malinen return -ENOENT; 180463fa1e0cSJouni Malinen 180563fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 180663fa1e0cSJouni Malinen } 180763fa1e0cSJouni Malinen 18088bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 18098bdfbf40SJouni Malinen size_t len, unsigned int freq) 18108bdfbf40SJouni Malinen { 18118bdfbf40SJouni Malinen const u8 *pos; 18128bdfbf40SJouni Malinen u8 *p2p; 18138bdfbf40SJouni Malinen int p2p_len; 18148bdfbf40SJouni Malinen int ret; 18158bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18168bdfbf40SJouni Malinen 18178bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18188bdfbf40SJouni Malinen 18198bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 18208bdfbf40SJouni Malinen 18218bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 18228bdfbf40SJouni Malinen if (p2p == NULL) 18238bdfbf40SJouni Malinen return -ENOMEM; 18248bdfbf40SJouni Malinen p2p_len = 0; 18258bdfbf40SJouni Malinen 18268bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 18278bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 18288bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 18298bdfbf40SJouni Malinen break; 18308bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 18318bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 18328bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 18338bdfbf40SJouni Malinen } 18348bdfbf40SJouni Malinen pos += 2 + pos[1]; 18358bdfbf40SJouni Malinen } 18368bdfbf40SJouni Malinen 18378bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18388bdfbf40SJouni Malinen p2p, p2p_len); 18398bdfbf40SJouni Malinen kfree(p2p); 18408bdfbf40SJouni Malinen return ret; 18418bdfbf40SJouni Malinen } 18428bdfbf40SJouni Malinen 18438a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18448a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18458a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18468a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1847e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1848e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 18498a6c8060SJouni Malinen { 18508a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 185159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18528a6c8060SJouni Malinen u32 id; 18538bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18548bdfbf40SJouni Malinen 18558bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18568bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 185759c98449SVasanthakumar Thiagarajan ar->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 18588bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18598bdfbf40SJouni Malinen /* 18608bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18618bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18628bdfbf40SJouni Malinen */ 18638bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18648bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18658bdfbf40SJouni Malinen chan->center_freq); 18668bdfbf40SJouni Malinen } 18678a6c8060SJouni Malinen 18688a6c8060SJouni Malinen id = ar->send_action_id++; 18698a6c8060SJouni Malinen if (id == 0) { 18708a6c8060SJouni Malinen /* 18718a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18728a6c8060SJouni Malinen * used for the command. 18738a6c8060SJouni Malinen */ 18748a6c8060SJouni Malinen id = ar->send_action_id++; 18758a6c8060SJouni Malinen } 18768a6c8060SJouni Malinen 18778a6c8060SJouni Malinen *cookie = id; 18788a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18798a6c8060SJouni Malinen buf, len); 18808a6c8060SJouni Malinen } 18818a6c8060SJouni Malinen 1882ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1883ae32c30aSJouni Malinen struct net_device *dev, 1884ae32c30aSJouni Malinen u16 frame_type, bool reg) 1885ae32c30aSJouni Malinen { 1886ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1887ae32c30aSJouni Malinen 1888ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1889ae32c30aSJouni Malinen __func__, frame_type, reg); 1890ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1891ae32c30aSJouni Malinen /* 1892ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1893ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1894ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1895ae32c30aSJouni Malinen */ 1896ae32c30aSJouni Malinen ar->probe_req_report = reg; 1897ae32c30aSJouni Malinen } 1898ae32c30aSJouni Malinen } 1899ae32c30aSJouni Malinen 1900f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1901f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1902f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1903f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1904f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1905f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1906f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1907f80574aeSJouni Malinen }, 1908f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1909f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1910f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1911f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1912f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1913f80574aeSJouni Malinen }, 1914f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1915f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1916f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1917f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1918f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1919f80574aeSJouni Malinen }, 1920f80574aeSJouni Malinen }; 1921f80574aeSJouni Malinen 1922bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1923bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1924bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1925bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1926bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1927bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1928bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1929bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1930bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1931bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1932bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1933bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1934bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1935bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1936bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1937bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1938bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1939bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1940bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1941003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 1942abcb344bSKalle Valo #ifdef CONFIG_PM 1943abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1944aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 1945abcb344bSKalle Valo #endif 19466a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19476a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19486a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19496a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 195023875136SJouni Malinen .change_station = ath6kl_change_station, 195163fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 195263fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19538a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1954ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1955bdcd8170SKalle Valo }; 1956bdcd8170SKalle Valo 19578dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 1958bdcd8170SKalle Valo { 19596bbc7c35SJouni Malinen struct ath6kl *ar; 1960be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 19618dafb70eSVasanthakumar Thiagarajan u8 ctr; 1962bdcd8170SKalle Valo 1963bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1964be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 19658dafb70eSVasanthakumar Thiagarajan 1966be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 1967bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1968bdcd8170SKalle Valo return NULL; 1969bdcd8170SKalle Valo } 1970bdcd8170SKalle Valo 1971be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 19726bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 1973be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 19748dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 19758dafb70eSVasanthakumar Thiagarajan 19768dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 19778dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 19788dafb70eSVasanthakumar Thiagarajan 19798dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 19808dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 19818dafb70eSVasanthakumar Thiagarajan 19828dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 19838dafb70eSVasanthakumar Thiagarajan 19848dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 19858dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 19868dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 19878dafb70eSVasanthakumar Thiagarajan 19888dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 19898dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 19908dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 19918dafb70eSVasanthakumar Thiagarajan 19928dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 19938dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 19948dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 19958dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 19968dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 19978dafb70eSVasanthakumar Thiagarajan 19988dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 19998dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 20008dafb70eSVasanthakumar Thiagarajan 20018dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 20028dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 20038dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 20048dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 20058dafb70eSVasanthakumar Thiagarajan } 20068dafb70eSVasanthakumar Thiagarajan 20078dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 20088dafb70eSVasanthakumar Thiagarajan 20098dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 20108dafb70eSVasanthakumar Thiagarajan 20118dafb70eSVasanthakumar Thiagarajan return ar; 20128dafb70eSVasanthakumar Thiagarajan } 20138dafb70eSVasanthakumar Thiagarajan 20148dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 20158dafb70eSVasanthakumar Thiagarajan { 20168dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 20178dafb70eSVasanthakumar Thiagarajan int ret; 20186bbc7c35SJouni Malinen 2019be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2020f80574aeSJouni Malinen 2021be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 202263fa1e0cSJouni Malinen 2023bdcd8170SKalle Valo /* set device pointer for wiphy */ 20248dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2025bdcd8170SKalle Valo 2026be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 20278dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 20288dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 20296bbc7c35SJouni Malinen if (ar->p2p) { 2030be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 20316bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 20326bbc7c35SJouni Malinen } 20338dafb70eSVasanthakumar Thiagarajan 2034bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2035be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2036be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2037be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2038be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2039be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2040bdcd8170SKalle Valo 2041be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2042be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2043bdcd8170SKalle Valo 2044be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2045bdcd8170SKalle Valo if (ret < 0) { 2046bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 20478dafb70eSVasanthakumar Thiagarajan return ret; 20488dafb70eSVasanthakumar Thiagarajan } 20498dafb70eSVasanthakumar Thiagarajan 20508dafb70eSVasanthakumar Thiagarajan return 0; 20518dafb70eSVasanthakumar Thiagarajan } 20528dafb70eSVasanthakumar Thiagarajan 2053108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 20548dafb70eSVasanthakumar Thiagarajan { 2055108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2056108438bcSVasanthakumar Thiagarajan 2057108438bcSVasanthakumar Thiagarajan ar->aggr_cntxt = aggr_init(vif->ndev); 20588dafb70eSVasanthakumar Thiagarajan if (!ar->aggr_cntxt) { 20598dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 20608dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 20618dafb70eSVasanthakumar Thiagarajan } 20628dafb70eSVasanthakumar Thiagarajan 20638dafb70eSVasanthakumar Thiagarajan setup_timer(&ar->disconnect_timer, disconnect_timer_handler, 2064108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 20658dafb70eSVasanthakumar Thiagarajan 20668dafb70eSVasanthakumar Thiagarajan return 0; 20678dafb70eSVasanthakumar Thiagarajan } 20688dafb70eSVasanthakumar Thiagarajan 2069108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 20708dafb70eSVasanthakumar Thiagarajan { 2071108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2072108438bcSVasanthakumar Thiagarajan 20738dafb70eSVasanthakumar Thiagarajan aggr_module_destroy(ar->aggr_cntxt); 20748dafb70eSVasanthakumar Thiagarajan 20758dafb70eSVasanthakumar Thiagarajan ar->aggr_cntxt = NULL; 20768dafb70eSVasanthakumar Thiagarajan 207759c98449SVasanthakumar Thiagarajan if (test_bit(NETDEV_REGISTERED, &vif->flags)) { 2078108438bcSVasanthakumar Thiagarajan unregister_netdev(vif->ndev); 207959c98449SVasanthakumar Thiagarajan clear_bit(NETDEV_REGISTERED, &vif->flags); 20808dafb70eSVasanthakumar Thiagarajan } 20818dafb70eSVasanthakumar Thiagarajan 2082108438bcSVasanthakumar Thiagarajan free_netdev(vif->ndev); 20838dafb70eSVasanthakumar Thiagarajan } 20848dafb70eSVasanthakumar Thiagarajan 20858dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 20868dafb70eSVasanthakumar Thiagarajan enum nl80211_iftype type) 20878dafb70eSVasanthakumar Thiagarajan { 20888dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2089108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 20908dafb70eSVasanthakumar Thiagarajan 2091108438bcSVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), "wlan%d", ether_setup); 20928dafb70eSVasanthakumar Thiagarajan if (!ndev) 20938dafb70eSVasanthakumar Thiagarajan return NULL; 20948dafb70eSVasanthakumar Thiagarajan 2095108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2096108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2097108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2098108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2099108438bcSVasanthakumar Thiagarajan ar->vif = vif; 2100108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2101108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2102108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2103108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2104108438bcSVasanthakumar Thiagarajan ar->wdev = &vif->wdev; 21058dafb70eSVasanthakumar Thiagarajan ar->net_dev = ndev; 21068dafb70eSVasanthakumar Thiagarajan 21078dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 21088dafb70eSVasanthakumar Thiagarajan 21098dafb70eSVasanthakumar Thiagarajan ath6kl_init_control_info(ar); 21108dafb70eSVasanthakumar Thiagarajan 21118dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2112108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 21138dafb70eSVasanthakumar Thiagarajan goto err; 21148dafb70eSVasanthakumar Thiagarajan 21158dafb70eSVasanthakumar Thiagarajan if (register_netdev(ndev)) 21168dafb70eSVasanthakumar Thiagarajan goto err; 21178dafb70eSVasanthakumar Thiagarajan 21188dafb70eSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 211959c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 21208dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 212159c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 21228dafb70eSVasanthakumar Thiagarajan 21238dafb70eSVasanthakumar Thiagarajan return ndev; 21248dafb70eSVasanthakumar Thiagarajan 21258dafb70eSVasanthakumar Thiagarajan err: 2126108438bcSVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 21278dafb70eSVasanthakumar Thiagarajan 2128bdcd8170SKalle Valo return NULL; 2129bdcd8170SKalle Valo } 2130bdcd8170SKalle Valo 21318dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2132bdcd8170SKalle Valo { 2133bdcd8170SKalle Valo if (ar->scan_req) { 2134bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 2135bdcd8170SKalle Valo ar->scan_req = NULL; 2136bdcd8170SKalle Valo } 2137bdcd8170SKalle Valo 2138be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2139be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2140bdcd8170SKalle Valo } 2141