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 { 234bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 235bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 236bdcd8170SKalle Valo return false; 237bdcd8170SKalle Valo } 238bdcd8170SKalle Valo 239575b5f34SRaja Mani if (!test_bit(WLAN_ENABLED, &ar->flag)) { 240bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 241bdcd8170SKalle Valo return false; 242bdcd8170SKalle Valo } 243bdcd8170SKalle Valo 244bdcd8170SKalle Valo return true; 245bdcd8170SKalle Valo } 246bdcd8170SKalle Valo 2476981ffdcSKevin Fang static bool ath6kl_is_wpa_ie(const u8 *pos) 2486981ffdcSKevin Fang { 2496981ffdcSKevin Fang return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 2506981ffdcSKevin Fang pos[2] == 0x00 && pos[3] == 0x50 && 2516981ffdcSKevin Fang pos[4] == 0xf2 && pos[5] == 0x01; 2526981ffdcSKevin Fang } 2536981ffdcSKevin Fang 2546981ffdcSKevin Fang static bool ath6kl_is_rsn_ie(const u8 *pos) 2556981ffdcSKevin Fang { 2566981ffdcSKevin Fang return pos[0] == WLAN_EID_RSN; 2576981ffdcSKevin Fang } 2586981ffdcSKevin Fang 2596981ffdcSKevin Fang static int ath6kl_set_assoc_req_ies(struct ath6kl *ar, const u8 *ies, 2606981ffdcSKevin Fang size_t ies_len) 2616981ffdcSKevin Fang { 2626981ffdcSKevin Fang const u8 *pos; 2636981ffdcSKevin Fang u8 *buf = NULL; 2646981ffdcSKevin Fang size_t len = 0; 2656981ffdcSKevin Fang int ret; 2666981ffdcSKevin Fang 2676981ffdcSKevin Fang /* 2686981ffdcSKevin Fang * Filter out RSN/WPA IE(s) 2696981ffdcSKevin Fang */ 2706981ffdcSKevin Fang 2716981ffdcSKevin Fang if (ies && ies_len) { 2726981ffdcSKevin Fang buf = kmalloc(ies_len, GFP_KERNEL); 2736981ffdcSKevin Fang if (buf == NULL) 2746981ffdcSKevin Fang return -ENOMEM; 2756981ffdcSKevin Fang pos = ies; 2766981ffdcSKevin Fang 2776981ffdcSKevin Fang while (pos + 1 < ies + ies_len) { 2786981ffdcSKevin Fang if (pos + 2 + pos[1] > ies + ies_len) 2796981ffdcSKevin Fang break; 2806981ffdcSKevin Fang if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 2816981ffdcSKevin Fang memcpy(buf + len, pos, 2 + pos[1]); 2826981ffdcSKevin Fang len += 2 + pos[1]; 2836981ffdcSKevin Fang } 2846981ffdcSKevin Fang pos += 2 + pos[1]; 2856981ffdcSKevin Fang } 2866981ffdcSKevin Fang } 2876981ffdcSKevin Fang 2886981ffdcSKevin Fang ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_REQ, 2896981ffdcSKevin Fang buf, len); 2906981ffdcSKevin Fang kfree(buf); 2916981ffdcSKevin Fang return ret; 2926981ffdcSKevin Fang } 2936981ffdcSKevin Fang 294bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 295bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 296bdcd8170SKalle Valo { 297bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 298bdcd8170SKalle Valo int status; 299bdcd8170SKalle Valo 300bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 301bdcd8170SKalle Valo 302bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 303bdcd8170SKalle Valo return -EIO; 304bdcd8170SKalle Valo 305bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 306bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 307bdcd8170SKalle Valo return -EBUSY; 308bdcd8170SKalle Valo } 309bdcd8170SKalle Valo 310bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 311bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 312bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 313bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 314bdcd8170SKalle Valo return -EINVAL; 315bdcd8170SKalle Valo } 316bdcd8170SKalle Valo 317bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 318bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 319bdcd8170SKalle Valo return -ERESTARTSYS; 320bdcd8170SKalle Valo } 321bdcd8170SKalle Valo 322bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 323bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 324bdcd8170SKalle Valo up(&ar->sem); 325bdcd8170SKalle Valo return -EBUSY; 326bdcd8170SKalle Valo } 327bdcd8170SKalle Valo 328bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 329bdcd8170SKalle Valo /* 330bdcd8170SKalle Valo * sleep until the command queue drains 331bdcd8170SKalle Valo */ 332bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 333bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 334bdcd8170SKalle Valo WMI_TIMEOUT); 335bdcd8170SKalle Valo if (signal_pending(current)) { 336bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 337bdcd8170SKalle Valo up(&ar->sem); 338bdcd8170SKalle Valo return -EINTR; 339bdcd8170SKalle Valo } 340bdcd8170SKalle Valo } 341bdcd8170SKalle Valo 3426981ffdcSKevin Fang if (sme->ie && (sme->ie_len > 0)) { 3436981ffdcSKevin Fang status = ath6kl_set_assoc_req_ies(ar, sme->ie, sme->ie_len); 3446981ffdcSKevin Fang if (status) 3456981ffdcSKevin Fang return status; 3466981ffdcSKevin Fang } 3476981ffdcSKevin Fang 348bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag) && 349bdcd8170SKalle Valo ar->ssid_len == sme->ssid_len && 350bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 351bdcd8170SKalle Valo ar->reconnect_flag = true; 352bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 353bdcd8170SKalle Valo ar->ch_hint); 354bdcd8170SKalle Valo 355bdcd8170SKalle Valo up(&ar->sem); 356bdcd8170SKalle Valo if (status) { 357bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 358bdcd8170SKalle Valo return -EIO; 359bdcd8170SKalle Valo } 360bdcd8170SKalle Valo return 0; 361bdcd8170SKalle Valo } else if (ar->ssid_len == sme->ssid_len && 362bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 363bdcd8170SKalle Valo ath6kl_disconnect(ar); 364bdcd8170SKalle Valo } 365bdcd8170SKalle Valo 366bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 367bdcd8170SKalle Valo ar->ssid_len = sme->ssid_len; 368bdcd8170SKalle Valo memcpy(ar->ssid, sme->ssid, sme->ssid_len); 369bdcd8170SKalle Valo 370bdcd8170SKalle Valo if (sme->channel) 371bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 372bdcd8170SKalle Valo 373bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 374bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 375bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 376bdcd8170SKalle Valo 377bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 378bdcd8170SKalle Valo 379bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 380bdcd8170SKalle Valo if (status) { 381bdcd8170SKalle Valo up(&ar->sem); 382bdcd8170SKalle Valo return status; 383bdcd8170SKalle Valo } 384bdcd8170SKalle Valo 385bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 386bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 387bdcd8170SKalle Valo else 388bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 389bdcd8170SKalle Valo 390bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 391bdcd8170SKalle Valo 392bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 393bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 394bdcd8170SKalle Valo 395bdcd8170SKalle Valo if ((sme->key_len) && 396bdcd8170SKalle Valo (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) { 397bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 398bdcd8170SKalle Valo 399bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 400bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 401bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 402bdcd8170SKalle Valo sme->key_idx); 403bdcd8170SKalle Valo up(&ar->sem); 404bdcd8170SKalle Valo return -ENOENT; 405bdcd8170SKalle Valo } 406bdcd8170SKalle Valo 407bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 408bdcd8170SKalle Valo key->key_len = sme->key_len; 409bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 410bdcd8170SKalle Valo key->cipher = ar->prwise_crypto; 411bdcd8170SKalle Valo ar->def_txkey_index = sme->key_idx; 412bdcd8170SKalle Valo 413bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 414bdcd8170SKalle Valo ar->prwise_crypto, 415bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 416bdcd8170SKalle Valo key->key_len, 417bdcd8170SKalle Valo NULL, 418bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 419bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 420bdcd8170SKalle Valo } 421bdcd8170SKalle Valo 422bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 423551185caSJouni Malinen clear_bit(CLEAR_BSSFILTER_ON_BEACON, &ar->flag); 424bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 425bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 426bdcd8170SKalle Valo up(&ar->sem); 427bdcd8170SKalle Valo return -EIO; 428bdcd8170SKalle Valo } 429bdcd8170SKalle Valo } 430bdcd8170SKalle Valo 431bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 432bdcd8170SKalle Valo 433bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 434bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 435bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 436bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 437bdcd8170SKalle Valo __func__, 438bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 439bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 44038acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 441bdcd8170SKalle Valo 442bdcd8170SKalle Valo ar->reconnect_flag = 0; 443bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 444bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 445bdcd8170SKalle Valo ar->prwise_crypto, 446bdcd8170SKalle Valo ar->prwise_crypto_len, 44738acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 448bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 449bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 450bdcd8170SKalle Valo ar->connect_ctrl_flags); 451bdcd8170SKalle Valo 452bdcd8170SKalle Valo up(&ar->sem); 453bdcd8170SKalle Valo 454bdcd8170SKalle Valo if (status == -EINVAL) { 455bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 456bdcd8170SKalle Valo ar->ssid_len = 0; 457bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 458bdcd8170SKalle Valo return -ENOENT; 459bdcd8170SKalle Valo } else if (status) { 460bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 461bdcd8170SKalle Valo return -EIO; 462bdcd8170SKalle Valo } 463bdcd8170SKalle Valo 464bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 465bdcd8170SKalle Valo ((ar->auth_mode == WPA_PSK_AUTH) 466bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH))) { 467bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 468bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 469bdcd8170SKalle Valo } 470bdcd8170SKalle Valo 471bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 472bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 473bdcd8170SKalle Valo 474bdcd8170SKalle Valo return 0; 475bdcd8170SKalle Valo } 476bdcd8170SKalle Valo 47701cac476SJouni Malinen static int ath6kl_add_bss_if_needed(struct ath6kl *ar, const u8 *bssid, 47801cac476SJouni Malinen struct ieee80211_channel *chan, 47901cac476SJouni Malinen const u8 *beacon_ie, size_t beacon_ie_len) 48001cac476SJouni Malinen { 48101cac476SJouni Malinen struct cfg80211_bss *bss; 48201cac476SJouni Malinen u8 *ie; 48301cac476SJouni Malinen 48401cac476SJouni Malinen bss = cfg80211_get_bss(ar->wdev->wiphy, chan, bssid, 48501cac476SJouni Malinen ar->ssid, ar->ssid_len, WLAN_CAPABILITY_ESS, 48601cac476SJouni Malinen WLAN_CAPABILITY_ESS); 48701cac476SJouni Malinen if (bss == NULL) { 48801cac476SJouni Malinen /* 48901cac476SJouni Malinen * Since cfg80211 may not yet know about the BSS, 49001cac476SJouni Malinen * generate a partial entry until the first BSS info 49101cac476SJouni Malinen * event becomes available. 49201cac476SJouni Malinen * 49301cac476SJouni Malinen * Prepend SSID element since it is not included in the Beacon 49401cac476SJouni Malinen * IEs from the target. 49501cac476SJouni Malinen */ 49601cac476SJouni Malinen ie = kmalloc(2 + ar->ssid_len + beacon_ie_len, GFP_KERNEL); 49701cac476SJouni Malinen if (ie == NULL) 49801cac476SJouni Malinen return -ENOMEM; 49901cac476SJouni Malinen ie[0] = WLAN_EID_SSID; 50001cac476SJouni Malinen ie[1] = ar->ssid_len; 50101cac476SJouni Malinen memcpy(ie + 2, ar->ssid, ar->ssid_len); 50201cac476SJouni Malinen memcpy(ie + 2 + ar->ssid_len, beacon_ie, beacon_ie_len); 50301cac476SJouni Malinen bss = cfg80211_inform_bss(ar->wdev->wiphy, chan, 50401cac476SJouni Malinen bssid, 0, WLAN_CAPABILITY_ESS, 100, 50501cac476SJouni Malinen ie, 2 + ar->ssid_len + beacon_ie_len, 50601cac476SJouni Malinen 0, GFP_KERNEL); 50701cac476SJouni Malinen if (bss) 50801cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "added dummy bss for " 50901cac476SJouni Malinen "%pM prior to indicating connect/roamed " 51001cac476SJouni Malinen "event\n", bssid); 51101cac476SJouni Malinen kfree(ie); 51201cac476SJouni Malinen } else 51301cac476SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss " 51401cac476SJouni Malinen "entry\n"); 51501cac476SJouni Malinen 51601cac476SJouni Malinen if (bss == NULL) 51701cac476SJouni Malinen return -ENOMEM; 51801cac476SJouni Malinen 51901cac476SJouni Malinen cfg80211_put_bss(bss); 52001cac476SJouni Malinen 52101cac476SJouni Malinen return 0; 52201cac476SJouni Malinen } 52301cac476SJouni Malinen 524bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 525bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 526bdcd8170SKalle Valo u16 beacon_intvl, 527bdcd8170SKalle Valo enum network_type nw_type, 528bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 529bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 530bdcd8170SKalle Valo { 53101cac476SJouni Malinen struct ieee80211_channel *chan; 532bdcd8170SKalle Valo 533bdcd8170SKalle Valo /* capinfo + listen interval */ 534bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 535bdcd8170SKalle Valo 536bdcd8170SKalle Valo /* capinfo + status code + associd */ 537bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 538bdcd8170SKalle Valo 539bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 540bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 541bdcd8170SKalle Valo assoc_resp_ie_offset; 542bdcd8170SKalle Valo 543bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 544bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 545bdcd8170SKalle Valo 54632c10874SJouni Malinen /* 54732c10874SJouni Malinen * Store Beacon interval here; DTIM period will be available only once 54832c10874SJouni Malinen * a Beacon frame from the AP is seen. 54932c10874SJouni Malinen */ 55032c10874SJouni Malinen ar->assoc_bss_beacon_int = beacon_intvl; 55132c10874SJouni Malinen clear_bit(DTIM_PERIOD_AVAIL, &ar->flag); 55232c10874SJouni Malinen 553bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 554bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 555bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 556bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 557bdcd8170SKalle Valo return; 558bdcd8170SKalle Valo } 559bdcd8170SKalle Valo } 560bdcd8170SKalle Valo 561bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 5626b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 5636b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 564bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 565bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 566bdcd8170SKalle Valo return; 567bdcd8170SKalle Valo } 568bdcd8170SKalle Valo } 569bdcd8170SKalle Valo 57001cac476SJouni Malinen chan = ieee80211_get_channel(ar->wdev->wiphy, (int) channel); 571bdcd8170SKalle Valo 572bdcd8170SKalle Valo 573bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 574bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 575bdcd8170SKalle Valo return; 576bdcd8170SKalle Valo } 577bdcd8170SKalle Valo 57801cac476SJouni Malinen if (ath6kl_add_bss_if_needed(ar, bssid, chan, assoc_info, 57901cac476SJouni Malinen beacon_ie_len) < 0) { 58001cac476SJouni Malinen ath6kl_err("could not add cfg80211 bss entry for " 58101cac476SJouni Malinen "connect/roamed notification\n"); 58201cac476SJouni Malinen return; 58301cac476SJouni Malinen } 58401cac476SJouni Malinen 5859aa60357SRaja Mani if (ar->sme_state == SME_CONNECTING) { 586bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 5879aa60357SRaja Mani ar->sme_state = SME_CONNECTED; 588bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 589bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 590bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 591bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 5929aa60357SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 593bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 59401cac476SJouni Malinen cfg80211_roamed(ar->net_dev, chan, bssid, 595bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 596bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 597bdcd8170SKalle Valo } 598bdcd8170SKalle Valo } 599bdcd8170SKalle Valo 600bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 601bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 602bdcd8170SKalle Valo { 603bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 604bdcd8170SKalle Valo 605bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 606bdcd8170SKalle Valo reason_code); 607bdcd8170SKalle Valo 608bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 609bdcd8170SKalle Valo return -EIO; 610bdcd8170SKalle Valo 611bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 612bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 613bdcd8170SKalle Valo return -EBUSY; 614bdcd8170SKalle Valo } 615bdcd8170SKalle Valo 616bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 617bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 618bdcd8170SKalle Valo return -ERESTARTSYS; 619bdcd8170SKalle Valo } 620bdcd8170SKalle Valo 621bdcd8170SKalle Valo ar->reconnect_flag = 0; 622bdcd8170SKalle Valo ath6kl_disconnect(ar); 623bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 624bdcd8170SKalle Valo ar->ssid_len = 0; 625bdcd8170SKalle Valo 626bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 627bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 628bdcd8170SKalle Valo 629bdcd8170SKalle Valo up(&ar->sem); 630bdcd8170SKalle Valo 631170826ddSVasanthakumar Thiagarajan ar->sme_state = SME_DISCONNECTED; 632170826ddSVasanthakumar Thiagarajan 633bdcd8170SKalle Valo return 0; 634bdcd8170SKalle Valo } 635bdcd8170SKalle Valo 636bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 637bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 638bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 639bdcd8170SKalle Valo { 640bdcd8170SKalle Valo if (ar->scan_req) { 641bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 642bdcd8170SKalle Valo ar->scan_req = NULL; 643bdcd8170SKalle Valo } 644bdcd8170SKalle Valo 645bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 646bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 647bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 648bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 649bdcd8170SKalle Valo return; 650bdcd8170SKalle Valo } 651bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 652bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 653bdcd8170SKalle Valo return; 654bdcd8170SKalle Valo } 655bdcd8170SKalle Valo 656bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 6576b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 6586b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 659bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 660bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 661bdcd8170SKalle Valo return; 662bdcd8170SKalle Valo } 663bdcd8170SKalle Valo } 664bdcd8170SKalle Valo 6651de547d6SVasanthakumar Thiagarajan /* 6661de547d6SVasanthakumar Thiagarajan * Send a disconnect command to target when a disconnect event is 6671de547d6SVasanthakumar Thiagarajan * received with reason code other than 3 (DISCONNECT_CMD - disconnect 6681de547d6SVasanthakumar Thiagarajan * request from host) to make the firmware stop trying to connect even 6691de547d6SVasanthakumar Thiagarajan * after giving disconnect event. There will be one more disconnect 6701de547d6SVasanthakumar Thiagarajan * event for this disconnect command with reason code DISCONNECT_CMD 6711de547d6SVasanthakumar Thiagarajan * which will be notified to cfg80211. 6721de547d6SVasanthakumar Thiagarajan */ 673bdcd8170SKalle Valo 6741de547d6SVasanthakumar Thiagarajan if (reason != DISCONNECT_CMD) { 675bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 676bdcd8170SKalle Valo return; 677bdcd8170SKalle Valo } 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo clear_bit(CONNECT_PEND, &ar->flag); 680bdcd8170SKalle Valo 681bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 682bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 683bdcd8170SKalle Valo bssid, NULL, 0, 684bdcd8170SKalle Valo NULL, 0, 685bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 686bdcd8170SKalle Valo GFP_KERNEL); 6870e5cc8e6SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 688bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 689bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 690bdcd8170SKalle Valo } 691bdcd8170SKalle Valo 692bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 693bdcd8170SKalle Valo } 694bdcd8170SKalle Valo 695bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 696bdcd8170SKalle Valo struct cfg80211_scan_request *request) 697bdcd8170SKalle Valo { 698bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 6991276c9efSEdward Lu s8 n_channels = 0; 7001276c9efSEdward Lu u16 *channels = NULL; 701bdcd8170SKalle Valo int ret = 0; 702f1f92179SVasanthakumar Thiagarajan u32 force_fg_scan = 0; 703bdcd8170SKalle Valo 704bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 705bdcd8170SKalle Valo return -EIO; 706bdcd8170SKalle Valo 707bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 708551185caSJouni Malinen clear_bit(CLEAR_BSSFILTER_ON_BEACON, &ar->flag); 7091b1e6ee3SJouni Malinen ret = ath6kl_wmi_bssfilter_cmd( 7101b1e6ee3SJouni Malinen ar->wmi, 711bdcd8170SKalle Valo (test_bit(CONNECTED, &ar->flag) ? 7121b1e6ee3SJouni Malinen ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 7131b1e6ee3SJouni Malinen if (ret) { 714bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 7151b1e6ee3SJouni Malinen return ret; 716bdcd8170SKalle Valo } 717bdcd8170SKalle Valo } 718bdcd8170SKalle Valo 719bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 720bdcd8170SKalle Valo u8 i; 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 723bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 724bdcd8170SKalle Valo 725bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 726bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 727bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 728bdcd8170SKalle Valo request->ssids[i].ssid_len, 729bdcd8170SKalle Valo request->ssids[i].ssid); 730bdcd8170SKalle Valo } 731bdcd8170SKalle Valo 732b84da8c7SJouni Malinen if (request->ie) { 733b84da8c7SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_REQ, 734b84da8c7SJouni Malinen request->ie, request->ie_len); 735b84da8c7SJouni Malinen if (ret) { 736b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 737b84da8c7SJouni Malinen "scan"); 738b84da8c7SJouni Malinen return ret; 739b84da8c7SJouni Malinen } 740b84da8c7SJouni Malinen } 741b84da8c7SJouni Malinen 74211869befSJouni Malinen /* 74311869befSJouni Malinen * Scan only the requested channels if the request specifies a set of 74411869befSJouni Malinen * channels. If the list is longer than the target supports, do not 74511869befSJouni Malinen * configure the list and instead, scan all available channels. 74611869befSJouni Malinen */ 74711869befSJouni Malinen if (request->n_channels > 0 && 74811869befSJouni Malinen request->n_channels <= WMI_MAX_CHANNELS) { 7491276c9efSEdward Lu u8 i; 7501276c9efSEdward Lu 75111869befSJouni Malinen n_channels = request->n_channels; 7521276c9efSEdward Lu 7531276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 7541276c9efSEdward Lu if (channels == NULL) { 7551276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 7561276c9efSEdward Lu "scan all channels"); 7571276c9efSEdward Lu n_channels = 0; 7581276c9efSEdward Lu } 7591276c9efSEdward Lu 7601276c9efSEdward Lu for (i = 0; i < n_channels; i++) 7611276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 7621276c9efSEdward Lu } 7631276c9efSEdward Lu 764f1f92179SVasanthakumar Thiagarajan if (test_bit(CONNECTED, &ar->flag)) 765f1f92179SVasanthakumar Thiagarajan force_fg_scan = 1; 766f1f92179SVasanthakumar Thiagarajan 767f1f92179SVasanthakumar Thiagarajan ret = ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, force_fg_scan, 7681b1e6ee3SJouni Malinen false, 0, 0, n_channels, channels); 7691b1e6ee3SJouni Malinen if (ret) 770bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 77111869befSJouni Malinen else 772bdcd8170SKalle Valo ar->scan_req = request; 773bdcd8170SKalle Valo 7741276c9efSEdward Lu kfree(channels); 7751276c9efSEdward Lu 776bdcd8170SKalle Valo return ret; 777bdcd8170SKalle Valo } 778bdcd8170SKalle Valo 779bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 780bdcd8170SKalle Valo { 7816fd1eaceSKalle Valo int i; 782bdcd8170SKalle Valo 783bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 784bdcd8170SKalle Valo 7856fd1eaceSKalle Valo if (!ar->scan_req) 7866fd1eaceSKalle Valo return; 7876fd1eaceSKalle Valo 7886fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 7896fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 7906fd1eaceSKalle Valo goto out; 7916fd1eaceSKalle Valo } 7926fd1eaceSKalle Valo 7936fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 794bdcd8170SKalle Valo 795bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 796bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 797bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 798bdcd8170SKalle Valo DISABLE_SSID_FLAG, 799bdcd8170SKalle Valo 0, NULL); 800bdcd8170SKalle Valo } 801bdcd8170SKalle Valo } 8026fd1eaceSKalle Valo 8036fd1eaceSKalle Valo out: 804bdcd8170SKalle Valo ar->scan_req = NULL; 805bdcd8170SKalle Valo } 806bdcd8170SKalle Valo 807bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 808bdcd8170SKalle Valo u8 key_index, bool pairwise, 809bdcd8170SKalle Valo const u8 *mac_addr, 810bdcd8170SKalle Valo struct key_params *params) 811bdcd8170SKalle Valo { 812bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 813bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 814bdcd8170SKalle Valo u8 key_usage; 815bdcd8170SKalle Valo u8 key_type; 816bdcd8170SKalle Valo int status = 0; 817bdcd8170SKalle Valo 818bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 819bdcd8170SKalle Valo return -EIO; 820bdcd8170SKalle Valo 821837cb97eSJouni Malinen if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 822837cb97eSJouni Malinen if (params->key_len != WMI_KRK_LEN) 823837cb97eSJouni Malinen return -EINVAL; 824837cb97eSJouni Malinen return ath6kl_wmi_add_krk_cmd(ar->wmi, params->key); 825837cb97eSJouni Malinen } 826837cb97eSJouni Malinen 827bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 828bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 829bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 830bdcd8170SKalle Valo key_index); 831bdcd8170SKalle Valo return -ENOENT; 832bdcd8170SKalle Valo } 833bdcd8170SKalle Valo 834bdcd8170SKalle Valo key = &ar->keys[key_index]; 835bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 836bdcd8170SKalle Valo 837bdcd8170SKalle Valo if (pairwise) 838bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 839bdcd8170SKalle Valo else 840bdcd8170SKalle Valo key_usage = GROUP_USAGE; 841bdcd8170SKalle Valo 842bdcd8170SKalle Valo if (params) { 843bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 844bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 845bdcd8170SKalle Valo return -EINVAL; 846bdcd8170SKalle Valo 847bdcd8170SKalle Valo key->key_len = params->key_len; 848bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 849bdcd8170SKalle Valo key->seq_len = params->seq_len; 850bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 851bdcd8170SKalle Valo key->cipher = params->cipher; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo 854bdcd8170SKalle Valo switch (key->cipher) { 855bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 856bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 857bdcd8170SKalle Valo key_type = WEP_CRYPT; 858bdcd8170SKalle Valo break; 859bdcd8170SKalle Valo 860bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 861bdcd8170SKalle Valo key_type = TKIP_CRYPT; 862bdcd8170SKalle Valo break; 863bdcd8170SKalle Valo 864bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 865bdcd8170SKalle Valo key_type = AES_CRYPT; 866bdcd8170SKalle Valo break; 867bdcd8170SKalle Valo 868bdcd8170SKalle Valo default: 869bdcd8170SKalle Valo return -ENOTSUPP; 870bdcd8170SKalle Valo } 871bdcd8170SKalle Valo 872bdcd8170SKalle Valo if (((ar->auth_mode == WPA_PSK_AUTH) 873bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH)) 874bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 875bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 876bdcd8170SKalle Valo 877bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 878bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 879bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 880bdcd8170SKalle Valo key_usage, key->seq_len); 881bdcd8170SKalle Valo 882bdcd8170SKalle Valo ar->def_txkey_index = key_index; 8839a5b1318SJouni Malinen 8849a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !pairwise && 8859a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 8869a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 8879a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 8889a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 8899a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 8909a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 8919a5b1318SJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) { 8929a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 8939a5b1318SJouni Malinen "key configuration until AP mode has been " 8949a5b1318SJouni Malinen "started\n"); 8959a5b1318SJouni Malinen /* 8969a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 8979a5b1318SJouni Malinen * the connected event is received from the target. 8989a5b1318SJouni Malinen */ 8999a5b1318SJouni Malinen return 0; 9009a5b1318SJouni Malinen } 9019a5b1318SJouni Malinen } 9029a5b1318SJouni Malinen 903151411e8SJouni Malinen if (ar->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 904151411e8SJouni Malinen !test_bit(CONNECTED, &ar->flag)) { 905151411e8SJouni Malinen /* 906151411e8SJouni Malinen * Store the key locally so that it can be re-configured after 907151411e8SJouni Malinen * the AP mode has properly started 908151411e8SJouni Malinen * (ath6kl_install_statioc_wep_keys). 909151411e8SJouni Malinen */ 910151411e8SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay WEP key configuration " 911151411e8SJouni Malinen "until AP mode has been started\n"); 912151411e8SJouni Malinen ar->wep_key_list[key_index].key_len = key->key_len; 913151411e8SJouni Malinen memcpy(ar->wep_key_list[key_index].key, key->key, key->key_len); 914151411e8SJouni Malinen return 0; 915151411e8SJouni Malinen } 916151411e8SJouni Malinen 917bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 918bdcd8170SKalle Valo key_type, key_usage, key->key_len, 919bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 920bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 921bdcd8170SKalle Valo 922bdcd8170SKalle Valo if (status) 923bdcd8170SKalle Valo return -EIO; 924bdcd8170SKalle Valo 925bdcd8170SKalle Valo return 0; 926bdcd8170SKalle Valo } 927bdcd8170SKalle Valo 928bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 929bdcd8170SKalle Valo u8 key_index, bool pairwise, 930bdcd8170SKalle Valo const u8 *mac_addr) 931bdcd8170SKalle Valo { 932bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 933bdcd8170SKalle Valo 934bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 935bdcd8170SKalle Valo 936bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 937bdcd8170SKalle Valo return -EIO; 938bdcd8170SKalle Valo 939bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 940bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 941bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 942bdcd8170SKalle Valo key_index); 943bdcd8170SKalle Valo return -ENOENT; 944bdcd8170SKalle Valo } 945bdcd8170SKalle Valo 946bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 947bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 948bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 949bdcd8170SKalle Valo return 0; 950bdcd8170SKalle Valo } 951bdcd8170SKalle Valo 952bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 953bdcd8170SKalle Valo 954bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 955bdcd8170SKalle Valo } 956bdcd8170SKalle Valo 957bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 958bdcd8170SKalle Valo u8 key_index, bool pairwise, 959bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 960bdcd8170SKalle Valo void (*callback) (void *cookie, 961bdcd8170SKalle Valo struct key_params *)) 962bdcd8170SKalle Valo { 963bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 964bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 965bdcd8170SKalle Valo struct key_params params; 966bdcd8170SKalle Valo 967bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 968bdcd8170SKalle Valo 969bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 970bdcd8170SKalle Valo return -EIO; 971bdcd8170SKalle Valo 972bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 973bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 974bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 975bdcd8170SKalle Valo key_index); 976bdcd8170SKalle Valo return -ENOENT; 977bdcd8170SKalle Valo } 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo key = &ar->keys[key_index]; 980bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 981bdcd8170SKalle Valo params.cipher = key->cipher; 982bdcd8170SKalle Valo params.key_len = key->key_len; 983bdcd8170SKalle Valo params.seq_len = key->seq_len; 984bdcd8170SKalle Valo params.seq = key->seq; 985bdcd8170SKalle Valo params.key = key->key; 986bdcd8170SKalle Valo 987bdcd8170SKalle Valo callback(cookie, ¶ms); 988bdcd8170SKalle Valo 989bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 990bdcd8170SKalle Valo } 991bdcd8170SKalle Valo 992bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 993bdcd8170SKalle Valo struct net_device *ndev, 994bdcd8170SKalle Valo u8 key_index, bool unicast, 995bdcd8170SKalle Valo bool multicast) 996bdcd8170SKalle Valo { 997bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 998bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 999bdcd8170SKalle Valo int status = 0; 1000bdcd8170SKalle Valo u8 key_usage; 1001229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1002bdcd8170SKalle Valo 1003bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1004bdcd8170SKalle Valo 1005bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1006bdcd8170SKalle Valo return -EIO; 1007bdcd8170SKalle Valo 1008bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1009bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1010bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1011bdcd8170SKalle Valo __func__, key_index); 1012bdcd8170SKalle Valo return -ENOENT; 1013bdcd8170SKalle Valo } 1014bdcd8170SKalle Valo 1015bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1016bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1017bdcd8170SKalle Valo __func__, key_index); 1018bdcd8170SKalle Valo return -EINVAL; 1019bdcd8170SKalle Valo } 1020bdcd8170SKalle Valo 1021bdcd8170SKalle Valo ar->def_txkey_index = key_index; 1022bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 1023bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1024bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 1025bdcd8170SKalle Valo key_usage |= TX_USAGE; 1026229ed6b5SEdward Lu if (unicast) 1027229ed6b5SEdward Lu key_type = ar->prwise_crypto; 1028229ed6b5SEdward Lu if (multicast) 1029229ed6b5SEdward Lu key_type = ar->grp_crypto; 1030bdcd8170SKalle Valo 1031151411e8SJouni Malinen if (ar->next_mode == AP_NETWORK && !test_bit(CONNECTED, &ar->flag)) 10329a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10339a5b1318SJouni Malinen 1034bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1035229ed6b5SEdward Lu key_type, key_usage, 1036bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1037bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1038bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1039bdcd8170SKalle Valo if (status) 1040bdcd8170SKalle Valo return -EIO; 1041bdcd8170SKalle Valo 1042bdcd8170SKalle Valo return 0; 1043bdcd8170SKalle Valo } 1044bdcd8170SKalle Valo 1045bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1046bdcd8170SKalle Valo bool ismcast) 1047bdcd8170SKalle Valo { 1048bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1049bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1050bdcd8170SKalle Valo 1051bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1052bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1053bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1054bdcd8170SKalle Valo GFP_KERNEL); 1055bdcd8170SKalle Valo } 1056bdcd8170SKalle Valo 1057bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1058bdcd8170SKalle Valo { 1059bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1060bdcd8170SKalle Valo int ret; 1061bdcd8170SKalle Valo 1062bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1063bdcd8170SKalle Valo changed); 1064bdcd8170SKalle Valo 1065bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1066bdcd8170SKalle Valo return -EIO; 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1069bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1070bdcd8170SKalle Valo if (ret != 0) { 1071bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1072bdcd8170SKalle Valo return -EIO; 1073bdcd8170SKalle Valo } 1074bdcd8170SKalle Valo } 1075bdcd8170SKalle Valo 1076bdcd8170SKalle Valo return 0; 1077bdcd8170SKalle Valo } 1078bdcd8170SKalle Valo 1079bdcd8170SKalle Valo /* 1080bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1081bdcd8170SKalle Valo * data type from 2.6.36 onwards 1082bdcd8170SKalle Valo */ 1083bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1084bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1085bdcd8170SKalle Valo int dbm) 1086bdcd8170SKalle Valo { 1087bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1088bdcd8170SKalle Valo u8 ath6kl_dbm; 1089bdcd8170SKalle Valo 1090bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1091bdcd8170SKalle Valo type, dbm); 1092bdcd8170SKalle Valo 1093bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1094bdcd8170SKalle Valo return -EIO; 1095bdcd8170SKalle Valo 1096bdcd8170SKalle Valo switch (type) { 1097bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1098bdcd8170SKalle Valo return 0; 1099bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1100bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1101bdcd8170SKalle Valo break; 1102bdcd8170SKalle Valo default: 1103bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1104bdcd8170SKalle Valo __func__, type); 1105bdcd8170SKalle Valo return -EOPNOTSUPP; 1106bdcd8170SKalle Valo } 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1109bdcd8170SKalle Valo 1110bdcd8170SKalle Valo return 0; 1111bdcd8170SKalle Valo } 1112bdcd8170SKalle Valo 1113bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1114bdcd8170SKalle Valo { 1115bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1116bdcd8170SKalle Valo 1117bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1118bdcd8170SKalle Valo return -EIO; 1119bdcd8170SKalle Valo 1120bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) { 1121bdcd8170SKalle Valo ar->tx_pwr = 0; 1122bdcd8170SKalle Valo 1123bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1124bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1125bdcd8170SKalle Valo return -EIO; 1126bdcd8170SKalle Valo } 1127bdcd8170SKalle Valo 1128bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1129bdcd8170SKalle Valo 5 * HZ); 1130bdcd8170SKalle Valo 1131bdcd8170SKalle Valo if (signal_pending(current)) { 1132bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1133bdcd8170SKalle Valo return -EINTR; 1134bdcd8170SKalle Valo } 1135bdcd8170SKalle Valo } 1136bdcd8170SKalle Valo 1137bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1138bdcd8170SKalle Valo return 0; 1139bdcd8170SKalle Valo } 1140bdcd8170SKalle Valo 1141bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1142bdcd8170SKalle Valo struct net_device *dev, 1143bdcd8170SKalle Valo bool pmgmt, int timeout) 1144bdcd8170SKalle Valo { 1145bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1146bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1147bdcd8170SKalle Valo 1148bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1149bdcd8170SKalle Valo __func__, pmgmt, timeout); 1150bdcd8170SKalle Valo 1151bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1152bdcd8170SKalle Valo return -EIO; 1153bdcd8170SKalle Valo 1154bdcd8170SKalle Valo if (pmgmt) { 1155bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1156bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1157bdcd8170SKalle Valo } else { 1158bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1159bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1160bdcd8170SKalle Valo } 1161bdcd8170SKalle Valo 1162bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1163bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1164bdcd8170SKalle Valo return -EIO; 1165bdcd8170SKalle Valo } 1166bdcd8170SKalle Valo 1167bdcd8170SKalle Valo return 0; 1168bdcd8170SKalle Valo } 1169bdcd8170SKalle Valo 1170bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1171bdcd8170SKalle Valo struct net_device *ndev, 1172bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1173bdcd8170SKalle Valo struct vif_params *params) 1174bdcd8170SKalle Valo { 1175bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1176bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1177bdcd8170SKalle Valo 1178bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1179bdcd8170SKalle Valo 1180bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1181bdcd8170SKalle Valo return -EIO; 1182bdcd8170SKalle Valo 1183bdcd8170SKalle Valo switch (type) { 1184bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1185bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1186bdcd8170SKalle Valo break; 1187bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1188bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1189bdcd8170SKalle Valo break; 11906e4604c8SJouni Malinen case NL80211_IFTYPE_AP: 11916e4604c8SJouni Malinen ar->next_mode = AP_NETWORK; 11926e4604c8SJouni Malinen break; 11936b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 11946b5e5d25SJouni Malinen ar->next_mode = INFRA_NETWORK; 11956b5e5d25SJouni Malinen break; 11966b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 11976b5e5d25SJouni Malinen ar->next_mode = AP_NETWORK; 11986b5e5d25SJouni Malinen break; 1199bdcd8170SKalle Valo default: 1200bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1201bdcd8170SKalle Valo return -EOPNOTSUPP; 1202bdcd8170SKalle Valo } 1203bdcd8170SKalle Valo 1204bdcd8170SKalle Valo wdev->iftype = type; 1205bdcd8170SKalle Valo 1206bdcd8170SKalle Valo return 0; 1207bdcd8170SKalle Valo } 1208bdcd8170SKalle Valo 1209bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1210bdcd8170SKalle Valo struct net_device *dev, 1211bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1212bdcd8170SKalle Valo { 1213bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1214bdcd8170SKalle Valo int status; 1215bdcd8170SKalle Valo 1216bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1217bdcd8170SKalle Valo return -EIO; 1218bdcd8170SKalle Valo 1219bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1220bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1221bdcd8170SKalle Valo 1222bdcd8170SKalle Valo if (ibss_param->channel) 1223bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1224bdcd8170SKalle Valo 1225bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1226bdcd8170SKalle Valo /* 1227bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1228bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1229bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1230bdcd8170SKalle Valo * updated. 1231bdcd8170SKalle Valo */ 1232bdcd8170SKalle Valo return -EOPNOTSUPP; 1233bdcd8170SKalle Valo } 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1236bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1237bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1238bdcd8170SKalle Valo 1239bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1240bdcd8170SKalle Valo 1241bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1242bdcd8170SKalle Valo if (status) 1243bdcd8170SKalle Valo return status; 1244bdcd8170SKalle Valo 1245bdcd8170SKalle Valo if (ibss_param->privacy) { 1246bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1247bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1248bdcd8170SKalle Valo } else { 1249bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1250bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1251bdcd8170SKalle Valo } 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1254bdcd8170SKalle Valo 1255bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1256bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1257bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1258bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1259bdcd8170SKalle Valo __func__, 1260bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1261bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 126238acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 1263bdcd8170SKalle Valo 1264bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1265bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1266bdcd8170SKalle Valo ar->prwise_crypto, 1267bdcd8170SKalle Valo ar->prwise_crypto_len, 126838acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 1269bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1270bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1271bdcd8170SKalle Valo ar->connect_ctrl_flags); 1272bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 1273bdcd8170SKalle Valo 1274bdcd8170SKalle Valo return 0; 1275bdcd8170SKalle Valo } 1276bdcd8170SKalle Valo 1277bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1278bdcd8170SKalle Valo struct net_device *dev) 1279bdcd8170SKalle Valo { 1280bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1281bdcd8170SKalle Valo 1282bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1283bdcd8170SKalle Valo return -EIO; 1284bdcd8170SKalle Valo 1285bdcd8170SKalle Valo ath6kl_disconnect(ar); 1286bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1287bdcd8170SKalle Valo ar->ssid_len = 0; 1288bdcd8170SKalle Valo 1289bdcd8170SKalle Valo return 0; 1290bdcd8170SKalle Valo } 1291bdcd8170SKalle Valo 1292bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1293bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1294bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1295bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1296bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1297837cb97eSJouni Malinen CCKM_KRK_CIPHER_SUITE, 1298bdcd8170SKalle Valo }; 1299bdcd8170SKalle Valo 1300bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1301bdcd8170SKalle Valo { 1302bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1303bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1304bdcd8170SKalle Valo 36000, 48000, 54000 1305bdcd8170SKalle Valo }; 1306bdcd8170SKalle Valo u8 i; 1307bdcd8170SKalle Valo 1308bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1309bdcd8170SKalle Valo if (rate == legacy[i]) 1310bdcd8170SKalle Valo return true; 1311bdcd8170SKalle Valo 1312bdcd8170SKalle Valo return false; 1313bdcd8170SKalle Valo } 1314bdcd8170SKalle Valo 1315bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1316bdcd8170SKalle Valo { 1317bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1318bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1319bdcd8170SKalle Valo }; 1320bdcd8170SKalle Valo u8 i; 1321bdcd8170SKalle Valo 1322bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1323bdcd8170SKalle Valo if (rate == ht20[i]) { 1324bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1325bdcd8170SKalle Valo /* last rate uses sgi */ 1326bdcd8170SKalle Valo *sgi = true; 1327bdcd8170SKalle Valo else 1328bdcd8170SKalle Valo *sgi = false; 1329bdcd8170SKalle Valo 1330bdcd8170SKalle Valo *mcs = i; 1331bdcd8170SKalle Valo return true; 1332bdcd8170SKalle Valo } 1333bdcd8170SKalle Valo } 1334bdcd8170SKalle Valo return false; 1335bdcd8170SKalle Valo } 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1338bdcd8170SKalle Valo { 1339bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1340bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1341bdcd8170SKalle Valo 150000 1342bdcd8170SKalle Valo }; 1343bdcd8170SKalle Valo u8 i; 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1346bdcd8170SKalle Valo if (rate == ht40[i]) { 1347bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1348bdcd8170SKalle Valo /* last rate uses sgi */ 1349bdcd8170SKalle Valo *sgi = true; 1350bdcd8170SKalle Valo else 1351bdcd8170SKalle Valo *sgi = false; 1352bdcd8170SKalle Valo 1353bdcd8170SKalle Valo *mcs = i; 1354bdcd8170SKalle Valo return true; 1355bdcd8170SKalle Valo } 1356bdcd8170SKalle Valo } 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo return false; 1359bdcd8170SKalle Valo } 1360bdcd8170SKalle Valo 1361bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1362bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1363bdcd8170SKalle Valo { 1364bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1365bdcd8170SKalle Valo long left; 1366bdcd8170SKalle Valo bool sgi; 1367bdcd8170SKalle Valo s32 rate; 1368bdcd8170SKalle Valo int ret; 1369bdcd8170SKalle Valo u8 mcs; 1370bdcd8170SKalle Valo 1371bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1372bdcd8170SKalle Valo return -ENOENT; 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1375bdcd8170SKalle Valo return -EBUSY; 1376bdcd8170SKalle Valo 1377bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1380bdcd8170SKalle Valo 1381bdcd8170SKalle Valo if (ret != 0) { 1382bdcd8170SKalle Valo up(&ar->sem); 1383bdcd8170SKalle Valo return -EIO; 1384bdcd8170SKalle Valo } 1385bdcd8170SKalle Valo 1386bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1387bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1388bdcd8170SKalle Valo &ar->flag), 1389bdcd8170SKalle Valo WMI_TIMEOUT); 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo up(&ar->sem); 1392bdcd8170SKalle Valo 1393bdcd8170SKalle Valo if (left == 0) 1394bdcd8170SKalle Valo return -ETIMEDOUT; 1395bdcd8170SKalle Valo else if (left < 0) 1396bdcd8170SKalle Valo return left; 1397bdcd8170SKalle Valo 1398bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1399bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1400bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1401bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1402bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1403bdcd8170SKalle Valo } 1404bdcd8170SKalle Valo 1405bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1406bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1407bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1408bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1409bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1410bdcd8170SKalle Valo } 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1413bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1416bdcd8170SKalle Valo 1417bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1418bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1419bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1420bdcd8170SKalle Valo if (sgi) { 1421bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1422bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1423bdcd8170SKalle Valo } else { 1424bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1425bdcd8170SKalle Valo } 1426bdcd8170SKalle Valo 1427bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1428bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1429bdcd8170SKalle Valo if (sgi) { 1430bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1431bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1432bdcd8170SKalle Valo } else { 1433bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1437bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1438bdcd8170SKalle Valo } else { 14399a730834SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 14409a730834SKalle Valo "invalid rate from stats: %d\n", rate); 14419a730834SKalle Valo ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1442bdcd8170SKalle Valo return 0; 1443bdcd8170SKalle Valo } 1444bdcd8170SKalle Valo 1445bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1446bdcd8170SKalle Valo 144732c10874SJouni Malinen if (test_bit(CONNECTED, &ar->flag) && 144832c10874SJouni Malinen test_bit(DTIM_PERIOD_AVAIL, &ar->flag) && 144932c10874SJouni Malinen ar->nw_type == INFRA_NETWORK) { 145032c10874SJouni Malinen sinfo->filled |= STATION_INFO_BSS_PARAM; 145132c10874SJouni Malinen sinfo->bss_param.flags = 0; 145232c10874SJouni Malinen sinfo->bss_param.dtim_period = ar->assoc_bss_dtim_period; 145332c10874SJouni Malinen sinfo->bss_param.beacon_interval = ar->assoc_bss_beacon_int; 145432c10874SJouni Malinen } 145532c10874SJouni Malinen 1456bdcd8170SKalle Valo return 0; 1457bdcd8170SKalle Valo } 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1460bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1461bdcd8170SKalle Valo { 1462bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1463bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1464bdcd8170SKalle Valo pmksa->pmkid, true); 1465bdcd8170SKalle Valo } 1466bdcd8170SKalle Valo 1467bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1468bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1469bdcd8170SKalle Valo { 1470bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1471bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1472bdcd8170SKalle Valo pmksa->pmkid, false); 1473bdcd8170SKalle Valo } 1474bdcd8170SKalle Valo 1475bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1476bdcd8170SKalle Valo { 1477bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1478bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) 1479bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1480bdcd8170SKalle Valo return 0; 1481bdcd8170SKalle Valo } 1482bdcd8170SKalle Valo 1483abcb344bSKalle Valo #ifdef CONFIG_PM 1484abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1485abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1486abcb344bSKalle Valo { 1487abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1488abcb344bSKalle Valo 1489abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1490abcb344bSKalle Valo } 1491aa6cffc1SChilam Ng 1492aa6cffc1SChilam Ng static int ar6k_cfg80211_resume(struct wiphy *wiphy) 1493aa6cffc1SChilam Ng { 1494aa6cffc1SChilam Ng struct ath6kl *ar = wiphy_priv(wiphy); 1495aa6cffc1SChilam Ng 1496aa6cffc1SChilam Ng return ath6kl_hif_resume(ar); 1497aa6cffc1SChilam Ng } 1498abcb344bSKalle Valo #endif 1499abcb344bSKalle Valo 15006a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15016a7c9badSJouni Malinen struct ieee80211_channel *chan, 15026a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15036a7c9badSJouni Malinen { 15046a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15056a7c9badSJouni Malinen 15066a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15076a7c9badSJouni Malinen return -EIO; 15086a7c9badSJouni Malinen 15096a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15106a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15116a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15126a7c9badSJouni Malinen 15136a7c9badSJouni Malinen return 0; 15146a7c9badSJouni Malinen } 15156a7c9badSJouni Malinen 15168bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15178bdfbf40SJouni Malinen { 15188bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15198bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15208bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15218bdfbf40SJouni Malinen } 15228bdfbf40SJouni Malinen 15238bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15248bdfbf40SJouni Malinen size_t ies_len) 15258bdfbf40SJouni Malinen { 15268bdfbf40SJouni Malinen const u8 *pos; 15278bdfbf40SJouni Malinen u8 *buf = NULL; 15288bdfbf40SJouni Malinen size_t len = 0; 15298bdfbf40SJouni Malinen int ret; 15308bdfbf40SJouni Malinen 15318bdfbf40SJouni Malinen /* 15328bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15338bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15348bdfbf40SJouni Malinen */ 15358bdfbf40SJouni Malinen 15368bdfbf40SJouni Malinen if (ies && ies_len) { 15378bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15388bdfbf40SJouni Malinen if (buf == NULL) 15398bdfbf40SJouni Malinen return -ENOMEM; 15408bdfbf40SJouni Malinen pos = ies; 15418bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15428bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15438bdfbf40SJouni Malinen break; 15448bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15458bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15468bdfbf40SJouni Malinen len += 2 + pos[1]; 15478bdfbf40SJouni Malinen } 15488bdfbf40SJouni Malinen pos += 2 + pos[1]; 15498bdfbf40SJouni Malinen } 15508bdfbf40SJouni Malinen } 15518bdfbf40SJouni Malinen 15528bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15538bdfbf40SJouni Malinen buf, len); 15548bdfbf40SJouni Malinen kfree(buf); 15558bdfbf40SJouni Malinen return ret; 15568bdfbf40SJouni Malinen } 15578bdfbf40SJouni Malinen 15586a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 15596a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 15606a7c9badSJouni Malinen { 15616a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15626a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 15636a7c9badSJouni Malinen u8 *ies; 15646a7c9badSJouni Malinen int ies_len; 15656a7c9badSJouni Malinen struct wmi_connect_cmd p; 15666a7c9badSJouni Malinen int res; 15676a7c9badSJouni Malinen int i; 15686a7c9badSJouni Malinen 15696a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 15706a7c9badSJouni Malinen 15716a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15726a7c9badSJouni Malinen return -EIO; 15736a7c9badSJouni Malinen 15746a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 15756a7c9badSJouni Malinen return -EOPNOTSUPP; 15766a7c9badSJouni Malinen 15776a7c9badSJouni Malinen if (info->beacon_ies) { 15786a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 15796a7c9badSJouni Malinen info->beacon_ies, 15806a7c9badSJouni Malinen info->beacon_ies_len); 15816a7c9badSJouni Malinen if (res) 15826a7c9badSJouni Malinen return res; 15836a7c9badSJouni Malinen } 15846a7c9badSJouni Malinen if (info->proberesp_ies) { 15858bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 15866a7c9badSJouni Malinen info->proberesp_ies_len); 15876a7c9badSJouni Malinen if (res) 15886a7c9badSJouni Malinen return res; 15896a7c9badSJouni Malinen } 15906a7c9badSJouni Malinen if (info->assocresp_ies) { 15916a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 15926a7c9badSJouni Malinen info->assocresp_ies, 15936a7c9badSJouni Malinen info->assocresp_ies_len); 15946a7c9badSJouni Malinen if (res) 15956a7c9badSJouni Malinen return res; 15966a7c9badSJouni Malinen } 15976a7c9badSJouni Malinen 15986a7c9badSJouni Malinen if (!add) 15996a7c9badSJouni Malinen return 0; 16006a7c9badSJouni Malinen 16019a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16029a5b1318SJouni Malinen 16036a7c9badSJouni Malinen /* TODO: 16046a7c9badSJouni Malinen * info->interval 16056a7c9badSJouni Malinen * info->dtim_period 16066a7c9badSJouni Malinen */ 16076a7c9badSJouni Malinen 16086a7c9badSJouni Malinen if (info->head == NULL) 16096a7c9badSJouni Malinen return -EINVAL; 16106a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16116a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16126a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16136a7c9badSJouni Malinen return -EINVAL; 16146a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16156a7c9badSJouni Malinen 16166a7c9badSJouni Malinen if (info->ssid == NULL) 16176a7c9badSJouni Malinen return -EINVAL; 16186a7c9badSJouni Malinen memcpy(ar->ssid, info->ssid, info->ssid_len); 16196a7c9badSJouni Malinen ar->ssid_len = info->ssid_len; 16206a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16216a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16226a7c9badSJouni Malinen 16236a7c9badSJouni Malinen ar->dot11_auth_mode = OPEN_AUTH; 16246a7c9badSJouni Malinen 16256a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16266a7c9badSJouni Malinen 16276a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16286a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16296a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16306a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16316a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16326a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16336a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16346a7c9badSJouni Malinen break; 16356a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16366a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16376a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16386a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16396a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16406a7c9badSJouni Malinen break; 16416a7c9badSJouni Malinen } 16426a7c9badSJouni Malinen } 16436a7c9badSJouni Malinen if (p.auth_mode == 0) 16446a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16456a7c9badSJouni Malinen ar->auth_mode = p.auth_mode; 16466a7c9badSJouni Malinen 16476a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16486a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16496a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16506a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16516a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16526a7c9badSJouni Malinen break; 16536a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16546a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16556a7c9badSJouni Malinen break; 16566a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16576a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 16586a7c9badSJouni Malinen break; 16596a7c9badSJouni Malinen } 16606a7c9badSJouni Malinen } 1661229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 16626a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1663229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1664229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1665229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 16666a7c9badSJouni Malinen 16676a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 16686a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16706a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 16716a7c9badSJouni Malinen break; 16726a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16736a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 16746a7c9badSJouni Malinen break; 16756a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16766a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 16776a7c9badSJouni Malinen break; 16786a7c9badSJouni Malinen default: 16796a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 16806a7c9badSJouni Malinen break; 16816a7c9badSJouni Malinen } 1682229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 16836a7c9badSJouni Malinen 16846a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 16856a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 16866a7c9badSJouni Malinen 16876a7c9badSJouni Malinen p.ssid_len = ar->ssid_len; 16886a7c9badSJouni Malinen memcpy(p.ssid, ar->ssid, ar->ssid_len); 16896a7c9badSJouni Malinen p.dot11_auth_mode = ar->dot11_auth_mode; 16906a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 16916a7c9badSJouni Malinen 16929a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 16939a5b1318SJouni Malinen if (res < 0) 16949a5b1318SJouni Malinen return res; 16959a5b1318SJouni Malinen 16969a5b1318SJouni Malinen return 0; 16976a7c9badSJouni Malinen } 16986a7c9badSJouni Malinen 16996a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17006a7c9badSJouni Malinen struct beacon_parameters *info) 17016a7c9badSJouni Malinen { 17026a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17036a7c9badSJouni Malinen } 17046a7c9badSJouni Malinen 17056a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17066a7c9badSJouni Malinen struct beacon_parameters *info) 17076a7c9badSJouni Malinen { 17086a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17096a7c9badSJouni Malinen } 17106a7c9badSJouni Malinen 17116a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17126a7c9badSJouni Malinen { 17136a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 17146a7c9badSJouni Malinen 17156a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 17166a7c9badSJouni Malinen return -EOPNOTSUPP; 17176a7c9badSJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) 17186a7c9badSJouni Malinen return -ENOTCONN; 17196a7c9badSJouni Malinen 17206a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 17216a7c9badSJouni Malinen clear_bit(CONNECTED, &ar->flag); 17226a7c9badSJouni Malinen 17236a7c9badSJouni Malinen return 0; 17246a7c9badSJouni Malinen } 17256a7c9badSJouni Malinen 172623875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 172723875136SJouni Malinen u8 *mac, struct station_parameters *params) 172823875136SJouni Malinen { 172923875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 173023875136SJouni Malinen 173123875136SJouni Malinen if (ar->nw_type != AP_NETWORK) 173223875136SJouni Malinen return -EOPNOTSUPP; 173323875136SJouni Malinen 173423875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 173523875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 173623875136SJouni Malinen return -EOPNOTSUPP; 173723875136SJouni Malinen 173823875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 173923875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 174023875136SJouni Malinen mac, 0); 174123875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 174223875136SJouni Malinen 0); 174323875136SJouni Malinen } 174423875136SJouni Malinen 174563fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 174663fa1e0cSJouni Malinen struct net_device *dev, 174763fa1e0cSJouni Malinen struct ieee80211_channel *chan, 174863fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 174963fa1e0cSJouni Malinen unsigned int duration, 175063fa1e0cSJouni Malinen u64 *cookie) 175163fa1e0cSJouni Malinen { 175263fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 175363fa1e0cSJouni Malinen 175463fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 175563fa1e0cSJouni Malinen * return -EBUSY */ 175663fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 175763fa1e0cSJouni Malinen 175863fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 175963fa1e0cSJouni Malinen duration); 176063fa1e0cSJouni Malinen } 176163fa1e0cSJouni Malinen 176263fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 176363fa1e0cSJouni Malinen struct net_device *dev, 176463fa1e0cSJouni Malinen u64 cookie) 176563fa1e0cSJouni Malinen { 176663fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 176763fa1e0cSJouni Malinen 176863fa1e0cSJouni Malinen if (cookie != 1) 176963fa1e0cSJouni Malinen return -ENOENT; 177063fa1e0cSJouni Malinen 177163fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 177263fa1e0cSJouni Malinen } 177363fa1e0cSJouni Malinen 17748bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 17758bdfbf40SJouni Malinen size_t len, unsigned int freq) 17768bdfbf40SJouni Malinen { 17778bdfbf40SJouni Malinen const u8 *pos; 17788bdfbf40SJouni Malinen u8 *p2p; 17798bdfbf40SJouni Malinen int p2p_len; 17808bdfbf40SJouni Malinen int ret; 17818bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 17828bdfbf40SJouni Malinen 17838bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 17848bdfbf40SJouni Malinen 17858bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 17868bdfbf40SJouni Malinen 17878bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 17888bdfbf40SJouni Malinen if (p2p == NULL) 17898bdfbf40SJouni Malinen return -ENOMEM; 17908bdfbf40SJouni Malinen p2p_len = 0; 17918bdfbf40SJouni Malinen 17928bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 17938bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 17948bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 17958bdfbf40SJouni Malinen break; 17968bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 17978bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 17988bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 17998bdfbf40SJouni Malinen } 18008bdfbf40SJouni Malinen pos += 2 + pos[1]; 18018bdfbf40SJouni Malinen } 18028bdfbf40SJouni Malinen 18038bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18048bdfbf40SJouni Malinen p2p, p2p_len); 18058bdfbf40SJouni Malinen kfree(p2p); 18068bdfbf40SJouni Malinen return ret; 18078bdfbf40SJouni Malinen } 18088bdfbf40SJouni Malinen 18098a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18108a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18118a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18128a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 1813e247bd90SJohannes Berg const u8 *buf, size_t len, bool no_cck, 1814e247bd90SJohannes Berg bool dont_wait_for_ack, u64 *cookie) 18158a6c8060SJouni Malinen { 18168a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 18178a6c8060SJouni Malinen u32 id; 18188bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18198bdfbf40SJouni Malinen 18208bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18218bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 18228bdfbf40SJouni Malinen ar->nw_type == AP_NETWORK && test_bit(CONNECTED, &ar->flag) && 18238bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18248bdfbf40SJouni Malinen /* 18258bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18268bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18278bdfbf40SJouni Malinen */ 18288bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18298bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18308bdfbf40SJouni Malinen chan->center_freq); 18318bdfbf40SJouni Malinen } 18328a6c8060SJouni Malinen 18338a6c8060SJouni Malinen id = ar->send_action_id++; 18348a6c8060SJouni Malinen if (id == 0) { 18358a6c8060SJouni Malinen /* 18368a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18378a6c8060SJouni Malinen * used for the command. 18388a6c8060SJouni Malinen */ 18398a6c8060SJouni Malinen id = ar->send_action_id++; 18408a6c8060SJouni Malinen } 18418a6c8060SJouni Malinen 18428a6c8060SJouni Malinen *cookie = id; 18438a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18448a6c8060SJouni Malinen buf, len); 18458a6c8060SJouni Malinen } 18468a6c8060SJouni Malinen 1847ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1848ae32c30aSJouni Malinen struct net_device *dev, 1849ae32c30aSJouni Malinen u16 frame_type, bool reg) 1850ae32c30aSJouni Malinen { 1851ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1852ae32c30aSJouni Malinen 1853ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1854ae32c30aSJouni Malinen __func__, frame_type, reg); 1855ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1856ae32c30aSJouni Malinen /* 1857ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1858ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1859ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1860ae32c30aSJouni Malinen */ 1861ae32c30aSJouni Malinen ar->probe_req_report = reg; 1862ae32c30aSJouni Malinen } 1863ae32c30aSJouni Malinen } 1864ae32c30aSJouni Malinen 1865f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1866f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1867f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1868f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1869f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1870f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1871f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1872f80574aeSJouni Malinen }, 1873f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1874f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1875f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1876f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1877f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1878f80574aeSJouni Malinen }, 1879f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1880f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1881f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1882f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1883f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1884f80574aeSJouni Malinen }, 1885f80574aeSJouni Malinen }; 1886f80574aeSJouni Malinen 1887bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1888bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1889bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1890bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1891bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1892bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1893bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1894bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1895bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1896bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1897bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1898bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1899bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1900bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1901bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1902bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1903bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1904bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1905bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1906003353b0SKalle Valo CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 1907abcb344bSKalle Valo #ifdef CONFIG_PM 1908abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1909aa6cffc1SChilam Ng .resume = ar6k_cfg80211_resume, 1910abcb344bSKalle Valo #endif 19116a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19126a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19136a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19146a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 191523875136SJouni Malinen .change_station = ath6kl_change_station, 191663fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 191763fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19188a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1919ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1920bdcd8170SKalle Valo }; 1921bdcd8170SKalle Valo 1922bdcd8170SKalle Valo struct wireless_dev *ath6kl_cfg80211_init(struct device *dev) 1923bdcd8170SKalle Valo { 1924bdcd8170SKalle Valo int ret = 0; 1925bdcd8170SKalle Valo struct wireless_dev *wdev; 19266bbc7c35SJouni Malinen struct ath6kl *ar; 1927bdcd8170SKalle Valo 1928bdcd8170SKalle Valo wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL); 1929bdcd8170SKalle Valo if (!wdev) { 1930bdcd8170SKalle Valo ath6kl_err("couldn't allocate wireless device\n"); 1931bdcd8170SKalle Valo return NULL; 1932bdcd8170SKalle Valo } 1933bdcd8170SKalle Valo 1934bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1935bdcd8170SKalle Valo wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 1936bdcd8170SKalle Valo if (!wdev->wiphy) { 1937bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1938bdcd8170SKalle Valo kfree(wdev); 1939bdcd8170SKalle Valo return NULL; 1940bdcd8170SKalle Valo } 1941bdcd8170SKalle Valo 19426bbc7c35SJouni Malinen ar = wiphy_priv(wdev->wiphy); 19436bbc7c35SJouni Malinen ar->p2p = !!ath6kl_p2p; 19446bbc7c35SJouni Malinen 1945f80574aeSJouni Malinen wdev->wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 1946f80574aeSJouni Malinen 194763fa1e0cSJouni Malinen wdev->wiphy->max_remain_on_channel_duration = 5000; 194863fa1e0cSJouni Malinen 1949bdcd8170SKalle Valo /* set device pointer for wiphy */ 1950bdcd8170SKalle Valo set_wiphy_dev(wdev->wiphy, dev); 1951bdcd8170SKalle Valo 1952bdcd8170SKalle Valo wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 19536e4604c8SJouni Malinen BIT(NL80211_IFTYPE_ADHOC) | BIT(NL80211_IFTYPE_AP); 19546bbc7c35SJouni Malinen if (ar->p2p) { 19556bbc7c35SJouni Malinen wdev->wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 19566bbc7c35SJouni Malinen BIT(NL80211_IFTYPE_P2P_CLIENT); 19576bbc7c35SJouni Malinen } 1958bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 1959bdcd8170SKalle Valo wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 1960b84da8c7SJouni Malinen wdev->wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 1961bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 1962bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 1963bdcd8170SKalle Valo wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 1964bdcd8170SKalle Valo 1965bdcd8170SKalle Valo wdev->wiphy->cipher_suites = cipher_suites; 1966bdcd8170SKalle Valo wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 1967bdcd8170SKalle Valo 1968bdcd8170SKalle Valo ret = wiphy_register(wdev->wiphy); 1969bdcd8170SKalle Valo if (ret < 0) { 1970bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 1971bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1972bdcd8170SKalle Valo kfree(wdev); 1973bdcd8170SKalle Valo return NULL; 1974bdcd8170SKalle Valo } 1975bdcd8170SKalle Valo 1976bdcd8170SKalle Valo return wdev; 1977bdcd8170SKalle Valo } 1978bdcd8170SKalle Valo 1979bdcd8170SKalle Valo void ath6kl_cfg80211_deinit(struct ath6kl *ar) 1980bdcd8170SKalle Valo { 1981bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1982bdcd8170SKalle Valo 1983bdcd8170SKalle Valo if (ar->scan_req) { 1984bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 1985bdcd8170SKalle Valo ar->scan_req = NULL; 1986bdcd8170SKalle Valo } 1987bdcd8170SKalle Valo 1988bdcd8170SKalle Valo if (!wdev) 1989bdcd8170SKalle Valo return; 1990bdcd8170SKalle Valo 1991bdcd8170SKalle Valo wiphy_unregister(wdev->wiphy); 1992bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1993bdcd8170SKalle Valo kfree(wdev); 1994bdcd8170SKalle Valo } 1995