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; 3668c8b65e3SVasanthakumar Thiagarajan status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->req_bssid, 367f74bac54SVasanthakumar Thiagarajan vif->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) 385f74bac54SVasanthakumar Thiagarajan vif->ch_hint = sme->channel->center_freq; 386bdcd8170SKalle Valo 3878c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 388bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 3898c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, sme->bssid, sizeof(vif->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 4226f2a73f9SVasanthakumar Thiagarajan key = &vif->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, 455f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->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, 464f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->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)) 6478c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->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 8596f2a73f9SVasanthakumar Thiagarajan key = &vif->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"); 9376f2a73f9SVasanthakumar Thiagarajan vif->wep_key_list[key_index].key_len = key->key_len; 9386f2a73f9SVasanthakumar Thiagarajan memcpy(vif->wep_key_list[key_index].key, key->key, 9396f2a73f9SVasanthakumar Thiagarajan key->key_len); 940151411e8SJouni Malinen return 0; 941151411e8SJouni Malinen } 942151411e8SJouni Malinen 9433450334fSVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->def_txkey_index, 944bdcd8170SKalle Valo key_type, key_usage, key->key_len, 945bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 946bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 947bdcd8170SKalle Valo 948bdcd8170SKalle Valo if (status) 949bdcd8170SKalle Valo return -EIO; 950bdcd8170SKalle Valo 951bdcd8170SKalle Valo return 0; 952bdcd8170SKalle Valo } 953bdcd8170SKalle Valo 954bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 955bdcd8170SKalle Valo u8 key_index, bool pairwise, 956bdcd8170SKalle Valo const u8 *mac_addr) 957bdcd8170SKalle Valo { 958bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 9596f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 962bdcd8170SKalle Valo 963bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 964bdcd8170SKalle Valo return -EIO; 965bdcd8170SKalle Valo 966bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 967bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 968bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 969bdcd8170SKalle Valo key_index); 970bdcd8170SKalle Valo return -ENOENT; 971bdcd8170SKalle Valo } 972bdcd8170SKalle Valo 9736f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 974bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 975bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 976bdcd8170SKalle Valo return 0; 977bdcd8170SKalle Valo } 978bdcd8170SKalle Valo 9796f2a73f9SVasanthakumar Thiagarajan vif->keys[key_index].key_len = 0; 980bdcd8170SKalle Valo 981bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 982bdcd8170SKalle Valo } 983bdcd8170SKalle Valo 984bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 985bdcd8170SKalle Valo u8 key_index, bool pairwise, 986bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 987bdcd8170SKalle Valo void (*callback) (void *cookie, 988bdcd8170SKalle Valo struct key_params *)) 989bdcd8170SKalle Valo { 990bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 9916f2a73f9SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 992bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 993bdcd8170SKalle Valo struct key_params params; 994bdcd8170SKalle Valo 995bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 996bdcd8170SKalle Valo 997bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 998bdcd8170SKalle Valo return -EIO; 999bdcd8170SKalle Valo 1000bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1001bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1002bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1003bdcd8170SKalle Valo key_index); 1004bdcd8170SKalle Valo return -ENOENT; 1005bdcd8170SKalle Valo } 1006bdcd8170SKalle Valo 10076f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[key_index]; 1008bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1009bdcd8170SKalle Valo params.cipher = key->cipher; 1010bdcd8170SKalle Valo params.key_len = key->key_len; 1011bdcd8170SKalle Valo params.seq_len = key->seq_len; 1012bdcd8170SKalle Valo params.seq = key->seq; 1013bdcd8170SKalle Valo params.key = key->key; 1014bdcd8170SKalle Valo 1015bdcd8170SKalle Valo callback(cookie, ¶ms); 1016bdcd8170SKalle Valo 1017bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1018bdcd8170SKalle Valo } 1019bdcd8170SKalle Valo 1020bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1021bdcd8170SKalle Valo struct net_device *ndev, 1022bdcd8170SKalle Valo u8 key_index, bool unicast, 1023bdcd8170SKalle Valo bool multicast) 1024bdcd8170SKalle Valo { 1025bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 102659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1027bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1028bdcd8170SKalle Valo int status = 0; 1029bdcd8170SKalle Valo u8 key_usage; 1030229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1031bdcd8170SKalle Valo 1032bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1035bdcd8170SKalle Valo return -EIO; 1036bdcd8170SKalle Valo 1037bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1038bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1039bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1040bdcd8170SKalle Valo __func__, key_index); 1041bdcd8170SKalle Valo return -ENOENT; 1042bdcd8170SKalle Valo } 1043bdcd8170SKalle Valo 10446f2a73f9SVasanthakumar Thiagarajan if (!vif->keys[key_index].key_len) { 1045bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1046bdcd8170SKalle Valo __func__, key_index); 1047bdcd8170SKalle Valo return -EINVAL; 1048bdcd8170SKalle Valo } 1049bdcd8170SKalle Valo 10503450334fSVasanthakumar Thiagarajan vif->def_txkey_index = key_index; 10516f2a73f9SVasanthakumar Thiagarajan key = &vif->keys[vif->def_txkey_index]; 1052bdcd8170SKalle Valo key_usage = GROUP_USAGE; 10533450334fSVasanthakumar Thiagarajan if (vif->prwise_crypto == WEP_CRYPT) 1054bdcd8170SKalle Valo key_usage |= TX_USAGE; 1055229ed6b5SEdward Lu if (unicast) 10563450334fSVasanthakumar Thiagarajan key_type = vif->prwise_crypto; 1057229ed6b5SEdward Lu if (multicast) 10583450334fSVasanthakumar Thiagarajan key_type = vif->grp_crypto; 1059bdcd8170SKalle Valo 1060f5938f24SVasanthakumar Thiagarajan if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 10619a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10629a5b1318SJouni Malinen 10633450334fSVasanthakumar Thiagarajan status = ath6kl_wmi_addkey_cmd(ar->wmi, vif->def_txkey_index, 1064229ed6b5SEdward Lu key_type, key_usage, 1065bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1066bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1067bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1068bdcd8170SKalle Valo if (status) 1069bdcd8170SKalle Valo return -EIO; 1070bdcd8170SKalle Valo 1071bdcd8170SKalle Valo return 0; 1072bdcd8170SKalle Valo } 1073bdcd8170SKalle Valo 1074bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1075bdcd8170SKalle Valo bool ismcast) 1076bdcd8170SKalle Valo { 10778c8b65e3SVasanthakumar Thiagarajan /* TODO: Findout vif */ 10788c8b65e3SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 10798c8b65e3SVasanthakumar Thiagarajan 1080bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1081bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1082bdcd8170SKalle Valo 10838c8b65e3SVasanthakumar Thiagarajan cfg80211_michael_mic_failure(ar->net_dev, vif->bssid, 1084bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1085bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1086bdcd8170SKalle Valo GFP_KERNEL); 1087bdcd8170SKalle Valo } 1088bdcd8170SKalle Valo 1089bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1090bdcd8170SKalle Valo { 1091bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1092bdcd8170SKalle Valo int ret; 1093bdcd8170SKalle Valo 1094bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1095bdcd8170SKalle Valo changed); 1096bdcd8170SKalle Valo 1097bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1098bdcd8170SKalle Valo return -EIO; 1099bdcd8170SKalle Valo 1100bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1101bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1102bdcd8170SKalle Valo if (ret != 0) { 1103bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1104bdcd8170SKalle Valo return -EIO; 1105bdcd8170SKalle Valo } 1106bdcd8170SKalle Valo } 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo return 0; 1109bdcd8170SKalle Valo } 1110bdcd8170SKalle Valo 1111bdcd8170SKalle Valo /* 1112bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1113bdcd8170SKalle Valo * data type from 2.6.36 onwards 1114bdcd8170SKalle Valo */ 1115bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1116bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1117bdcd8170SKalle Valo int dbm) 1118bdcd8170SKalle Valo { 1119bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1120bdcd8170SKalle Valo u8 ath6kl_dbm; 1121bdcd8170SKalle Valo 1122bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1123bdcd8170SKalle Valo type, dbm); 1124bdcd8170SKalle Valo 1125bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1126bdcd8170SKalle Valo return -EIO; 1127bdcd8170SKalle Valo 1128bdcd8170SKalle Valo switch (type) { 1129bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1130bdcd8170SKalle Valo return 0; 1131bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1132bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1133bdcd8170SKalle Valo break; 1134bdcd8170SKalle Valo default: 1135bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1136bdcd8170SKalle Valo __func__, type); 1137bdcd8170SKalle Valo return -EOPNOTSUPP; 1138bdcd8170SKalle Valo } 1139bdcd8170SKalle Valo 1140bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1141bdcd8170SKalle Valo 1142bdcd8170SKalle Valo return 0; 1143bdcd8170SKalle Valo } 1144bdcd8170SKalle Valo 1145bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1146bdcd8170SKalle Valo { 1147bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 114859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 1149bdcd8170SKalle Valo 1150bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1151bdcd8170SKalle Valo return -EIO; 1152bdcd8170SKalle Valo 115359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1154bdcd8170SKalle Valo ar->tx_pwr = 0; 1155bdcd8170SKalle Valo 1156bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1157bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1158bdcd8170SKalle Valo return -EIO; 1159bdcd8170SKalle Valo } 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1162bdcd8170SKalle Valo 5 * HZ); 1163bdcd8170SKalle Valo 1164bdcd8170SKalle Valo if (signal_pending(current)) { 1165bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1166bdcd8170SKalle Valo return -EINTR; 1167bdcd8170SKalle Valo } 1168bdcd8170SKalle Valo } 1169bdcd8170SKalle Valo 1170bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1171bdcd8170SKalle Valo return 0; 1172bdcd8170SKalle Valo } 1173bdcd8170SKalle Valo 1174bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1175bdcd8170SKalle Valo struct net_device *dev, 1176bdcd8170SKalle Valo bool pmgmt, int timeout) 1177bdcd8170SKalle Valo { 1178bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1179bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1182bdcd8170SKalle Valo __func__, pmgmt, timeout); 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1185bdcd8170SKalle Valo return -EIO; 1186bdcd8170SKalle Valo 1187bdcd8170SKalle Valo if (pmgmt) { 1188bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1189bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1190bdcd8170SKalle Valo } else { 1191bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1192bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1193bdcd8170SKalle Valo } 1194bdcd8170SKalle Valo 1195bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1196bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1197bdcd8170SKalle Valo return -EIO; 1198bdcd8170SKalle Valo } 1199bdcd8170SKalle Valo 1200bdcd8170SKalle Valo return 0; 1201bdcd8170SKalle Valo } 1202bdcd8170SKalle Valo 1203bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1204bdcd8170SKalle Valo struct net_device *ndev, 1205bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1206bdcd8170SKalle Valo struct vif_params *params) 1207bdcd8170SKalle Valo { 1208bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1209bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1210f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1211bdcd8170SKalle Valo 1212bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1213bdcd8170SKalle Valo 1214bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1215bdcd8170SKalle Valo return -EIO; 1216bdcd8170SKalle Valo 1217bdcd8170SKalle Valo switch (type) { 1218bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1219f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 1220bdcd8170SKalle Valo break; 1221bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1222f5938f24SVasanthakumar Thiagarajan vif->next_mode = ADHOC_NETWORK; 1223bdcd8170SKalle Valo break; 12246e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 1225f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 12266e4604c8SJouni Malinen break; 12276b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 1228f5938f24SVasanthakumar Thiagarajan vif->next_mode = INFRA_NETWORK; 12296b5e5d25SJouni Malinen break; 12306b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 1231f5938f24SVasanthakumar Thiagarajan vif->next_mode = AP_NETWORK; 12326b5e5d25SJouni Malinen break; 1233bdcd8170SKalle Valo default: 1234bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1235bdcd8170SKalle Valo return -EOPNOTSUPP; 1236bdcd8170SKalle Valo } 1237bdcd8170SKalle Valo 1238bdcd8170SKalle Valo wdev->iftype = type; 1239bdcd8170SKalle Valo 1240bdcd8170SKalle Valo return 0; 1241bdcd8170SKalle Valo } 1242bdcd8170SKalle Valo 1243bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1244bdcd8170SKalle Valo struct net_device *dev, 1245bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1246bdcd8170SKalle Valo { 1247bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 124859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1249bdcd8170SKalle Valo int status; 1250bdcd8170SKalle Valo 1251bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1252bdcd8170SKalle Valo return -EIO; 1253bdcd8170SKalle Valo 12543450334fSVasanthakumar Thiagarajan vif->ssid_len = ibss_param->ssid_len; 12553450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1256bdcd8170SKalle Valo 1257bdcd8170SKalle Valo if (ibss_param->channel) 1258f74bac54SVasanthakumar Thiagarajan vif->ch_hint = ibss_param->channel->center_freq; 1259bdcd8170SKalle Valo 1260bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1261bdcd8170SKalle Valo /* 1262bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1263bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1264bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1265bdcd8170SKalle Valo * updated. 1266bdcd8170SKalle Valo */ 1267bdcd8170SKalle Valo return -EOPNOTSUPP; 1268bdcd8170SKalle Valo } 1269bdcd8170SKalle Valo 12708c8b65e3SVasanthakumar Thiagarajan memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1271bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 12728c8b65e3SVasanthakumar Thiagarajan memcpy(vif->req_bssid, ibss_param->bssid, 12738c8b65e3SVasanthakumar Thiagarajan sizeof(vif->req_bssid)); 1274bdcd8170SKalle Valo 1275bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1276bdcd8170SKalle Valo 1277bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1278bdcd8170SKalle Valo if (status) 1279bdcd8170SKalle Valo return status; 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo if (ibss_param->privacy) { 1282bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1283bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1284bdcd8170SKalle Valo } else { 1285bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1286bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1287bdcd8170SKalle Valo } 1288bdcd8170SKalle Valo 1289f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 1290bdcd8170SKalle Valo 1291bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1292bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1293bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1294bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1295bdcd8170SKalle Valo __func__, 12963450334fSVasanthakumar Thiagarajan vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 12973450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, vif->grp_crypto, 1298f74bac54SVasanthakumar Thiagarajan vif->grp_crypto_len, vif->ch_hint); 1299bdcd8170SKalle Valo 1300f5938f24SVasanthakumar Thiagarajan status = ath6kl_wmi_connect_cmd(ar->wmi, vif->nw_type, 13013450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode, vif->auth_mode, 13023450334fSVasanthakumar Thiagarajan vif->prwise_crypto, 13033450334fSVasanthakumar Thiagarajan vif->prwise_crypto_len, 13043450334fSVasanthakumar Thiagarajan vif->grp_crypto, vif->grp_crypto_len, 13053450334fSVasanthakumar Thiagarajan vif->ssid_len, vif->ssid, 1306f74bac54SVasanthakumar Thiagarajan vif->req_bssid, vif->ch_hint, 1307bdcd8170SKalle Valo ar->connect_ctrl_flags); 130859c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1309bdcd8170SKalle Valo 1310bdcd8170SKalle Valo return 0; 1311bdcd8170SKalle Valo } 1312bdcd8170SKalle Valo 1313bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1314bdcd8170SKalle Valo struct net_device *dev) 1315bdcd8170SKalle Valo { 1316bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 13173450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1318bdcd8170SKalle Valo 1319bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1320bdcd8170SKalle Valo return -EIO; 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo ath6kl_disconnect(ar); 13233450334fSVasanthakumar Thiagarajan memset(vif->ssid, 0, sizeof(vif->ssid)); 13243450334fSVasanthakumar Thiagarajan vif->ssid_len = 0; 1325bdcd8170SKalle Valo 1326bdcd8170SKalle Valo return 0; 1327bdcd8170SKalle Valo } 1328bdcd8170SKalle Valo 1329bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1330bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1331bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1332bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1333bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1334837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1335bdcd8170SKalle Valo }; 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1338bdcd8170SKalle Valo { 1339bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1340bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1341bdcd8170SKalle Valo 36000, 48000, 54000 1342bdcd8170SKalle Valo }; 1343bdcd8170SKalle Valo u8 i; 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1346bdcd8170SKalle Valo if (rate == legacy[i]) 1347bdcd8170SKalle Valo return true; 1348bdcd8170SKalle Valo 1349bdcd8170SKalle Valo return false; 1350bdcd8170SKalle Valo } 1351bdcd8170SKalle Valo 1352bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1353bdcd8170SKalle Valo { 1354bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1355bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1356bdcd8170SKalle Valo }; 1357bdcd8170SKalle Valo u8 i; 1358bdcd8170SKalle Valo 1359bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1360bdcd8170SKalle Valo if (rate == ht20[i]) { 1361bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1362bdcd8170SKalle Valo /* last rate uses sgi */ 1363bdcd8170SKalle Valo *sgi = true; 1364bdcd8170SKalle Valo else 1365bdcd8170SKalle Valo *sgi = false; 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo *mcs = i; 1368bdcd8170SKalle Valo return true; 1369bdcd8170SKalle Valo } 1370bdcd8170SKalle Valo } 1371bdcd8170SKalle Valo return false; 1372bdcd8170SKalle Valo } 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1375bdcd8170SKalle Valo { 1376bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1377bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1378bdcd8170SKalle Valo 150000 1379bdcd8170SKalle Valo }; 1380bdcd8170SKalle Valo u8 i; 1381bdcd8170SKalle Valo 1382bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1383bdcd8170SKalle Valo if (rate == ht40[i]) { 1384bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1385bdcd8170SKalle Valo /* last rate uses sgi */ 1386bdcd8170SKalle Valo *sgi = true; 1387bdcd8170SKalle Valo else 1388bdcd8170SKalle Valo *sgi = false; 1389bdcd8170SKalle Valo 1390bdcd8170SKalle Valo *mcs = i; 1391bdcd8170SKalle Valo return true; 1392bdcd8170SKalle Valo } 1393bdcd8170SKalle Valo } 1394bdcd8170SKalle Valo 1395bdcd8170SKalle Valo return false; 1396bdcd8170SKalle Valo } 1397bdcd8170SKalle Valo 1398bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1399bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1400bdcd8170SKalle Valo { 1401bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 140259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1403bdcd8170SKalle Valo long left; 1404bdcd8170SKalle Valo bool sgi; 1405bdcd8170SKalle Valo s32 rate; 1406bdcd8170SKalle Valo int ret; 1407bdcd8170SKalle Valo u8 mcs; 1408bdcd8170SKalle Valo 14098c8b65e3SVasanthakumar Thiagarajan if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1410bdcd8170SKalle Valo return -ENOENT; 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1413bdcd8170SKalle Valo return -EBUSY; 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1416bdcd8170SKalle Valo 1417bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1418bdcd8170SKalle Valo 1419bdcd8170SKalle Valo if (ret != 0) { 1420bdcd8170SKalle Valo up(&ar->sem); 1421bdcd8170SKalle Valo return -EIO; 1422bdcd8170SKalle Valo } 1423bdcd8170SKalle Valo 1424bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1425bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1426bdcd8170SKalle Valo &ar->flag), 1427bdcd8170SKalle Valo WMI_TIMEOUT); 1428bdcd8170SKalle Valo 1429bdcd8170SKalle Valo up(&ar->sem); 1430bdcd8170SKalle Valo 1431bdcd8170SKalle Valo if (left == 0) 1432bdcd8170SKalle Valo return -ETIMEDOUT; 1433bdcd8170SKalle Valo else if (left < 0) 1434bdcd8170SKalle Valo return left; 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1437bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1438bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1439bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1440bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1441bdcd8170SKalle Valo } 1442bdcd8170SKalle Valo 1443bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1444bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1445bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1446bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1447bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1448bdcd8170SKalle Valo } 1449bdcd8170SKalle Valo 1450bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1451bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1452bdcd8170SKalle Valo 1453bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1454bdcd8170SKalle Valo 1455bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1456bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1457bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1458bdcd8170SKalle Valo if (sgi) { 1459bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1460bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1461bdcd8170SKalle Valo } else { 1462bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1463bdcd8170SKalle Valo } 1464bdcd8170SKalle Valo 1465bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1466bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1467bdcd8170SKalle Valo if (sgi) { 1468bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1469bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1470bdcd8170SKalle Valo } else { 1471bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1472bdcd8170SKalle Valo } 1473bdcd8170SKalle Valo 1474bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1475bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1476bdcd8170SKalle Valo } else { 14779a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 14789a730834SKalle Valo "invalid rate from stats: %d\n", rate); 14799a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1480bdcd8170SKalle Valo return 0; 1481bdcd8170SKalle Valo } 1482bdcd8170SKalle Valo 1483bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1484bdcd8170SKalle Valo 148559c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 148659c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1487f5938f24SVasanthakumar Thiagarajan vif->nw_type == INFRA_NETWORK) { 148832c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 148932c10874SJouni Malinen sinfo->bss_param.flags = 0; 149032c10874SJouni Malinen sinfo->bss_param.dtim_period = ar->assoc_bss_dtim_period; 149132c10874SJouni Malinen sinfo->bss_param.beacon_interval = ar->assoc_bss_beacon_int; 149232c10874SJouni Malinen } 149332c10874SJouni Malinen 1494bdcd8170SKalle Valo return 0; 1495bdcd8170SKalle Valo } 1496bdcd8170SKalle Valo 1497bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1498bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1499bdcd8170SKalle Valo { 1500bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1501bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1502bdcd8170SKalle Valo pmksa->pmkid, true); 1503bdcd8170SKalle Valo } 1504bdcd8170SKalle Valo 1505bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1506bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1507bdcd8170SKalle Valo { 1508bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1509bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1510bdcd8170SKalle Valo pmksa->pmkid, false); 1511bdcd8170SKalle Valo } 1512bdcd8170SKalle Valo 1513bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1514bdcd8170SKalle Valo { 1515bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 151659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 151759c98449SVasanthakumar Thiagarajan 151859c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 15198c8b65e3SVasanthakumar Thiagarajan return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->bssid, 15208c8b65e3SVasanthakumar Thiagarajan NULL, false); 1521bdcd8170SKalle Valo return 0; 1522bdcd8170SKalle Valo } 1523bdcd8170SKalle Valo 1524abcb344bSKalle Valo #ifdef CONFIG_PM 1525abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1526abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1527abcb344bSKalle Valo { 1528abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1529abcb344bSKalle Valo 1530abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1531abcb344bSKalle Valo } 1532aa6cffc1SChilam Ng 1533aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1534aa6cffc1SChilam Ng { 1535aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1536aa6cffc1SChilam Ng 1537aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1538aa6cffc1SChilam Ng } 1539abcb344bSKalle Valo #endif 1540abcb344bSKalle Valo 15416a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15426a7c9badSJouni Malinen struct ieee80211_channel *chan, 15436a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15446a7c9badSJouni Malinen { 15456a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15466a7c9badSJouni Malinen 15476a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15486a7c9badSJouni Malinen return -EIO; 15496a7c9badSJouni Malinen 15506a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15516a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15526a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15536a7c9badSJouni Malinen 15546a7c9badSJouni Malinen return 0; 15556a7c9badSJouni Malinen } 15566a7c9badSJouni Malinen 15578bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15588bdfbf40SJouni Malinen { 15598bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15608bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15618bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15628bdfbf40SJouni Malinen } 15638bdfbf40SJouni Malinen 15648bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15658bdfbf40SJouni Malinen size_t ies_len) 15668bdfbf40SJouni Malinen { 15678bdfbf40SJouni Malinen const u8 *pos; 15688bdfbf40SJouni Malinen u8 *buf = NULL; 15698bdfbf40SJouni Malinen size_t len = 0; 15708bdfbf40SJouni Malinen int ret; 15718bdfbf40SJouni Malinen 15728bdfbf40SJouni Malinen /* 15738bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15748bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15758bdfbf40SJouni Malinen */ 15768bdfbf40SJouni Malinen 15778bdfbf40SJouni Malinen if (ies && ies_len) { 15788bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15798bdfbf40SJouni Malinen if (buf == NULL) 15808bdfbf40SJouni Malinen return -ENOMEM; 15818bdfbf40SJouni Malinen pos = ies; 15828bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15838bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15848bdfbf40SJouni Malinen break; 15858bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15868bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15878bdfbf40SJouni Malinen len += 2 + pos[1]; 15888bdfbf40SJouni Malinen } 15898bdfbf40SJouni Malinen pos += 2 + pos[1]; 15908bdfbf40SJouni Malinen } 15918bdfbf40SJouni Malinen } 15928bdfbf40SJouni Malinen 15938bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15948bdfbf40SJouni Malinen buf, len); 15958bdfbf40SJouni Malinen kfree(buf); 15968bdfbf40SJouni Malinen return ret; 15978bdfbf40SJouni Malinen } 15988bdfbf40SJouni Malinen 15996a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 16006a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 16016a7c9badSJouni Malinen { 16026a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 16033450334fSVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 16046a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 16056a7c9badSJouni Malinen u8 *ies; 16066a7c9badSJouni Malinen int ies_len; 16076a7c9badSJouni Malinen struct wmi_connect_cmd p; 16086a7c9badSJouni Malinen int res; 16096a7c9badSJouni Malinen int i; 16106a7c9badSJouni Malinen 16116a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 16126a7c9badSJouni Malinen 16136a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 16146a7c9badSJouni Malinen return -EIO; 16156a7c9badSJouni Malinen 1616f5938f24SVasanthakumar Thiagarajan if (vif->next_mode != AP_NETWORK) 16176a7c9badSJouni Malinen return -EOPNOTSUPP; 16186a7c9badSJouni Malinen 16196a7c9badSJouni Malinen if (info->beacon_ies) { 16206a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 16216a7c9badSJouni Malinen info->beacon_ies, 16226a7c9badSJouni Malinen info->beacon_ies_len); 16236a7c9badSJouni Malinen if (res) 16246a7c9badSJouni Malinen return res; 16256a7c9badSJouni Malinen } 16266a7c9badSJouni Malinen if (info->proberesp_ies) { 16278bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 16286a7c9badSJouni Malinen info->proberesp_ies_len); 16296a7c9badSJouni Malinen if (res) 16306a7c9badSJouni Malinen return res; 16316a7c9badSJouni Malinen } 16326a7c9badSJouni Malinen if (info->assocresp_ies) { 16336a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 16346a7c9badSJouni Malinen info->assocresp_ies, 16356a7c9badSJouni Malinen info->assocresp_ies_len); 16366a7c9badSJouni Malinen if (res) 16376a7c9badSJouni Malinen return res; 16386a7c9badSJouni Malinen } 16396a7c9badSJouni Malinen 16406a7c9badSJouni Malinen if (!add) 16416a7c9badSJouni Malinen return 0; 16426a7c9badSJouni Malinen 16439a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16449a5b1318SJouni Malinen 16456a7c9badSJouni Malinen /* TODO: 16466a7c9badSJouni Malinen * info->interval 16476a7c9badSJouni Malinen * info->dtim_period 16486a7c9badSJouni Malinen */ 16496a7c9badSJouni Malinen 16506a7c9badSJouni Malinen if (info->head == NULL) 16516a7c9badSJouni Malinen return -EINVAL; 16526a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16536a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16546a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16556a7c9badSJouni Malinen return -EINVAL; 16566a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16576a7c9badSJouni Malinen 16586a7c9badSJouni Malinen if (info->ssid == NULL) 16596a7c9badSJouni Malinen return -EINVAL; 16603450334fSVasanthakumar Thiagarajan memcpy(vif->ssid, info->ssid, info->ssid_len); 16613450334fSVasanthakumar Thiagarajan vif->ssid_len = info->ssid_len; 16626a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16636a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16646a7c9badSJouni Malinen 16653450334fSVasanthakumar Thiagarajan vif->dot11_auth_mode = OPEN_AUTH; 16666a7c9badSJouni Malinen 16676a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16686a7c9badSJouni Malinen 16696a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16706a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16716a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16726a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16736a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16746a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16756a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16766a7c9badSJouni Malinen break; 16776a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16786a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16796a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16806a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16816a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16826a7c9badSJouni Malinen break; 16836a7c9badSJouni Malinen } 16846a7c9badSJouni Malinen } 16856a7c9badSJouni Malinen if (p.auth_mode == 0) 16866a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16873450334fSVasanthakumar Thiagarajan vif->auth_mode = p.auth_mode; 16886a7c9badSJouni Malinen 16896a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16906a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16916a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16926a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16936a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16946a7c9badSJouni Malinen break; 16956a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16966a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16976a7c9badSJouni Malinen break; 16986a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16996a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 17006a7c9badSJouni Malinen break; 17016a7c9badSJouni Malinen } 17026a7c9badSJouni Malinen } 1703229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 17046a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1705229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1706229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1707229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 17086a7c9badSJouni Malinen 17096a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 17106a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 17116a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 17126a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 17136a7c9badSJouni Malinen break; 17146a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 17156a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 17166a7c9badSJouni Malinen break; 17176a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 17186a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 17196a7c9badSJouni Malinen break; 17206a7c9badSJouni Malinen default: 17216a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 17226a7c9badSJouni Malinen break; 17236a7c9badSJouni Malinen } 1724229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 17256a7c9badSJouni Malinen 17266a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 1727f5938f24SVasanthakumar Thiagarajan vif->nw_type = vif->next_mode; 17286a7c9badSJouni Malinen 17293450334fSVasanthakumar Thiagarajan p.ssid_len = vif->ssid_len; 17303450334fSVasanthakumar Thiagarajan memcpy(p.ssid, vif->ssid, vif->ssid_len); 17313450334fSVasanthakumar Thiagarajan p.dot11_auth_mode = vif->dot11_auth_mode; 17326a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 17336a7c9badSJouni Malinen 17349a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 17359a5b1318SJouni Malinen if (res < 0) 17369a5b1318SJouni Malinen return res; 17379a5b1318SJouni Malinen 17389a5b1318SJouni Malinen return 0; 17396a7c9badSJouni Malinen } 17406a7c9badSJouni Malinen 17416a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17426a7c9badSJouni Malinen struct beacon_parameters *info) 17436a7c9badSJouni Malinen { 17446a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17456a7c9badSJouni Malinen } 17466a7c9badSJouni Malinen 17476a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17486a7c9badSJouni Malinen struct beacon_parameters *info) 17496a7c9badSJouni Malinen { 17506a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17516a7c9badSJouni Malinen } 17526a7c9badSJouni Malinen 17536a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17546a7c9badSJouni Malinen { 17556a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 175659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17576a7c9badSJouni Malinen 1758f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 17596a7c9badSJouni Malinen return -EOPNOTSUPP; 176059c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 17616a7c9badSJouni Malinen return -ENOTCONN; 17626a7c9badSJouni Malinen 17636a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 176459c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 17656a7c9badSJouni Malinen 17666a7c9badSJouni Malinen return 0; 17676a7c9badSJouni Malinen } 17686a7c9badSJouni Malinen 176923875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 177023875136SJouni Malinen u8 *mac, struct station_parameters *params) 177123875136SJouni Malinen { 177223875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1773f5938f24SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 177423875136SJouni Malinen 1775f5938f24SVasanthakumar Thiagarajan if (vif->nw_type != AP_NETWORK) 177623875136SJouni Malinen return -EOPNOTSUPP; 177723875136SJouni Malinen 177823875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 177923875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 178023875136SJouni Malinen return -EOPNOTSUPP; 178123875136SJouni Malinen 178223875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 178323875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 178423875136SJouni Malinen mac, 0); 178523875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 178623875136SJouni Malinen 0); 178723875136SJouni Malinen } 178823875136SJouni Malinen 178963fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 179063fa1e0cSJouni Malinen struct net_device *dev, 179163fa1e0cSJouni Malinen struct ieee80211_channel *chan, 179263fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 179363fa1e0cSJouni Malinen unsigned int duration, 179463fa1e0cSJouni Malinen u64 *cookie) 179563fa1e0cSJouni Malinen { 179663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 179763fa1e0cSJouni Malinen 179863fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 179963fa1e0cSJouni Malinen * return -EBUSY */ 180063fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 180163fa1e0cSJouni Malinen 180263fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 180363fa1e0cSJouni Malinen duration); 180463fa1e0cSJouni Malinen } 180563fa1e0cSJouni Malinen 180663fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 180763fa1e0cSJouni Malinen struct net_device *dev, 180863fa1e0cSJouni Malinen u64 cookie) 180963fa1e0cSJouni Malinen { 181063fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 181163fa1e0cSJouni Malinen 181263fa1e0cSJouni Malinen if (cookie != 1) 181363fa1e0cSJouni Malinen return -ENOENT; 181463fa1e0cSJouni Malinen 181563fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 181663fa1e0cSJouni Malinen } 181763fa1e0cSJouni Malinen 18188bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 18198bdfbf40SJouni Malinen size_t len, unsigned int freq) 18208bdfbf40SJouni Malinen { 18218bdfbf40SJouni Malinen const u8 *pos; 18228bdfbf40SJouni Malinen u8 *p2p; 18238bdfbf40SJouni Malinen int p2p_len; 18248bdfbf40SJouni Malinen int ret; 18258bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18268bdfbf40SJouni Malinen 18278bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18288bdfbf40SJouni Malinen 18298bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 18308bdfbf40SJouni Malinen 18318bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 18328bdfbf40SJouni Malinen if (p2p == NULL) 18338bdfbf40SJouni Malinen return -ENOMEM; 18348bdfbf40SJouni Malinen p2p_len = 0; 18358bdfbf40SJouni Malinen 18368bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 18378bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 18388bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 18398bdfbf40SJouni Malinen break; 18408bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 18418bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 18428bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 18438bdfbf40SJouni Malinen } 18448bdfbf40SJouni Malinen pos += 2 + pos[1]; 18458bdfbf40SJouni Malinen } 18468bdfbf40SJouni Malinen 18478bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18488bdfbf40SJouni Malinen p2p, p2p_len); 18498bdfbf40SJouni Malinen kfree(p2p); 18508bdfbf40SJouni Malinen return ret; 18518bdfbf40SJouni Malinen } 18528bdfbf40SJouni Malinen 18538a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18548a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18558a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18568a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1857e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1858e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 18598a6c8060SJouni Malinen { 18608a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 186159c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18628a6c8060SJouni Malinen u32 id; 18638bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18648bdfbf40SJouni Malinen 18658bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18668bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 1867f5938f24SVasanthakumar Thiagarajan vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 18688bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18698bdfbf40SJouni Malinen /* 18708bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18718bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18728bdfbf40SJouni Malinen */ 18738bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18748bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18758bdfbf40SJouni Malinen chan->center_freq); 18768bdfbf40SJouni Malinen } 18778a6c8060SJouni Malinen 18788a6c8060SJouni Malinen id = ar->send_action_id++; 18798a6c8060SJouni Malinen if (id == 0) { 18808a6c8060SJouni Malinen /* 18818a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18828a6c8060SJouni Malinen * used for the command. 18838a6c8060SJouni Malinen */ 18848a6c8060SJouni Malinen id = ar->send_action_id++; 18858a6c8060SJouni Malinen } 18868a6c8060SJouni Malinen 18878a6c8060SJouni Malinen *cookie = id; 18888a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18898a6c8060SJouni Malinen buf, len); 18908a6c8060SJouni Malinen } 18918a6c8060SJouni Malinen 1892ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1893ae32c30aSJouni Malinen struct net_device *dev, 1894ae32c30aSJouni Malinen u16 frame_type, bool reg) 1895ae32c30aSJouni Malinen { 1896ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1897ae32c30aSJouni Malinen 1898ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1899ae32c30aSJouni Malinen __func__, frame_type, reg); 1900ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1901ae32c30aSJouni Malinen /* 1902ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1903ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1904ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1905ae32c30aSJouni Malinen */ 1906ae32c30aSJouni Malinen ar->probe_req_report = reg; 1907ae32c30aSJouni Malinen } 1908ae32c30aSJouni Malinen } 1909ae32c30aSJouni Malinen 1910f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1911f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1912f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1913f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1914f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1915f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1916f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1917f80574aeSJouni Malinen }, 1918f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1919f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1920f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1921f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1922f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1923f80574aeSJouni Malinen }, 1924f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1925f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1926f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1927f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1928f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1929f80574aeSJouni Malinen }, 1930f80574aeSJouni Malinen }; 1931f80574aeSJouni Malinen 1932bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1933bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1934bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1935bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1936bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1937bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1938bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1939bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1940bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1941bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1942bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1943bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1944bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1945bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1946bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1947bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1948bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1949bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1950bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1951003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 1952abcb344bSKalle Valo #ifdef CONFIG_PM 1953abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1954aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 1955abcb344bSKalle Valo #endif 19566a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19576a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19586a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19596a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 196023875136SJouni Malinen .change_station = ath6kl_change_station, 196163fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 196263fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19638a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1964ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1965bdcd8170SKalle Valo }; 1966bdcd8170SKalle Valo 19678dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 1968bdcd8170SKalle Valo { 19696bbc7c35SJouni Malinen struct ath6kl *ar; 1970be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 19718dafb70eSVasanthakumar Thiagarajan u8 ctr; 1972bdcd8170SKalle Valo 1973bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1974be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 19758dafb70eSVasanthakumar Thiagarajan 1976be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 1977bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1978bdcd8170SKalle Valo return NULL; 1979bdcd8170SKalle Valo } 1980bdcd8170SKalle Valo 1981be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 19826bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 1983be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 19848dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 19858dafb70eSVasanthakumar Thiagarajan 19868dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 19878dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 19888dafb70eSVasanthakumar Thiagarajan 19898dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 19908dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 19918dafb70eSVasanthakumar Thiagarajan 19928dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 19938dafb70eSVasanthakumar Thiagarajan 19948dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 19958dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 19968dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 19978dafb70eSVasanthakumar Thiagarajan 19988dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 19998dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 20008dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 20018dafb70eSVasanthakumar Thiagarajan 20028dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 20038dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 20048dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 20058dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 20068dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 20078dafb70eSVasanthakumar Thiagarajan 20088dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 20098dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 20108dafb70eSVasanthakumar Thiagarajan 20118dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 20128dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 20138dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 20148dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 20158dafb70eSVasanthakumar Thiagarajan } 20168dafb70eSVasanthakumar Thiagarajan 20178dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 20188dafb70eSVasanthakumar Thiagarajan 20198dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 20208dafb70eSVasanthakumar Thiagarajan 20218dafb70eSVasanthakumar Thiagarajan return ar; 20228dafb70eSVasanthakumar Thiagarajan } 20238dafb70eSVasanthakumar Thiagarajan 20248dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 20258dafb70eSVasanthakumar Thiagarajan { 20268dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 20278dafb70eSVasanthakumar Thiagarajan int ret; 20286bbc7c35SJouni Malinen 2029be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2030f80574aeSJouni Malinen 2031be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 203263fa1e0cSJouni Malinen 2033bdcd8170SKalle Valo /* set device pointer for wiphy */ 20348dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2035bdcd8170SKalle Valo 2036be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 20378dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 20388dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 20396bbc7c35SJouni Malinen if (ar->p2p) { 2040be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 20416bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 20426bbc7c35SJouni Malinen } 20438dafb70eSVasanthakumar Thiagarajan 2044bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2045be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2046be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2047be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2048be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2049be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2050bdcd8170SKalle Valo 2051be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2052be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2053bdcd8170SKalle Valo 2054be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2055bdcd8170SKalle Valo if (ret < 0) { 2056bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 20578dafb70eSVasanthakumar Thiagarajan return ret; 20588dafb70eSVasanthakumar Thiagarajan } 20598dafb70eSVasanthakumar Thiagarajan 20608dafb70eSVasanthakumar Thiagarajan return 0; 20618dafb70eSVasanthakumar Thiagarajan } 20628dafb70eSVasanthakumar Thiagarajan 2063108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 20648dafb70eSVasanthakumar Thiagarajan { 2065108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2066108438bcSVasanthakumar Thiagarajan 20672132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = aggr_init(vif->ndev); 20682132c69cSVasanthakumar Thiagarajan if (!vif->aggr_cntxt) { 20698dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 20708dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 20718dafb70eSVasanthakumar Thiagarajan } 20728dafb70eSVasanthakumar Thiagarajan 20738dafb70eSVasanthakumar Thiagarajan setup_timer(&ar->disconnect_timer, disconnect_timer_handler, 2074108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 20758dafb70eSVasanthakumar Thiagarajan 20768dafb70eSVasanthakumar Thiagarajan return 0; 20778dafb70eSVasanthakumar Thiagarajan } 20788dafb70eSVasanthakumar Thiagarajan 2079108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 20808dafb70eSVasanthakumar Thiagarajan { 20812132c69cSVasanthakumar Thiagarajan aggr_module_destroy(vif->aggr_cntxt); 2082108438bcSVasanthakumar Thiagarajan 20832132c69cSVasanthakumar Thiagarajan vif->aggr_cntxt = NULL; 20848dafb70eSVasanthakumar Thiagarajan 208559c98449SVasanthakumar Thiagarajan if (test_bit(NETDEV_REGISTERED, &vif->flags)) { 2086108438bcSVasanthakumar Thiagarajan unregister_netdev(vif->ndev); 208759c98449SVasanthakumar Thiagarajan clear_bit(NETDEV_REGISTERED, &vif->flags); 20888dafb70eSVasanthakumar Thiagarajan } 20898dafb70eSVasanthakumar Thiagarajan 2090108438bcSVasanthakumar Thiagarajan free_netdev(vif->ndev); 20918dafb70eSVasanthakumar Thiagarajan } 20928dafb70eSVasanthakumar Thiagarajan 20938dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 20948dafb70eSVasanthakumar Thiagarajan enum nl80211_iftype type) 20958dafb70eSVasanthakumar Thiagarajan { 20968dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2097108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 20988dafb70eSVasanthakumar Thiagarajan 2099108438bcSVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), "wlan%d", ether_setup); 21008dafb70eSVasanthakumar Thiagarajan if (!ndev) 21018dafb70eSVasanthakumar Thiagarajan return NULL; 21028dafb70eSVasanthakumar Thiagarajan 2103108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2104108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2105108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2106108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2107108438bcSVasanthakumar Thiagarajan ar->vif = vif; 2108108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2109108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2110108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2111108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2112108438bcSVasanthakumar Thiagarajan ar->wdev = &vif->wdev; 21138dafb70eSVasanthakumar Thiagarajan ar->net_dev = ndev; 21148dafb70eSVasanthakumar Thiagarajan 21158dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 21168dafb70eSVasanthakumar Thiagarajan 21178dafb70eSVasanthakumar Thiagarajan ath6kl_init_control_info(ar); 21188dafb70eSVasanthakumar Thiagarajan 21198dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2120108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 21218dafb70eSVasanthakumar Thiagarajan goto err; 21228dafb70eSVasanthakumar Thiagarajan 21238dafb70eSVasanthakumar Thiagarajan if (register_netdev(ndev)) 21248dafb70eSVasanthakumar Thiagarajan goto err; 21258dafb70eSVasanthakumar Thiagarajan 21268dafb70eSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 212759c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 21288dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 212959c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 21308dafb70eSVasanthakumar Thiagarajan 21318dafb70eSVasanthakumar Thiagarajan return ndev; 21328dafb70eSVasanthakumar Thiagarajan 21338dafb70eSVasanthakumar Thiagarajan err: 2134108438bcSVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 21358dafb70eSVasanthakumar Thiagarajan 2136bdcd8170SKalle Valo return NULL; 2137bdcd8170SKalle Valo } 2138bdcd8170SKalle Valo 21398dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2140bdcd8170SKalle Valo { 2141bdcd8170SKalle Valo if (ar->scan_req) { 2142bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 2143bdcd8170SKalle Valo ar->scan_req = NULL; 2144bdcd8170SKalle Valo } 2145bdcd8170SKalle Valo 2146be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2147be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2148bdcd8170SKalle Valo } 2149