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