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 { 129bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 130bdcd8170SKalle Valo 131bdcd8170SKalle Valo if (!wpa_version) { 132bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 133bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 134bdcd8170SKalle Valo ar->auth_mode = WPA2_AUTH; 135bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 136bdcd8170SKalle Valo ar->auth_mode = WPA_AUTH; 137bdcd8170SKalle Valo } else { 138bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 139bdcd8170SKalle Valo return -ENOTSUPP; 140bdcd8170SKalle Valo } 141bdcd8170SKalle Valo 142bdcd8170SKalle Valo return 0; 143bdcd8170SKalle Valo } 144bdcd8170SKalle Valo 145bdcd8170SKalle Valo static int ath6kl_set_auth_type(struct ath6kl *ar, 146bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 147bdcd8170SKalle Valo { 148bdcd8170SKalle Valo 149bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 150bdcd8170SKalle Valo 151bdcd8170SKalle Valo switch (auth_type) { 152bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 153bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 154bdcd8170SKalle Valo break; 155bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 156bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 157bdcd8170SKalle Valo break; 158bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 159bdcd8170SKalle Valo ar->dot11_auth_mode = LEAP_AUTH; 160bdcd8170SKalle Valo break; 161bdcd8170SKalle Valo 162bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 163ac59a2b2SVasanthakumar Thiagarajan ar->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 164bdcd8170SKalle Valo break; 165bdcd8170SKalle Valo 166bdcd8170SKalle Valo default: 167bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 168bdcd8170SKalle Valo return -ENOTSUPP; 169bdcd8170SKalle Valo } 170bdcd8170SKalle Valo 171bdcd8170SKalle Valo return 0; 172bdcd8170SKalle Valo } 173bdcd8170SKalle Valo 174bdcd8170SKalle Valo static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast) 175bdcd8170SKalle Valo { 176bdcd8170SKalle Valo u8 *ar_cipher = ucast ? &ar->prwise_crypto : &ar->grp_crypto; 17738acde3cSEdward Lu u8 *ar_cipher_len = ucast ? &ar->prwise_crypto_len : 17838acde3cSEdward Lu &ar->grp_crypto_len; 179bdcd8170SKalle Valo 180bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 181bdcd8170SKalle Valo __func__, cipher, ucast); 182bdcd8170SKalle Valo 183bdcd8170SKalle Valo switch (cipher) { 184bdcd8170SKalle Valo case 0: 185bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 186bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 187bdcd8170SKalle Valo *ar_cipher_len = 0; 188bdcd8170SKalle Valo break; 189bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 190bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 191bdcd8170SKalle Valo *ar_cipher_len = 5; 192bdcd8170SKalle Valo break; 193bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 194bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 195bdcd8170SKalle Valo *ar_cipher_len = 13; 196bdcd8170SKalle Valo break; 197bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 198bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 199bdcd8170SKalle Valo *ar_cipher_len = 0; 200bdcd8170SKalle Valo break; 201bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 202bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 203bdcd8170SKalle Valo *ar_cipher_len = 0; 204bdcd8170SKalle Valo break; 205bdcd8170SKalle Valo default: 206bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 207bdcd8170SKalle Valo return -ENOTSUPP; 208bdcd8170SKalle Valo } 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo return 0; 211bdcd8170SKalle Valo } 212bdcd8170SKalle Valo 213bdcd8170SKalle Valo static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt) 214bdcd8170SKalle Valo { 215bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 216bdcd8170SKalle Valo 217bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 218bdcd8170SKalle Valo if (ar->auth_mode == WPA_AUTH) 219bdcd8170SKalle Valo ar->auth_mode = WPA_PSK_AUTH; 220bdcd8170SKalle Valo else if (ar->auth_mode == WPA2_AUTH) 221bdcd8170SKalle Valo ar->auth_mode = WPA2_PSK_AUTH; 222837cb97eSJouni Malinen } else if (key_mgmt == 0x00409600) { 223837cb97eSJouni Malinen if (ar->auth_mode == WPA_AUTH) 224837cb97eSJouni Malinen ar->auth_mode = WPA_AUTH_CCKM; 225837cb97eSJouni Malinen else if (ar->auth_mode == WPA2_AUTH) 226837cb97eSJouni Malinen ar->auth_mode = WPA2_AUTH_CCKM; 227bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 228bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 229bdcd8170SKalle Valo } 230bdcd8170SKalle Valo } 231bdcd8170SKalle Valo 232bdcd8170SKalle Valo static bool ath6kl_cfg80211_ready(struct ath6kl *ar) 233bdcd8170SKalle Valo { 23459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 23559c98449SVasanthakumar Thiagarajan 236bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 237bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 238bdcd8170SKalle Valo return false; 239bdcd8170SKalle Valo } 240bdcd8170SKalle Valo 24159c98449SVasanthakumar Thiagarajan if (!test_bit(WLAN_ENABLED, &vif->flags)) { 242bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 243bdcd8170SKalle Valo return false; 244bdcd8170SKalle Valo } 245bdcd8170SKalle Valo 246bdcd8170SKalle Valo return true; 247bdcd8170SKalle Valo } 248bdcd8170SKalle Valo 2496981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2506981ffdcSKevin Fang { 2516981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2526981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2536981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2546981ffdcSKevin Fang } 2556981ffdcSKevin Fang 2566981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2576981ffdcSKevin Fang { 2586981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2596981ffdcSKevin Fang } 2606981ffdcSKevin Fang 2616981ffdcSKevin Fang static int ath6kl_set_assoc_req_ies(struct ath6kl *ar, const u8 *ies, 2626981ffdcSKevin Fang size_t ies_len) 2636981ffdcSKevin Fang { 2646981ffdcSKevin Fang const u8 *pos; 2656981ffdcSKevin Fang u8 *buf = NULL; 2666981ffdcSKevin Fang size_t len = 0; 2676981ffdcSKevin Fang int ret; 2686981ffdcSKevin Fang 2696981ffdcSKevin Fang /* 2706981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2716981ffdcSKevin Fang */ 2726981ffdcSKevin Fang 2736981ffdcSKevin Fang if (ies && ies_len) { 2746981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2756981ffdcSKevin Fang if (buf == NULL) 2766981ffdcSKevin Fang return -ENOMEM; 2776981ffdcSKevin Fang pos = ies; 2786981ffdcSKevin Fang 2796981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 2806981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 2816981ffdcSKevin Fang break; 2826981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 2836981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 2846981ffdcSKevin Fang len += 2 + pos[1]; 2856981ffdcSKevin Fang } 2866981ffdcSKevin Fang pos += 2 + pos[1]; 2876981ffdcSKevin Fang } 2886981ffdcSKevin Fang } 2896981ffdcSKevin Fang 2906981ffdcSKevin Fang ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_REQ, 2916981ffdcSKevin Fang buf, len); 2926981ffdcSKevin Fang kfree(buf); 2936981ffdcSKevin Fang return ret; 2946981ffdcSKevin Fang } 2956981ffdcSKevin Fang 296bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 297bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 298bdcd8170SKalle Valo { 299bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 30059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 301bdcd8170SKalle Valo int status; 302bdcd8170SKalle Valo 303bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 304bdcd8170SKalle Valo 305bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 306bdcd8170SKalle Valo return -EIO; 307bdcd8170SKalle Valo 308bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 309bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 310bdcd8170SKalle Valo return -EBUSY; 311bdcd8170SKalle Valo } 312bdcd8170SKalle Valo 313bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 314bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 315bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 316bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 317bdcd8170SKalle Valo return -EINVAL; 318bdcd8170SKalle Valo } 319bdcd8170SKalle Valo 320bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 321bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 322bdcd8170SKalle Valo return -ERESTARTSYS; 323bdcd8170SKalle Valo } 324bdcd8170SKalle Valo 325bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 326bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 327bdcd8170SKalle Valo up(&ar->sem); 328bdcd8170SKalle Valo return -EBUSY; 329bdcd8170SKalle Valo } 330bdcd8170SKalle Valo 331bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 332bdcd8170SKalle Valo /* 333bdcd8170SKalle Valo * sleep until the command queue drains 334bdcd8170SKalle Valo */ 335bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 336bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 337bdcd8170SKalle Valo WMI_TIMEOUT); 338bdcd8170SKalle Valo if (signal_pending(current)) { 339bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 340bdcd8170SKalle Valo up(&ar->sem); 341bdcd8170SKalle Valo return -EINTR; 342bdcd8170SKalle Valo } 343bdcd8170SKalle Valo } 344bdcd8170SKalle Valo 3456981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 3466981ffdcSKevin Fang status = ath6kl_set_assoc_req_ies(ar, sme->ie, sme->ie_len); 3476981ffdcSKevin Fang if (status) 3486981ffdcSKevin Fang return status; 3496981ffdcSKevin Fang } 3506981ffdcSKevin Fang 35159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 352bdcd8170SKalle Valo ar->ssid_len == sme->ssid_len && 353bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 354bdcd8170SKalle Valo ar->reconnect_flag = true; 355bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 356bdcd8170SKalle Valo ar->ch_hint); 357bdcd8170SKalle Valo 358bdcd8170SKalle Valo up(&ar->sem); 359bdcd8170SKalle Valo if (status) { 360bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 361bdcd8170SKalle Valo return -EIO; 362bdcd8170SKalle Valo } 363bdcd8170SKalle Valo return 0; 364bdcd8170SKalle Valo } else if (ar->ssid_len == sme->ssid_len && 365bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 366bdcd8170SKalle Valo ath6kl_disconnect(ar); 367bdcd8170SKalle Valo } 368bdcd8170SKalle Valo 369bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 370bdcd8170SKalle Valo ar->ssid_len = sme->ssid_len; 371bdcd8170SKalle Valo memcpy(ar->ssid, sme->ssid, sme->ssid_len); 372bdcd8170SKalle Valo 373bdcd8170SKalle Valo if (sme->channel) 374bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 375bdcd8170SKalle Valo 376bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 377bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 378bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 379bdcd8170SKalle Valo 380bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 381bdcd8170SKalle Valo 382bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 383bdcd8170SKalle Valo if (status) { 384bdcd8170SKalle Valo up(&ar->sem); 385bdcd8170SKalle Valo return status; 386bdcd8170SKalle Valo } 387bdcd8170SKalle Valo 388bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 389bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 390bdcd8170SKalle Valo else 391bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 392bdcd8170SKalle Valo 393bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 394bdcd8170SKalle Valo 395bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 396bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 397bdcd8170SKalle Valo 398bdcd8170SKalle Valo if ((sme->key_len) && 399bdcd8170SKalle Valo (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) { 400bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 401bdcd8170SKalle Valo 402bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 403bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 404bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 405bdcd8170SKalle Valo sme->key_idx); 406bdcd8170SKalle Valo up(&ar->sem); 407bdcd8170SKalle Valo return -ENOENT; 408bdcd8170SKalle Valo } 409bdcd8170SKalle Valo 410bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 411bdcd8170SKalle Valo key->key_len = sme->key_len; 412bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 413bdcd8170SKalle Valo key->cipher = ar->prwise_crypto; 414bdcd8170SKalle Valo ar->def_txkey_index = sme->key_idx; 415bdcd8170SKalle Valo 416bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 417bdcd8170SKalle Valo ar->prwise_crypto, 418bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 419bdcd8170SKalle Valo key->key_len, 420bdcd8170SKalle Valo NULL, 421bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 422bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 423bdcd8170SKalle Valo } 424bdcd8170SKalle Valo 425bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 42659c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 427bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 428bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 429bdcd8170SKalle Valo up(&ar->sem); 430bdcd8170SKalle Valo return -EIO; 431bdcd8170SKalle Valo } 432bdcd8170SKalle Valo } 433bdcd8170SKalle Valo 434bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 435bdcd8170SKalle Valo 436bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 437bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 438bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 439bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 440bdcd8170SKalle Valo __func__, 441bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 442bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 44338acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 444bdcd8170SKalle Valo 445bdcd8170SKalle Valo ar->reconnect_flag = 0; 446bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 447bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 448bdcd8170SKalle Valo ar->prwise_crypto, 449bdcd8170SKalle Valo ar->prwise_crypto_len, 45038acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 451bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 452bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 453bdcd8170SKalle Valo ar->connect_ctrl_flags); 454bdcd8170SKalle Valo 455bdcd8170SKalle Valo up(&ar->sem); 456bdcd8170SKalle Valo 457bdcd8170SKalle Valo if (status == -EINVAL) { 458bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 459bdcd8170SKalle Valo ar->ssid_len = 0; 460bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 461bdcd8170SKalle Valo return -ENOENT; 462bdcd8170SKalle Valo } else if (status) { 463bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 464bdcd8170SKalle Valo return -EIO; 465bdcd8170SKalle Valo } 466bdcd8170SKalle Valo 467bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 468bdcd8170SKalle Valo ((ar->auth_mode == WPA_PSK_AUTH) 469bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH))) { 470bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 471bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 472bdcd8170SKalle Valo } 473bdcd8170SKalle Valo 474bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 47559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 476bdcd8170SKalle Valo 477bdcd8170SKalle Valo return 0; 478bdcd8170SKalle Valo } 479bdcd8170SKalle Valo 48001cac476SJouni Malinen static int ath6kl_add_bss_if_needed(struct ath6kl *ar, const u8 *bssid, 48101cac476SJouni Malinen struct ieee80211_channel *chan, 48201cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 48301cac476SJouni Malinen { 48401cac476SJouni Malinen struct cfg80211_bss *bss; 48501cac476SJouni Malinen u8 *ie; 48601cac476SJouni Malinen 487be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 48801cac476SJouni Malinen ar->ssid, ar->ssid_len, WLAN_CAPABILITY_ESS, 48901cac476SJouni Malinen WLAN_CAPABILITY_ESS); 49001cac476SJouni Malinen if (bss == NULL) { 49101cac476SJouni Malinen /* 49201cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 49301cac476SJouni Malinen * generate a partial entry until the first BSS info 49401cac476SJouni Malinen * event becomes available. 49501cac476SJouni Malinen * 49601cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 49701cac476SJouni Malinen * IEs from the target. 49801cac476SJouni Malinen */ 49901cac476SJouni Malinen ie = kmalloc(2 + ar->ssid_len + beacon_ie_len, GFP_KERNEL); 50001cac476SJouni Malinen if (ie == NULL) 50101cac476SJouni Malinen return -ENOMEM; 50201cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 50301cac476SJouni Malinen ie[1] = ar->ssid_len; 50401cac476SJouni Malinen memcpy(ie + 2, ar->ssid, ar->ssid_len); 50501cac476SJouni Malinen memcpy(ie + 2 + ar->ssid_len, beacon_ie, beacon_ie_len); 506be98e3a4SVasanthakumar Thiagarajan bss = cfg80211_inform_bss(ar->wiphy, chan, 50701cac476SJouni Malinen bssid, 0, WLAN_CAPABILITY_ESS, 100, 50801cac476SJouni Malinen ie, 2 + ar->ssid_len + beacon_ie_len, 50901cac476SJouni Malinen 0, GFP_KERNEL); 51001cac476SJouni Malinen if (bss) 51101cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for " 51201cac476SJouni Malinen "%pM prior to indicating connect/roamed " 51301cac476SJouni Malinen "event\n", bssid); 51401cac476SJouni Malinen kfree(ie); 51501cac476SJouni Malinen } else 51601cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 51701cac476SJouni Malinen "entry\n"); 51801cac476SJouni Malinen 51901cac476SJouni Malinen if (bss == NULL) 52001cac476SJouni Malinen return -ENOMEM; 52101cac476SJouni Malinen 52201cac476SJouni Malinen cfg80211_put_bss(bss); 52301cac476SJouni Malinen 52401cac476SJouni Malinen return 0; 52501cac476SJouni Malinen } 52601cac476SJouni Malinen 527bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 528bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 529bdcd8170SKalle Valo u16 beacon_intvl, 530bdcd8170SKalle Valo enum network_type nw_type, 531bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 532bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 533bdcd8170SKalle Valo { 53401cac476SJouni Malinen struct ieee80211_channel *chan; 53559c98449SVasanthakumar Thiagarajan /* TODO: Findout vif */ 53659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 537bdcd8170SKalle Valo 538bdcd8170SKalle Valo /* capinfo + listen interval */ 539bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 540bdcd8170SKalle Valo 541bdcd8170SKalle Valo /* capinfo + status code + associd */ 542bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 543bdcd8170SKalle Valo 544bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 545bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 546bdcd8170SKalle Valo assoc_resp_ie_offset; 547bdcd8170SKalle Valo 548bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 549bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 550bdcd8170SKalle Valo 55132c10874SJouni Malinen /* 55232c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 55332c10874SJouni Malinen * a Beacon frame from the AP is seen. 55432c10874SJouni Malinen */ 55532c10874SJouni Malinen ar->assoc_bss_beacon_int = beacon_intvl; 55659c98449SVasanthakumar Thiagarajan clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 55732c10874SJouni Malinen 558bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 559bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 560bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 561bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 562bdcd8170SKalle Valo return; 563bdcd8170SKalle Valo } 564bdcd8170SKalle Valo } 565bdcd8170SKalle Valo 566bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 5676b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 5686b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 569bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 570bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 571bdcd8170SKalle Valo return; 572bdcd8170SKalle Valo } 573bdcd8170SKalle Valo } 574bdcd8170SKalle Valo 575be98e3a4SVasanthakumar Thiagarajan chan = ieee80211_get_channel(ar->wiphy, (int) channel); 576bdcd8170SKalle Valo 577bdcd8170SKalle Valo 578bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 579bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 580bdcd8170SKalle Valo return; 581bdcd8170SKalle Valo } 582bdcd8170SKalle Valo 58301cac476SJouni Malinen if (ath6kl_add_bss_if_needed(ar, bssid, chan, assoc_info, 58401cac476SJouni Malinen beacon_ie_len) < 0) { 58501cac476SJouni Malinen ath6kl_err("could not add cfg80211 bss entry for " 58601cac476SJouni Malinen "connect/roamed notification\n"); 58701cac476SJouni Malinen return; 58801cac476SJouni Malinen } 58901cac476SJouni Malinen 5909aa60357SRaja Mani if (ar->sme_state == SME_CONNECTING) { 591bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 5929aa60357SRaja Mani ar->sme_state = SME_CONNECTED; 593bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 594bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 595bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 596bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 5979aa60357SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 598bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 59901cac476SJouni Malinen cfg80211_roamed(ar->net_dev, chan, bssid, 600bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 601bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 602bdcd8170SKalle Valo } 603bdcd8170SKalle Valo } 604bdcd8170SKalle Valo 605bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 606bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 607bdcd8170SKalle Valo { 608bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 609bdcd8170SKalle Valo 610bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 611bdcd8170SKalle Valo reason_code); 612bdcd8170SKalle Valo 613bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 614bdcd8170SKalle Valo return -EIO; 615bdcd8170SKalle Valo 616bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 617bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 618bdcd8170SKalle Valo return -EBUSY; 619bdcd8170SKalle Valo } 620bdcd8170SKalle Valo 621bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 622bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 623bdcd8170SKalle Valo return -ERESTARTSYS; 624bdcd8170SKalle Valo } 625bdcd8170SKalle Valo 626bdcd8170SKalle Valo ar->reconnect_flag = 0; 627bdcd8170SKalle Valo ath6kl_disconnect(ar); 628bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 629bdcd8170SKalle Valo ar->ssid_len = 0; 630bdcd8170SKalle Valo 631bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 632bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 633bdcd8170SKalle Valo 634bdcd8170SKalle Valo up(&ar->sem); 635bdcd8170SKalle Valo 636170826ddSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 637170826ddSVasanthakumar Thiagarajan 638bdcd8170SKalle Valo return 0; 639bdcd8170SKalle Valo } 640bdcd8170SKalle Valo 641bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 642bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 643bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 644bdcd8170SKalle Valo { 64559c98449SVasanthakumar Thiagarajan /* TODO: Findout vif */ 64659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 64759c98449SVasanthakumar Thiagarajan 648bdcd8170SKalle Valo if (ar->scan_req) { 649bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 650bdcd8170SKalle Valo ar->scan_req = NULL; 651bdcd8170SKalle Valo } 652bdcd8170SKalle Valo 653bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 654bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 655bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 656bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 657bdcd8170SKalle Valo return; 658bdcd8170SKalle Valo } 659bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 660bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 661bdcd8170SKalle Valo return; 662bdcd8170SKalle Valo } 663bdcd8170SKalle Valo 664bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 6656b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 6666b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 667bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 668bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 669bdcd8170SKalle Valo return; 670bdcd8170SKalle Valo } 671bdcd8170SKalle Valo } 672bdcd8170SKalle Valo 6731de547d6SVasanthakumar Thiagarajan /* 6741de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 6751de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 6761de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 6771de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 6781de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 6791de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 6801de547d6SVasanthakumar Thiagarajan */ 681bdcd8170SKalle Valo 6821de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 683bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 684bdcd8170SKalle Valo return; 685bdcd8170SKalle Valo } 686bdcd8170SKalle Valo 68759c98449SVasanthakumar Thiagarajan clear_bit(CONNECT_PEND, &vif->flags); 688bdcd8170SKalle Valo 689bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 690bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 691bdcd8170SKalle Valo bssid, NULL, 0, 692bdcd8170SKalle Valo NULL, 0, 693bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 694bdcd8170SKalle Valo GFP_KERNEL); 6950e5cc8e6SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 696bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 697bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 698bdcd8170SKalle Valo } 699bdcd8170SKalle Valo 700bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 701bdcd8170SKalle Valo } 702bdcd8170SKalle Valo 703bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 704bdcd8170SKalle Valo struct cfg80211_scan_request *request) 705bdcd8170SKalle Valo { 706bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 70759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 7081276c9efSEdward Lu s8 n_channels = 0; 7091276c9efSEdward Lu u16 *channels = NULL; 710bdcd8170SKalle Valo int ret = 0; 711f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 712bdcd8170SKalle Valo 713bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 714bdcd8170SKalle Valo return -EIO; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 71759c98449SVasanthakumar Thiagarajan clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 7181b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 7191b1e6ee3SJouni Malinen ar->wmi, 72059c98449SVasanthakumar Thiagarajan (test_bit(CONNECTED, &vif->flags) ? 7211b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 7221b1e6ee3SJouni Malinen if (ret) { 723bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 7241b1e6ee3SJouni Malinen return ret; 725bdcd8170SKalle Valo } 726bdcd8170SKalle Valo } 727bdcd8170SKalle Valo 728bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 729bdcd8170SKalle Valo u8 i; 730bdcd8170SKalle Valo 731bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 732bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 733bdcd8170SKalle Valo 734bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 735bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 736bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 737bdcd8170SKalle Valo request->ssids[i].ssid_len, 738bdcd8170SKalle Valo request->ssids[i].ssid); 739bdcd8170SKalle Valo } 740bdcd8170SKalle Valo 741b84da8c7SJouni Malinen if (request->ie) { 742b84da8c7SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_REQ, 743b84da8c7SJouni Malinen request->ie, request->ie_len); 744b84da8c7SJouni Malinen if (ret) { 745b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 746b84da8c7SJouni Malinen "scan"); 747b84da8c7SJouni Malinen return ret; 748b84da8c7SJouni Malinen } 749b84da8c7SJouni Malinen } 750b84da8c7SJouni Malinen 75111869befSJouni Malinen /* 75211869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 75311869befSJouni Malinen * channels. If the list is longer than the target supports, do not 75411869befSJouni Malinen * configure the list and instead, scan all available channels. 75511869befSJouni Malinen */ 75611869befSJouni Malinen if (request->n_channels > 0 && 75711869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 7581276c9efSEdward Lu u8 i; 7591276c9efSEdward Lu 76011869befSJouni Malinen n_channels = request->n_channels; 7611276c9efSEdward Lu 7621276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 7631276c9efSEdward Lu if (channels == NULL) { 7641276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 7651276c9efSEdward Lu "scan all channels"); 7661276c9efSEdward Lu n_channels = 0; 7671276c9efSEdward Lu } 7681276c9efSEdward Lu 7691276c9efSEdward Lu for (i = 0; i < n_channels; i++) 7701276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 7711276c9efSEdward Lu } 7721276c9efSEdward Lu 77359c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 774f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 775f1f92179SVasanthakumar Thiagarajan 776f1f92179SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, force_fg_scan, 7771b1e6ee3SJouni Malinen false, 0, 0, n_channels, channels); 7781b1e6ee3SJouni Malinen if (ret) 779bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 78011869befSJouni Malinen else 781bdcd8170SKalle Valo ar->scan_req = request; 782bdcd8170SKalle Valo 7831276c9efSEdward Lu kfree(channels); 7841276c9efSEdward Lu 785bdcd8170SKalle Valo return ret; 786bdcd8170SKalle Valo } 787bdcd8170SKalle Valo 788bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 789bdcd8170SKalle Valo { 7906fd1eaceSKalle Valo int i; 791bdcd8170SKalle Valo 792bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 793bdcd8170SKalle Valo 7946fd1eaceSKalle Valo if (!ar->scan_req) 7956fd1eaceSKalle Valo return; 7966fd1eaceSKalle Valo 7976fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 7986fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 7996fd1eaceSKalle Valo goto out; 8006fd1eaceSKalle Valo } 8016fd1eaceSKalle Valo 8026fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 803bdcd8170SKalle Valo 804bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 805bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 806bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 807bdcd8170SKalle Valo DISABLE_SSID_FLAG, 808bdcd8170SKalle Valo 0, NULL); 809bdcd8170SKalle Valo } 810bdcd8170SKalle Valo } 8116fd1eaceSKalle Valo 8126fd1eaceSKalle Valo out: 813bdcd8170SKalle Valo ar->scan_req = NULL; 814bdcd8170SKalle Valo } 815bdcd8170SKalle Valo 816bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 817bdcd8170SKalle Valo u8 key_index, bool pairwise, 818bdcd8170SKalle Valo const u8 *mac_addr, 819bdcd8170SKalle Valo struct key_params *params) 820bdcd8170SKalle Valo { 821bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 82259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 823bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 824bdcd8170SKalle Valo u8 key_usage; 825bdcd8170SKalle Valo u8 key_type; 826bdcd8170SKalle Valo int status = 0; 827bdcd8170SKalle Valo 828bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 829bdcd8170SKalle Valo return -EIO; 830bdcd8170SKalle Valo 831837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 832837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 833837cb97eSJouni Malinen return -EINVAL; 834837cb97eSJouni Malinen return ath6kl_wmi_add_krk_cmd(ar->wmi, params->key); 835837cb97eSJouni Malinen } 836837cb97eSJouni Malinen 837bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 838bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 839bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 840bdcd8170SKalle Valo key_index); 841bdcd8170SKalle Valo return -ENOENT; 842bdcd8170SKalle Valo } 843bdcd8170SKalle Valo 844bdcd8170SKalle Valo key = &ar->keys[key_index]; 845bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 846bdcd8170SKalle Valo 847bdcd8170SKalle Valo if (pairwise) 848bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 849bdcd8170SKalle Valo else 850bdcd8170SKalle Valo key_usage = GROUP_USAGE; 851bdcd8170SKalle Valo 852bdcd8170SKalle Valo if (params) { 853bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 854bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 855bdcd8170SKalle Valo return -EINVAL; 856bdcd8170SKalle Valo 857bdcd8170SKalle Valo key->key_len = params->key_len; 858bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 859bdcd8170SKalle Valo key->seq_len = params->seq_len; 860bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 861bdcd8170SKalle Valo key->cipher = params->cipher; 862bdcd8170SKalle Valo } 863bdcd8170SKalle Valo 864bdcd8170SKalle Valo switch (key->cipher) { 865bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 866bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 867bdcd8170SKalle Valo key_type = WEP_CRYPT; 868bdcd8170SKalle Valo break; 869bdcd8170SKalle Valo 870bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 871bdcd8170SKalle Valo key_type = TKIP_CRYPT; 872bdcd8170SKalle Valo break; 873bdcd8170SKalle Valo 874bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 875bdcd8170SKalle Valo key_type = AES_CRYPT; 876bdcd8170SKalle Valo break; 877bdcd8170SKalle Valo 878bdcd8170SKalle Valo default: 879bdcd8170SKalle Valo return -ENOTSUPP; 880bdcd8170SKalle Valo } 881bdcd8170SKalle Valo 882bdcd8170SKalle Valo if (((ar->auth_mode == WPA_PSK_AUTH) 883bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH)) 884bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 885bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 886bdcd8170SKalle Valo 887bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 888bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 889bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 890bdcd8170SKalle Valo key_usage, key->seq_len); 891bdcd8170SKalle Valo 892bdcd8170SKalle Valo ar->def_txkey_index = key_index; 8939a5b1318SJouni Malinen 8949a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !pairwise && 8959a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 8969a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 8979a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 8989a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 8999a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 9009a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 90159c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) { 9029a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9039a5b1318SJouni Malinen "key configuration until AP mode has been " 9049a5b1318SJouni Malinen "started\n"); 9059a5b1318SJouni Malinen /* 9069a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9079a5b1318SJouni Malinen * the connected event is received from the target. 9089a5b1318SJouni Malinen */ 9099a5b1318SJouni Malinen return 0; 9109a5b1318SJouni Malinen } 9119a5b1318SJouni Malinen } 9129a5b1318SJouni Malinen 913151411e8SJouni Malinen if (ar->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 91459c98449SVasanthakumar Thiagarajan !test_bit(CONNECTED, &vif->flags)) { 915151411e8SJouni Malinen /* 916151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 917151411e8SJouni Malinen * the AP mode has properly started 918151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 919151411e8SJouni Malinen */ 920151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 921151411e8SJouni Malinen "until AP mode has been started\n"); 922151411e8SJouni Malinen ar->wep_key_list[key_index].key_len = key->key_len; 923151411e8SJouni Malinen memcpy(ar->wep_key_list[key_index].key, key->key, key->key_len); 924151411e8SJouni Malinen return 0; 925151411e8SJouni Malinen } 926151411e8SJouni Malinen 927bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 928bdcd8170SKalle Valo key_type, key_usage, key->key_len, 929bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 930bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 931bdcd8170SKalle Valo 932bdcd8170SKalle Valo if (status) 933bdcd8170SKalle Valo return -EIO; 934bdcd8170SKalle Valo 935bdcd8170SKalle Valo return 0; 936bdcd8170SKalle Valo } 937bdcd8170SKalle Valo 938bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 939bdcd8170SKalle Valo u8 key_index, bool pairwise, 940bdcd8170SKalle Valo const u8 *mac_addr) 941bdcd8170SKalle Valo { 942bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 943bdcd8170SKalle Valo 944bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 945bdcd8170SKalle Valo 946bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 947bdcd8170SKalle Valo return -EIO; 948bdcd8170SKalle Valo 949bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 950bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 951bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 952bdcd8170SKalle Valo key_index); 953bdcd8170SKalle Valo return -ENOENT; 954bdcd8170SKalle Valo } 955bdcd8170SKalle Valo 956bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 957bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 958bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 959bdcd8170SKalle Valo return 0; 960bdcd8170SKalle Valo } 961bdcd8170SKalle Valo 962bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 963bdcd8170SKalle Valo 964bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 965bdcd8170SKalle Valo } 966bdcd8170SKalle Valo 967bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 968bdcd8170SKalle Valo u8 key_index, bool pairwise, 969bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 970bdcd8170SKalle Valo void (*callback) (void *cookie, 971bdcd8170SKalle Valo struct key_params *)) 972bdcd8170SKalle Valo { 973bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 974bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 975bdcd8170SKalle Valo struct key_params params; 976bdcd8170SKalle Valo 977bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 980bdcd8170SKalle Valo return -EIO; 981bdcd8170SKalle Valo 982bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 983bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 984bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 985bdcd8170SKalle Valo key_index); 986bdcd8170SKalle Valo return -ENOENT; 987bdcd8170SKalle Valo } 988bdcd8170SKalle Valo 989bdcd8170SKalle Valo key = &ar->keys[key_index]; 990bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 991bdcd8170SKalle Valo params.cipher = key->cipher; 992bdcd8170SKalle Valo params.key_len = key->key_len; 993bdcd8170SKalle Valo params.seq_len = key->seq_len; 994bdcd8170SKalle Valo params.seq = key->seq; 995bdcd8170SKalle Valo params.key = key->key; 996bdcd8170SKalle Valo 997bdcd8170SKalle Valo callback(cookie, ¶ms); 998bdcd8170SKalle Valo 999bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1000bdcd8170SKalle Valo } 1001bdcd8170SKalle Valo 1002bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1003bdcd8170SKalle Valo struct net_device *ndev, 1004bdcd8170SKalle Valo u8 key_index, bool unicast, 1005bdcd8170SKalle Valo bool multicast) 1006bdcd8170SKalle Valo { 1007bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 100859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(ndev); 1009bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1010bdcd8170SKalle Valo int status = 0; 1011bdcd8170SKalle Valo u8 key_usage; 1012229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1013bdcd8170SKalle Valo 1014bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1015bdcd8170SKalle Valo 1016bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1017bdcd8170SKalle Valo return -EIO; 1018bdcd8170SKalle Valo 1019bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1020bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1021bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1022bdcd8170SKalle Valo __func__, key_index); 1023bdcd8170SKalle Valo return -ENOENT; 1024bdcd8170SKalle Valo } 1025bdcd8170SKalle Valo 1026bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1027bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1028bdcd8170SKalle Valo __func__, key_index); 1029bdcd8170SKalle Valo return -EINVAL; 1030bdcd8170SKalle Valo } 1031bdcd8170SKalle Valo 1032bdcd8170SKalle Valo ar->def_txkey_index = key_index; 1033bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 1034bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1035bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 1036bdcd8170SKalle Valo key_usage |= TX_USAGE; 1037229ed6b5SEdward Lu if (unicast) 1038229ed6b5SEdward Lu key_type = ar->prwise_crypto; 1039229ed6b5SEdward Lu if (multicast) 1040229ed6b5SEdward Lu key_type = ar->grp_crypto; 1041bdcd8170SKalle Valo 104259c98449SVasanthakumar Thiagarajan if (ar->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 10439a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10449a5b1318SJouni Malinen 1045bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1046229ed6b5SEdward Lu key_type, key_usage, 1047bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1048bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1049bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1050bdcd8170SKalle Valo if (status) 1051bdcd8170SKalle Valo return -EIO; 1052bdcd8170SKalle Valo 1053bdcd8170SKalle Valo return 0; 1054bdcd8170SKalle Valo } 1055bdcd8170SKalle Valo 1056bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1057bdcd8170SKalle Valo bool ismcast) 1058bdcd8170SKalle Valo { 1059bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1060bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1061bdcd8170SKalle Valo 1062bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1063bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1064bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1065bdcd8170SKalle Valo GFP_KERNEL); 1066bdcd8170SKalle Valo } 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1069bdcd8170SKalle Valo { 1070bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1071bdcd8170SKalle Valo int ret; 1072bdcd8170SKalle Valo 1073bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1074bdcd8170SKalle Valo changed); 1075bdcd8170SKalle Valo 1076bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1077bdcd8170SKalle Valo return -EIO; 1078bdcd8170SKalle Valo 1079bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1080bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1081bdcd8170SKalle Valo if (ret != 0) { 1082bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1083bdcd8170SKalle Valo return -EIO; 1084bdcd8170SKalle Valo } 1085bdcd8170SKalle Valo } 1086bdcd8170SKalle Valo 1087bdcd8170SKalle Valo return 0; 1088bdcd8170SKalle Valo } 1089bdcd8170SKalle Valo 1090bdcd8170SKalle Valo /* 1091bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1092bdcd8170SKalle Valo * data type from 2.6.36 onwards 1093bdcd8170SKalle Valo */ 1094bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1095bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1096bdcd8170SKalle Valo int dbm) 1097bdcd8170SKalle Valo { 1098bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1099bdcd8170SKalle Valo u8 ath6kl_dbm; 1100bdcd8170SKalle Valo 1101bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1102bdcd8170SKalle Valo type, dbm); 1103bdcd8170SKalle Valo 1104bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1105bdcd8170SKalle Valo return -EIO; 1106bdcd8170SKalle Valo 1107bdcd8170SKalle Valo switch (type) { 1108bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1109bdcd8170SKalle Valo return 0; 1110bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1111bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1112bdcd8170SKalle Valo break; 1113bdcd8170SKalle Valo default: 1114bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1115bdcd8170SKalle Valo __func__, type); 1116bdcd8170SKalle Valo return -EOPNOTSUPP; 1117bdcd8170SKalle Valo } 1118bdcd8170SKalle Valo 1119bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1120bdcd8170SKalle Valo 1121bdcd8170SKalle Valo return 0; 1122bdcd8170SKalle Valo } 1123bdcd8170SKalle Valo 1124bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1125bdcd8170SKalle Valo { 1126bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 112759c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = ar->vif; 1128bdcd8170SKalle Valo 1129bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1130bdcd8170SKalle Valo return -EIO; 1131bdcd8170SKalle Valo 113259c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) { 1133bdcd8170SKalle Valo ar->tx_pwr = 0; 1134bdcd8170SKalle Valo 1135bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1136bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1137bdcd8170SKalle Valo return -EIO; 1138bdcd8170SKalle Valo } 1139bdcd8170SKalle Valo 1140bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1141bdcd8170SKalle Valo 5 * HZ); 1142bdcd8170SKalle Valo 1143bdcd8170SKalle Valo if (signal_pending(current)) { 1144bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1145bdcd8170SKalle Valo return -EINTR; 1146bdcd8170SKalle Valo } 1147bdcd8170SKalle Valo } 1148bdcd8170SKalle Valo 1149bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1150bdcd8170SKalle Valo return 0; 1151bdcd8170SKalle Valo } 1152bdcd8170SKalle Valo 1153bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1154bdcd8170SKalle Valo struct net_device *dev, 1155bdcd8170SKalle Valo bool pmgmt, int timeout) 1156bdcd8170SKalle Valo { 1157bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1158bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1159bdcd8170SKalle Valo 1160bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1161bdcd8170SKalle Valo __func__, pmgmt, timeout); 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1164bdcd8170SKalle Valo return -EIO; 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo if (pmgmt) { 1167bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1168bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1169bdcd8170SKalle Valo } else { 1170bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1171bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1172bdcd8170SKalle Valo } 1173bdcd8170SKalle Valo 1174bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1175bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1176bdcd8170SKalle Valo return -EIO; 1177bdcd8170SKalle Valo } 1178bdcd8170SKalle Valo 1179bdcd8170SKalle Valo return 0; 1180bdcd8170SKalle Valo } 1181bdcd8170SKalle Valo 1182bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1183bdcd8170SKalle Valo struct net_device *ndev, 1184bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1185bdcd8170SKalle Valo struct vif_params *params) 1186bdcd8170SKalle Valo { 1187bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1188bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1189bdcd8170SKalle Valo 1190bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1191bdcd8170SKalle Valo 1192bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1193bdcd8170SKalle Valo return -EIO; 1194bdcd8170SKalle Valo 1195bdcd8170SKalle Valo switch (type) { 1196bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1197bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1198bdcd8170SKalle Valo break; 1199bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1200bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1201bdcd8170SKalle Valo break; 12026e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 12036e4604c8SJouni Malinen ar->next_mode = AP_NETWORK; 12046e4604c8SJouni Malinen break; 12056b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 12066b5e5d25SJouni Malinen ar->next_mode = INFRA_NETWORK; 12076b5e5d25SJouni Malinen break; 12086b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 12096b5e5d25SJouni Malinen ar->next_mode = AP_NETWORK; 12106b5e5d25SJouni Malinen break; 1211bdcd8170SKalle Valo default: 1212bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1213bdcd8170SKalle Valo return -EOPNOTSUPP; 1214bdcd8170SKalle Valo } 1215bdcd8170SKalle Valo 1216bdcd8170SKalle Valo wdev->iftype = type; 1217bdcd8170SKalle Valo 1218bdcd8170SKalle Valo return 0; 1219bdcd8170SKalle Valo } 1220bdcd8170SKalle Valo 1221bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1222bdcd8170SKalle Valo struct net_device *dev, 1223bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1224bdcd8170SKalle Valo { 1225bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 122659c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1227bdcd8170SKalle Valo int status; 1228bdcd8170SKalle Valo 1229bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1230bdcd8170SKalle Valo return -EIO; 1231bdcd8170SKalle Valo 1232bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1233bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo if (ibss_param->channel) 1236bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1237bdcd8170SKalle Valo 1238bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1239bdcd8170SKalle Valo /* 1240bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1241bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1242bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1243bdcd8170SKalle Valo * updated. 1244bdcd8170SKalle Valo */ 1245bdcd8170SKalle Valo return -EOPNOTSUPP; 1246bdcd8170SKalle Valo } 1247bdcd8170SKalle Valo 1248bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1249bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1250bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1251bdcd8170SKalle Valo 1252bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1253bdcd8170SKalle Valo 1254bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1255bdcd8170SKalle Valo if (status) 1256bdcd8170SKalle Valo return status; 1257bdcd8170SKalle Valo 1258bdcd8170SKalle Valo if (ibss_param->privacy) { 1259bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1260bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1261bdcd8170SKalle Valo } else { 1262bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1263bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1264bdcd8170SKalle Valo } 1265bdcd8170SKalle Valo 1266bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1267bdcd8170SKalle Valo 1268bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1269bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1270bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1271bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1272bdcd8170SKalle Valo __func__, 1273bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1274bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 127538acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 1276bdcd8170SKalle Valo 1277bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1278bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1279bdcd8170SKalle Valo ar->prwise_crypto, 1280bdcd8170SKalle Valo ar->prwise_crypto_len, 128138acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 1282bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1283bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1284bdcd8170SKalle Valo ar->connect_ctrl_flags); 128559c98449SVasanthakumar Thiagarajan set_bit(CONNECT_PEND, &vif->flags); 1286bdcd8170SKalle Valo 1287bdcd8170SKalle Valo return 0; 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo 1290bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1291bdcd8170SKalle Valo struct net_device *dev) 1292bdcd8170SKalle Valo { 1293bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1294bdcd8170SKalle Valo 1295bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1296bdcd8170SKalle Valo return -EIO; 1297bdcd8170SKalle Valo 1298bdcd8170SKalle Valo ath6kl_disconnect(ar); 1299bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1300bdcd8170SKalle Valo ar->ssid_len = 0; 1301bdcd8170SKalle Valo 1302bdcd8170SKalle Valo return 0; 1303bdcd8170SKalle Valo } 1304bdcd8170SKalle Valo 1305bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1306bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1307bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1308bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1309bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1310837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1311bdcd8170SKalle Valo }; 1312bdcd8170SKalle Valo 1313bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1314bdcd8170SKalle Valo { 1315bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1316bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1317bdcd8170SKalle Valo 36000, 48000, 54000 1318bdcd8170SKalle Valo }; 1319bdcd8170SKalle Valo u8 i; 1320bdcd8170SKalle Valo 1321bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1322bdcd8170SKalle Valo if (rate == legacy[i]) 1323bdcd8170SKalle Valo return true; 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo return false; 1326bdcd8170SKalle Valo } 1327bdcd8170SKalle Valo 1328bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1329bdcd8170SKalle Valo { 1330bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1331bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1332bdcd8170SKalle Valo }; 1333bdcd8170SKalle Valo u8 i; 1334bdcd8170SKalle Valo 1335bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1336bdcd8170SKalle Valo if (rate == ht20[i]) { 1337bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1338bdcd8170SKalle Valo /* last rate uses sgi */ 1339bdcd8170SKalle Valo *sgi = true; 1340bdcd8170SKalle Valo else 1341bdcd8170SKalle Valo *sgi = false; 1342bdcd8170SKalle Valo 1343bdcd8170SKalle Valo *mcs = i; 1344bdcd8170SKalle Valo return true; 1345bdcd8170SKalle Valo } 1346bdcd8170SKalle Valo } 1347bdcd8170SKalle Valo return false; 1348bdcd8170SKalle Valo } 1349bdcd8170SKalle Valo 1350bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1351bdcd8170SKalle Valo { 1352bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1353bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1354bdcd8170SKalle Valo 150000 1355bdcd8170SKalle Valo }; 1356bdcd8170SKalle Valo u8 i; 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1359bdcd8170SKalle Valo if (rate == ht40[i]) { 1360bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1361bdcd8170SKalle Valo /* last rate uses sgi */ 1362bdcd8170SKalle Valo *sgi = true; 1363bdcd8170SKalle Valo else 1364bdcd8170SKalle Valo *sgi = false; 1365bdcd8170SKalle Valo 1366bdcd8170SKalle Valo *mcs = i; 1367bdcd8170SKalle Valo return true; 1368bdcd8170SKalle Valo } 1369bdcd8170SKalle Valo } 1370bdcd8170SKalle Valo 1371bdcd8170SKalle Valo return false; 1372bdcd8170SKalle Valo } 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1375bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1376bdcd8170SKalle Valo { 1377bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 137859c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 1379bdcd8170SKalle Valo long left; 1380bdcd8170SKalle Valo bool sgi; 1381bdcd8170SKalle Valo s32 rate; 1382bdcd8170SKalle Valo int ret; 1383bdcd8170SKalle Valo u8 mcs; 1384bdcd8170SKalle Valo 1385bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1386bdcd8170SKalle Valo return -ENOENT; 1387bdcd8170SKalle Valo 1388bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1389bdcd8170SKalle Valo return -EBUSY; 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1392bdcd8170SKalle Valo 1393bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1394bdcd8170SKalle Valo 1395bdcd8170SKalle Valo if (ret != 0) { 1396bdcd8170SKalle Valo up(&ar->sem); 1397bdcd8170SKalle Valo return -EIO; 1398bdcd8170SKalle Valo } 1399bdcd8170SKalle Valo 1400bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1401bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1402bdcd8170SKalle Valo &ar->flag), 1403bdcd8170SKalle Valo WMI_TIMEOUT); 1404bdcd8170SKalle Valo 1405bdcd8170SKalle Valo up(&ar->sem); 1406bdcd8170SKalle Valo 1407bdcd8170SKalle Valo if (left == 0) 1408bdcd8170SKalle Valo return -ETIMEDOUT; 1409bdcd8170SKalle Valo else if (left < 0) 1410bdcd8170SKalle Valo return left; 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1413bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1414bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1415bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1416bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1417bdcd8170SKalle Valo } 1418bdcd8170SKalle Valo 1419bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1420bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1421bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1422bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1423bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1424bdcd8170SKalle Valo } 1425bdcd8170SKalle Valo 1426bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1427bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1428bdcd8170SKalle Valo 1429bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1430bdcd8170SKalle Valo 1431bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1432bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1433bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1434bdcd8170SKalle Valo if (sgi) { 1435bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1436bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1437bdcd8170SKalle Valo } else { 1438bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1439bdcd8170SKalle Valo } 1440bdcd8170SKalle Valo 1441bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1442bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1443bdcd8170SKalle Valo if (sgi) { 1444bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1445bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1446bdcd8170SKalle Valo } else { 1447bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1448bdcd8170SKalle Valo } 1449bdcd8170SKalle Valo 1450bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1451bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1452bdcd8170SKalle Valo } else { 14539a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 14549a730834SKalle Valo "invalid rate from stats: %d\n", rate); 14559a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1456bdcd8170SKalle Valo return 0; 1457bdcd8170SKalle Valo } 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1460bdcd8170SKalle Valo 146159c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags) && 146259c98449SVasanthakumar Thiagarajan test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 146332c10874SJouni Malinen ar->nw_type == INFRA_NETWORK) { 146432c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 146532c10874SJouni Malinen sinfo->bss_param.flags = 0; 146632c10874SJouni Malinen sinfo->bss_param.dtim_period = ar->assoc_bss_dtim_period; 146732c10874SJouni Malinen sinfo->bss_param.beacon_interval = ar->assoc_bss_beacon_int; 146832c10874SJouni Malinen } 146932c10874SJouni Malinen 1470bdcd8170SKalle Valo return 0; 1471bdcd8170SKalle Valo } 1472bdcd8170SKalle Valo 1473bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1474bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1475bdcd8170SKalle Valo { 1476bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1477bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1478bdcd8170SKalle Valo pmksa->pmkid, true); 1479bdcd8170SKalle Valo } 1480bdcd8170SKalle Valo 1481bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1482bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1483bdcd8170SKalle Valo { 1484bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1485bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1486bdcd8170SKalle Valo pmksa->pmkid, false); 1487bdcd8170SKalle Valo } 1488bdcd8170SKalle Valo 1489bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1490bdcd8170SKalle Valo { 1491bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 149259c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(netdev); 149359c98449SVasanthakumar Thiagarajan 149459c98449SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &vif->flags)) 1495bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1496bdcd8170SKalle Valo return 0; 1497bdcd8170SKalle Valo } 1498bdcd8170SKalle Valo 1499abcb344bSKalle Valo #ifdef CONFIG_PM 1500abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1501abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1502abcb344bSKalle Valo { 1503abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1504abcb344bSKalle Valo 1505abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1506abcb344bSKalle Valo } 1507aa6cffc1SChilam Ng 1508aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1509aa6cffc1SChilam Ng { 1510aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1511aa6cffc1SChilam Ng 1512aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1513aa6cffc1SChilam Ng } 1514abcb344bSKalle Valo #endif 1515abcb344bSKalle Valo 15166a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15176a7c9badSJouni Malinen struct ieee80211_channel *chan, 15186a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15196a7c9badSJouni Malinen { 15206a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15216a7c9badSJouni Malinen 15226a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15236a7c9badSJouni Malinen return -EIO; 15246a7c9badSJouni Malinen 15256a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15266a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15276a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15286a7c9badSJouni Malinen 15296a7c9badSJouni Malinen return 0; 15306a7c9badSJouni Malinen } 15316a7c9badSJouni Malinen 15328bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15338bdfbf40SJouni Malinen { 15348bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15358bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15368bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15378bdfbf40SJouni Malinen } 15388bdfbf40SJouni Malinen 15398bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15408bdfbf40SJouni Malinen size_t ies_len) 15418bdfbf40SJouni Malinen { 15428bdfbf40SJouni Malinen const u8 *pos; 15438bdfbf40SJouni Malinen u8 *buf = NULL; 15448bdfbf40SJouni Malinen size_t len = 0; 15458bdfbf40SJouni Malinen int ret; 15468bdfbf40SJouni Malinen 15478bdfbf40SJouni Malinen /* 15488bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15498bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15508bdfbf40SJouni Malinen */ 15518bdfbf40SJouni Malinen 15528bdfbf40SJouni Malinen if (ies && ies_len) { 15538bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15548bdfbf40SJouni Malinen if (buf == NULL) 15558bdfbf40SJouni Malinen return -ENOMEM; 15568bdfbf40SJouni Malinen pos = ies; 15578bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15588bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15598bdfbf40SJouni Malinen break; 15608bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15618bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15628bdfbf40SJouni Malinen len += 2 + pos[1]; 15638bdfbf40SJouni Malinen } 15648bdfbf40SJouni Malinen pos += 2 + pos[1]; 15658bdfbf40SJouni Malinen } 15668bdfbf40SJouni Malinen } 15678bdfbf40SJouni Malinen 15688bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15698bdfbf40SJouni Malinen buf, len); 15708bdfbf40SJouni Malinen kfree(buf); 15718bdfbf40SJouni Malinen return ret; 15728bdfbf40SJouni Malinen } 15738bdfbf40SJouni Malinen 15746a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 15756a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 15766a7c9badSJouni Malinen { 15776a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15786a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 15796a7c9badSJouni Malinen u8 *ies; 15806a7c9badSJouni Malinen int ies_len; 15816a7c9badSJouni Malinen struct wmi_connect_cmd p; 15826a7c9badSJouni Malinen int res; 15836a7c9badSJouni Malinen int i; 15846a7c9badSJouni Malinen 15856a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 15866a7c9badSJouni Malinen 15876a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15886a7c9badSJouni Malinen return -EIO; 15896a7c9badSJouni Malinen 15906a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 15916a7c9badSJouni Malinen return -EOPNOTSUPP; 15926a7c9badSJouni Malinen 15936a7c9badSJouni Malinen if (info->beacon_ies) { 15946a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 15956a7c9badSJouni Malinen info->beacon_ies, 15966a7c9badSJouni Malinen info->beacon_ies_len); 15976a7c9badSJouni Malinen if (res) 15986a7c9badSJouni Malinen return res; 15996a7c9badSJouni Malinen } 16006a7c9badSJouni Malinen if (info->proberesp_ies) { 16018bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 16026a7c9badSJouni Malinen info->proberesp_ies_len); 16036a7c9badSJouni Malinen if (res) 16046a7c9badSJouni Malinen return res; 16056a7c9badSJouni Malinen } 16066a7c9badSJouni Malinen if (info->assocresp_ies) { 16076a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 16086a7c9badSJouni Malinen info->assocresp_ies, 16096a7c9badSJouni Malinen info->assocresp_ies_len); 16106a7c9badSJouni Malinen if (res) 16116a7c9badSJouni Malinen return res; 16126a7c9badSJouni Malinen } 16136a7c9badSJouni Malinen 16146a7c9badSJouni Malinen if (!add) 16156a7c9badSJouni Malinen return 0; 16166a7c9badSJouni Malinen 16179a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16189a5b1318SJouni Malinen 16196a7c9badSJouni Malinen /* TODO: 16206a7c9badSJouni Malinen * info->interval 16216a7c9badSJouni Malinen * info->dtim_period 16226a7c9badSJouni Malinen */ 16236a7c9badSJouni Malinen 16246a7c9badSJouni Malinen if (info->head == NULL) 16256a7c9badSJouni Malinen return -EINVAL; 16266a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16276a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16286a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16296a7c9badSJouni Malinen return -EINVAL; 16306a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16316a7c9badSJouni Malinen 16326a7c9badSJouni Malinen if (info->ssid == NULL) 16336a7c9badSJouni Malinen return -EINVAL; 16346a7c9badSJouni Malinen memcpy(ar->ssid, info->ssid, info->ssid_len); 16356a7c9badSJouni Malinen ar->ssid_len = info->ssid_len; 16366a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16376a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16386a7c9badSJouni Malinen 16396a7c9badSJouni Malinen ar->dot11_auth_mode = OPEN_AUTH; 16406a7c9badSJouni Malinen 16416a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16426a7c9badSJouni Malinen 16436a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16446a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16456a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16466a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16476a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16486a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16496a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16506a7c9badSJouni Malinen break; 16516a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16526a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16536a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16546a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16556a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16566a7c9badSJouni Malinen break; 16576a7c9badSJouni Malinen } 16586a7c9badSJouni Malinen } 16596a7c9badSJouni Malinen if (p.auth_mode == 0) 16606a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16616a7c9badSJouni Malinen ar->auth_mode = p.auth_mode; 16626a7c9badSJouni Malinen 16636a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16646a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16656a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16666a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16676a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16686a7c9badSJouni Malinen break; 16696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16706a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16716a7c9badSJouni Malinen break; 16726a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16736a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 16746a7c9badSJouni Malinen break; 16756a7c9badSJouni Malinen } 16766a7c9badSJouni Malinen } 1677229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 16786a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1679229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1680229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1681229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 16826a7c9badSJouni Malinen 16836a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 16846a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16856a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16866a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 16876a7c9badSJouni Malinen break; 16886a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16896a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 16906a7c9badSJouni Malinen break; 16916a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16926a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 16936a7c9badSJouni Malinen break; 16946a7c9badSJouni Malinen default: 16956a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 16966a7c9badSJouni Malinen break; 16976a7c9badSJouni Malinen } 1698229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 16996a7c9badSJouni Malinen 17006a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 17016a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 17026a7c9badSJouni Malinen 17036a7c9badSJouni Malinen p.ssid_len = ar->ssid_len; 17046a7c9badSJouni Malinen memcpy(p.ssid, ar->ssid, ar->ssid_len); 17056a7c9badSJouni Malinen p.dot11_auth_mode = ar->dot11_auth_mode; 17066a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 17076a7c9badSJouni Malinen 17089a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 17099a5b1318SJouni Malinen if (res < 0) 17109a5b1318SJouni Malinen return res; 17119a5b1318SJouni Malinen 17129a5b1318SJouni Malinen return 0; 17136a7c9badSJouni Malinen } 17146a7c9badSJouni Malinen 17156a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17166a7c9badSJouni Malinen struct beacon_parameters *info) 17176a7c9badSJouni Malinen { 17186a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17196a7c9badSJouni Malinen } 17206a7c9badSJouni Malinen 17216a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17226a7c9badSJouni Malinen struct beacon_parameters *info) 17236a7c9badSJouni Malinen { 17246a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17256a7c9badSJouni Malinen } 17266a7c9badSJouni Malinen 17276a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17286a7c9badSJouni Malinen { 17296a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 173059c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 17316a7c9badSJouni Malinen 17326a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 17336a7c9badSJouni Malinen return -EOPNOTSUPP; 173459c98449SVasanthakumar Thiagarajan if (!test_bit(CONNECTED, &vif->flags)) 17356a7c9badSJouni Malinen return -ENOTCONN; 17366a7c9badSJouni Malinen 17376a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 173859c98449SVasanthakumar Thiagarajan clear_bit(CONNECTED, &vif->flags); 17396a7c9badSJouni Malinen 17406a7c9badSJouni Malinen return 0; 17416a7c9badSJouni Malinen } 17426a7c9badSJouni Malinen 174323875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 174423875136SJouni Malinen u8 *mac, struct station_parameters *params) 174523875136SJouni Malinen { 174623875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 174723875136SJouni Malinen 174823875136SJouni Malinen if (ar->nw_type != AP_NETWORK) 174923875136SJouni Malinen return -EOPNOTSUPP; 175023875136SJouni Malinen 175123875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 175223875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 175323875136SJouni Malinen return -EOPNOTSUPP; 175423875136SJouni Malinen 175523875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 175623875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 175723875136SJouni Malinen mac, 0); 175823875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 175923875136SJouni Malinen 0); 176023875136SJouni Malinen } 176123875136SJouni Malinen 176263fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 176363fa1e0cSJouni Malinen struct net_device *dev, 176463fa1e0cSJouni Malinen struct ieee80211_channel *chan, 176563fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 176663fa1e0cSJouni Malinen unsigned int duration, 176763fa1e0cSJouni Malinen u64 *cookie) 176863fa1e0cSJouni Malinen { 176963fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 177063fa1e0cSJouni Malinen 177163fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 177263fa1e0cSJouni Malinen * return -EBUSY */ 177363fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 177463fa1e0cSJouni Malinen 177563fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 177663fa1e0cSJouni Malinen duration); 177763fa1e0cSJouni Malinen } 177863fa1e0cSJouni Malinen 177963fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 178063fa1e0cSJouni Malinen struct net_device *dev, 178163fa1e0cSJouni Malinen u64 cookie) 178263fa1e0cSJouni Malinen { 178363fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 178463fa1e0cSJouni Malinen 178563fa1e0cSJouni Malinen if (cookie != 1) 178663fa1e0cSJouni Malinen return -ENOENT; 178763fa1e0cSJouni Malinen 178863fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 178963fa1e0cSJouni Malinen } 179063fa1e0cSJouni Malinen 17918bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 17928bdfbf40SJouni Malinen size_t len, unsigned int freq) 17938bdfbf40SJouni Malinen { 17948bdfbf40SJouni Malinen const u8 *pos; 17958bdfbf40SJouni Malinen u8 *p2p; 17968bdfbf40SJouni Malinen int p2p_len; 17978bdfbf40SJouni Malinen int ret; 17988bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 17998bdfbf40SJouni Malinen 18008bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18018bdfbf40SJouni Malinen 18028bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 18038bdfbf40SJouni Malinen 18048bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 18058bdfbf40SJouni Malinen if (p2p == NULL) 18068bdfbf40SJouni Malinen return -ENOMEM; 18078bdfbf40SJouni Malinen p2p_len = 0; 18088bdfbf40SJouni Malinen 18098bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 18108bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 18118bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 18128bdfbf40SJouni Malinen break; 18138bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 18148bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 18158bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 18168bdfbf40SJouni Malinen } 18178bdfbf40SJouni Malinen pos += 2 + pos[1]; 18188bdfbf40SJouni Malinen } 18198bdfbf40SJouni Malinen 18208bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18218bdfbf40SJouni Malinen p2p, p2p_len); 18228bdfbf40SJouni Malinen kfree(p2p); 18238bdfbf40SJouni Malinen return ret; 18248bdfbf40SJouni Malinen } 18258bdfbf40SJouni Malinen 18268a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18278a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18288a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18298a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1830e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1831e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 18328a6c8060SJouni Malinen { 18338a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 183459c98449SVasanthakumar Thiagarajan struct ath6kl_vif *vif = netdev_priv(dev); 18358a6c8060SJouni Malinen u32 id; 18368bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18378bdfbf40SJouni Malinen 18388bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18398bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 184059c98449SVasanthakumar Thiagarajan ar->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 18418bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18428bdfbf40SJouni Malinen /* 18438bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18448bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18458bdfbf40SJouni Malinen */ 18468bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18478bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18488bdfbf40SJouni Malinen chan->center_freq); 18498bdfbf40SJouni Malinen } 18508a6c8060SJouni Malinen 18518a6c8060SJouni Malinen id = ar->send_action_id++; 18528a6c8060SJouni Malinen if (id == 0) { 18538a6c8060SJouni Malinen /* 18548a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18558a6c8060SJouni Malinen * used for the command. 18568a6c8060SJouni Malinen */ 18578a6c8060SJouni Malinen id = ar->send_action_id++; 18588a6c8060SJouni Malinen } 18598a6c8060SJouni Malinen 18608a6c8060SJouni Malinen *cookie = id; 18618a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18628a6c8060SJouni Malinen buf, len); 18638a6c8060SJouni Malinen } 18648a6c8060SJouni Malinen 1865ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1866ae32c30aSJouni Malinen struct net_device *dev, 1867ae32c30aSJouni Malinen u16 frame_type, bool reg) 1868ae32c30aSJouni Malinen { 1869ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1870ae32c30aSJouni Malinen 1871ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1872ae32c30aSJouni Malinen __func__, frame_type, reg); 1873ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1874ae32c30aSJouni Malinen /* 1875ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1876ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1877ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1878ae32c30aSJouni Malinen */ 1879ae32c30aSJouni Malinen ar->probe_req_report = reg; 1880ae32c30aSJouni Malinen } 1881ae32c30aSJouni Malinen } 1882ae32c30aSJouni Malinen 1883f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1884f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1885f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1886f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1887f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1888f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1889f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1890f80574aeSJouni Malinen }, 1891f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1892f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1893f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1894f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1895f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1896f80574aeSJouni Malinen }, 1897f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1898f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1899f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1900f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1901f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1902f80574aeSJouni Malinen }, 1903f80574aeSJouni Malinen }; 1904f80574aeSJouni Malinen 1905bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1906bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1907bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1908bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1909bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1910bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1911bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1912bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1913bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1914bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1915bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1916bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1917bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1918bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1919bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1920bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1921bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1922bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1923bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1924003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 1925abcb344bSKalle Valo #ifdef CONFIG_PM 1926abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1927aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 1928abcb344bSKalle Valo #endif 19296a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19306a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19316a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19326a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 193323875136SJouni Malinen .change_station = ath6kl_change_station, 193463fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 193563fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19368a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1937ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1938bdcd8170SKalle Valo }; 1939bdcd8170SKalle Valo 19408dafb70eSVasanthakumar Thiagarajan struct ath6kl *ath6kl_core_alloc(struct device *dev) 1941bdcd8170SKalle Valo { 19426bbc7c35SJouni Malinen struct ath6kl *ar; 1943be98e3a4SVasanthakumar Thiagarajan struct wiphy *wiphy; 19448dafb70eSVasanthakumar Thiagarajan u8 ctr; 1945bdcd8170SKalle Valo 1946bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1947be98e3a4SVasanthakumar Thiagarajan wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 19488dafb70eSVasanthakumar Thiagarajan 1949be98e3a4SVasanthakumar Thiagarajan if (!wiphy) { 1950bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1951bdcd8170SKalle Valo return NULL; 1952bdcd8170SKalle Valo } 1953bdcd8170SKalle Valo 1954be98e3a4SVasanthakumar Thiagarajan ar = wiphy_priv(wiphy); 19556bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 1956be98e3a4SVasanthakumar Thiagarajan ar->wiphy = wiphy; 19578dafb70eSVasanthakumar Thiagarajan ar->dev = dev; 19588dafb70eSVasanthakumar Thiagarajan 19598dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->lock); 19608dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->mcastpsq_lock); 19618dafb70eSVasanthakumar Thiagarajan 19628dafb70eSVasanthakumar Thiagarajan init_waitqueue_head(&ar->event_wq); 19638dafb70eSVasanthakumar Thiagarajan sema_init(&ar->sem, 1); 19648dafb70eSVasanthakumar Thiagarajan 19658dafb70eSVasanthakumar Thiagarajan INIT_LIST_HEAD(&ar->amsdu_rx_buffer_queue); 19668dafb70eSVasanthakumar Thiagarajan 19678dafb70eSVasanthakumar Thiagarajan clear_bit(WMI_ENABLED, &ar->flag); 19688dafb70eSVasanthakumar Thiagarajan clear_bit(SKIP_SCAN, &ar->flag); 19698dafb70eSVasanthakumar Thiagarajan clear_bit(DESTROY_IN_PROGRESS, &ar->flag); 19708dafb70eSVasanthakumar Thiagarajan 19718dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_t = A_DEFAULT_LISTEN_INTERVAL; 19728dafb70eSVasanthakumar Thiagarajan ar->listen_intvl_b = 0; 19738dafb70eSVasanthakumar Thiagarajan ar->tx_pwr = 0; 19748dafb70eSVasanthakumar Thiagarajan 19758dafb70eSVasanthakumar Thiagarajan ar->intra_bss = 1; 19768dafb70eSVasanthakumar Thiagarajan memset(&ar->sc_params, 0, sizeof(ar->sc_params)); 19778dafb70eSVasanthakumar Thiagarajan ar->sc_params.short_scan_ratio = WMI_SHORTSCANRATIO_DEFAULT; 19788dafb70eSVasanthakumar Thiagarajan ar->sc_params.scan_ctrl_flags = DEFAULT_SCAN_CTRL_FLAGS; 19798dafb70eSVasanthakumar Thiagarajan ar->lrssi_roam_threshold = DEF_LRSSI_ROAM_THRESHOLD; 19808dafb70eSVasanthakumar Thiagarajan 19818dafb70eSVasanthakumar Thiagarajan memset((u8 *)ar->sta_list, 0, 19828dafb70eSVasanthakumar Thiagarajan AP_MAX_NUM_STA * sizeof(struct ath6kl_sta)); 19838dafb70eSVasanthakumar Thiagarajan 19848dafb70eSVasanthakumar Thiagarajan /* Init the PS queues */ 19858dafb70eSVasanthakumar Thiagarajan for (ctr = 0; ctr < AP_MAX_NUM_STA; ctr++) { 19868dafb70eSVasanthakumar Thiagarajan spin_lock_init(&ar->sta_list[ctr].psq_lock); 19878dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->sta_list[ctr].psq); 19888dafb70eSVasanthakumar Thiagarajan } 19898dafb70eSVasanthakumar Thiagarajan 19908dafb70eSVasanthakumar Thiagarajan skb_queue_head_init(&ar->mcastpsq); 19918dafb70eSVasanthakumar Thiagarajan 19928dafb70eSVasanthakumar Thiagarajan memcpy(ar->ap_country_code, DEF_AP_COUNTRY_CODE, 3); 19938dafb70eSVasanthakumar Thiagarajan 19948dafb70eSVasanthakumar Thiagarajan return ar; 19958dafb70eSVasanthakumar Thiagarajan } 19968dafb70eSVasanthakumar Thiagarajan 19978dafb70eSVasanthakumar Thiagarajan int ath6kl_register_ieee80211_hw(struct ath6kl *ar) 19988dafb70eSVasanthakumar Thiagarajan { 19998dafb70eSVasanthakumar Thiagarajan struct wiphy *wiphy = ar->wiphy; 20008dafb70eSVasanthakumar Thiagarajan int ret; 20016bbc7c35SJouni Malinen 2002be98e3a4SVasanthakumar Thiagarajan wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 2003f80574aeSJouni Malinen 2004be98e3a4SVasanthakumar Thiagarajan wiphy->max_remain_on_channel_duration = 5000; 200563fa1e0cSJouni Malinen 2006bdcd8170SKalle Valo /* set device pointer for wiphy */ 20078dafb70eSVasanthakumar Thiagarajan set_wiphy_dev(wiphy, ar->dev); 2008bdcd8170SKalle Valo 2009be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 20108dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_ADHOC) | 20118dafb70eSVasanthakumar Thiagarajan BIT(NL80211_IFTYPE_AP); 20126bbc7c35SJouni Malinen if (ar->p2p) { 2013be98e3a4SVasanthakumar Thiagarajan wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 20146bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 20156bbc7c35SJouni Malinen } 20168dafb70eSVasanthakumar Thiagarajan 2017bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 2018be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 2019be98e3a4SVasanthakumar Thiagarajan wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 2020be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 2021be98e3a4SVasanthakumar Thiagarajan wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 2022be98e3a4SVasanthakumar Thiagarajan wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 2023bdcd8170SKalle Valo 2024be98e3a4SVasanthakumar Thiagarajan wiphy->cipher_suites = cipher_suites; 2025be98e3a4SVasanthakumar Thiagarajan wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 2026bdcd8170SKalle Valo 2027be98e3a4SVasanthakumar Thiagarajan ret = wiphy_register(wiphy); 2028bdcd8170SKalle Valo if (ret < 0) { 2029bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 20308dafb70eSVasanthakumar Thiagarajan return ret; 20318dafb70eSVasanthakumar Thiagarajan } 20328dafb70eSVasanthakumar Thiagarajan 20338dafb70eSVasanthakumar Thiagarajan return 0; 20348dafb70eSVasanthakumar Thiagarajan } 20358dafb70eSVasanthakumar Thiagarajan 2036108438bcSVasanthakumar Thiagarajan static int ath6kl_init_if_data(struct ath6kl_vif *vif) 20378dafb70eSVasanthakumar Thiagarajan { 2038108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2039108438bcSVasanthakumar Thiagarajan 2040108438bcSVasanthakumar Thiagarajan ar->aggr_cntxt = aggr_init(vif->ndev); 20418dafb70eSVasanthakumar Thiagarajan if (!ar->aggr_cntxt) { 20428dafb70eSVasanthakumar Thiagarajan ath6kl_err("failed to initialize aggr\n"); 20438dafb70eSVasanthakumar Thiagarajan return -ENOMEM; 20448dafb70eSVasanthakumar Thiagarajan } 20458dafb70eSVasanthakumar Thiagarajan 20468dafb70eSVasanthakumar Thiagarajan setup_timer(&ar->disconnect_timer, disconnect_timer_handler, 2047108438bcSVasanthakumar Thiagarajan (unsigned long) vif->ndev); 20488dafb70eSVasanthakumar Thiagarajan 20498dafb70eSVasanthakumar Thiagarajan return 0; 20508dafb70eSVasanthakumar Thiagarajan } 20518dafb70eSVasanthakumar Thiagarajan 2052108438bcSVasanthakumar Thiagarajan void ath6kl_deinit_if_data(struct ath6kl_vif *vif) 20538dafb70eSVasanthakumar Thiagarajan { 2054108438bcSVasanthakumar Thiagarajan struct ath6kl *ar = vif->ar; 2055108438bcSVasanthakumar Thiagarajan 20568dafb70eSVasanthakumar Thiagarajan aggr_module_destroy(ar->aggr_cntxt); 20578dafb70eSVasanthakumar Thiagarajan 20588dafb70eSVasanthakumar Thiagarajan ar->aggr_cntxt = NULL; 20598dafb70eSVasanthakumar Thiagarajan 206059c98449SVasanthakumar Thiagarajan if (test_bit(NETDEV_REGISTERED, &vif->flags)) { 2061108438bcSVasanthakumar Thiagarajan unregister_netdev(vif->ndev); 206259c98449SVasanthakumar Thiagarajan clear_bit(NETDEV_REGISTERED, &vif->flags); 20638dafb70eSVasanthakumar Thiagarajan } 20648dafb70eSVasanthakumar Thiagarajan 2065108438bcSVasanthakumar Thiagarajan free_netdev(vif->ndev); 20668dafb70eSVasanthakumar Thiagarajan } 20678dafb70eSVasanthakumar Thiagarajan 20688dafb70eSVasanthakumar Thiagarajan struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 20698dafb70eSVasanthakumar Thiagarajan enum nl80211_iftype type) 20708dafb70eSVasanthakumar Thiagarajan { 20718dafb70eSVasanthakumar Thiagarajan struct net_device *ndev; 2072108438bcSVasanthakumar Thiagarajan struct ath6kl_vif *vif; 20738dafb70eSVasanthakumar Thiagarajan 2074108438bcSVasanthakumar Thiagarajan ndev = alloc_netdev(sizeof(*vif), "wlan%d", ether_setup); 20758dafb70eSVasanthakumar Thiagarajan if (!ndev) 20768dafb70eSVasanthakumar Thiagarajan return NULL; 20778dafb70eSVasanthakumar Thiagarajan 2078108438bcSVasanthakumar Thiagarajan vif = netdev_priv(ndev); 2079108438bcSVasanthakumar Thiagarajan ndev->ieee80211_ptr = &vif->wdev; 2080108438bcSVasanthakumar Thiagarajan vif->wdev.wiphy = ar->wiphy; 2081108438bcSVasanthakumar Thiagarajan vif->ar = ar; 2082108438bcSVasanthakumar Thiagarajan ar->vif = vif; 2083108438bcSVasanthakumar Thiagarajan vif->ndev = ndev; 2084108438bcSVasanthakumar Thiagarajan SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 2085108438bcSVasanthakumar Thiagarajan vif->wdev.netdev = ndev; 2086108438bcSVasanthakumar Thiagarajan vif->wdev.iftype = type; 2087108438bcSVasanthakumar Thiagarajan ar->wdev = &vif->wdev; 20888dafb70eSVasanthakumar Thiagarajan ar->net_dev = ndev; 20898dafb70eSVasanthakumar Thiagarajan 20908dafb70eSVasanthakumar Thiagarajan init_netdev(ndev); 20918dafb70eSVasanthakumar Thiagarajan 20928dafb70eSVasanthakumar Thiagarajan ath6kl_init_control_info(ar); 20938dafb70eSVasanthakumar Thiagarajan 20948dafb70eSVasanthakumar Thiagarajan /* TODO: Pass interface specific pointer instead of ar */ 2095108438bcSVasanthakumar Thiagarajan if (ath6kl_init_if_data(vif)) 20968dafb70eSVasanthakumar Thiagarajan goto err; 20978dafb70eSVasanthakumar Thiagarajan 20988dafb70eSVasanthakumar Thiagarajan if (register_netdev(ndev)) 20998dafb70eSVasanthakumar Thiagarajan goto err; 21008dafb70eSVasanthakumar Thiagarajan 21018dafb70eSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 210259c98449SVasanthakumar Thiagarajan set_bit(WLAN_ENABLED, &vif->flags); 21038dafb70eSVasanthakumar Thiagarajan ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 210459c98449SVasanthakumar Thiagarajan set_bit(NETDEV_REGISTERED, &vif->flags); 21058dafb70eSVasanthakumar Thiagarajan 21068dafb70eSVasanthakumar Thiagarajan return ndev; 21078dafb70eSVasanthakumar Thiagarajan 21088dafb70eSVasanthakumar Thiagarajan err: 2109108438bcSVasanthakumar Thiagarajan ath6kl_deinit_if_data(vif); 21108dafb70eSVasanthakumar Thiagarajan 2111bdcd8170SKalle Valo return NULL; 2112bdcd8170SKalle Valo } 2113bdcd8170SKalle Valo 21148dafb70eSVasanthakumar Thiagarajan void ath6kl_deinit_ieee80211_hw(struct ath6kl *ar) 2115bdcd8170SKalle Valo { 2116bdcd8170SKalle Valo if (ar->scan_req) { 2117bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 2118bdcd8170SKalle Valo ar->scan_req = NULL; 2119bdcd8170SKalle Valo } 2120bdcd8170SKalle Valo 2121be98e3a4SVasanthakumar Thiagarajan wiphy_unregister(ar->wiphy); 2122be98e3a4SVasanthakumar Thiagarajan wiphy_free(ar->wiphy); 2123bdcd8170SKalle Valo } 2124