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 446f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->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; 458f5938f24SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->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 668f5938f24SVasanthakumar Thiagarajan if (vif->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 679f5938f24SVasanthakumar Thiagarajan if (vif->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 909f5938f24SVasanthakumar Thiagarajan if (vif->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 928f5938f24SVasanthakumar Thiagarajan if (vif->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 1057f5938f24SVasanthakumar Thiagarajan if (vif->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; 1204f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1205bdcd8170SKalle Valo 1206bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1207bdcd8170SKalle Valo 1208bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1209bdcd8170SKalle Valo return -EIO; 1210bdcd8170SKalle Valo 1211bdcd8170SKalle Valo switch (type) { 1212bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1213f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1214bdcd8170SKalle Valo break; 1215bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1216f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1217bdcd8170SKalle Valo break; 12186e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1219f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 12206e4604c8SJouni Malinen break; 12216b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1222f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 12236b5e5d25SJouni Malinen break; 12246b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1225f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 12266b5e5d25SJouni Malinen break; 1227bdcd8170SKalle Valo default: 1228bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1229bdcd8170SKalle Valo return -EOPNOTSUPP; 1230bdcd8170SKalle Valo } 1231bdcd8170SKalle Valo 1232bdcd8170SKalle Valo wdev->iftype = type; 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo return 0; 1235bdcd8170SKalle Valo } 1236bdcd8170SKalle Valo 1237bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1238bdcd8170SKalle Valo struct net_device *dev, 1239bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1240bdcd8170SKalle Valo { 1241bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 124259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1243bdcd8170SKalle Valo int status; 1244bdcd8170SKalle Valo 1245bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1246bdcd8170SKalle Valo return -EIO; 1247bdcd8170SKalle Valo 12483450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 12493450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1250bdcd8170SKalle Valo 1251bdcd8170SKalle Valo if (ibss_param->channel) 1252bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1253bdcd8170SKalle Valo 1254bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1255bdcd8170SKalle Valo /* 1256bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1257bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1258bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1259bdcd8170SKalle Valo * updated. 1260bdcd8170SKalle Valo */ 1261bdcd8170SKalle Valo return -EOPNOTSUPP; 1262bdcd8170SKalle Valo } 1263bdcd8170SKalle Valo 1264bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1265bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1266bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1267bdcd8170SKalle Valo 1268bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1269bdcd8170SKalle Valo 1270bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1271bdcd8170SKalle Valo if (status) 1272bdcd8170SKalle Valo return status; 1273bdcd8170SKalle Valo 1274bdcd8170SKalle Valo if (ibss_param->privacy) { 1275bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1276bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1277bdcd8170SKalle Valo } else { 1278bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1279bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1280bdcd8170SKalle Valo } 1281bdcd8170SKalle Valo 1282f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1283bdcd8170SKalle Valo 1284bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1285bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1286bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1287bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1288bdcd8170SKalle Valo __func__, 12893450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 12903450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 12913450334fSVasanthakumar Thiagarajan vif->grp_crypto_len, ar->ch_hint); 1292bdcd8170SKalle Valo 1293f5938f24SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->nw_type, 12943450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 12953450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 12963450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 12973450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 12983450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1299bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1300bdcd8170SKalle Valo ar->connect_ctrl_flags); 130159c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1302bdcd8170SKalle Valo 1303bdcd8170SKalle Valo return 0; 1304bdcd8170SKalle Valo } 1305bdcd8170SKalle Valo 1306bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1307bdcd8170SKalle Valo struct net_device *dev) 1308bdcd8170SKalle Valo { 1309bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 13103450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1311bdcd8170SKalle Valo 1312bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1313bdcd8170SKalle Valo return -EIO; 1314bdcd8170SKalle Valo 1315bdcd8170SKalle Valo ath6kl_disconnect(ar); 13163450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 13173450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1318bdcd8170SKalle Valo 1319bdcd8170SKalle Valo return 0; 1320bdcd8170SKalle Valo } 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1323bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1324bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1325bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1326bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1327837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1328bdcd8170SKalle Valo }; 1329bdcd8170SKalle Valo 1330bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1331bdcd8170SKalle Valo { 1332bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1333bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1334bdcd8170SKalle Valo 36000, 48000, 54000 1335bdcd8170SKalle Valo }; 1336bdcd8170SKalle Valo u8 i; 1337bdcd8170SKalle Valo 1338bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1339bdcd8170SKalle Valo if (rate == legacy[i]) 1340bdcd8170SKalle Valo return true; 1341bdcd8170SKalle Valo 1342bdcd8170SKalle Valo return false; 1343bdcd8170SKalle Valo } 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1346bdcd8170SKalle Valo { 1347bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1348bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1349bdcd8170SKalle Valo }; 1350bdcd8170SKalle Valo u8 i; 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1353bdcd8170SKalle Valo if (rate == ht20[i]) { 1354bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1355bdcd8170SKalle Valo /* last rate uses sgi */ 1356bdcd8170SKalle Valo *sgi = true; 1357bdcd8170SKalle Valo else 1358bdcd8170SKalle Valo *sgi = false; 1359bdcd8170SKalle Valo 1360bdcd8170SKalle Valo *mcs = i; 1361bdcd8170SKalle Valo return true; 1362bdcd8170SKalle Valo } 1363bdcd8170SKalle Valo } 1364bdcd8170SKalle Valo return false; 1365bdcd8170SKalle Valo } 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1368bdcd8170SKalle Valo { 1369bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1370bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1371bdcd8170SKalle Valo 150000 1372bdcd8170SKalle Valo }; 1373bdcd8170SKalle Valo u8 i; 1374bdcd8170SKalle Valo 1375bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1376bdcd8170SKalle Valo if (rate == ht40[i]) { 1377bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1378bdcd8170SKalle Valo /* last rate uses sgi */ 1379bdcd8170SKalle Valo *sgi = true; 1380bdcd8170SKalle Valo else 1381bdcd8170SKalle Valo *sgi = false; 1382bdcd8170SKalle Valo 1383bdcd8170SKalle Valo *mcs = i; 1384bdcd8170SKalle Valo return true; 1385bdcd8170SKalle Valo } 1386bdcd8170SKalle Valo } 1387bdcd8170SKalle Valo 1388bdcd8170SKalle Valo return false; 1389bdcd8170SKalle Valo } 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1392bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1393bdcd8170SKalle Valo { 1394bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 139559c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1396bdcd8170SKalle Valo long left; 1397bdcd8170SKalle Valo bool sgi; 1398bdcd8170SKalle Valo s32 rate; 1399bdcd8170SKalle Valo int ret; 1400bdcd8170SKalle Valo u8 mcs; 1401bdcd8170SKalle Valo 1402bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1403bdcd8170SKalle Valo return -ENOENT; 1404bdcd8170SKalle Valo 1405bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1406bdcd8170SKalle Valo return -EBUSY; 1407bdcd8170SKalle Valo 1408bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1409bdcd8170SKalle Valo 1410bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo if (ret != 0) { 1413bdcd8170SKalle Valo up(&ar->sem); 1414bdcd8170SKalle Valo return -EIO; 1415bdcd8170SKalle Valo } 1416bdcd8170SKalle Valo 1417bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1418bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1419bdcd8170SKalle Valo &ar->flag), 1420bdcd8170SKalle Valo WMI_TIMEOUT); 1421bdcd8170SKalle Valo 1422bdcd8170SKalle Valo up(&ar->sem); 1423bdcd8170SKalle Valo 1424bdcd8170SKalle Valo if (left == 0) 1425bdcd8170SKalle Valo return -ETIMEDOUT; 1426bdcd8170SKalle Valo else if (left < 0) 1427bdcd8170SKalle Valo return left; 1428bdcd8170SKalle Valo 1429bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1430bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1431bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1432bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1433bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1437bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1438bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1439bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1440bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1441bdcd8170SKalle Valo } 1442bdcd8170SKalle Valo 1443bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1444bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1445bdcd8170SKalle Valo 1446bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1447bdcd8170SKalle Valo 1448bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1449bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1450bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1451bdcd8170SKalle Valo if (sgi) { 1452bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1453bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1454bdcd8170SKalle Valo } else { 1455bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1456bdcd8170SKalle Valo } 1457bdcd8170SKalle Valo 1458bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1459bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1460bdcd8170SKalle Valo if (sgi) { 1461bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1462bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1463bdcd8170SKalle Valo } else { 1464bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1465bdcd8170SKalle Valo } 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1468bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1469bdcd8170SKalle Valo } else { 14709a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 14719a730834SKalle Valo "invalid rate from stats: %d\n", rate); 14729a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1473bdcd8170SKalle Valo return 0; 1474bdcd8170SKalle Valo } 1475bdcd8170SKalle Valo 1476bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1477bdcd8170SKalle Valo 147859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 147959c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1480f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 148132c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 148232c10874SJouni Malinen sinfo->bss_param.flags = 0; 148332c10874SJouni Malinen sinfo->bss_param.dtim_period = ar->assoc_bss_dtim_period; 148432c10874SJouni Malinen sinfo->bss_param.beacon_interval = ar->assoc_bss_beacon_int; 148532c10874SJouni Malinen } 148632c10874SJouni Malinen 1487bdcd8170SKalle Valo return 0; 1488bdcd8170SKalle Valo } 1489bdcd8170SKalle Valo 1490bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1491bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1492bdcd8170SKalle Valo { 1493bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1494bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1495bdcd8170SKalle Valo pmksa->pmkid, true); 1496bdcd8170SKalle Valo } 1497bdcd8170SKalle Valo 1498bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1499bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1500bdcd8170SKalle Valo { 1501bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1502bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1503bdcd8170SKalle Valo pmksa->pmkid, false); 1504bdcd8170SKalle Valo } 1505bdcd8170SKalle Valo 1506bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1507bdcd8170SKalle Valo { 1508bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 150959c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 151059c98449SVasanthakumar Thiagarajan 151159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1512bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1513bdcd8170SKalle Valo return 0; 1514bdcd8170SKalle Valo } 1515bdcd8170SKalle Valo 1516abcb344bSKalle Valo #ifdef CONFIG_PM 1517abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1518abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1519abcb344bSKalle Valo { 1520abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1521abcb344bSKalle Valo 1522abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1523abcb344bSKalle Valo } 1524aa6cffc1SChilam Ng 1525aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1526aa6cffc1SChilam Ng { 1527aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1528aa6cffc1SChilam Ng 1529aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1530aa6cffc1SChilam Ng } 1531abcb344bSKalle Valo #endif 1532abcb344bSKalle Valo 15336a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15346a7c9badSJouni Malinen struct ieee80211_channel *chan, 15356a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15366a7c9badSJouni Malinen { 15376a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15386a7c9badSJouni Malinen 15396a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15406a7c9badSJouni Malinen return -EIO; 15416a7c9badSJouni Malinen 15426a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15436a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15446a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15456a7c9badSJouni Malinen 15466a7c9badSJouni Malinen return 0; 15476a7c9badSJouni Malinen } 15486a7c9badSJouni Malinen 15498bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15508bdfbf40SJouni Malinen { 15518bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15528bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15538bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15548bdfbf40SJouni Malinen } 15558bdfbf40SJouni Malinen 15568bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15578bdfbf40SJouni Malinen size_t ies_len) 15588bdfbf40SJouni Malinen { 15598bdfbf40SJouni Malinen const u8 *pos; 15608bdfbf40SJouni Malinen u8 *buf = NULL; 15618bdfbf40SJouni Malinen size_t len = 0; 15628bdfbf40SJouni Malinen int ret; 15638bdfbf40SJouni Malinen 15648bdfbf40SJouni Malinen /* 15658bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15668bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15678bdfbf40SJouni Malinen */ 15688bdfbf40SJouni Malinen 15698bdfbf40SJouni Malinen if (ies && ies_len) { 15708bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15718bdfbf40SJouni Malinen if (buf == NULL) 15728bdfbf40SJouni Malinen return -ENOMEM; 15738bdfbf40SJouni Malinen pos = ies; 15748bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15758bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15768bdfbf40SJouni Malinen break; 15778bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15788bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15798bdfbf40SJouni Malinen len += 2 + pos[1]; 15808bdfbf40SJouni Malinen } 15818bdfbf40SJouni Malinen pos += 2 + pos[1]; 15828bdfbf40SJouni Malinen } 15838bdfbf40SJouni Malinen } 15848bdfbf40SJouni Malinen 15858bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15868bdfbf40SJouni Malinen buf, len); 15878bdfbf40SJouni Malinen kfree(buf); 15888bdfbf40SJouni Malinen return ret; 15898bdfbf40SJouni Malinen } 15908bdfbf40SJouni Malinen 15916a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 15926a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 15936a7c9badSJouni Malinen { 15946a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15953450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 15966a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 15976a7c9badSJouni Malinen u8 *ies; 15986a7c9badSJouni Malinen int ies_len; 15996a7c9badSJouni Malinen struct wmi_connect_cmd p; 16006a7c9badSJouni Malinen int res; 16016a7c9badSJouni Malinen int i; 16026a7c9badSJouni Malinen 16036a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 16046a7c9badSJouni Malinen 16056a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 16066a7c9badSJouni Malinen return -EIO; 16076a7c9badSJouni Malinen 1608f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 16096a7c9badSJouni Malinen return -EOPNOTSUPP; 16106a7c9badSJouni Malinen 16116a7c9badSJouni Malinen if (info->beacon_ies) { 16126a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 16136a7c9badSJouni Malinen info->beacon_ies, 16146a7c9badSJouni Malinen info->beacon_ies_len); 16156a7c9badSJouni Malinen if (res) 16166a7c9badSJouni Malinen return res; 16176a7c9badSJouni Malinen } 16186a7c9badSJouni Malinen if (info->proberesp_ies) { 16198bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 16206a7c9badSJouni Malinen info->proberesp_ies_len); 16216a7c9badSJouni Malinen if (res) 16226a7c9badSJouni Malinen return res; 16236a7c9badSJouni Malinen } 16246a7c9badSJouni Malinen if (info->assocresp_ies) { 16256a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 16266a7c9badSJouni Malinen info->assocresp_ies, 16276a7c9badSJouni Malinen info->assocresp_ies_len); 16286a7c9badSJouni Malinen if (res) 16296a7c9badSJouni Malinen return res; 16306a7c9badSJouni Malinen } 16316a7c9badSJouni Malinen 16326a7c9badSJouni Malinen if (!add) 16336a7c9badSJouni Malinen return 0; 16346a7c9badSJouni Malinen 16359a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16369a5b1318SJouni Malinen 16376a7c9badSJouni Malinen /* TODO: 16386a7c9badSJouni Malinen * info->interval 16396a7c9badSJouni Malinen * info->dtim_period 16406a7c9badSJouni Malinen */ 16416a7c9badSJouni Malinen 16426a7c9badSJouni Malinen if (info->head == NULL) 16436a7c9badSJouni Malinen return -EINVAL; 16446a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16456a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16466a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16476a7c9badSJouni Malinen return -EINVAL; 16486a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16496a7c9badSJouni Malinen 16506a7c9badSJouni Malinen if (info->ssid == NULL) 16516a7c9badSJouni Malinen return -EINVAL; 16523450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 16533450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 16546a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16556a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16566a7c9badSJouni Malinen 16573450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 16586a7c9badSJouni Malinen 16596a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16606a7c9badSJouni Malinen 16616a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16626a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16636a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16646a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16656a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16666a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16676a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16686a7c9badSJouni Malinen break; 16696a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16706a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16716a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16726a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16736a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16746a7c9badSJouni Malinen break; 16756a7c9badSJouni Malinen } 16766a7c9badSJouni Malinen } 16776a7c9badSJouni Malinen if (p.auth_mode == 0) 16786a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16793450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 16806a7c9badSJouni Malinen 16816a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16826a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16836a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16846a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16856a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16866a7c9badSJouni Malinen break; 16876a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16886a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16896a7c9badSJouni Malinen break; 16906a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16916a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 16926a7c9badSJouni Malinen break; 16936a7c9badSJouni Malinen } 16946a7c9badSJouni Malinen } 1695229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 16966a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1697229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1698229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1699229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 17006a7c9badSJouni Malinen 17016a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 17026a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 17036a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 17046a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 17056a7c9badSJouni Malinen break; 17066a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 17076a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 17086a7c9badSJouni Malinen break; 17096a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 17106a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 17116a7c9badSJouni Malinen break; 17126a7c9badSJouni Malinen default: 17136a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 17146a7c9badSJouni Malinen break; 17156a7c9badSJouni Malinen } 1716229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 17176a7c9badSJouni Malinen 17186a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 1719f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 17206a7c9badSJouni Malinen 17213450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 17223450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 17233450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 17246a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 17256a7c9badSJouni Malinen 17269a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 17279a5b1318SJouni Malinen if (res < 0) 17289a5b1318SJouni Malinen return res; 17299a5b1318SJouni Malinen 17309a5b1318SJouni Malinen return 0; 17316a7c9badSJouni Malinen } 17326a7c9badSJouni Malinen 17336a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17346a7c9badSJouni Malinen struct beacon_parameters *info) 17356a7c9badSJouni Malinen { 17366a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17376a7c9badSJouni Malinen } 17386a7c9badSJouni Malinen 17396a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17406a7c9badSJouni Malinen struct beacon_parameters *info) 17416a7c9badSJouni Malinen { 17426a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17436a7c9badSJouni Malinen } 17446a7c9badSJouni Malinen 17456a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17466a7c9badSJouni Malinen { 17476a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 174859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17496a7c9badSJouni Malinen 1750f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 17516a7c9badSJouni Malinen return -EOPNOTSUPP; 175259c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 17536a7c9badSJouni Malinen return -ENOTCONN; 17546a7c9badSJouni Malinen 17556a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 175659c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 17576a7c9badSJouni Malinen 17586a7c9badSJouni Malinen return 0; 17596a7c9badSJouni Malinen } 17606a7c9badSJouni Malinen 176123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 176223875136SJouni Malinen u8 *mac, struct station_parameters *params) 176323875136SJouni Malinen { 176423875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1765f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 176623875136SJouni Malinen 1767f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 176823875136SJouni Malinen return -EOPNOTSUPP; 176923875136SJouni Malinen 177023875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 177123875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 177223875136SJouni Malinen return -EOPNOTSUPP; 177323875136SJouni Malinen 177423875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 177523875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 177623875136SJouni Malinen mac, 0); 177723875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 177823875136SJouni Malinen 0); 177923875136SJouni Malinen } 178023875136SJouni Malinen 178163fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 178263fa1e0cSJouni Malinen struct net_device *dev, 178363fa1e0cSJouni Malinen struct ieee80211_channel *chan, 178463fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 178563fa1e0cSJouni Malinen unsigned int duration, 178663fa1e0cSJouni Malinen u64 *cookie) 178763fa1e0cSJouni Malinen { 178863fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 178963fa1e0cSJouni Malinen 179063fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 179163fa1e0cSJouni Malinen * return -EBUSY */ 179263fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 179363fa1e0cSJouni Malinen 179463fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 179563fa1e0cSJouni Malinen duration); 179663fa1e0cSJouni Malinen } 179763fa1e0cSJouni Malinen 179863fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 179963fa1e0cSJouni Malinen struct net_device *dev, 180063fa1e0cSJouni Malinen u64 cookie) 180163fa1e0cSJouni Malinen { 180263fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 180363fa1e0cSJouni Malinen 180463fa1e0cSJouni Malinen if (cookie != 1) 180563fa1e0cSJouni Malinen return -ENOENT; 180663fa1e0cSJouni Malinen 180763fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 180863fa1e0cSJouni Malinen } 180963fa1e0cSJouni Malinen 18108bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 18118bdfbf40SJouni Malinen size_t len, unsigned int freq) 18128bdfbf40SJouni Malinen { 18138bdfbf40SJouni Malinen const u8 *pos; 18148bdfbf40SJouni Malinen u8 *p2p; 18158bdfbf40SJouni Malinen int p2p_len; 18168bdfbf40SJouni Malinen int ret; 18178bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18188bdfbf40SJouni Malinen 18198bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18208bdfbf40SJouni Malinen 18218bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 18228bdfbf40SJouni Malinen 18238bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 18248bdfbf40SJouni Malinen if (p2p == NULL) 18258bdfbf40SJouni Malinen return -ENOMEM; 18268bdfbf40SJouni Malinen p2p_len = 0; 18278bdfbf40SJouni Malinen 18288bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 18298bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 18308bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 18318bdfbf40SJouni Malinen break; 18328bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 18338bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 18348bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 18358bdfbf40SJouni Malinen } 18368bdfbf40SJouni Malinen pos += 2 + pos[1]; 18378bdfbf40SJouni Malinen } 18388bdfbf40SJouni Malinen 18398bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18408bdfbf40SJouni Malinen p2p, p2p_len); 18418bdfbf40SJouni Malinen kfree(p2p); 18428bdfbf40SJouni Malinen return ret; 18438bdfbf40SJouni Malinen } 18448bdfbf40SJouni Malinen 18458a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18468a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18478a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18488a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1849e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1850e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 18518a6c8060SJouni Malinen { 18528a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 185359c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18548a6c8060SJouni Malinen u32 id; 18558bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18568bdfbf40SJouni Malinen 18578bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18588bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 1859f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 18608bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18618bdfbf40SJouni Malinen /* 18628bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18638bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18648bdfbf40SJouni Malinen */ 18658bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18668bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18678bdfbf40SJouni Malinen chan->center_freq); 18688bdfbf40SJouni Malinen } 18698a6c8060SJouni Malinen 18708a6c8060SJouni Malinen id = ar->send_action_id++; 18718a6c8060SJouni Malinen if (id == 0) { 18728a6c8060SJouni Malinen /* 18738a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18748a6c8060SJouni Malinen * used for the command. 18758a6c8060SJouni Malinen */ 18768a6c8060SJouni Malinen id = ar->send_action_id++; 18778a6c8060SJouni Malinen } 18788a6c8060SJouni Malinen 18798a6c8060SJouni Malinen *cookie = id; 18808a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18818a6c8060SJouni Malinen buf, len); 18828a6c8060SJouni Malinen } 18838a6c8060SJouni Malinen 1884ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1885ae32c30aSJouni Malinen struct net_device *dev, 1886ae32c30aSJouni Malinen u16 frame_type, bool reg) 1887ae32c30aSJouni Malinen { 1888ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1889ae32c30aSJouni Malinen 1890ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1891ae32c30aSJouni Malinen __func__, frame_type, reg); 1892ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1893ae32c30aSJouni Malinen /* 1894ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1895ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1896ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1897ae32c30aSJouni Malinen */ 1898ae32c30aSJouni Malinen ar->probe_req_report = reg; 1899ae32c30aSJouni Malinen } 1900ae32c30aSJouni Malinen } 1901ae32c30aSJouni Malinen 1902f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1903f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1904f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1905f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1906f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1907f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1908f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1909f80574aeSJouni Malinen }, 1910f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1911f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1912f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1913f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1914f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1915f80574aeSJouni Malinen }, 1916f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1917f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1918f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1919f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1920f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1921f80574aeSJouni Malinen }, 1922f80574aeSJouni Malinen }; 1923f80574aeSJouni Malinen 1924bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1925bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1926bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1927bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1928bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1929bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1930bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1931bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1932bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1933bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1934bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1935bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1936bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1937bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1938bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1939bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1940bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1941bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1942bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1943003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 1944abcb344bSKalle Valo #ifdef CONFIG_PM 1945abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1946aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 1947abcb344bSKalle Valo #endif 19486a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19496a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19506a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19516a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 195223875136SJouni Malinen .change_station = ath6kl_change_station, 195363fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 195463fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19558a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1956ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1957bdcd8170SKalle Valo }; 1958bdcd8170SKalle Valo 19598dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 1960bdcd8170SKalle Valo { 19616bbc7c35SJouni Malinen struct ath6kl *ar; 1962be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 19638dafb70eSVasanthakumar Thiagarajan u8 ctr; 1964bdcd8170SKalle Valo 1965bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1966be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 19678dafb70eSVasanthakumar Thiagarajan 1968be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 1969bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1970bdcd8170SKalle Valo return NULL; 1971bdcd8170SKalle Valo } 1972bdcd8170SKalle Valo 1973be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 19746bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 1975be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 19768dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 19778dafb70eSVasanthakumar Thiagarajan 19788dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 19798dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 19808dafb70eSVasanthakumar Thiagarajan 19818dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 19828dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 19838dafb70eSVasanthakumar Thiagarajan 19848dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 19858dafb70eSVasanthakumar Thiagarajan 19868dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 19878dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 19888dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 19898dafb70eSVasanthakumar Thiagarajan 19908dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 19918dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 19928dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 19938dafb70eSVasanthakumar Thiagarajan 19948dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 19958dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 19968dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 19978dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 19988dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 19998dafb70eSVasanthakumar Thiagarajan 20008dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 20018dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 20028dafb70eSVasanthakumar Thiagarajan 20038dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 20048dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 20058dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 20068dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 20078dafb70eSVasanthakumar Thiagarajan } 20088dafb70eSVasanthakumar Thiagarajan 20098dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 20108dafb70eSVasanthakumar Thiagarajan 20118dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 20128dafb70eSVasanthakumar Thiagarajan 20138dafb70eSVasanthakumar Thiagarajan return ar; 20148dafb70eSVasanthakumar Thiagarajan } 20158dafb70eSVasanthakumar Thiagarajan 20168dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 20178dafb70eSVasanthakumar Thiagarajan { 20188dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 20198dafb70eSVasanthakumar Thiagarajan int ret; 20206bbc7c35SJouni Malinen 2021be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2022f80574aeSJouni Malinen 2023be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 202463fa1e0cSJouni Malinen 2025bdcd8170SKalle Valo /* set device pointer for wiphy */ 20268dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2027bdcd8170SKalle Valo 2028be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 20298dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 20308dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 20316bbc7c35SJouni Malinen if (ar->p2p) { 2032be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 20336bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 20346bbc7c35SJouni Malinen } 20358dafb70eSVasanthakumar Thiagarajan 2036bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2037be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2038be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2039be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2040be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2041be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2042bdcd8170SKalle Valo 2043be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2044be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2045bdcd8170SKalle Valo 2046be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2047bdcd8170SKalle Valo if (ret < 0) { 2048bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 20498dafb70eSVasanthakumar Thiagarajan return ret; 20508dafb70eSVasanthakumar Thiagarajan } 20518dafb70eSVasanthakumar Thiagarajan 20528dafb70eSVasanthakumar Thiagarajan return 0; 20538dafb70eSVasanthakumar Thiagarajan } 20548dafb70eSVasanthakumar Thiagarajan 2055108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 20568dafb70eSVasanthakumar Thiagarajan { 2057108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2058108438bcSVasanthakumar Thiagarajan 2059108438bcSVasanthakumar Thiagarajan ar->aggr_cntxt = aggr_init(vif->ndev); 20608dafb70eSVasanthakumar Thiagarajan if (!ar->aggr_cntxt) { 20618dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 20628dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 20638dafb70eSVasanthakumar Thiagarajan } 20648dafb70eSVasanthakumar Thiagarajan 20658dafb70eSVasanthakumar Thiagarajan setup_timer(&ar->disconnect_timer, disconnect_timer_handler, 2066108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 20678dafb70eSVasanthakumar Thiagarajan 20688dafb70eSVasanthakumar Thiagarajan return 0; 20698dafb70eSVasanthakumar Thiagarajan } 20708dafb70eSVasanthakumar Thiagarajan 2071108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 20728dafb70eSVasanthakumar Thiagarajan { 2073108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2074108438bcSVasanthakumar Thiagarajan 20758dafb70eSVasanthakumar Thiagarajan aggr_module_destroy(ar->aggr_cntxt); 20768dafb70eSVasanthakumar Thiagarajan 20778dafb70eSVasanthakumar Thiagarajan ar->aggr_cntxt = NULL; 20788dafb70eSVasanthakumar Thiagarajan 207959c98449SVasanthakumar Thiagarajan if (test_bit(NETDEV_REGISTERED, &vif->flags)) { 2080108438bcSVasanthakumar Thiagarajan unregister_netdev(vif->ndev); 208159c98449SVasanthakumar Thiagarajan clear_bit(NETDEV_REGISTERED, &vif->flags); 20828dafb70eSVasanthakumar Thiagarajan } 20838dafb70eSVasanthakumar Thiagarajan 2084108438bcSVasanthakumar Thiagarajan free_netdev(vif->ndev); 20858dafb70eSVasanthakumar Thiagarajan } 20868dafb70eSVasanthakumar Thiagarajan 20878dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 20888dafb70eSVasanthakumar Thiagarajan enum nl80211_iftype type) 20898dafb70eSVasanthakumar Thiagarajan { 20908dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2091108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 20928dafb70eSVasanthakumar Thiagarajan 2093108438bcSVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), "wlan%d", ether_setup); 20948dafb70eSVasanthakumar Thiagarajan if (!ndev) 20958dafb70eSVasanthakumar Thiagarajan return NULL; 20968dafb70eSVasanthakumar Thiagarajan 2097108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2098108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2099108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2100108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2101108438bcSVasanthakumar Thiagarajan ar->vif = vif; 2102108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2103108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2104108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2105108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2106108438bcSVasanthakumar Thiagarajan ar->wdev = &vif->wdev; 21078dafb70eSVasanthakumar Thiagarajan ar->net_dev = ndev; 21088dafb70eSVasanthakumar Thiagarajan 21098dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 21108dafb70eSVasanthakumar Thiagarajan 21118dafb70eSVasanthakumar Thiagarajan ath6kl_init_control_info(ar); 21128dafb70eSVasanthakumar Thiagarajan 21138dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2114108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 21158dafb70eSVasanthakumar Thiagarajan goto err; 21168dafb70eSVasanthakumar Thiagarajan 21178dafb70eSVasanthakumar Thiagarajan if (register_netdev(ndev)) 21188dafb70eSVasanthakumar Thiagarajan goto err; 21198dafb70eSVasanthakumar Thiagarajan 21208dafb70eSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 212159c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 21228dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 212359c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 21248dafb70eSVasanthakumar Thiagarajan 21258dafb70eSVasanthakumar Thiagarajan return ndev; 21268dafb70eSVasanthakumar Thiagarajan 21278dafb70eSVasanthakumar Thiagarajan err: 2128108438bcSVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 21298dafb70eSVasanthakumar Thiagarajan 2130bdcd8170SKalle Valo return NULL; 2131bdcd8170SKalle Valo } 2132bdcd8170SKalle Valo 21338dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2134bdcd8170SKalle Valo { 2135bdcd8170SKalle Valo if (ar->scan_req) { 2136bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 2137bdcd8170SKalle Valo ar->scan_req = NULL; 2138bdcd8170SKalle Valo } 2139bdcd8170SKalle Valo 2140be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2141be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2142bdcd8170SKalle Valo } 2143