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" 21bdcd8170SKalle Valo 22bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 23bdcd8170SKalle Valo .bitrate = (_rate), \ 24bdcd8170SKalle Valo .flags = (_flags), \ 25bdcd8170SKalle Valo .hw_value = (_rateid), \ 26bdcd8170SKalle Valo } 27bdcd8170SKalle Valo 28bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 29bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 30bdcd8170SKalle Valo .hw_value = (_channel), \ 31bdcd8170SKalle Valo .center_freq = (_freq), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .max_antenna_gain = 0, \ 34bdcd8170SKalle Valo .max_power = 30, \ 35bdcd8170SKalle Valo } 36bdcd8170SKalle Valo 37bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 38bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 39bdcd8170SKalle Valo .hw_value = (_channel), \ 40bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 41bdcd8170SKalle Valo .flags = (_flags), \ 42bdcd8170SKalle Valo .max_antenna_gain = 0, \ 43bdcd8170SKalle Valo .max_power = 30, \ 44bdcd8170SKalle Valo } 45bdcd8170SKalle Valo 46bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 47bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 48bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 49bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 50bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 51bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 52bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 53bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 54bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 55bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 56bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 57bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 58bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 59bdcd8170SKalle Valo }; 60bdcd8170SKalle Valo 61bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 62bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 63bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 64bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 65bdcd8170SKalle Valo 66bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 67bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 68bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 69bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 70bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 71bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 72bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 73bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 74bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 75bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 76bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 77bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 78bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 79bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 80bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 81bdcd8170SKalle Valo }; 82bdcd8170SKalle Valo 83bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 84bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 85bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 86bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 87bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 88bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 89bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 90bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 91bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 92bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 93bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 94bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 95bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 96bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 97bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 98bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 99bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 100bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 101bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 102bdcd8170SKalle Valo CHAN5G(216, 0), 103bdcd8170SKalle Valo }; 104bdcd8170SKalle Valo 105bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 106bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 107bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 108bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 109bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 110bdcd8170SKalle Valo }; 111bdcd8170SKalle Valo 112bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 113bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 114bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 115bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 116bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 117bdcd8170SKalle Valo }; 118bdcd8170SKalle Valo 119bdcd8170SKalle Valo static int ath6kl_set_wpa_version(struct ath6kl *ar, 120bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 121bdcd8170SKalle Valo { 122bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 123bdcd8170SKalle Valo 124bdcd8170SKalle Valo if (!wpa_version) { 125bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 126bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 127bdcd8170SKalle Valo ar->auth_mode = WPA2_AUTH; 128bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 129bdcd8170SKalle Valo ar->auth_mode = WPA_AUTH; 130bdcd8170SKalle Valo } else { 131bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 132bdcd8170SKalle Valo return -ENOTSUPP; 133bdcd8170SKalle Valo } 134bdcd8170SKalle Valo 135bdcd8170SKalle Valo return 0; 136bdcd8170SKalle Valo } 137bdcd8170SKalle Valo 138bdcd8170SKalle Valo static int ath6kl_set_auth_type(struct ath6kl *ar, 139bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 140bdcd8170SKalle Valo { 141bdcd8170SKalle Valo 142bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 143bdcd8170SKalle Valo 144bdcd8170SKalle Valo switch (auth_type) { 145bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 146bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 147bdcd8170SKalle Valo break; 148bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 149bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 150bdcd8170SKalle Valo break; 151bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 152bdcd8170SKalle Valo ar->dot11_auth_mode = LEAP_AUTH; 153bdcd8170SKalle Valo break; 154bdcd8170SKalle Valo 155bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 156bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 157bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_OPEN_IN_PROGRESS; 158bdcd8170SKalle Valo break; 159bdcd8170SKalle Valo 160bdcd8170SKalle Valo default: 161bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 162bdcd8170SKalle Valo return -ENOTSUPP; 163bdcd8170SKalle Valo } 164bdcd8170SKalle Valo 165bdcd8170SKalle Valo return 0; 166bdcd8170SKalle Valo } 167bdcd8170SKalle Valo 168bdcd8170SKalle Valo static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast) 169bdcd8170SKalle Valo { 170bdcd8170SKalle Valo u8 *ar_cipher = ucast ? &ar->prwise_crypto : &ar->grp_crypto; 17138acde3cSEdward Lu u8 *ar_cipher_len = ucast ? &ar->prwise_crypto_len : 17238acde3cSEdward Lu &ar->grp_crypto_len; 173bdcd8170SKalle Valo 174bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 175bdcd8170SKalle Valo __func__, cipher, ucast); 176bdcd8170SKalle Valo 177bdcd8170SKalle Valo switch (cipher) { 178bdcd8170SKalle Valo case 0: 179bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 180bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 181bdcd8170SKalle Valo *ar_cipher_len = 0; 182bdcd8170SKalle Valo break; 183bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 184bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 185bdcd8170SKalle Valo *ar_cipher_len = 5; 186bdcd8170SKalle Valo break; 187bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 188bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 189bdcd8170SKalle Valo *ar_cipher_len = 13; 190bdcd8170SKalle Valo break; 191bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 192bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 193bdcd8170SKalle Valo *ar_cipher_len = 0; 194bdcd8170SKalle Valo break; 195bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 196bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 197bdcd8170SKalle Valo *ar_cipher_len = 0; 198bdcd8170SKalle Valo break; 199bdcd8170SKalle Valo default: 200bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 201bdcd8170SKalle Valo return -ENOTSUPP; 202bdcd8170SKalle Valo } 203bdcd8170SKalle Valo 204bdcd8170SKalle Valo return 0; 205bdcd8170SKalle Valo } 206bdcd8170SKalle Valo 207bdcd8170SKalle Valo static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt) 208bdcd8170SKalle Valo { 209bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 212bdcd8170SKalle Valo if (ar->auth_mode == WPA_AUTH) 213bdcd8170SKalle Valo ar->auth_mode = WPA_PSK_AUTH; 214bdcd8170SKalle Valo else if (ar->auth_mode == WPA2_AUTH) 215bdcd8170SKalle Valo ar->auth_mode = WPA2_PSK_AUTH; 216bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 217bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 218bdcd8170SKalle Valo } 219bdcd8170SKalle Valo } 220bdcd8170SKalle Valo 221bdcd8170SKalle Valo static bool ath6kl_cfg80211_ready(struct ath6kl *ar) 222bdcd8170SKalle Valo { 223bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 224bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 225bdcd8170SKalle Valo return false; 226bdcd8170SKalle Valo } 227bdcd8170SKalle Valo 228575b5f34SRaja Mani if (!test_bit(WLAN_ENABLED, &ar->flag)) { 229bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 230bdcd8170SKalle Valo return false; 231bdcd8170SKalle Valo } 232bdcd8170SKalle Valo 233bdcd8170SKalle Valo return true; 234bdcd8170SKalle Valo } 235bdcd8170SKalle Valo 236bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 237bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 238bdcd8170SKalle Valo { 239bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 240bdcd8170SKalle Valo int status; 241bdcd8170SKalle Valo 242bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 243bdcd8170SKalle Valo 244bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 245bdcd8170SKalle Valo return -EIO; 246bdcd8170SKalle Valo 247bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 248bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 249bdcd8170SKalle Valo return -EBUSY; 250bdcd8170SKalle Valo } 251bdcd8170SKalle Valo 252bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 253bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 254bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 255bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 256bdcd8170SKalle Valo return -EINVAL; 257bdcd8170SKalle Valo } 258bdcd8170SKalle Valo 259bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 260bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 261bdcd8170SKalle Valo return -ERESTARTSYS; 262bdcd8170SKalle Valo } 263bdcd8170SKalle Valo 264bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 265bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 266bdcd8170SKalle Valo up(&ar->sem); 267bdcd8170SKalle Valo return -EBUSY; 268bdcd8170SKalle Valo } 269bdcd8170SKalle Valo 270bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 271bdcd8170SKalle Valo /* 272bdcd8170SKalle Valo * sleep until the command queue drains 273bdcd8170SKalle Valo */ 274bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 275bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 276bdcd8170SKalle Valo WMI_TIMEOUT); 277bdcd8170SKalle Valo if (signal_pending(current)) { 278bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 279bdcd8170SKalle Valo up(&ar->sem); 280bdcd8170SKalle Valo return -EINTR; 281bdcd8170SKalle Valo } 282bdcd8170SKalle Valo } 283bdcd8170SKalle Valo 284bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag) && 285bdcd8170SKalle Valo ar->ssid_len == sme->ssid_len && 286bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 287bdcd8170SKalle Valo ar->reconnect_flag = true; 288bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 289bdcd8170SKalle Valo ar->ch_hint); 290bdcd8170SKalle Valo 291bdcd8170SKalle Valo up(&ar->sem); 292bdcd8170SKalle Valo if (status) { 293bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 294bdcd8170SKalle Valo return -EIO; 295bdcd8170SKalle Valo } 296bdcd8170SKalle Valo return 0; 297bdcd8170SKalle Valo } else if (ar->ssid_len == sme->ssid_len && 298bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 299bdcd8170SKalle Valo ath6kl_disconnect(ar); 300bdcd8170SKalle Valo } 301bdcd8170SKalle Valo 302bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 303bdcd8170SKalle Valo ar->ssid_len = sme->ssid_len; 304bdcd8170SKalle Valo memcpy(ar->ssid, sme->ssid, sme->ssid_len); 305bdcd8170SKalle Valo 306bdcd8170SKalle Valo if (sme->channel) 307bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 308bdcd8170SKalle Valo 309bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 310bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 311bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 312bdcd8170SKalle Valo 313bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 314bdcd8170SKalle Valo 315bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 316bdcd8170SKalle Valo if (status) { 317bdcd8170SKalle Valo up(&ar->sem); 318bdcd8170SKalle Valo return status; 319bdcd8170SKalle Valo } 320bdcd8170SKalle Valo 321bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 322bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 323bdcd8170SKalle Valo else 324bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 325bdcd8170SKalle Valo 326bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 327bdcd8170SKalle Valo 328bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 329bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 330bdcd8170SKalle Valo 331bdcd8170SKalle Valo if ((sme->key_len) && 332bdcd8170SKalle Valo (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) { 333bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 334bdcd8170SKalle Valo 335bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 336bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 337bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 338bdcd8170SKalle Valo sme->key_idx); 339bdcd8170SKalle Valo up(&ar->sem); 340bdcd8170SKalle Valo return -ENOENT; 341bdcd8170SKalle Valo } 342bdcd8170SKalle Valo 343bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 344bdcd8170SKalle Valo key->key_len = sme->key_len; 345bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 346bdcd8170SKalle Valo key->cipher = ar->prwise_crypto; 347bdcd8170SKalle Valo ar->def_txkey_index = sme->key_idx; 348bdcd8170SKalle Valo 349bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 350bdcd8170SKalle Valo ar->prwise_crypto, 351bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 352bdcd8170SKalle Valo key->key_len, 353bdcd8170SKalle Valo NULL, 354bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 355bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 356bdcd8170SKalle Valo } 357bdcd8170SKalle Valo 358bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 359bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 360bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 361bdcd8170SKalle Valo up(&ar->sem); 362bdcd8170SKalle Valo return -EIO; 363bdcd8170SKalle Valo } 364bdcd8170SKalle Valo } 365bdcd8170SKalle Valo 366bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 367bdcd8170SKalle Valo 368bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 369bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 370bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 371bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 372bdcd8170SKalle Valo __func__, 373bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 374bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 37538acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 376bdcd8170SKalle Valo 377bdcd8170SKalle Valo ar->reconnect_flag = 0; 378bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 379bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 380bdcd8170SKalle Valo ar->prwise_crypto, 381bdcd8170SKalle Valo ar->prwise_crypto_len, 38238acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 383bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 384bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 385bdcd8170SKalle Valo ar->connect_ctrl_flags); 386bdcd8170SKalle Valo 387bdcd8170SKalle Valo up(&ar->sem); 388bdcd8170SKalle Valo 389bdcd8170SKalle Valo if (status == -EINVAL) { 390bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 391bdcd8170SKalle Valo ar->ssid_len = 0; 392bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 393bdcd8170SKalle Valo return -ENOENT; 394bdcd8170SKalle Valo } else if (status) { 395bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 396bdcd8170SKalle Valo return -EIO; 397bdcd8170SKalle Valo } 398bdcd8170SKalle Valo 399bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 400bdcd8170SKalle Valo ((ar->auth_mode == WPA_PSK_AUTH) 401bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH))) { 402bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 403bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 404bdcd8170SKalle Valo } 405bdcd8170SKalle Valo 406bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 407bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 408bdcd8170SKalle Valo 409bdcd8170SKalle Valo return 0; 410bdcd8170SKalle Valo } 411bdcd8170SKalle Valo 412bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 413bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 414bdcd8170SKalle Valo u16 beacon_intvl, 415bdcd8170SKalle Valo enum network_type nw_type, 416bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 417bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 418bdcd8170SKalle Valo { 419bdcd8170SKalle Valo u16 size = 0; 420bdcd8170SKalle Valo u16 capability = 0; 421bdcd8170SKalle Valo struct cfg80211_bss *bss = NULL; 422bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt = NULL; 423bdcd8170SKalle Valo struct ieee80211_channel *ibss_ch = NULL; 424bdcd8170SKalle Valo s32 signal = 50 * 100; 425bdcd8170SKalle Valo u8 ie_buf_len = 0; 426bdcd8170SKalle Valo unsigned char ie_buf[256]; 427bdcd8170SKalle Valo unsigned char *ptr_ie_buf = ie_buf; 428bdcd8170SKalle Valo unsigned char *ieeemgmtbuf = NULL; 429bdcd8170SKalle Valo u8 source_mac[ETH_ALEN]; 430bdcd8170SKalle Valo 431bdcd8170SKalle Valo /* capinfo + listen interval */ 432bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 433bdcd8170SKalle Valo 434bdcd8170SKalle Valo /* capinfo + status code + associd */ 435bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 436bdcd8170SKalle Valo 437bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 438bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 439bdcd8170SKalle Valo assoc_resp_ie_offset; 440bdcd8170SKalle Valo 441bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 442bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 443bdcd8170SKalle Valo 444bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 447bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 448bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 449bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 450bdcd8170SKalle Valo return; 451bdcd8170SKalle Valo } 452bdcd8170SKalle Valo } 453bdcd8170SKalle Valo 454bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 4556b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 4566b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 457bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 458bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 459bdcd8170SKalle Valo return; 460bdcd8170SKalle Valo } 461bdcd8170SKalle Valo } 462bdcd8170SKalle Valo 463bdcd8170SKalle Valo /* 464bdcd8170SKalle Valo * Earlier we were updating the cfg about bss by making a beacon frame 465bdcd8170SKalle Valo * only if the entry for bss is not there. This can have some issue if 466bdcd8170SKalle Valo * ROAM event is generated and a heavy traffic is ongoing. The ROAM 467bdcd8170SKalle Valo * event is handled through a work queue and by the time it really gets 468bdcd8170SKalle Valo * handled, BSS would have been aged out. So it is better to update the 469bdcd8170SKalle Valo * cfg about BSS irrespective of its entry being present right now or 470bdcd8170SKalle Valo * not. 471bdcd8170SKalle Valo */ 472bdcd8170SKalle Valo 473bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 474bdcd8170SKalle Valo /* construct 802.11 mgmt beacon */ 475bdcd8170SKalle Valo if (ptr_ie_buf) { 476bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_SSID; 477bdcd8170SKalle Valo *ptr_ie_buf++ = ar->ssid_len; 478bdcd8170SKalle Valo memcpy(ptr_ie_buf, ar->ssid, ar->ssid_len); 479bdcd8170SKalle Valo ptr_ie_buf += ar->ssid_len; 480bdcd8170SKalle Valo 481bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_IBSS_PARAMS; 482bdcd8170SKalle Valo *ptr_ie_buf++ = 2; /* length */ 483bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 484bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 485bdcd8170SKalle Valo 486bdcd8170SKalle Valo /* TODO: update ibss params and include supported rates, 487bdcd8170SKalle Valo * DS param set, extened support rates, wmm. */ 488bdcd8170SKalle Valo 489bdcd8170SKalle Valo ie_buf_len = ptr_ie_buf - ie_buf; 490bdcd8170SKalle Valo } 491bdcd8170SKalle Valo 492bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_IBSS; 493bdcd8170SKalle Valo 494bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 495bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_PRIVACY; 496bdcd8170SKalle Valo 497bdcd8170SKalle Valo memcpy(source_mac, ar->net_dev->dev_addr, ETH_ALEN); 498bdcd8170SKalle Valo ptr_ie_buf = ie_buf; 499bdcd8170SKalle Valo } else { 500bdcd8170SKalle Valo capability = *(u16 *) (&assoc_info[beacon_ie_len]); 501bdcd8170SKalle Valo memcpy(source_mac, bssid, ETH_ALEN); 502bdcd8170SKalle Valo ptr_ie_buf = assoc_req_ie; 503bdcd8170SKalle Valo ie_buf_len = assoc_req_len; 504bdcd8170SKalle Valo } 505bdcd8170SKalle Valo 506bdcd8170SKalle Valo size = offsetof(struct ieee80211_mgmt, u) 507bdcd8170SKalle Valo + sizeof(mgmt->u.beacon) 508bdcd8170SKalle Valo + ie_buf_len; 509bdcd8170SKalle Valo 510bdcd8170SKalle Valo ieeemgmtbuf = kzalloc(size, GFP_ATOMIC); 511bdcd8170SKalle Valo if (!ieeemgmtbuf) { 512bdcd8170SKalle Valo ath6kl_err("ieee mgmt buf alloc error\n"); 513bdcd8170SKalle Valo return; 514bdcd8170SKalle Valo } 515bdcd8170SKalle Valo 516bdcd8170SKalle Valo mgmt = (struct ieee80211_mgmt *)ieeemgmtbuf; 517bdcd8170SKalle Valo mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 518bdcd8170SKalle Valo IEEE80211_STYPE_BEACON); 519bdcd8170SKalle Valo memset(mgmt->da, 0xff, ETH_ALEN); /* broadcast addr */ 520bdcd8170SKalle Valo memcpy(mgmt->sa, source_mac, ETH_ALEN); 521bdcd8170SKalle Valo memcpy(mgmt->bssid, bssid, ETH_ALEN); 522bdcd8170SKalle Valo mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_intvl); 523bdcd8170SKalle Valo mgmt->u.beacon.capab_info = cpu_to_le16(capability); 524bdcd8170SKalle Valo memcpy(mgmt->u.beacon.variable, ptr_ie_buf, ie_buf_len); 525bdcd8170SKalle Valo 526bdcd8170SKalle Valo ibss_ch = ieee80211_get_channel(ar->wdev->wiphy, (int)channel); 527bdcd8170SKalle Valo 528bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 529bdcd8170SKalle Valo "%s: inform bss with bssid %pM channel %d beacon_intvl %d capability 0x%x\n", 530bdcd8170SKalle Valo __func__, mgmt->bssid, ibss_ch->hw_value, 531bdcd8170SKalle Valo beacon_intvl, capability); 532bdcd8170SKalle Valo 533bdcd8170SKalle Valo bss = cfg80211_inform_bss_frame(ar->wdev->wiphy, 534bdcd8170SKalle Valo ibss_ch, mgmt, 535bdcd8170SKalle Valo size, signal, GFP_KERNEL); 536bdcd8170SKalle Valo kfree(ieeemgmtbuf); 537bdcd8170SKalle Valo cfg80211_put_bss(bss); 538bdcd8170SKalle Valo 539bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 540bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 541bdcd8170SKalle Valo return; 542bdcd8170SKalle Valo } 543bdcd8170SKalle Valo 5449aa60357SRaja Mani if (ar->sme_state == SME_CONNECTING) { 545bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 5469aa60357SRaja Mani ar->sme_state = SME_CONNECTED; 547bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 548bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 549bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 550bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 5519aa60357SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 552bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 553bdcd8170SKalle Valo cfg80211_roamed(ar->net_dev, ibss_ch, bssid, 554bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 555bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 556bdcd8170SKalle Valo } 557bdcd8170SKalle Valo } 558bdcd8170SKalle Valo 559bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 560bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 561bdcd8170SKalle Valo { 562bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 563bdcd8170SKalle Valo 564bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 565bdcd8170SKalle Valo reason_code); 566bdcd8170SKalle Valo 567bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 568bdcd8170SKalle Valo return -EIO; 569bdcd8170SKalle Valo 570bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 571bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 572bdcd8170SKalle Valo return -EBUSY; 573bdcd8170SKalle Valo } 574bdcd8170SKalle Valo 575bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 576bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 577bdcd8170SKalle Valo return -ERESTARTSYS; 578bdcd8170SKalle Valo } 579bdcd8170SKalle Valo 580bdcd8170SKalle Valo ar->reconnect_flag = 0; 581bdcd8170SKalle Valo ath6kl_disconnect(ar); 582bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 583bdcd8170SKalle Valo ar->ssid_len = 0; 584bdcd8170SKalle Valo 585bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 586bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 587bdcd8170SKalle Valo 588bdcd8170SKalle Valo up(&ar->sem); 589bdcd8170SKalle Valo 590bdcd8170SKalle Valo return 0; 591bdcd8170SKalle Valo } 592bdcd8170SKalle Valo 593bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 594bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 595bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 596bdcd8170SKalle Valo { 597bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 598bdcd8170SKalle Valo u16 status; 599bdcd8170SKalle Valo 600bdcd8170SKalle Valo if (ar->scan_req) { 601bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 602bdcd8170SKalle Valo ar->scan_req = NULL; 603bdcd8170SKalle Valo } 604bdcd8170SKalle Valo 605bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 606bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 607bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 608bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 609bdcd8170SKalle Valo return; 610bdcd8170SKalle Valo } 611bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 612bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 613bdcd8170SKalle Valo return; 614bdcd8170SKalle Valo } 615bdcd8170SKalle Valo 616bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 6176b5e5d25SJouni Malinen if (ar->wdev->iftype != NL80211_IFTYPE_STATION && 6186b5e5d25SJouni Malinen ar->wdev->iftype != NL80211_IFTYPE_P2P_CLIENT) { 619bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 620bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 621bdcd8170SKalle Valo return; 622bdcd8170SKalle Valo } 623bdcd8170SKalle Valo } 624bdcd8170SKalle Valo 625bdcd8170SKalle Valo if (!test_bit(CONNECT_PEND, &ar->flag)) { 626bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 627bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 628bdcd8170SKalle Valo 629bdcd8170SKalle Valo return; 630bdcd8170SKalle Valo } 631bdcd8170SKalle Valo 632bdcd8170SKalle Valo if (reason == NO_NETWORK_AVAIL) { 633bdcd8170SKalle Valo /* connect cmd failed */ 634bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 635bdcd8170SKalle Valo return; 636bdcd8170SKalle Valo } 637bdcd8170SKalle Valo 638bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 639bdcd8170SKalle Valo return; 640bdcd8170SKalle Valo 641bdcd8170SKalle Valo if (!ar->auto_auth_stage) { 642bdcd8170SKalle Valo clear_bit(CONNECT_PEND, &ar->flag); 643bdcd8170SKalle Valo 644bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 645bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 646bdcd8170SKalle Valo bssid, NULL, 0, 647bdcd8170SKalle Valo NULL, 0, 648bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 649bdcd8170SKalle Valo GFP_KERNEL); 6500e5cc8e6SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 651bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 652bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 653bdcd8170SKalle Valo } 654bdcd8170SKalle Valo 655bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 656bdcd8170SKalle Valo return; 657bdcd8170SKalle Valo } 658bdcd8170SKalle Valo 659bdcd8170SKalle Valo if (ar->dot11_auth_mode != OPEN_AUTH) 660bdcd8170SKalle Valo return; 661bdcd8170SKalle Valo 662bdcd8170SKalle Valo /* 663bdcd8170SKalle Valo * If the current auth algorithm is open, try shared and 664bdcd8170SKalle Valo * make autoAuthStage idle. We do not make it leap for now 665bdcd8170SKalle Valo * being. 666bdcd8170SKalle Valo */ 667bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 668bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 669bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 670bdcd8170SKalle Valo return; 671bdcd8170SKalle Valo } 672bdcd8170SKalle Valo 673bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 674bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 675bdcd8170SKalle Valo 676bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, 677bdcd8170SKalle Valo ar->def_txkey_index, 678bdcd8170SKalle Valo ar->prwise_crypto, 679bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 680bdcd8170SKalle Valo key->key_len, NULL, 681bdcd8170SKalle Valo key->key, 682bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 683bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 684bdcd8170SKalle Valo 685bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, 686bdcd8170SKalle Valo ar->nw_type, 687bdcd8170SKalle Valo ar->dot11_auth_mode, 688bdcd8170SKalle Valo ar->auth_mode, 689bdcd8170SKalle Valo ar->prwise_crypto, 690bdcd8170SKalle Valo ar->prwise_crypto_len, 691bdcd8170SKalle Valo ar->grp_crypto, 69238acde3cSEdward Lu ar->grp_crypto_len, 693bdcd8170SKalle Valo ar->ssid_len, 694bdcd8170SKalle Valo ar->ssid, 695bdcd8170SKalle Valo ar->req_bssid, 696bdcd8170SKalle Valo ar->ch_hint, 697bdcd8170SKalle Valo ar->connect_ctrl_flags); 698bdcd8170SKalle Valo up(&ar->sem); 699bdcd8170SKalle Valo } 700bdcd8170SKalle Valo 701bdcd8170SKalle Valo static inline bool is_ch_11a(u16 ch) 702bdcd8170SKalle Valo { 703bdcd8170SKalle Valo return (!((ch >= 2412) && (ch <= 2484))); 704bdcd8170SKalle Valo } 705bdcd8170SKalle Valo 706cf104c2aSKalle Valo /* struct ath6kl_node_table::nt_nodelock is locked when calling this */ 70791db35daSVasanthakumar Thiagarajan void ath6kl_cfg80211_scan_node(struct wiphy *wiphy, struct bss *ni) 708bdcd8170SKalle Valo { 709bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt; 710bdcd8170SKalle Valo struct ieee80211_channel *channel; 711bdcd8170SKalle Valo struct ieee80211_supported_band *band; 712bdcd8170SKalle Valo struct ath6kl_common_ie *cie; 713bdcd8170SKalle Valo s32 signal; 714bdcd8170SKalle Valo int freq; 715bdcd8170SKalle Valo 716bdcd8170SKalle Valo cie = &ni->ni_cie; 717bdcd8170SKalle Valo 718bdcd8170SKalle Valo if (is_ch_11a(cie->ie_chan)) 719bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_5GHZ]; /* 11a */ 720bdcd8170SKalle Valo else if ((cie->ie_erp) || (cie->ie_xrates)) 721bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11g */ 722bdcd8170SKalle Valo else 723bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11b */ 724bdcd8170SKalle Valo 725bdcd8170SKalle Valo freq = cie->ie_chan; 726bdcd8170SKalle Valo channel = ieee80211_get_channel(wiphy, freq); 727bdcd8170SKalle Valo signal = ni->ni_snr * 100; 728bdcd8170SKalle Valo 729bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 730bdcd8170SKalle Valo "%s: bssid %pM ch %d freq %d size %d\n", __func__, 7310ce77920SJouni Malinen ni->ni_macaddr, channel->hw_value, freq, ni->ni_framelen); 7320ce77920SJouni Malinen /* 7330ce77920SJouni Malinen * Both Beacon and Probe Response frames have same payload structure, 7340ce77920SJouni Malinen * so it is fine to share the parser for both. 7350ce77920SJouni Malinen */ 7360ce77920SJouni Malinen if (ni->ni_framelen < 8 + 2 + 2) 7370ce77920SJouni Malinen return; 7380ce77920SJouni Malinen mgmt = (struct ieee80211_mgmt *) (ni->ni_buf - 7390ce77920SJouni Malinen offsetof(struct ieee80211_mgmt, u)); 7400ce77920SJouni Malinen cfg80211_inform_bss(wiphy, channel, ni->ni_macaddr, 7410ce77920SJouni Malinen le64_to_cpu(mgmt->u.beacon.timestamp), 7420ce77920SJouni Malinen le16_to_cpu(mgmt->u.beacon.capab_info), 7430ce77920SJouni Malinen le16_to_cpu(mgmt->u.beacon.beacon_int), 7440ce77920SJouni Malinen mgmt->u.beacon.variable, 7450ce77920SJouni Malinen ni->ni_buf + ni->ni_framelen - 7460ce77920SJouni Malinen mgmt->u.beacon.variable, 7470ce77920SJouni Malinen signal, GFP_ATOMIC); 748bdcd8170SKalle Valo } 749bdcd8170SKalle Valo 750bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 751bdcd8170SKalle Valo struct cfg80211_scan_request *request) 752bdcd8170SKalle Valo { 753bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 7541276c9efSEdward Lu s8 n_channels = 0; 7551276c9efSEdward Lu u16 *channels = NULL; 756bdcd8170SKalle Valo int ret = 0; 757bdcd8170SKalle Valo 758bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 759bdcd8170SKalle Valo return -EIO; 760bdcd8170SKalle Valo 761bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 762bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, 763bdcd8170SKalle Valo (test_bit(CONNECTED, &ar->flag) ? 764bdcd8170SKalle Valo ALL_BUT_BSS_FILTER : 765bdcd8170SKalle Valo ALL_BSS_FILTER), 0) != 0) { 766bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 767bdcd8170SKalle Valo return -EIO; 768bdcd8170SKalle Valo } 769bdcd8170SKalle Valo } 770bdcd8170SKalle Valo 771bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 772bdcd8170SKalle Valo u8 i; 773bdcd8170SKalle Valo 774bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 775bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 776bdcd8170SKalle Valo 777bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 778bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 779bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 780bdcd8170SKalle Valo request->ssids[i].ssid_len, 781bdcd8170SKalle Valo request->ssids[i].ssid); 782bdcd8170SKalle Valo } 783bdcd8170SKalle Valo 784b84da8c7SJouni Malinen if (request->ie) { 785b84da8c7SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_REQ, 786b84da8c7SJouni Malinen request->ie, request->ie_len); 787b84da8c7SJouni Malinen if (ret) { 788b84da8c7SJouni Malinen ath6kl_err("failed to set Probe Request appie for " 789b84da8c7SJouni Malinen "scan"); 790b84da8c7SJouni Malinen return ret; 791b84da8c7SJouni Malinen } 792b84da8c7SJouni Malinen } 793b84da8c7SJouni Malinen 7941276c9efSEdward Lu if (request->n_channels > 0) { 7951276c9efSEdward Lu u8 i; 7961276c9efSEdward Lu 7971276c9efSEdward Lu n_channels = min(127U, request->n_channels); 7981276c9efSEdward Lu 7991276c9efSEdward Lu channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 8001276c9efSEdward Lu if (channels == NULL) { 8011276c9efSEdward Lu ath6kl_warn("failed to set scan channels, " 8021276c9efSEdward Lu "scan all channels"); 8031276c9efSEdward Lu n_channels = 0; 8041276c9efSEdward Lu } 8051276c9efSEdward Lu 8061276c9efSEdward Lu for (i = 0; i < n_channels; i++) 8071276c9efSEdward Lu channels[i] = request->channels[i]->center_freq; 8081276c9efSEdward Lu } 8091276c9efSEdward Lu 810b2c76bbeSKalle Valo if (ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, 0, 8111276c9efSEdward Lu false, 0, 0, n_channels, channels) != 0) { 812bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 813bdcd8170SKalle Valo ret = -EIO; 814bdcd8170SKalle Valo } 815bdcd8170SKalle Valo 816bdcd8170SKalle Valo ar->scan_req = request; 817bdcd8170SKalle Valo 8181276c9efSEdward Lu kfree(channels); 8191276c9efSEdward Lu 820bdcd8170SKalle Valo return ret; 821bdcd8170SKalle Valo } 822bdcd8170SKalle Valo 823bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 824bdcd8170SKalle Valo { 8256fd1eaceSKalle Valo int i; 826bdcd8170SKalle Valo 827bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 828bdcd8170SKalle Valo 8296fd1eaceSKalle Valo if (!ar->scan_req) 8306fd1eaceSKalle Valo return; 8316fd1eaceSKalle Valo 8326fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 8336fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 8346fd1eaceSKalle Valo goto out; 8356fd1eaceSKalle Valo } 8366fd1eaceSKalle Valo 837bdcd8170SKalle Valo /* Translate data to cfg80211 mgmt format */ 8388a8bc5a4SVasanthakumar Thiagarajan wlan_iterate_nodes(&ar->scan_table, ar->wdev->wiphy); 839bdcd8170SKalle Valo 8406fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 841bdcd8170SKalle Valo 842bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 843bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 844bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 845bdcd8170SKalle Valo DISABLE_SSID_FLAG, 846bdcd8170SKalle Valo 0, NULL); 847bdcd8170SKalle Valo } 848bdcd8170SKalle Valo } 8496fd1eaceSKalle Valo 8506fd1eaceSKalle Valo out: 851bdcd8170SKalle Valo ar->scan_req = NULL; 852bdcd8170SKalle Valo } 853bdcd8170SKalle Valo 854bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 855bdcd8170SKalle Valo u8 key_index, bool pairwise, 856bdcd8170SKalle Valo const u8 *mac_addr, 857bdcd8170SKalle Valo struct key_params *params) 858bdcd8170SKalle Valo { 859bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 860bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 861bdcd8170SKalle Valo u8 key_usage; 862bdcd8170SKalle Valo u8 key_type; 863bdcd8170SKalle Valo int status = 0; 864bdcd8170SKalle Valo 865bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 866bdcd8170SKalle Valo return -EIO; 867bdcd8170SKalle Valo 868bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 869bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 870bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 871bdcd8170SKalle Valo key_index); 872bdcd8170SKalle Valo return -ENOENT; 873bdcd8170SKalle Valo } 874bdcd8170SKalle Valo 875bdcd8170SKalle Valo key = &ar->keys[key_index]; 876bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 877bdcd8170SKalle Valo 878bdcd8170SKalle Valo if (pairwise) 879bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 880bdcd8170SKalle Valo else 881bdcd8170SKalle Valo key_usage = GROUP_USAGE; 882bdcd8170SKalle Valo 883bdcd8170SKalle Valo if (params) { 884bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 885bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 886bdcd8170SKalle Valo return -EINVAL; 887bdcd8170SKalle Valo 888bdcd8170SKalle Valo key->key_len = params->key_len; 889bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 890bdcd8170SKalle Valo key->seq_len = params->seq_len; 891bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 892bdcd8170SKalle Valo key->cipher = params->cipher; 893bdcd8170SKalle Valo } 894bdcd8170SKalle Valo 895bdcd8170SKalle Valo switch (key->cipher) { 896bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 897bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 898bdcd8170SKalle Valo key_type = WEP_CRYPT; 899bdcd8170SKalle Valo break; 900bdcd8170SKalle Valo 901bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 902bdcd8170SKalle Valo key_type = TKIP_CRYPT; 903bdcd8170SKalle Valo break; 904bdcd8170SKalle Valo 905bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 906bdcd8170SKalle Valo key_type = AES_CRYPT; 907bdcd8170SKalle Valo break; 908bdcd8170SKalle Valo 909bdcd8170SKalle Valo default: 910bdcd8170SKalle Valo return -ENOTSUPP; 911bdcd8170SKalle Valo } 912bdcd8170SKalle Valo 913bdcd8170SKalle Valo if (((ar->auth_mode == WPA_PSK_AUTH) 914bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH)) 915bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 916bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 917bdcd8170SKalle Valo 918bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 919bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 920bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 921bdcd8170SKalle Valo key_usage, key->seq_len); 922bdcd8170SKalle Valo 923bdcd8170SKalle Valo ar->def_txkey_index = key_index; 9249a5b1318SJouni Malinen 9259a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !pairwise && 9269a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 9279a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 9289a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 9299a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 9309a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 9319a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 9329a5b1318SJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) { 9339a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9349a5b1318SJouni Malinen "key configuration until AP mode has been " 9359a5b1318SJouni Malinen "started\n"); 9369a5b1318SJouni Malinen /* 9379a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9389a5b1318SJouni Malinen * the connected event is received from the target. 9399a5b1318SJouni Malinen */ 9409a5b1318SJouni Malinen return 0; 9419a5b1318SJouni Malinen } 9429a5b1318SJouni Malinen } 9439a5b1318SJouni Malinen 944bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 945bdcd8170SKalle Valo key_type, key_usage, key->key_len, 946bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 947bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 948bdcd8170SKalle Valo 949bdcd8170SKalle Valo if (status) 950bdcd8170SKalle Valo return -EIO; 951bdcd8170SKalle Valo 952bdcd8170SKalle Valo return 0; 953bdcd8170SKalle Valo } 954bdcd8170SKalle Valo 955bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 956bdcd8170SKalle Valo u8 key_index, bool pairwise, 957bdcd8170SKalle Valo const u8 *mac_addr) 958bdcd8170SKalle Valo { 959bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 962bdcd8170SKalle Valo 963bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 964bdcd8170SKalle Valo return -EIO; 965bdcd8170SKalle Valo 966bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 967bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 968bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 969bdcd8170SKalle Valo key_index); 970bdcd8170SKalle Valo return -ENOENT; 971bdcd8170SKalle Valo } 972bdcd8170SKalle Valo 973bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 974bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 975bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 976bdcd8170SKalle Valo return 0; 977bdcd8170SKalle Valo } 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 980bdcd8170SKalle Valo 981bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 982bdcd8170SKalle Valo } 983bdcd8170SKalle Valo 984bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 985bdcd8170SKalle Valo u8 key_index, bool pairwise, 986bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 987bdcd8170SKalle Valo void (*callback) (void *cookie, 988bdcd8170SKalle Valo struct key_params *)) 989bdcd8170SKalle Valo { 990bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 991bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 992bdcd8170SKalle Valo struct key_params params; 993bdcd8170SKalle Valo 994bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 995bdcd8170SKalle Valo 996bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 997bdcd8170SKalle Valo return -EIO; 998bdcd8170SKalle Valo 999bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1000bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1001bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 1002bdcd8170SKalle Valo key_index); 1003bdcd8170SKalle Valo return -ENOENT; 1004bdcd8170SKalle Valo } 1005bdcd8170SKalle Valo 1006bdcd8170SKalle Valo key = &ar->keys[key_index]; 1007bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 1008bdcd8170SKalle Valo params.cipher = key->cipher; 1009bdcd8170SKalle Valo params.key_len = key->key_len; 1010bdcd8170SKalle Valo params.seq_len = key->seq_len; 1011bdcd8170SKalle Valo params.seq = key->seq; 1012bdcd8170SKalle Valo params.key = key->key; 1013bdcd8170SKalle Valo 1014bdcd8170SKalle Valo callback(cookie, ¶ms); 1015bdcd8170SKalle Valo 1016bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 1017bdcd8170SKalle Valo } 1018bdcd8170SKalle Valo 1019bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1020bdcd8170SKalle Valo struct net_device *ndev, 1021bdcd8170SKalle Valo u8 key_index, bool unicast, 1022bdcd8170SKalle Valo bool multicast) 1023bdcd8170SKalle Valo { 1024bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 1025bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1026bdcd8170SKalle Valo int status = 0; 1027bdcd8170SKalle Valo u8 key_usage; 1028229ed6b5SEdward Lu enum crypto_type key_type = NONE_CRYPT; 1029bdcd8170SKalle Valo 1030bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1031bdcd8170SKalle Valo 1032bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1033bdcd8170SKalle Valo return -EIO; 1034bdcd8170SKalle Valo 1035bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1036bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1037bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1038bdcd8170SKalle Valo __func__, key_index); 1039bdcd8170SKalle Valo return -ENOENT; 1040bdcd8170SKalle Valo } 1041bdcd8170SKalle Valo 1042bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1043bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1044bdcd8170SKalle Valo __func__, key_index); 1045bdcd8170SKalle Valo return -EINVAL; 1046bdcd8170SKalle Valo } 1047bdcd8170SKalle Valo 1048bdcd8170SKalle Valo ar->def_txkey_index = key_index; 1049bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 1050bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1051bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 1052bdcd8170SKalle Valo key_usage |= TX_USAGE; 1053229ed6b5SEdward Lu if (unicast) 1054229ed6b5SEdward Lu key_type = ar->prwise_crypto; 1055229ed6b5SEdward Lu if (multicast) 1056229ed6b5SEdward Lu key_type = ar->grp_crypto; 1057bdcd8170SKalle Valo 10589a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !test_bit(CONNECTED, &ar->flag)) 10599a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10609a5b1318SJouni Malinen 1061bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1062229ed6b5SEdward Lu key_type, key_usage, 1063bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1064bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1065bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1066bdcd8170SKalle Valo if (status) 1067bdcd8170SKalle Valo return -EIO; 1068bdcd8170SKalle Valo 1069bdcd8170SKalle Valo return 0; 1070bdcd8170SKalle Valo } 1071bdcd8170SKalle Valo 1072bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1073bdcd8170SKalle Valo bool ismcast) 1074bdcd8170SKalle Valo { 1075bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1076bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1077bdcd8170SKalle Valo 1078bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1079bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1080bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1081bdcd8170SKalle Valo GFP_KERNEL); 1082bdcd8170SKalle Valo } 1083bdcd8170SKalle Valo 1084bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1085bdcd8170SKalle Valo { 1086bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1087bdcd8170SKalle Valo int ret; 1088bdcd8170SKalle Valo 1089bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1090bdcd8170SKalle Valo changed); 1091bdcd8170SKalle Valo 1092bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1093bdcd8170SKalle Valo return -EIO; 1094bdcd8170SKalle Valo 1095bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1096bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1097bdcd8170SKalle Valo if (ret != 0) { 1098bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1099bdcd8170SKalle Valo return -EIO; 1100bdcd8170SKalle Valo } 1101bdcd8170SKalle Valo } 1102bdcd8170SKalle Valo 1103bdcd8170SKalle Valo return 0; 1104bdcd8170SKalle Valo } 1105bdcd8170SKalle Valo 1106bdcd8170SKalle Valo /* 1107bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1108bdcd8170SKalle Valo * data type from 2.6.36 onwards 1109bdcd8170SKalle Valo */ 1110bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1111bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1112bdcd8170SKalle Valo int dbm) 1113bdcd8170SKalle Valo { 1114bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1115bdcd8170SKalle Valo u8 ath6kl_dbm; 1116bdcd8170SKalle Valo 1117bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1118bdcd8170SKalle Valo type, dbm); 1119bdcd8170SKalle Valo 1120bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1121bdcd8170SKalle Valo return -EIO; 1122bdcd8170SKalle Valo 1123bdcd8170SKalle Valo switch (type) { 1124bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1125bdcd8170SKalle Valo return 0; 1126bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1127bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1128bdcd8170SKalle Valo break; 1129bdcd8170SKalle Valo default: 1130bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1131bdcd8170SKalle Valo __func__, type); 1132bdcd8170SKalle Valo return -EOPNOTSUPP; 1133bdcd8170SKalle Valo } 1134bdcd8170SKalle Valo 1135bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1136bdcd8170SKalle Valo 1137bdcd8170SKalle Valo return 0; 1138bdcd8170SKalle Valo } 1139bdcd8170SKalle Valo 1140bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1141bdcd8170SKalle Valo { 1142bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1143bdcd8170SKalle Valo 1144bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1145bdcd8170SKalle Valo return -EIO; 1146bdcd8170SKalle Valo 1147bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) { 1148bdcd8170SKalle Valo ar->tx_pwr = 0; 1149bdcd8170SKalle Valo 1150bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1151bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1152bdcd8170SKalle Valo return -EIO; 1153bdcd8170SKalle Valo } 1154bdcd8170SKalle Valo 1155bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1156bdcd8170SKalle Valo 5 * HZ); 1157bdcd8170SKalle Valo 1158bdcd8170SKalle Valo if (signal_pending(current)) { 1159bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1160bdcd8170SKalle Valo return -EINTR; 1161bdcd8170SKalle Valo } 1162bdcd8170SKalle Valo } 1163bdcd8170SKalle Valo 1164bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1165bdcd8170SKalle Valo return 0; 1166bdcd8170SKalle Valo } 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1169bdcd8170SKalle Valo struct net_device *dev, 1170bdcd8170SKalle Valo bool pmgmt, int timeout) 1171bdcd8170SKalle Valo { 1172bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1173bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1174bdcd8170SKalle Valo 1175bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1176bdcd8170SKalle Valo __func__, pmgmt, timeout); 1177bdcd8170SKalle Valo 1178bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1179bdcd8170SKalle Valo return -EIO; 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo if (pmgmt) { 1182bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1183bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1184bdcd8170SKalle Valo } else { 1185bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1186bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1187bdcd8170SKalle Valo } 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1190bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1191bdcd8170SKalle Valo return -EIO; 1192bdcd8170SKalle Valo } 1193bdcd8170SKalle Valo 1194bdcd8170SKalle Valo return 0; 1195bdcd8170SKalle Valo } 1196bdcd8170SKalle Valo 1197bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1198bdcd8170SKalle Valo struct net_device *ndev, 1199bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1200bdcd8170SKalle Valo struct vif_params *params) 1201bdcd8170SKalle Valo { 1202bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1203bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1206bdcd8170SKalle Valo 1207bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1208bdcd8170SKalle Valo return -EIO; 1209bdcd8170SKalle Valo 1210bdcd8170SKalle Valo switch (type) { 1211bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1212bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1213bdcd8170SKalle Valo break; 1214bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1215bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1216bdcd8170SKalle Valo break; 12176b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_CLIENT: 12186b5e5d25SJouni Malinen ar->next_mode = INFRA_NETWORK; 12196b5e5d25SJouni Malinen break; 12206b5e5d25SJouni Malinen case NL80211_IFTYPE_P2P_GO: 12216b5e5d25SJouni Malinen ar->next_mode = AP_NETWORK; 12226b5e5d25SJouni Malinen break; 1223bdcd8170SKalle Valo default: 1224bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1225bdcd8170SKalle Valo return -EOPNOTSUPP; 1226bdcd8170SKalle Valo } 1227bdcd8170SKalle Valo 1228bdcd8170SKalle Valo wdev->iftype = type; 1229bdcd8170SKalle Valo 1230bdcd8170SKalle Valo return 0; 1231bdcd8170SKalle Valo } 1232bdcd8170SKalle Valo 1233bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1234bdcd8170SKalle Valo struct net_device *dev, 1235bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1236bdcd8170SKalle Valo { 1237bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1238bdcd8170SKalle Valo int status; 1239bdcd8170SKalle Valo 1240bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1241bdcd8170SKalle Valo return -EIO; 1242bdcd8170SKalle Valo 1243bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1244bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1245bdcd8170SKalle Valo 1246bdcd8170SKalle Valo if (ibss_param->channel) 1247bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1248bdcd8170SKalle Valo 1249bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1250bdcd8170SKalle Valo /* 1251bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1252bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1253bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1254bdcd8170SKalle Valo * updated. 1255bdcd8170SKalle Valo */ 1256bdcd8170SKalle Valo return -EOPNOTSUPP; 1257bdcd8170SKalle Valo } 1258bdcd8170SKalle Valo 1259bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1260bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1261bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1264bdcd8170SKalle Valo 1265bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1266bdcd8170SKalle Valo if (status) 1267bdcd8170SKalle Valo return status; 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo if (ibss_param->privacy) { 1270bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1271bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1272bdcd8170SKalle Valo } else { 1273bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1274bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1275bdcd8170SKalle Valo } 1276bdcd8170SKalle Valo 1277bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1278bdcd8170SKalle Valo 1279bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1280bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1281bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1282bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1283bdcd8170SKalle Valo __func__, 1284bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1285bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 128638acde3cSEdward Lu ar->grp_crypto_len, ar->ch_hint); 1287bdcd8170SKalle Valo 1288bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1289bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1290bdcd8170SKalle Valo ar->prwise_crypto, 1291bdcd8170SKalle Valo ar->prwise_crypto_len, 129238acde3cSEdward Lu ar->grp_crypto, ar->grp_crypto_len, 1293bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1294bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1295bdcd8170SKalle Valo ar->connect_ctrl_flags); 1296bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 1297bdcd8170SKalle Valo 1298bdcd8170SKalle Valo return 0; 1299bdcd8170SKalle Valo } 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1302bdcd8170SKalle Valo struct net_device *dev) 1303bdcd8170SKalle Valo { 1304bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1305bdcd8170SKalle Valo 1306bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1307bdcd8170SKalle Valo return -EIO; 1308bdcd8170SKalle Valo 1309bdcd8170SKalle Valo ath6kl_disconnect(ar); 1310bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1311bdcd8170SKalle Valo ar->ssid_len = 0; 1312bdcd8170SKalle Valo 1313bdcd8170SKalle Valo return 0; 1314bdcd8170SKalle Valo } 1315bdcd8170SKalle Valo 1316bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1317bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1318bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1319bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1320bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1321bdcd8170SKalle Valo }; 1322bdcd8170SKalle Valo 1323bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1324bdcd8170SKalle Valo { 1325bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1326bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1327bdcd8170SKalle Valo 36000, 48000, 54000 1328bdcd8170SKalle Valo }; 1329bdcd8170SKalle Valo u8 i; 1330bdcd8170SKalle Valo 1331bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1332bdcd8170SKalle Valo if (rate == legacy[i]) 1333bdcd8170SKalle Valo return true; 1334bdcd8170SKalle Valo 1335bdcd8170SKalle Valo return false; 1336bdcd8170SKalle Valo } 1337bdcd8170SKalle Valo 1338bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1339bdcd8170SKalle Valo { 1340bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1341bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1342bdcd8170SKalle Valo }; 1343bdcd8170SKalle Valo u8 i; 1344bdcd8170SKalle Valo 1345bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1346bdcd8170SKalle Valo if (rate == ht20[i]) { 1347bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 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 return false; 1358bdcd8170SKalle Valo } 1359bdcd8170SKalle Valo 1360bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1361bdcd8170SKalle Valo { 1362bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1363bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1364bdcd8170SKalle Valo 150000 1365bdcd8170SKalle Valo }; 1366bdcd8170SKalle Valo u8 i; 1367bdcd8170SKalle Valo 1368bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1369bdcd8170SKalle Valo if (rate == ht40[i]) { 1370bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1371bdcd8170SKalle Valo /* last rate uses sgi */ 1372bdcd8170SKalle Valo *sgi = true; 1373bdcd8170SKalle Valo else 1374bdcd8170SKalle Valo *sgi = false; 1375bdcd8170SKalle Valo 1376bdcd8170SKalle Valo *mcs = i; 1377bdcd8170SKalle Valo return true; 1378bdcd8170SKalle Valo } 1379bdcd8170SKalle Valo } 1380bdcd8170SKalle Valo 1381bdcd8170SKalle Valo return false; 1382bdcd8170SKalle Valo } 1383bdcd8170SKalle Valo 1384bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1385bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1386bdcd8170SKalle Valo { 1387bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1388bdcd8170SKalle Valo long left; 1389bdcd8170SKalle Valo bool sgi; 1390bdcd8170SKalle Valo s32 rate; 1391bdcd8170SKalle Valo int ret; 1392bdcd8170SKalle Valo u8 mcs; 1393bdcd8170SKalle Valo 1394bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1395bdcd8170SKalle Valo return -ENOENT; 1396bdcd8170SKalle Valo 1397bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1398bdcd8170SKalle Valo return -EBUSY; 1399bdcd8170SKalle Valo 1400bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1401bdcd8170SKalle Valo 1402bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1403bdcd8170SKalle Valo 1404bdcd8170SKalle Valo if (ret != 0) { 1405bdcd8170SKalle Valo up(&ar->sem); 1406bdcd8170SKalle Valo return -EIO; 1407bdcd8170SKalle Valo } 1408bdcd8170SKalle Valo 1409bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1410bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1411bdcd8170SKalle Valo &ar->flag), 1412bdcd8170SKalle Valo WMI_TIMEOUT); 1413bdcd8170SKalle Valo 1414bdcd8170SKalle Valo up(&ar->sem); 1415bdcd8170SKalle Valo 1416bdcd8170SKalle Valo if (left == 0) 1417bdcd8170SKalle Valo return -ETIMEDOUT; 1418bdcd8170SKalle Valo else if (left < 0) 1419bdcd8170SKalle Valo return left; 1420bdcd8170SKalle Valo 1421bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1422bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1423bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1424bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1425bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1426bdcd8170SKalle Valo } 1427bdcd8170SKalle Valo 1428bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1429bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1430bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1431bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1432bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1433bdcd8170SKalle Valo } 1434bdcd8170SKalle Valo 1435bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1436bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1437bdcd8170SKalle Valo 1438bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1439bdcd8170SKalle Valo 1440bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1441bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1442bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1443bdcd8170SKalle Valo if (sgi) { 1444bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1445bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1446bdcd8170SKalle Valo } else { 1447bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1448bdcd8170SKalle Valo } 1449bdcd8170SKalle Valo 1450bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1451bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1452bdcd8170SKalle Valo if (sgi) { 1453bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1454bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1455bdcd8170SKalle Valo } else { 1456bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1457bdcd8170SKalle Valo } 1458bdcd8170SKalle Valo 1459bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1460bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1461bdcd8170SKalle Valo } else { 1462bdcd8170SKalle Valo ath6kl_warn("invalid rate: %d\n", rate); 1463bdcd8170SKalle Valo return 0; 1464bdcd8170SKalle Valo } 1465bdcd8170SKalle Valo 1466bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1467bdcd8170SKalle Valo 1468bdcd8170SKalle Valo return 0; 1469bdcd8170SKalle Valo } 1470bdcd8170SKalle Valo 1471bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1472bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1473bdcd8170SKalle Valo { 1474bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1475bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1476bdcd8170SKalle Valo pmksa->pmkid, true); 1477bdcd8170SKalle Valo } 1478bdcd8170SKalle Valo 1479bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1480bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1481bdcd8170SKalle Valo { 1482bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1483bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1484bdcd8170SKalle Valo pmksa->pmkid, false); 1485bdcd8170SKalle Valo } 1486bdcd8170SKalle Valo 1487bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1488bdcd8170SKalle Valo { 1489bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1490bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) 1491bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1492bdcd8170SKalle Valo return 0; 1493bdcd8170SKalle Valo } 1494bdcd8170SKalle Valo 1495abcb344bSKalle Valo #ifdef CONFIG_PM 1496abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1497abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1498abcb344bSKalle Valo { 1499abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1500abcb344bSKalle Valo 1501abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1502abcb344bSKalle Valo } 1503abcb344bSKalle Valo #endif 1504abcb344bSKalle Valo 15056a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 15066a7c9badSJouni Malinen struct ieee80211_channel *chan, 15076a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 15086a7c9badSJouni Malinen { 15096a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15106a7c9badSJouni Malinen 15116a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15126a7c9badSJouni Malinen return -EIO; 15136a7c9badSJouni Malinen 15146a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 15156a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 15166a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 15176a7c9badSJouni Malinen 15186a7c9badSJouni Malinen return 0; 15196a7c9badSJouni Malinen } 15206a7c9badSJouni Malinen 15218bdfbf40SJouni Malinen static bool ath6kl_is_p2p_ie(const u8 *pos) 15228bdfbf40SJouni Malinen { 15238bdfbf40SJouni Malinen return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 15248bdfbf40SJouni Malinen pos[2] == 0x50 && pos[3] == 0x6f && 15258bdfbf40SJouni Malinen pos[4] == 0x9a && pos[5] == 0x09; 15268bdfbf40SJouni Malinen } 15278bdfbf40SJouni Malinen 15288bdfbf40SJouni Malinen static int ath6kl_set_ap_probe_resp_ies(struct ath6kl *ar, const u8 *ies, 15298bdfbf40SJouni Malinen size_t ies_len) 15308bdfbf40SJouni Malinen { 15318bdfbf40SJouni Malinen const u8 *pos; 15328bdfbf40SJouni Malinen u8 *buf = NULL; 15338bdfbf40SJouni Malinen size_t len = 0; 15348bdfbf40SJouni Malinen int ret; 15358bdfbf40SJouni Malinen 15368bdfbf40SJouni Malinen /* 15378bdfbf40SJouni Malinen * Filter out P2P IE(s) since they will be included depending on 15388bdfbf40SJouni Malinen * the Probe Request frame in ath6kl_send_go_probe_resp(). 15398bdfbf40SJouni Malinen */ 15408bdfbf40SJouni Malinen 15418bdfbf40SJouni Malinen if (ies && ies_len) { 15428bdfbf40SJouni Malinen buf = kmalloc(ies_len, GFP_KERNEL); 15438bdfbf40SJouni Malinen if (buf == NULL) 15448bdfbf40SJouni Malinen return -ENOMEM; 15458bdfbf40SJouni Malinen pos = ies; 15468bdfbf40SJouni Malinen while (pos + 1 < ies + ies_len) { 15478bdfbf40SJouni Malinen if (pos + 2 + pos[1] > ies + ies_len) 15488bdfbf40SJouni Malinen break; 15498bdfbf40SJouni Malinen if (!ath6kl_is_p2p_ie(pos)) { 15508bdfbf40SJouni Malinen memcpy(buf + len, pos, 2 + pos[1]); 15518bdfbf40SJouni Malinen len += 2 + pos[1]; 15528bdfbf40SJouni Malinen } 15538bdfbf40SJouni Malinen pos += 2 + pos[1]; 15548bdfbf40SJouni Malinen } 15558bdfbf40SJouni Malinen } 15568bdfbf40SJouni Malinen 15578bdfbf40SJouni Malinen ret = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15588bdfbf40SJouni Malinen buf, len); 15598bdfbf40SJouni Malinen kfree(buf); 15608bdfbf40SJouni Malinen return ret; 15618bdfbf40SJouni Malinen } 15628bdfbf40SJouni Malinen 15636a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 15646a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 15656a7c9badSJouni Malinen { 15666a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 15676a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 15686a7c9badSJouni Malinen u8 *ies; 15696a7c9badSJouni Malinen int ies_len; 15706a7c9badSJouni Malinen struct wmi_connect_cmd p; 15716a7c9badSJouni Malinen int res; 15726a7c9badSJouni Malinen int i; 15736a7c9badSJouni Malinen 15746a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 15756a7c9badSJouni Malinen 15766a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 15776a7c9badSJouni Malinen return -EIO; 15786a7c9badSJouni Malinen 15796a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 15806a7c9badSJouni Malinen return -EOPNOTSUPP; 15816a7c9badSJouni Malinen 15826a7c9badSJouni Malinen if (info->beacon_ies) { 15836a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 15846a7c9badSJouni Malinen info->beacon_ies, 15856a7c9badSJouni Malinen info->beacon_ies_len); 15866a7c9badSJouni Malinen if (res) 15876a7c9badSJouni Malinen return res; 15886a7c9badSJouni Malinen } 15896a7c9badSJouni Malinen if (info->proberesp_ies) { 15908bdfbf40SJouni Malinen res = ath6kl_set_ap_probe_resp_ies(ar, info->proberesp_ies, 15916a7c9badSJouni Malinen info->proberesp_ies_len); 15926a7c9badSJouni Malinen if (res) 15936a7c9badSJouni Malinen return res; 15946a7c9badSJouni Malinen } 15956a7c9badSJouni Malinen if (info->assocresp_ies) { 15966a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 15976a7c9badSJouni Malinen info->assocresp_ies, 15986a7c9badSJouni Malinen info->assocresp_ies_len); 15996a7c9badSJouni Malinen if (res) 16006a7c9badSJouni Malinen return res; 16016a7c9badSJouni Malinen } 16026a7c9badSJouni Malinen 16036a7c9badSJouni Malinen if (!add) 16046a7c9badSJouni Malinen return 0; 16056a7c9badSJouni Malinen 16069a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 16079a5b1318SJouni Malinen 16086a7c9badSJouni Malinen /* TODO: 16096a7c9badSJouni Malinen * info->interval 16106a7c9badSJouni Malinen * info->dtim_period 16116a7c9badSJouni Malinen */ 16126a7c9badSJouni Malinen 16136a7c9badSJouni Malinen if (info->head == NULL) 16146a7c9badSJouni Malinen return -EINVAL; 16156a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 16166a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 16176a7c9badSJouni Malinen if (ies > info->head + info->head_len) 16186a7c9badSJouni Malinen return -EINVAL; 16196a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 16206a7c9badSJouni Malinen 16216a7c9badSJouni Malinen if (info->ssid == NULL) 16226a7c9badSJouni Malinen return -EINVAL; 16236a7c9badSJouni Malinen memcpy(ar->ssid, info->ssid, info->ssid_len); 16246a7c9badSJouni Malinen ar->ssid_len = info->ssid_len; 16256a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 16266a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 16276a7c9badSJouni Malinen 16286a7c9badSJouni Malinen ar->dot11_auth_mode = OPEN_AUTH; 16296a7c9badSJouni Malinen 16306a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 16316a7c9badSJouni Malinen 16326a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 16336a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 16346a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 16356a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16366a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 16376a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16386a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 16396a7c9badSJouni Malinen break; 16406a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 16416a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 16426a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 16436a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 16446a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 16456a7c9badSJouni Malinen break; 16466a7c9badSJouni Malinen } 16476a7c9badSJouni Malinen } 16486a7c9badSJouni Malinen if (p.auth_mode == 0) 16496a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 16506a7c9badSJouni Malinen ar->auth_mode = p.auth_mode; 16516a7c9badSJouni Malinen 16526a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 16536a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 16546a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16556a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16566a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 16576a7c9badSJouni Malinen break; 16586a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16596a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 16606a7c9badSJouni Malinen break; 16616a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16626a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 16636a7c9badSJouni Malinen break; 16646a7c9badSJouni Malinen } 16656a7c9badSJouni Malinen } 1666229ed6b5SEdward Lu if (p.prwise_crypto_type == 0) { 16676a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 1668229ed6b5SEdward Lu ath6kl_set_cipher(ar, 0, true); 1669229ed6b5SEdward Lu } else if (info->crypto.n_ciphers_pairwise == 1) 1670229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.ciphers_pairwise[0], true); 16716a7c9badSJouni Malinen 16726a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 16736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 16746a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 16756a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 16766a7c9badSJouni Malinen break; 16776a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 16786a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 16796a7c9badSJouni Malinen break; 16806a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 16816a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 16826a7c9badSJouni Malinen break; 16836a7c9badSJouni Malinen default: 16846a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 16856a7c9badSJouni Malinen break; 16866a7c9badSJouni Malinen } 1687229ed6b5SEdward Lu ath6kl_set_cipher(ar, info->crypto.cipher_group, false); 16886a7c9badSJouni Malinen 16896a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 16906a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 16916a7c9badSJouni Malinen 16926a7c9badSJouni Malinen p.ssid_len = ar->ssid_len; 16936a7c9badSJouni Malinen memcpy(p.ssid, ar->ssid, ar->ssid_len); 16946a7c9badSJouni Malinen p.dot11_auth_mode = ar->dot11_auth_mode; 16956a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 16966a7c9badSJouni Malinen 16979a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 16989a5b1318SJouni Malinen if (res < 0) 16999a5b1318SJouni Malinen return res; 17009a5b1318SJouni Malinen 17019a5b1318SJouni Malinen return 0; 17026a7c9badSJouni Malinen } 17036a7c9badSJouni Malinen 17046a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 17056a7c9badSJouni Malinen struct beacon_parameters *info) 17066a7c9badSJouni Malinen { 17076a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 17086a7c9badSJouni Malinen } 17096a7c9badSJouni Malinen 17106a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 17116a7c9badSJouni Malinen struct beacon_parameters *info) 17126a7c9badSJouni Malinen { 17136a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 17146a7c9badSJouni Malinen } 17156a7c9badSJouni Malinen 17166a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 17176a7c9badSJouni Malinen { 17186a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 17196a7c9badSJouni Malinen 17206a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 17216a7c9badSJouni Malinen return -EOPNOTSUPP; 17226a7c9badSJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) 17236a7c9badSJouni Malinen return -ENOTCONN; 17246a7c9badSJouni Malinen 17256a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 17266a7c9badSJouni Malinen clear_bit(CONNECTED, &ar->flag); 17276a7c9badSJouni Malinen 17286a7c9badSJouni Malinen return 0; 17296a7c9badSJouni Malinen } 17306a7c9badSJouni Malinen 173123875136SJouni Malinen static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 173223875136SJouni Malinen u8 *mac, struct station_parameters *params) 173323875136SJouni Malinen { 173423875136SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 173523875136SJouni Malinen 173623875136SJouni Malinen if (ar->nw_type != AP_NETWORK) 173723875136SJouni Malinen return -EOPNOTSUPP; 173823875136SJouni Malinen 173923875136SJouni Malinen /* Use this only for authorizing/unauthorizing a station */ 174023875136SJouni Malinen if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 174123875136SJouni Malinen return -EOPNOTSUPP; 174223875136SJouni Malinen 174323875136SJouni Malinen if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 174423875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_AUTHORIZE, 174523875136SJouni Malinen mac, 0); 174623875136SJouni Malinen return ath6kl_wmi_ap_set_mlme(ar->wmi, WMI_AP_MLME_UNAUTHORIZE, mac, 174723875136SJouni Malinen 0); 174823875136SJouni Malinen } 174923875136SJouni Malinen 175063fa1e0cSJouni Malinen static int ath6kl_remain_on_channel(struct wiphy *wiphy, 175163fa1e0cSJouni Malinen struct net_device *dev, 175263fa1e0cSJouni Malinen struct ieee80211_channel *chan, 175363fa1e0cSJouni Malinen enum nl80211_channel_type channel_type, 175463fa1e0cSJouni Malinen unsigned int duration, 175563fa1e0cSJouni Malinen u64 *cookie) 175663fa1e0cSJouni Malinen { 175763fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 175863fa1e0cSJouni Malinen 175963fa1e0cSJouni Malinen /* TODO: if already pending or ongoing remain-on-channel, 176063fa1e0cSJouni Malinen * return -EBUSY */ 176163fa1e0cSJouni Malinen *cookie = 1; /* only a single pending request is supported */ 176263fa1e0cSJouni Malinen 176363fa1e0cSJouni Malinen return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, chan->center_freq, 176463fa1e0cSJouni Malinen duration); 176563fa1e0cSJouni Malinen } 176663fa1e0cSJouni Malinen 176763fa1e0cSJouni Malinen static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 176863fa1e0cSJouni Malinen struct net_device *dev, 176963fa1e0cSJouni Malinen u64 cookie) 177063fa1e0cSJouni Malinen { 177163fa1e0cSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 177263fa1e0cSJouni Malinen 177363fa1e0cSJouni Malinen if (cookie != 1) 177463fa1e0cSJouni Malinen return -ENOENT; 177563fa1e0cSJouni Malinen 177663fa1e0cSJouni Malinen return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi); 177763fa1e0cSJouni Malinen } 177863fa1e0cSJouni Malinen 17798bdfbf40SJouni Malinen static int ath6kl_send_go_probe_resp(struct ath6kl *ar, const u8 *buf, 17808bdfbf40SJouni Malinen size_t len, unsigned int freq) 17818bdfbf40SJouni Malinen { 17828bdfbf40SJouni Malinen const u8 *pos; 17838bdfbf40SJouni Malinen u8 *p2p; 17848bdfbf40SJouni Malinen int p2p_len; 17858bdfbf40SJouni Malinen int ret; 17868bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 17878bdfbf40SJouni Malinen 17888bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 17898bdfbf40SJouni Malinen 17908bdfbf40SJouni Malinen /* Include P2P IE(s) from the frame generated in user space. */ 17918bdfbf40SJouni Malinen 17928bdfbf40SJouni Malinen p2p = kmalloc(len, GFP_KERNEL); 17938bdfbf40SJouni Malinen if (p2p == NULL) 17948bdfbf40SJouni Malinen return -ENOMEM; 17958bdfbf40SJouni Malinen p2p_len = 0; 17968bdfbf40SJouni Malinen 17978bdfbf40SJouni Malinen pos = mgmt->u.probe_resp.variable; 17988bdfbf40SJouni Malinen while (pos + 1 < buf + len) { 17998bdfbf40SJouni Malinen if (pos + 2 + pos[1] > buf + len) 18008bdfbf40SJouni Malinen break; 18018bdfbf40SJouni Malinen if (ath6kl_is_p2p_ie(pos)) { 18028bdfbf40SJouni Malinen memcpy(p2p + p2p_len, pos, 2 + pos[1]); 18038bdfbf40SJouni Malinen p2p_len += 2 + pos[1]; 18048bdfbf40SJouni Malinen } 18058bdfbf40SJouni Malinen pos += 2 + pos[1]; 18068bdfbf40SJouni Malinen } 18078bdfbf40SJouni Malinen 18088bdfbf40SJouni Malinen ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, freq, mgmt->da, 18098bdfbf40SJouni Malinen p2p, p2p_len); 18108bdfbf40SJouni Malinen kfree(p2p); 18118bdfbf40SJouni Malinen return ret; 18128bdfbf40SJouni Malinen } 18138bdfbf40SJouni Malinen 18148a6c8060SJouni Malinen static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 18158a6c8060SJouni Malinen struct ieee80211_channel *chan, bool offchan, 18168a6c8060SJouni Malinen enum nl80211_channel_type channel_type, 18178a6c8060SJouni Malinen bool channel_type_valid, unsigned int wait, 18188a6c8060SJouni Malinen const u8 *buf, size_t len, u64 *cookie) 18198a6c8060SJouni Malinen { 18208a6c8060SJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 18218a6c8060SJouni Malinen u32 id; 18228bdfbf40SJouni Malinen const struct ieee80211_mgmt *mgmt; 18238bdfbf40SJouni Malinen 18248bdfbf40SJouni Malinen mgmt = (const struct ieee80211_mgmt *) buf; 18258bdfbf40SJouni Malinen if (buf + len >= mgmt->u.probe_resp.variable && 18268bdfbf40SJouni Malinen ar->nw_type == AP_NETWORK && test_bit(CONNECTED, &ar->flag) && 18278bdfbf40SJouni Malinen ieee80211_is_probe_resp(mgmt->frame_control)) { 18288bdfbf40SJouni Malinen /* 18298bdfbf40SJouni Malinen * Send Probe Response frame in AP mode using a separate WMI 18308bdfbf40SJouni Malinen * command to allow the target to fill in the generic IEs. 18318bdfbf40SJouni Malinen */ 18328bdfbf40SJouni Malinen *cookie = 0; /* TX status not supported */ 18338bdfbf40SJouni Malinen return ath6kl_send_go_probe_resp(ar, buf, len, 18348bdfbf40SJouni Malinen chan->center_freq); 18358bdfbf40SJouni Malinen } 18368a6c8060SJouni Malinen 18378a6c8060SJouni Malinen id = ar->send_action_id++; 18388a6c8060SJouni Malinen if (id == 0) { 18398a6c8060SJouni Malinen /* 18408a6c8060SJouni Malinen * 0 is a reserved value in the WMI command and shall not be 18418a6c8060SJouni Malinen * used for the command. 18428a6c8060SJouni Malinen */ 18438a6c8060SJouni Malinen id = ar->send_action_id++; 18448a6c8060SJouni Malinen } 18458a6c8060SJouni Malinen 18468a6c8060SJouni Malinen *cookie = id; 18478a6c8060SJouni Malinen return ath6kl_wmi_send_action_cmd(ar->wmi, id, chan->center_freq, wait, 18488a6c8060SJouni Malinen buf, len); 18498a6c8060SJouni Malinen } 18508a6c8060SJouni Malinen 1851ae32c30aSJouni Malinen static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 1852ae32c30aSJouni Malinen struct net_device *dev, 1853ae32c30aSJouni Malinen u16 frame_type, bool reg) 1854ae32c30aSJouni Malinen { 1855ae32c30aSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 1856ae32c30aSJouni Malinen 1857ae32c30aSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 1858ae32c30aSJouni Malinen __func__, frame_type, reg); 1859ae32c30aSJouni Malinen if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 1860ae32c30aSJouni Malinen /* 1861ae32c30aSJouni Malinen * Note: This notification callback is not allowed to sleep, so 1862ae32c30aSJouni Malinen * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 1863ae32c30aSJouni Malinen * hardcode target to report Probe Request frames all the time. 1864ae32c30aSJouni Malinen */ 1865ae32c30aSJouni Malinen ar->probe_req_report = reg; 1866ae32c30aSJouni Malinen } 1867ae32c30aSJouni Malinen } 1868ae32c30aSJouni Malinen 1869f80574aeSJouni Malinen static const struct ieee80211_txrx_stypes 1870f80574aeSJouni Malinen ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 1871f80574aeSJouni Malinen [NL80211_IFTYPE_STATION] = { 1872f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1873f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1874f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1875f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1876f80574aeSJouni Malinen }, 1877f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_CLIENT] = { 1878f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1879f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1880f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1881f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1882f80574aeSJouni Malinen }, 1883f80574aeSJouni Malinen [NL80211_IFTYPE_P2P_GO] = { 1884f80574aeSJouni Malinen .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1885f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 1886f80574aeSJouni Malinen .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 1887f80574aeSJouni Malinen BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 1888f80574aeSJouni Malinen }, 1889f80574aeSJouni Malinen }; 1890f80574aeSJouni Malinen 1891bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1892bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1893bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1894bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1895bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1896bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1897bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1898bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1899bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1900bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1901bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1902bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1903bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1904bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1905bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1906bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1907bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1908bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1909bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1910abcb344bSKalle Valo #ifdef CONFIG_PM 1911abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1912abcb344bSKalle Valo #endif 19136a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 19146a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 19156a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 19166a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 191723875136SJouni Malinen .change_station = ath6kl_change_station, 191863fa1e0cSJouni Malinen .remain_on_channel = ath6kl_remain_on_channel, 191963fa1e0cSJouni Malinen .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 19208a6c8060SJouni Malinen .mgmt_tx = ath6kl_mgmt_tx, 1921ae32c30aSJouni Malinen .mgmt_frame_register = ath6kl_mgmt_frame_register, 1922bdcd8170SKalle Valo }; 1923bdcd8170SKalle Valo 1924bdcd8170SKalle Valo struct wireless_dev *ath6kl_cfg80211_init(struct device *dev) 1925bdcd8170SKalle Valo { 1926bdcd8170SKalle Valo int ret = 0; 1927bdcd8170SKalle Valo struct wireless_dev *wdev; 1928bdcd8170SKalle Valo 1929bdcd8170SKalle Valo wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL); 1930bdcd8170SKalle Valo if (!wdev) { 1931bdcd8170SKalle Valo ath6kl_err("couldn't allocate wireless device\n"); 1932bdcd8170SKalle Valo return NULL; 1933bdcd8170SKalle Valo } 1934bdcd8170SKalle Valo 1935bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1936bdcd8170SKalle Valo wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 1937bdcd8170SKalle Valo if (!wdev->wiphy) { 1938bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1939bdcd8170SKalle Valo kfree(wdev); 1940bdcd8170SKalle Valo return NULL; 1941bdcd8170SKalle Valo } 1942bdcd8170SKalle Valo 1943f80574aeSJouni Malinen wdev->wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 1944f80574aeSJouni Malinen 194563fa1e0cSJouni Malinen wdev->wiphy->max_remain_on_channel_duration = 5000; 194663fa1e0cSJouni Malinen 1947bdcd8170SKalle Valo /* set device pointer for wiphy */ 1948bdcd8170SKalle Valo set_wiphy_dev(wdev->wiphy, dev); 1949bdcd8170SKalle Valo 1950bdcd8170SKalle Valo wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 1951bdcd8170SKalle Valo BIT(NL80211_IFTYPE_ADHOC); 1952bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 1953bdcd8170SKalle Valo wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 1954b84da8c7SJouni Malinen wdev->wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 1955bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 1956bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 1957bdcd8170SKalle Valo wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 1958bdcd8170SKalle Valo 1959bdcd8170SKalle Valo wdev->wiphy->cipher_suites = cipher_suites; 1960bdcd8170SKalle Valo wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 1961bdcd8170SKalle Valo 1962bdcd8170SKalle Valo ret = wiphy_register(wdev->wiphy); 1963bdcd8170SKalle Valo if (ret < 0) { 1964bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 1965bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1966bdcd8170SKalle Valo kfree(wdev); 1967bdcd8170SKalle Valo return NULL; 1968bdcd8170SKalle Valo } 1969bdcd8170SKalle Valo 1970bdcd8170SKalle Valo return wdev; 1971bdcd8170SKalle Valo } 1972bdcd8170SKalle Valo 1973bdcd8170SKalle Valo void ath6kl_cfg80211_deinit(struct ath6kl *ar) 1974bdcd8170SKalle Valo { 1975bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1976bdcd8170SKalle Valo 1977bdcd8170SKalle Valo if (ar->scan_req) { 1978bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 1979bdcd8170SKalle Valo ar->scan_req = NULL; 1980bdcd8170SKalle Valo } 1981bdcd8170SKalle Valo 1982bdcd8170SKalle Valo if (!wdev) 1983bdcd8170SKalle Valo return; 1984bdcd8170SKalle Valo 1985bdcd8170SKalle Valo wiphy_unregister(wdev->wiphy); 1986bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1987bdcd8170SKalle Valo kfree(wdev); 1988bdcd8170SKalle Valo } 1989