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" 20bdcd8170SKalle Valo 21bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 22bdcd8170SKalle Valo .bitrate = (_rate), \ 23bdcd8170SKalle Valo .flags = (_flags), \ 24bdcd8170SKalle Valo .hw_value = (_rateid), \ 25bdcd8170SKalle Valo } 26bdcd8170SKalle Valo 27bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 28bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 29bdcd8170SKalle Valo .hw_value = (_channel), \ 30bdcd8170SKalle Valo .center_freq = (_freq), \ 31bdcd8170SKalle Valo .flags = (_flags), \ 32bdcd8170SKalle Valo .max_antenna_gain = 0, \ 33bdcd8170SKalle Valo .max_power = 30, \ 34bdcd8170SKalle Valo } 35bdcd8170SKalle Valo 36bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 37bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 38bdcd8170SKalle Valo .hw_value = (_channel), \ 39bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 40bdcd8170SKalle Valo .flags = (_flags), \ 41bdcd8170SKalle Valo .max_antenna_gain = 0, \ 42bdcd8170SKalle Valo .max_power = 30, \ 43bdcd8170SKalle Valo } 44bdcd8170SKalle Valo 45bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 46bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 47bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 48bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 49bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 50bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 51bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 52bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 53bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 54bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 55bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 56bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 57bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 58bdcd8170SKalle Valo }; 59bdcd8170SKalle Valo 60bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 61bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 62bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 63bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 64bdcd8170SKalle Valo 65bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 66bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 67bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 68bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 69bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 70bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 71bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 72bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 73bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 74bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 75bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 76bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 77bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 78bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 79bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 80bdcd8170SKalle Valo }; 81bdcd8170SKalle Valo 82bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 83bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 84bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 85bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 86bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 87bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 88bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 89bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 90bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 91bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 92bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 93bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 94bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 95bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 96bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 97bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 98bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 99bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 100bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 101bdcd8170SKalle Valo CHAN5G(216, 0), 102bdcd8170SKalle Valo }; 103bdcd8170SKalle Valo 104bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 105bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 106bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 107bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 108bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 109bdcd8170SKalle Valo }; 110bdcd8170SKalle Valo 111bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 112bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 113bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 114bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 115bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 116bdcd8170SKalle Valo }; 117bdcd8170SKalle Valo 118bdcd8170SKalle Valo static int ath6kl_set_wpa_version(struct ath6kl *ar, 119bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 120bdcd8170SKalle Valo { 121bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 122bdcd8170SKalle Valo 123bdcd8170SKalle Valo if (!wpa_version) { 124bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 125bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 126bdcd8170SKalle Valo ar->auth_mode = WPA2_AUTH; 127bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 128bdcd8170SKalle Valo ar->auth_mode = WPA_AUTH; 129bdcd8170SKalle Valo } else { 130bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 131bdcd8170SKalle Valo return -ENOTSUPP; 132bdcd8170SKalle Valo } 133bdcd8170SKalle Valo 134bdcd8170SKalle Valo return 0; 135bdcd8170SKalle Valo } 136bdcd8170SKalle Valo 137bdcd8170SKalle Valo static int ath6kl_set_auth_type(struct ath6kl *ar, 138bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 139bdcd8170SKalle Valo { 140bdcd8170SKalle Valo 141bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 142bdcd8170SKalle Valo 143bdcd8170SKalle Valo switch (auth_type) { 144bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 145bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 146bdcd8170SKalle Valo break; 147bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 148bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 149bdcd8170SKalle Valo break; 150bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 151bdcd8170SKalle Valo ar->dot11_auth_mode = LEAP_AUTH; 152bdcd8170SKalle Valo break; 153bdcd8170SKalle Valo 154bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 155bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 156bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_OPEN_IN_PROGRESS; 157bdcd8170SKalle Valo break; 158bdcd8170SKalle Valo 159bdcd8170SKalle Valo default: 160bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 161bdcd8170SKalle Valo return -ENOTSUPP; 162bdcd8170SKalle Valo } 163bdcd8170SKalle Valo 164bdcd8170SKalle Valo return 0; 165bdcd8170SKalle Valo } 166bdcd8170SKalle Valo 167bdcd8170SKalle Valo static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast) 168bdcd8170SKalle Valo { 169bdcd8170SKalle Valo u8 *ar_cipher = ucast ? &ar->prwise_crypto : &ar->grp_crypto; 170bdcd8170SKalle Valo u8 *ar_cipher_len = ucast ? &ar->prwise_crypto_len : &ar->grp_crpto_len; 171bdcd8170SKalle Valo 172bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 173bdcd8170SKalle Valo __func__, cipher, ucast); 174bdcd8170SKalle Valo 175bdcd8170SKalle Valo switch (cipher) { 176bdcd8170SKalle Valo case 0: 177bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 178bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 179bdcd8170SKalle Valo *ar_cipher_len = 0; 180bdcd8170SKalle Valo break; 181bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 182bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 183bdcd8170SKalle Valo *ar_cipher_len = 5; 184bdcd8170SKalle Valo break; 185bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 186bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 187bdcd8170SKalle Valo *ar_cipher_len = 13; 188bdcd8170SKalle Valo break; 189bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 190bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 191bdcd8170SKalle Valo *ar_cipher_len = 0; 192bdcd8170SKalle Valo break; 193bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 194bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 195bdcd8170SKalle Valo *ar_cipher_len = 0; 196bdcd8170SKalle Valo break; 197bdcd8170SKalle Valo default: 198bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 199bdcd8170SKalle Valo return -ENOTSUPP; 200bdcd8170SKalle Valo } 201bdcd8170SKalle Valo 202bdcd8170SKalle Valo return 0; 203bdcd8170SKalle Valo } 204bdcd8170SKalle Valo 205bdcd8170SKalle Valo static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt) 206bdcd8170SKalle Valo { 207bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 208bdcd8170SKalle Valo 209bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 210bdcd8170SKalle Valo if (ar->auth_mode == WPA_AUTH) 211bdcd8170SKalle Valo ar->auth_mode = WPA_PSK_AUTH; 212bdcd8170SKalle Valo else if (ar->auth_mode == WPA2_AUTH) 213bdcd8170SKalle Valo ar->auth_mode = WPA2_PSK_AUTH; 214bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 215bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 216bdcd8170SKalle Valo } 217bdcd8170SKalle Valo } 218bdcd8170SKalle Valo 219bdcd8170SKalle Valo static bool ath6kl_cfg80211_ready(struct ath6kl *ar) 220bdcd8170SKalle Valo { 221bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 222bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 223bdcd8170SKalle Valo return false; 224bdcd8170SKalle Valo } 225bdcd8170SKalle Valo 226575b5f34SRaja Mani if (!test_bit(WLAN_ENABLED, &ar->flag)) { 227bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 228bdcd8170SKalle Valo return false; 229bdcd8170SKalle Valo } 230bdcd8170SKalle Valo 231bdcd8170SKalle Valo return true; 232bdcd8170SKalle Valo } 233bdcd8170SKalle Valo 234bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 235bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 236bdcd8170SKalle Valo { 237bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 238bdcd8170SKalle Valo int status; 239bdcd8170SKalle Valo 240bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 241bdcd8170SKalle Valo 242bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 243bdcd8170SKalle Valo return -EIO; 244bdcd8170SKalle Valo 245bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 246bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 247bdcd8170SKalle Valo return -EBUSY; 248bdcd8170SKalle Valo } 249bdcd8170SKalle Valo 250bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 251bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 252bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 253bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 254bdcd8170SKalle Valo return -EINVAL; 255bdcd8170SKalle Valo } 256bdcd8170SKalle Valo 257bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 258bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 259bdcd8170SKalle Valo return -ERESTARTSYS; 260bdcd8170SKalle Valo } 261bdcd8170SKalle Valo 262bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 263bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 264bdcd8170SKalle Valo up(&ar->sem); 265bdcd8170SKalle Valo return -EBUSY; 266bdcd8170SKalle Valo } 267bdcd8170SKalle Valo 268bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 269bdcd8170SKalle Valo /* 270bdcd8170SKalle Valo * sleep until the command queue drains 271bdcd8170SKalle Valo */ 272bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 273bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 274bdcd8170SKalle Valo WMI_TIMEOUT); 275bdcd8170SKalle Valo if (signal_pending(current)) { 276bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 277bdcd8170SKalle Valo up(&ar->sem); 278bdcd8170SKalle Valo return -EINTR; 279bdcd8170SKalle Valo } 280bdcd8170SKalle Valo } 281bdcd8170SKalle Valo 282bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag) && 283bdcd8170SKalle Valo ar->ssid_len == sme->ssid_len && 284bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 285bdcd8170SKalle Valo ar->reconnect_flag = true; 286bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 287bdcd8170SKalle Valo ar->ch_hint); 288bdcd8170SKalle Valo 289bdcd8170SKalle Valo up(&ar->sem); 290bdcd8170SKalle Valo if (status) { 291bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 292bdcd8170SKalle Valo return -EIO; 293bdcd8170SKalle Valo } 294bdcd8170SKalle Valo return 0; 295bdcd8170SKalle Valo } else if (ar->ssid_len == sme->ssid_len && 296bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 297bdcd8170SKalle Valo ath6kl_disconnect(ar); 298bdcd8170SKalle Valo } 299bdcd8170SKalle Valo 300bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 301bdcd8170SKalle Valo ar->ssid_len = sme->ssid_len; 302bdcd8170SKalle Valo memcpy(ar->ssid, sme->ssid, sme->ssid_len); 303bdcd8170SKalle Valo 304bdcd8170SKalle Valo if (sme->channel) 305bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 306bdcd8170SKalle Valo 307bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 308bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 309bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 310bdcd8170SKalle Valo 311bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 312bdcd8170SKalle Valo 313bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 314bdcd8170SKalle Valo if (status) { 315bdcd8170SKalle Valo up(&ar->sem); 316bdcd8170SKalle Valo return status; 317bdcd8170SKalle Valo } 318bdcd8170SKalle Valo 319bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 320bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 321bdcd8170SKalle Valo else 322bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 323bdcd8170SKalle Valo 324bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 325bdcd8170SKalle Valo 326bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 327bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 328bdcd8170SKalle Valo 329bdcd8170SKalle Valo if ((sme->key_len) && 330bdcd8170SKalle Valo (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) { 331bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 332bdcd8170SKalle Valo 333bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 334bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 335bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 336bdcd8170SKalle Valo sme->key_idx); 337bdcd8170SKalle Valo up(&ar->sem); 338bdcd8170SKalle Valo return -ENOENT; 339bdcd8170SKalle Valo } 340bdcd8170SKalle Valo 341bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 342bdcd8170SKalle Valo key->key_len = sme->key_len; 343bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 344bdcd8170SKalle Valo key->cipher = ar->prwise_crypto; 345bdcd8170SKalle Valo ar->def_txkey_index = sme->key_idx; 346bdcd8170SKalle Valo 347bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 348bdcd8170SKalle Valo ar->prwise_crypto, 349bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 350bdcd8170SKalle Valo key->key_len, 351bdcd8170SKalle Valo NULL, 352bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 353bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 354bdcd8170SKalle Valo } 355bdcd8170SKalle Valo 356bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 357bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 358bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 359bdcd8170SKalle Valo up(&ar->sem); 360bdcd8170SKalle Valo return -EIO; 361bdcd8170SKalle Valo } 362bdcd8170SKalle Valo } 363bdcd8170SKalle Valo 364bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 365bdcd8170SKalle Valo 366bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 367bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 368bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 369bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 370bdcd8170SKalle Valo __func__, 371bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 372bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 373bdcd8170SKalle Valo ar->grp_crpto_len, ar->ch_hint); 374bdcd8170SKalle Valo 375bdcd8170SKalle Valo ar->reconnect_flag = 0; 376bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 377bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 378bdcd8170SKalle Valo ar->prwise_crypto, 379bdcd8170SKalle Valo ar->prwise_crypto_len, 380bdcd8170SKalle Valo ar->grp_crypto, ar->grp_crpto_len, 381bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 382bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 383bdcd8170SKalle Valo ar->connect_ctrl_flags); 384bdcd8170SKalle Valo 385bdcd8170SKalle Valo up(&ar->sem); 386bdcd8170SKalle Valo 387bdcd8170SKalle Valo if (status == -EINVAL) { 388bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 389bdcd8170SKalle Valo ar->ssid_len = 0; 390bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 391bdcd8170SKalle Valo return -ENOENT; 392bdcd8170SKalle Valo } else if (status) { 393bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 394bdcd8170SKalle Valo return -EIO; 395bdcd8170SKalle Valo } 396bdcd8170SKalle Valo 397bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 398bdcd8170SKalle Valo ((ar->auth_mode == WPA_PSK_AUTH) 399bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH))) { 400bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 401bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 402bdcd8170SKalle Valo } 403bdcd8170SKalle Valo 404bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 405bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 406bdcd8170SKalle Valo 407bdcd8170SKalle Valo return 0; 408bdcd8170SKalle Valo } 409bdcd8170SKalle Valo 410bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 411bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 412bdcd8170SKalle Valo u16 beacon_intvl, 413bdcd8170SKalle Valo enum network_type nw_type, 414bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 415bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 416bdcd8170SKalle Valo { 417bdcd8170SKalle Valo u16 size = 0; 418bdcd8170SKalle Valo u16 capability = 0; 419bdcd8170SKalle Valo struct cfg80211_bss *bss = NULL; 420bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt = NULL; 421bdcd8170SKalle Valo struct ieee80211_channel *ibss_ch = NULL; 422bdcd8170SKalle Valo s32 signal = 50 * 100; 423bdcd8170SKalle Valo u8 ie_buf_len = 0; 424bdcd8170SKalle Valo unsigned char ie_buf[256]; 425bdcd8170SKalle Valo unsigned char *ptr_ie_buf = ie_buf; 426bdcd8170SKalle Valo unsigned char *ieeemgmtbuf = NULL; 427bdcd8170SKalle Valo u8 source_mac[ETH_ALEN]; 428bdcd8170SKalle Valo u16 capa_mask; 429bdcd8170SKalle Valo u16 capa_val; 430bdcd8170SKalle Valo 431bdcd8170SKalle Valo /* capinfo + listen interval */ 432bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 433bdcd8170SKalle Valo 434bdcd8170SKalle Valo /* capinfo + status code + associd */ 435bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 436bdcd8170SKalle Valo 437bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 438bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 439bdcd8170SKalle Valo assoc_resp_ie_offset; 440bdcd8170SKalle Valo 441bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 442bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 443bdcd8170SKalle Valo 444bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 447bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 448bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 449bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 450bdcd8170SKalle Valo return; 451bdcd8170SKalle Valo } 452bdcd8170SKalle Valo } 453bdcd8170SKalle Valo 454bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 455bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_STATION) { 456bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 457bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 458bdcd8170SKalle Valo return; 459bdcd8170SKalle Valo } 460bdcd8170SKalle Valo } 461bdcd8170SKalle Valo 462bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 463bdcd8170SKalle Valo capa_mask = WLAN_CAPABILITY_IBSS; 464bdcd8170SKalle Valo capa_val = WLAN_CAPABILITY_IBSS; 465bdcd8170SKalle Valo } else { 466bdcd8170SKalle Valo capa_mask = WLAN_CAPABILITY_ESS; 467bdcd8170SKalle Valo capa_val = WLAN_CAPABILITY_ESS; 468bdcd8170SKalle Valo } 469bdcd8170SKalle Valo 470bdcd8170SKalle Valo /* Before informing the join/connect event, make sure that 471bdcd8170SKalle Valo * bss entry is present in scan list, if it not present 472bdcd8170SKalle Valo * construct and insert into scan list, otherwise that 473bdcd8170SKalle Valo * event will be dropped on the way by cfg80211, due to 474bdcd8170SKalle Valo * this keys will not be plumbed in case of WEP and 475bdcd8170SKalle Valo * application will not be aware of join/connect status. */ 476bdcd8170SKalle Valo bss = cfg80211_get_bss(ar->wdev->wiphy, NULL, bssid, 477bdcd8170SKalle Valo ar->wdev->ssid, ar->wdev->ssid_len, 478bdcd8170SKalle Valo capa_mask, capa_val); 479bdcd8170SKalle Valo 480bdcd8170SKalle Valo /* 481bdcd8170SKalle Valo * Earlier we were updating the cfg about bss by making a beacon frame 482bdcd8170SKalle Valo * only if the entry for bss is not there. This can have some issue if 483bdcd8170SKalle Valo * ROAM event is generated and a heavy traffic is ongoing. The ROAM 484bdcd8170SKalle Valo * event is handled through a work queue and by the time it really gets 485bdcd8170SKalle Valo * handled, BSS would have been aged out. So it is better to update the 486bdcd8170SKalle Valo * cfg about BSS irrespective of its entry being present right now or 487bdcd8170SKalle Valo * not. 488bdcd8170SKalle Valo */ 489bdcd8170SKalle Valo 490bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 491bdcd8170SKalle Valo /* construct 802.11 mgmt beacon */ 492bdcd8170SKalle Valo if (ptr_ie_buf) { 493bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_SSID; 494bdcd8170SKalle Valo *ptr_ie_buf++ = ar->ssid_len; 495bdcd8170SKalle Valo memcpy(ptr_ie_buf, ar->ssid, ar->ssid_len); 496bdcd8170SKalle Valo ptr_ie_buf += ar->ssid_len; 497bdcd8170SKalle Valo 498bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_IBSS_PARAMS; 499bdcd8170SKalle Valo *ptr_ie_buf++ = 2; /* length */ 500bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 501bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 502bdcd8170SKalle Valo 503bdcd8170SKalle Valo /* TODO: update ibss params and include supported rates, 504bdcd8170SKalle Valo * DS param set, extened support rates, wmm. */ 505bdcd8170SKalle Valo 506bdcd8170SKalle Valo ie_buf_len = ptr_ie_buf - ie_buf; 507bdcd8170SKalle Valo } 508bdcd8170SKalle Valo 509bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_IBSS; 510bdcd8170SKalle Valo 511bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 512bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_PRIVACY; 513bdcd8170SKalle Valo 514bdcd8170SKalle Valo memcpy(source_mac, ar->net_dev->dev_addr, ETH_ALEN); 515bdcd8170SKalle Valo ptr_ie_buf = ie_buf; 516bdcd8170SKalle Valo } else { 517bdcd8170SKalle Valo capability = *(u16 *) (&assoc_info[beacon_ie_len]); 518bdcd8170SKalle Valo memcpy(source_mac, bssid, ETH_ALEN); 519bdcd8170SKalle Valo ptr_ie_buf = assoc_req_ie; 520bdcd8170SKalle Valo ie_buf_len = assoc_req_len; 521bdcd8170SKalle Valo } 522bdcd8170SKalle Valo 523bdcd8170SKalle Valo size = offsetof(struct ieee80211_mgmt, u) 524bdcd8170SKalle Valo + sizeof(mgmt->u.beacon) 525bdcd8170SKalle Valo + ie_buf_len; 526bdcd8170SKalle Valo 527bdcd8170SKalle Valo ieeemgmtbuf = kzalloc(size, GFP_ATOMIC); 528bdcd8170SKalle Valo if (!ieeemgmtbuf) { 529bdcd8170SKalle Valo ath6kl_err("ieee mgmt buf alloc error\n"); 530bdcd8170SKalle Valo cfg80211_put_bss(bss); 531bdcd8170SKalle Valo return; 532bdcd8170SKalle Valo } 533bdcd8170SKalle Valo 534bdcd8170SKalle Valo mgmt = (struct ieee80211_mgmt *)ieeemgmtbuf; 535bdcd8170SKalle Valo mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 536bdcd8170SKalle Valo IEEE80211_STYPE_BEACON); 537bdcd8170SKalle Valo memset(mgmt->da, 0xff, ETH_ALEN); /* broadcast addr */ 538bdcd8170SKalle Valo memcpy(mgmt->sa, source_mac, ETH_ALEN); 539bdcd8170SKalle Valo memcpy(mgmt->bssid, bssid, ETH_ALEN); 540bdcd8170SKalle Valo mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_intvl); 541bdcd8170SKalle Valo mgmt->u.beacon.capab_info = cpu_to_le16(capability); 542bdcd8170SKalle Valo memcpy(mgmt->u.beacon.variable, ptr_ie_buf, ie_buf_len); 543bdcd8170SKalle Valo 544bdcd8170SKalle Valo ibss_ch = ieee80211_get_channel(ar->wdev->wiphy, (int)channel); 545bdcd8170SKalle Valo 546bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 547bdcd8170SKalle Valo "%s: inform bss with bssid %pM channel %d beacon_intvl %d capability 0x%x\n", 548bdcd8170SKalle Valo __func__, mgmt->bssid, ibss_ch->hw_value, 549bdcd8170SKalle Valo beacon_intvl, capability); 550bdcd8170SKalle Valo 551bdcd8170SKalle Valo bss = cfg80211_inform_bss_frame(ar->wdev->wiphy, 552bdcd8170SKalle Valo ibss_ch, mgmt, 553bdcd8170SKalle Valo size, signal, GFP_KERNEL); 554bdcd8170SKalle Valo kfree(ieeemgmtbuf); 555bdcd8170SKalle Valo cfg80211_put_bss(bss); 556bdcd8170SKalle Valo 557bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 558bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 559bdcd8170SKalle Valo return; 560bdcd8170SKalle Valo } 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo if (!test_bit(CONNECTED, &ar->flag)) { 563bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 564bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 565bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 566bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 567bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 568bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 569bdcd8170SKalle Valo } else { 570bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 571bdcd8170SKalle Valo cfg80211_roamed(ar->net_dev, ibss_ch, bssid, 572bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 573bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 574bdcd8170SKalle Valo } 575bdcd8170SKalle Valo } 576bdcd8170SKalle Valo 577bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 578bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 579bdcd8170SKalle Valo { 580bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 581bdcd8170SKalle Valo 582bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 583bdcd8170SKalle Valo reason_code); 584bdcd8170SKalle Valo 585bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 586bdcd8170SKalle Valo return -EIO; 587bdcd8170SKalle Valo 588bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 589bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 590bdcd8170SKalle Valo return -EBUSY; 591bdcd8170SKalle Valo } 592bdcd8170SKalle Valo 593bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 594bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 595bdcd8170SKalle Valo return -ERESTARTSYS; 596bdcd8170SKalle Valo } 597bdcd8170SKalle Valo 598bdcd8170SKalle Valo ar->reconnect_flag = 0; 599bdcd8170SKalle Valo ath6kl_disconnect(ar); 600bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 601bdcd8170SKalle Valo ar->ssid_len = 0; 602bdcd8170SKalle Valo 603bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 604bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 605bdcd8170SKalle Valo 606bdcd8170SKalle Valo up(&ar->sem); 607bdcd8170SKalle Valo 608bdcd8170SKalle Valo return 0; 609bdcd8170SKalle Valo } 610bdcd8170SKalle Valo 611bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 612bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 613bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 614bdcd8170SKalle Valo { 615bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 616bdcd8170SKalle Valo u16 status; 617bdcd8170SKalle Valo 618bdcd8170SKalle Valo if (ar->scan_req) { 619bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 620bdcd8170SKalle Valo ar->scan_req = NULL; 621bdcd8170SKalle Valo } 622bdcd8170SKalle Valo 623bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 624bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 625bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 626bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 627bdcd8170SKalle Valo return; 628bdcd8170SKalle Valo } 629bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 630bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 631bdcd8170SKalle Valo return; 632bdcd8170SKalle Valo } 633bdcd8170SKalle Valo 634bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 635bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_STATION) { 636bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 637bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 638bdcd8170SKalle Valo return; 639bdcd8170SKalle Valo } 640bdcd8170SKalle Valo } 641bdcd8170SKalle Valo 642bdcd8170SKalle Valo if (!test_bit(CONNECT_PEND, &ar->flag)) { 643bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 644bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 645bdcd8170SKalle Valo 646bdcd8170SKalle Valo return; 647bdcd8170SKalle Valo } 648bdcd8170SKalle Valo 649bdcd8170SKalle Valo if (reason == NO_NETWORK_AVAIL) { 650bdcd8170SKalle Valo /* connect cmd failed */ 651bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 652bdcd8170SKalle Valo return; 653bdcd8170SKalle Valo } 654bdcd8170SKalle Valo 655bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 656bdcd8170SKalle Valo return; 657bdcd8170SKalle Valo 658bdcd8170SKalle Valo if (!ar->auto_auth_stage) { 659bdcd8170SKalle Valo clear_bit(CONNECT_PEND, &ar->flag); 660bdcd8170SKalle Valo 661bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 662bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 663bdcd8170SKalle Valo bssid, NULL, 0, 664bdcd8170SKalle Valo NULL, 0, 665bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 666bdcd8170SKalle Valo GFP_KERNEL); 667bdcd8170SKalle Valo } else { 668bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 669bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 670bdcd8170SKalle Valo } 671bdcd8170SKalle Valo 672bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 673bdcd8170SKalle Valo return; 674bdcd8170SKalle Valo } 675bdcd8170SKalle Valo 676bdcd8170SKalle Valo if (ar->dot11_auth_mode != OPEN_AUTH) 677bdcd8170SKalle Valo return; 678bdcd8170SKalle Valo 679bdcd8170SKalle Valo /* 680bdcd8170SKalle Valo * If the current auth algorithm is open, try shared and 681bdcd8170SKalle Valo * make autoAuthStage idle. We do not make it leap for now 682bdcd8170SKalle Valo * being. 683bdcd8170SKalle Valo */ 684bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 685bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 686bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 687bdcd8170SKalle Valo return; 688bdcd8170SKalle Valo } 689bdcd8170SKalle Valo 690bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 691bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 692bdcd8170SKalle Valo 693bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, 694bdcd8170SKalle Valo ar->def_txkey_index, 695bdcd8170SKalle Valo ar->prwise_crypto, 696bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 697bdcd8170SKalle Valo key->key_len, NULL, 698bdcd8170SKalle Valo key->key, 699bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 700bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 701bdcd8170SKalle Valo 702bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, 703bdcd8170SKalle Valo ar->nw_type, 704bdcd8170SKalle Valo ar->dot11_auth_mode, 705bdcd8170SKalle Valo ar->auth_mode, 706bdcd8170SKalle Valo ar->prwise_crypto, 707bdcd8170SKalle Valo ar->prwise_crypto_len, 708bdcd8170SKalle Valo ar->grp_crypto, 709bdcd8170SKalle Valo ar->grp_crpto_len, 710bdcd8170SKalle Valo ar->ssid_len, 711bdcd8170SKalle Valo ar->ssid, 712bdcd8170SKalle Valo ar->req_bssid, 713bdcd8170SKalle Valo ar->ch_hint, 714bdcd8170SKalle Valo ar->connect_ctrl_flags); 715bdcd8170SKalle Valo up(&ar->sem); 716bdcd8170SKalle Valo } 717bdcd8170SKalle Valo 718bdcd8170SKalle Valo static inline bool is_ch_11a(u16 ch) 719bdcd8170SKalle Valo { 720bdcd8170SKalle Valo return (!((ch >= 2412) && (ch <= 2484))); 721bdcd8170SKalle Valo } 722bdcd8170SKalle Valo 723cf104c2aSKalle Valo /* struct ath6kl_node_table::nt_nodelock is locked when calling this */ 724bdcd8170SKalle Valo static void ath6kl_cfg80211_scan_node(void *arg, struct bss *ni) 725bdcd8170SKalle Valo { 726bdcd8170SKalle Valo struct wiphy *wiphy = (struct wiphy *)arg; 727bdcd8170SKalle Valo u16 size; 728bdcd8170SKalle Valo unsigned char *ieeemgmtbuf = NULL; 729bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt; 730bdcd8170SKalle Valo struct ieee80211_channel *channel; 731bdcd8170SKalle Valo struct ieee80211_supported_band *band; 732bdcd8170SKalle Valo struct ath6kl_common_ie *cie; 733bdcd8170SKalle Valo s32 signal; 734bdcd8170SKalle Valo int freq; 735bdcd8170SKalle Valo 736bdcd8170SKalle Valo cie = &ni->ni_cie; 737bdcd8170SKalle Valo 738bdcd8170SKalle Valo if (is_ch_11a(cie->ie_chan)) 739bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_5GHZ]; /* 11a */ 740bdcd8170SKalle Valo else if ((cie->ie_erp) || (cie->ie_xrates)) 741bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11g */ 742bdcd8170SKalle Valo else 743bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11b */ 744bdcd8170SKalle Valo 745bdcd8170SKalle Valo size = ni->ni_framelen + offsetof(struct ieee80211_mgmt, u); 746bdcd8170SKalle Valo ieeemgmtbuf = kmalloc(size, GFP_ATOMIC); 747bdcd8170SKalle Valo if (!ieeemgmtbuf) { 748bdcd8170SKalle Valo ath6kl_err("ieee mgmt buf alloc error\n"); 749bdcd8170SKalle Valo return; 750bdcd8170SKalle Valo } 751bdcd8170SKalle Valo 752bdcd8170SKalle Valo /* 753bdcd8170SKalle Valo * TODO: Update target to include 802.11 mac header while sending 754bdcd8170SKalle Valo * bss info. Target removes 802.11 mac header while sending the bss 755bdcd8170SKalle Valo * info to host, cfg80211 needs it, for time being just filling the 756bdcd8170SKalle Valo * da, sa and bssid fields alone. 757bdcd8170SKalle Valo */ 758bdcd8170SKalle Valo mgmt = (struct ieee80211_mgmt *)ieeemgmtbuf; 759bdcd8170SKalle Valo memset(mgmt->da, 0xff, ETH_ALEN); /*broadcast addr */ 760bdcd8170SKalle Valo memcpy(mgmt->sa, ni->ni_macaddr, ETH_ALEN); 761bdcd8170SKalle Valo memcpy(mgmt->bssid, ni->ni_macaddr, ETH_ALEN); 762bdcd8170SKalle Valo memcpy(ieeemgmtbuf + offsetof(struct ieee80211_mgmt, u), 763bdcd8170SKalle Valo ni->ni_buf, ni->ni_framelen); 764bdcd8170SKalle Valo 765bdcd8170SKalle Valo freq = cie->ie_chan; 766bdcd8170SKalle Valo channel = ieee80211_get_channel(wiphy, freq); 767bdcd8170SKalle Valo signal = ni->ni_snr * 100; 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 770bdcd8170SKalle Valo "%s: bssid %pM ch %d freq %d size %d\n", __func__, 771bdcd8170SKalle Valo mgmt->bssid, channel->hw_value, freq, size); 772bdcd8170SKalle Valo cfg80211_inform_bss_frame(wiphy, channel, mgmt, 773cf104c2aSKalle Valo size, signal, GFP_ATOMIC); 774bdcd8170SKalle Valo 775bdcd8170SKalle Valo kfree(ieeemgmtbuf); 776bdcd8170SKalle Valo } 777bdcd8170SKalle Valo 778bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 779bdcd8170SKalle Valo struct cfg80211_scan_request *request) 780bdcd8170SKalle Valo { 781bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 782bdcd8170SKalle Valo int ret = 0; 783bdcd8170SKalle Valo 784bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 785bdcd8170SKalle Valo return -EIO; 786bdcd8170SKalle Valo 787bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 788bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, 789bdcd8170SKalle Valo (test_bit(CONNECTED, &ar->flag) ? 790bdcd8170SKalle Valo ALL_BUT_BSS_FILTER : 791bdcd8170SKalle Valo ALL_BSS_FILTER), 0) != 0) { 792bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 793bdcd8170SKalle Valo return -EIO; 794bdcd8170SKalle Valo } 795bdcd8170SKalle Valo } 796bdcd8170SKalle Valo 797bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 798bdcd8170SKalle Valo u8 i; 799bdcd8170SKalle Valo 800bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 801bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 802bdcd8170SKalle Valo 803bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 804bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 805bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 806bdcd8170SKalle Valo request->ssids[i].ssid_len, 807bdcd8170SKalle Valo request->ssids[i].ssid); 808bdcd8170SKalle Valo } 809bdcd8170SKalle Valo 810b2c76bbeSKalle Valo if (ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, 0, 811bdcd8170SKalle Valo false, 0, 0, 0, NULL) != 0) { 812bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 813bdcd8170SKalle Valo ret = -EIO; 814bdcd8170SKalle Valo } 815bdcd8170SKalle Valo 816bdcd8170SKalle Valo ar->scan_req = request; 817bdcd8170SKalle Valo 818bdcd8170SKalle Valo return ret; 819bdcd8170SKalle Valo } 820bdcd8170SKalle Valo 821bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 822bdcd8170SKalle Valo { 8236fd1eaceSKalle Valo int i; 824bdcd8170SKalle Valo 825bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 826bdcd8170SKalle Valo 8276fd1eaceSKalle Valo if (!ar->scan_req) 8286fd1eaceSKalle Valo return; 8296fd1eaceSKalle Valo 8306fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 8316fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 8326fd1eaceSKalle Valo goto out; 8336fd1eaceSKalle Valo } 8346fd1eaceSKalle Valo 835bdcd8170SKalle Valo /* Translate data to cfg80211 mgmt format */ 836bdcd8170SKalle Valo ath6kl_wmi_iterate_nodes(ar->wmi, ath6kl_cfg80211_scan_node, 837bdcd8170SKalle Valo ar->wdev->wiphy); 838bdcd8170SKalle Valo 8396fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 840bdcd8170SKalle Valo 841bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 842bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 843bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 844bdcd8170SKalle Valo DISABLE_SSID_FLAG, 845bdcd8170SKalle Valo 0, NULL); 846bdcd8170SKalle Valo } 847bdcd8170SKalle Valo } 8486fd1eaceSKalle Valo 8496fd1eaceSKalle Valo out: 850bdcd8170SKalle Valo ar->scan_req = NULL; 851bdcd8170SKalle Valo } 852bdcd8170SKalle Valo 853bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 854bdcd8170SKalle Valo u8 key_index, bool pairwise, 855bdcd8170SKalle Valo const u8 *mac_addr, 856bdcd8170SKalle Valo struct key_params *params) 857bdcd8170SKalle Valo { 858bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 859bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 860bdcd8170SKalle Valo u8 key_usage; 861bdcd8170SKalle Valo u8 key_type; 862bdcd8170SKalle Valo int status = 0; 863bdcd8170SKalle Valo 864bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 865bdcd8170SKalle Valo return -EIO; 866bdcd8170SKalle Valo 867bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 868bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 869bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 870bdcd8170SKalle Valo key_index); 871bdcd8170SKalle Valo return -ENOENT; 872bdcd8170SKalle Valo } 873bdcd8170SKalle Valo 874bdcd8170SKalle Valo key = &ar->keys[key_index]; 875bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 876bdcd8170SKalle Valo 877bdcd8170SKalle Valo if (pairwise) 878bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 879bdcd8170SKalle Valo else 880bdcd8170SKalle Valo key_usage = GROUP_USAGE; 881bdcd8170SKalle Valo 882bdcd8170SKalle Valo if (params) { 883bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 884bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 885bdcd8170SKalle Valo return -EINVAL; 886bdcd8170SKalle Valo 887bdcd8170SKalle Valo key->key_len = params->key_len; 888bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 889bdcd8170SKalle Valo key->seq_len = params->seq_len; 890bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 891bdcd8170SKalle Valo key->cipher = params->cipher; 892bdcd8170SKalle Valo } 893bdcd8170SKalle Valo 894bdcd8170SKalle Valo switch (key->cipher) { 895bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 896bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 897bdcd8170SKalle Valo key_type = WEP_CRYPT; 898bdcd8170SKalle Valo break; 899bdcd8170SKalle Valo 900bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 901bdcd8170SKalle Valo key_type = TKIP_CRYPT; 902bdcd8170SKalle Valo break; 903bdcd8170SKalle Valo 904bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 905bdcd8170SKalle Valo key_type = AES_CRYPT; 906bdcd8170SKalle Valo break; 907bdcd8170SKalle Valo 908bdcd8170SKalle Valo default: 909bdcd8170SKalle Valo return -ENOTSUPP; 910bdcd8170SKalle Valo } 911bdcd8170SKalle Valo 912bdcd8170SKalle Valo if (((ar->auth_mode == WPA_PSK_AUTH) 913bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH)) 914bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 915bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 916bdcd8170SKalle Valo 917bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 918bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 919bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 920bdcd8170SKalle Valo key_usage, key->seq_len); 921bdcd8170SKalle Valo 922bdcd8170SKalle Valo ar->def_txkey_index = key_index; 923bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 924bdcd8170SKalle Valo key_type, key_usage, key->key_len, 925bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 926bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 927bdcd8170SKalle Valo 928bdcd8170SKalle Valo if (status) 929bdcd8170SKalle Valo return -EIO; 930bdcd8170SKalle Valo 931bdcd8170SKalle Valo return 0; 932bdcd8170SKalle Valo } 933bdcd8170SKalle Valo 934bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 935bdcd8170SKalle Valo u8 key_index, bool pairwise, 936bdcd8170SKalle Valo const u8 *mac_addr) 937bdcd8170SKalle Valo { 938bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 939bdcd8170SKalle Valo 940bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 941bdcd8170SKalle Valo 942bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 943bdcd8170SKalle Valo return -EIO; 944bdcd8170SKalle Valo 945bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 946bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 947bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 948bdcd8170SKalle Valo key_index); 949bdcd8170SKalle Valo return -ENOENT; 950bdcd8170SKalle Valo } 951bdcd8170SKalle Valo 952bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 953bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 954bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 955bdcd8170SKalle Valo return 0; 956bdcd8170SKalle Valo } 957bdcd8170SKalle Valo 958bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 959bdcd8170SKalle Valo 960bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 961bdcd8170SKalle Valo } 962bdcd8170SKalle Valo 963bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 964bdcd8170SKalle Valo u8 key_index, bool pairwise, 965bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 966bdcd8170SKalle Valo void (*callback) (void *cookie, 967bdcd8170SKalle Valo struct key_params *)) 968bdcd8170SKalle Valo { 969bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 970bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 971bdcd8170SKalle Valo struct key_params params; 972bdcd8170SKalle Valo 973bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 974bdcd8170SKalle Valo 975bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 976bdcd8170SKalle Valo return -EIO; 977bdcd8170SKalle Valo 978bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 979bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 980bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 981bdcd8170SKalle Valo key_index); 982bdcd8170SKalle Valo return -ENOENT; 983bdcd8170SKalle Valo } 984bdcd8170SKalle Valo 985bdcd8170SKalle Valo key = &ar->keys[key_index]; 986bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 987bdcd8170SKalle Valo params.cipher = key->cipher; 988bdcd8170SKalle Valo params.key_len = key->key_len; 989bdcd8170SKalle Valo params.seq_len = key->seq_len; 990bdcd8170SKalle Valo params.seq = key->seq; 991bdcd8170SKalle Valo params.key = key->key; 992bdcd8170SKalle Valo 993bdcd8170SKalle Valo callback(cookie, ¶ms); 994bdcd8170SKalle Valo 995bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 996bdcd8170SKalle Valo } 997bdcd8170SKalle Valo 998bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 999bdcd8170SKalle Valo struct net_device *ndev, 1000bdcd8170SKalle Valo u8 key_index, bool unicast, 1001bdcd8170SKalle Valo bool multicast) 1002bdcd8170SKalle Valo { 1003bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 1004bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 1005bdcd8170SKalle Valo int status = 0; 1006bdcd8170SKalle Valo u8 key_usage; 1007bdcd8170SKalle Valo 1008bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1009bdcd8170SKalle Valo 1010bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1011bdcd8170SKalle Valo return -EIO; 1012bdcd8170SKalle Valo 1013bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1014bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1015bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1016bdcd8170SKalle Valo __func__, key_index); 1017bdcd8170SKalle Valo return -ENOENT; 1018bdcd8170SKalle Valo } 1019bdcd8170SKalle Valo 1020bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1021bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1022bdcd8170SKalle Valo __func__, key_index); 1023bdcd8170SKalle Valo return -EINVAL; 1024bdcd8170SKalle Valo } 1025bdcd8170SKalle Valo 1026bdcd8170SKalle Valo ar->def_txkey_index = key_index; 1027bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 1028bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1029bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 1030bdcd8170SKalle Valo key_usage |= TX_USAGE; 1031bdcd8170SKalle Valo 1032bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1033bdcd8170SKalle Valo ar->prwise_crypto, key_usage, 1034bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1035bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1036bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1037bdcd8170SKalle Valo if (status) 1038bdcd8170SKalle Valo return -EIO; 1039bdcd8170SKalle Valo 1040bdcd8170SKalle Valo return 0; 1041bdcd8170SKalle Valo } 1042bdcd8170SKalle Valo 1043bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1044bdcd8170SKalle Valo bool ismcast) 1045bdcd8170SKalle Valo { 1046bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1047bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1048bdcd8170SKalle Valo 1049bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1050bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1051bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1052bdcd8170SKalle Valo GFP_KERNEL); 1053bdcd8170SKalle Valo } 1054bdcd8170SKalle Valo 1055bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1056bdcd8170SKalle Valo { 1057bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1058bdcd8170SKalle Valo int ret; 1059bdcd8170SKalle Valo 1060bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1061bdcd8170SKalle Valo changed); 1062bdcd8170SKalle Valo 1063bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1064bdcd8170SKalle Valo return -EIO; 1065bdcd8170SKalle Valo 1066bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1067bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1068bdcd8170SKalle Valo if (ret != 0) { 1069bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1070bdcd8170SKalle Valo return -EIO; 1071bdcd8170SKalle Valo } 1072bdcd8170SKalle Valo } 1073bdcd8170SKalle Valo 1074bdcd8170SKalle Valo return 0; 1075bdcd8170SKalle Valo } 1076bdcd8170SKalle Valo 1077bdcd8170SKalle Valo /* 1078bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1079bdcd8170SKalle Valo * data type from 2.6.36 onwards 1080bdcd8170SKalle Valo */ 1081bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1082bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1083bdcd8170SKalle Valo int dbm) 1084bdcd8170SKalle Valo { 1085bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1086bdcd8170SKalle Valo u8 ath6kl_dbm; 1087bdcd8170SKalle Valo 1088bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1089bdcd8170SKalle Valo type, dbm); 1090bdcd8170SKalle Valo 1091bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1092bdcd8170SKalle Valo return -EIO; 1093bdcd8170SKalle Valo 1094bdcd8170SKalle Valo switch (type) { 1095bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1096bdcd8170SKalle Valo return 0; 1097bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1098bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1099bdcd8170SKalle Valo break; 1100bdcd8170SKalle Valo default: 1101bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1102bdcd8170SKalle Valo __func__, type); 1103bdcd8170SKalle Valo return -EOPNOTSUPP; 1104bdcd8170SKalle Valo } 1105bdcd8170SKalle Valo 1106bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1107bdcd8170SKalle Valo 1108bdcd8170SKalle Valo return 0; 1109bdcd8170SKalle Valo } 1110bdcd8170SKalle Valo 1111bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1112bdcd8170SKalle Valo { 1113bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1114bdcd8170SKalle Valo 1115bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1116bdcd8170SKalle Valo return -EIO; 1117bdcd8170SKalle Valo 1118bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) { 1119bdcd8170SKalle Valo ar->tx_pwr = 0; 1120bdcd8170SKalle Valo 1121bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1122bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1123bdcd8170SKalle Valo return -EIO; 1124bdcd8170SKalle Valo } 1125bdcd8170SKalle Valo 1126bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1127bdcd8170SKalle Valo 5 * HZ); 1128bdcd8170SKalle Valo 1129bdcd8170SKalle Valo if (signal_pending(current)) { 1130bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1131bdcd8170SKalle Valo return -EINTR; 1132bdcd8170SKalle Valo } 1133bdcd8170SKalle Valo } 1134bdcd8170SKalle Valo 1135bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1136bdcd8170SKalle Valo return 0; 1137bdcd8170SKalle Valo } 1138bdcd8170SKalle Valo 1139bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1140bdcd8170SKalle Valo struct net_device *dev, 1141bdcd8170SKalle Valo bool pmgmt, int timeout) 1142bdcd8170SKalle Valo { 1143bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1144bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1145bdcd8170SKalle Valo 1146bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1147bdcd8170SKalle Valo __func__, pmgmt, timeout); 1148bdcd8170SKalle Valo 1149bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1150bdcd8170SKalle Valo return -EIO; 1151bdcd8170SKalle Valo 1152bdcd8170SKalle Valo if (pmgmt) { 1153bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1154bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1155bdcd8170SKalle Valo } else { 1156bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1157bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1158bdcd8170SKalle Valo } 1159bdcd8170SKalle Valo 1160bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1161bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1162bdcd8170SKalle Valo return -EIO; 1163bdcd8170SKalle Valo } 1164bdcd8170SKalle Valo 1165bdcd8170SKalle Valo return 0; 1166bdcd8170SKalle Valo } 1167bdcd8170SKalle Valo 1168bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1169bdcd8170SKalle Valo struct net_device *ndev, 1170bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1171bdcd8170SKalle Valo struct vif_params *params) 1172bdcd8170SKalle Valo { 1173bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1174bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1175bdcd8170SKalle Valo 1176bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1177bdcd8170SKalle Valo 1178bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1179bdcd8170SKalle Valo return -EIO; 1180bdcd8170SKalle Valo 1181bdcd8170SKalle Valo switch (type) { 1182bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1183bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1184bdcd8170SKalle Valo break; 1185bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1186bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1187bdcd8170SKalle Valo break; 1188bdcd8170SKalle Valo default: 1189bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1190bdcd8170SKalle Valo return -EOPNOTSUPP; 1191bdcd8170SKalle Valo } 1192bdcd8170SKalle Valo 1193bdcd8170SKalle Valo wdev->iftype = type; 1194bdcd8170SKalle Valo 1195bdcd8170SKalle Valo return 0; 1196bdcd8170SKalle Valo } 1197bdcd8170SKalle Valo 1198bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1199bdcd8170SKalle Valo struct net_device *dev, 1200bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1201bdcd8170SKalle Valo { 1202bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1203bdcd8170SKalle Valo int status; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1206bdcd8170SKalle Valo return -EIO; 1207bdcd8170SKalle Valo 1208bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1209bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1210bdcd8170SKalle Valo 1211bdcd8170SKalle Valo if (ibss_param->channel) 1212bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1213bdcd8170SKalle Valo 1214bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1215bdcd8170SKalle Valo /* 1216bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1217bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1218bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1219bdcd8170SKalle Valo * updated. 1220bdcd8170SKalle Valo */ 1221bdcd8170SKalle Valo return -EOPNOTSUPP; 1222bdcd8170SKalle Valo } 1223bdcd8170SKalle Valo 1224bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1225bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1226bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1227bdcd8170SKalle Valo 1228bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1229bdcd8170SKalle Valo 1230bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1231bdcd8170SKalle Valo if (status) 1232bdcd8170SKalle Valo return status; 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo if (ibss_param->privacy) { 1235bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1236bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1237bdcd8170SKalle Valo } else { 1238bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1239bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1240bdcd8170SKalle Valo } 1241bdcd8170SKalle Valo 1242bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1243bdcd8170SKalle Valo 1244bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1245bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1246bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1247bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1248bdcd8170SKalle Valo __func__, 1249bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1250bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 1251bdcd8170SKalle Valo ar->grp_crpto_len, ar->ch_hint); 1252bdcd8170SKalle Valo 1253bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1254bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1255bdcd8170SKalle Valo ar->prwise_crypto, 1256bdcd8170SKalle Valo ar->prwise_crypto_len, 1257bdcd8170SKalle Valo ar->grp_crypto, ar->grp_crpto_len, 1258bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1259bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1260bdcd8170SKalle Valo ar->connect_ctrl_flags); 1261bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 1262bdcd8170SKalle Valo 1263bdcd8170SKalle Valo return 0; 1264bdcd8170SKalle Valo } 1265bdcd8170SKalle Valo 1266bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1267bdcd8170SKalle Valo struct net_device *dev) 1268bdcd8170SKalle Valo { 1269bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1270bdcd8170SKalle Valo 1271bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1272bdcd8170SKalle Valo return -EIO; 1273bdcd8170SKalle Valo 1274bdcd8170SKalle Valo ath6kl_disconnect(ar); 1275bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1276bdcd8170SKalle Valo ar->ssid_len = 0; 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo return 0; 1279bdcd8170SKalle Valo } 1280bdcd8170SKalle Valo 1281bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1282bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1283bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1284bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1285bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1286bdcd8170SKalle Valo }; 1287bdcd8170SKalle Valo 1288bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1289bdcd8170SKalle Valo { 1290bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1291bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1292bdcd8170SKalle Valo 36000, 48000, 54000 1293bdcd8170SKalle Valo }; 1294bdcd8170SKalle Valo u8 i; 1295bdcd8170SKalle Valo 1296bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1297bdcd8170SKalle Valo if (rate == legacy[i]) 1298bdcd8170SKalle Valo return true; 1299bdcd8170SKalle Valo 1300bdcd8170SKalle Valo return false; 1301bdcd8170SKalle Valo } 1302bdcd8170SKalle Valo 1303bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1304bdcd8170SKalle Valo { 1305bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1306bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1307bdcd8170SKalle Valo }; 1308bdcd8170SKalle Valo u8 i; 1309bdcd8170SKalle Valo 1310bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1311bdcd8170SKalle Valo if (rate == ht20[i]) { 1312bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1313bdcd8170SKalle Valo /* last rate uses sgi */ 1314bdcd8170SKalle Valo *sgi = true; 1315bdcd8170SKalle Valo else 1316bdcd8170SKalle Valo *sgi = false; 1317bdcd8170SKalle Valo 1318bdcd8170SKalle Valo *mcs = i; 1319bdcd8170SKalle Valo return true; 1320bdcd8170SKalle Valo } 1321bdcd8170SKalle Valo } 1322bdcd8170SKalle Valo return false; 1323bdcd8170SKalle Valo } 1324bdcd8170SKalle Valo 1325bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1326bdcd8170SKalle Valo { 1327bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1328bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1329bdcd8170SKalle Valo 150000 1330bdcd8170SKalle Valo }; 1331bdcd8170SKalle Valo u8 i; 1332bdcd8170SKalle Valo 1333bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1334bdcd8170SKalle Valo if (rate == ht40[i]) { 1335bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1336bdcd8170SKalle Valo /* last rate uses sgi */ 1337bdcd8170SKalle Valo *sgi = true; 1338bdcd8170SKalle Valo else 1339bdcd8170SKalle Valo *sgi = false; 1340bdcd8170SKalle Valo 1341bdcd8170SKalle Valo *mcs = i; 1342bdcd8170SKalle Valo return true; 1343bdcd8170SKalle Valo } 1344bdcd8170SKalle Valo } 1345bdcd8170SKalle Valo 1346bdcd8170SKalle Valo return false; 1347bdcd8170SKalle Valo } 1348bdcd8170SKalle Valo 1349bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1350bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1351bdcd8170SKalle Valo { 1352bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1353bdcd8170SKalle Valo long left; 1354bdcd8170SKalle Valo bool sgi; 1355bdcd8170SKalle Valo s32 rate; 1356bdcd8170SKalle Valo int ret; 1357bdcd8170SKalle Valo u8 mcs; 1358bdcd8170SKalle Valo 1359bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1360bdcd8170SKalle Valo return -ENOENT; 1361bdcd8170SKalle Valo 1362bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1363bdcd8170SKalle Valo return -EBUSY; 1364bdcd8170SKalle Valo 1365bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1366bdcd8170SKalle Valo 1367bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1368bdcd8170SKalle Valo 1369bdcd8170SKalle Valo if (ret != 0) { 1370bdcd8170SKalle Valo up(&ar->sem); 1371bdcd8170SKalle Valo return -EIO; 1372bdcd8170SKalle Valo } 1373bdcd8170SKalle Valo 1374bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1375bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1376bdcd8170SKalle Valo &ar->flag), 1377bdcd8170SKalle Valo WMI_TIMEOUT); 1378bdcd8170SKalle Valo 1379bdcd8170SKalle Valo up(&ar->sem); 1380bdcd8170SKalle Valo 1381bdcd8170SKalle Valo if (left == 0) 1382bdcd8170SKalle Valo return -ETIMEDOUT; 1383bdcd8170SKalle Valo else if (left < 0) 1384bdcd8170SKalle Valo return left; 1385bdcd8170SKalle Valo 1386bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1387bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1388bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1389bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1390bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1391bdcd8170SKalle Valo } 1392bdcd8170SKalle Valo 1393bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1394bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1395bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1396bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1397bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1398bdcd8170SKalle Valo } 1399bdcd8170SKalle Valo 1400bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1401bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1402bdcd8170SKalle Valo 1403bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1404bdcd8170SKalle Valo 1405bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1406bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1407bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1408bdcd8170SKalle Valo if (sgi) { 1409bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1410bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1411bdcd8170SKalle Valo } else { 1412bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1413bdcd8170SKalle Valo } 1414bdcd8170SKalle Valo 1415bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1416bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1417bdcd8170SKalle Valo if (sgi) { 1418bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1419bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1420bdcd8170SKalle Valo } else { 1421bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1422bdcd8170SKalle Valo } 1423bdcd8170SKalle Valo 1424bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1425bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1426bdcd8170SKalle Valo } else { 1427bdcd8170SKalle Valo ath6kl_warn("invalid rate: %d\n", rate); 1428bdcd8170SKalle Valo return 0; 1429bdcd8170SKalle Valo } 1430bdcd8170SKalle Valo 1431bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1432bdcd8170SKalle Valo 1433bdcd8170SKalle Valo return 0; 1434bdcd8170SKalle Valo } 1435bdcd8170SKalle Valo 1436bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1437bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1438bdcd8170SKalle Valo { 1439bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1440bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1441bdcd8170SKalle Valo pmksa->pmkid, true); 1442bdcd8170SKalle Valo } 1443bdcd8170SKalle Valo 1444bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1445bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1446bdcd8170SKalle Valo { 1447bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1448bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1449bdcd8170SKalle Valo pmksa->pmkid, false); 1450bdcd8170SKalle Valo } 1451bdcd8170SKalle Valo 1452bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1453bdcd8170SKalle Valo { 1454bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1455bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) 1456bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1457bdcd8170SKalle Valo return 0; 1458bdcd8170SKalle Valo } 1459bdcd8170SKalle Valo 1460bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1461bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1462bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1463bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1464bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1465bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1466bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1467bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1468bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1469bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1470bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1471bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1472bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1473bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1474bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1475bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1476bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1477bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1478bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1479bdcd8170SKalle Valo }; 1480bdcd8170SKalle Valo 1481bdcd8170SKalle Valo struct wireless_dev *ath6kl_cfg80211_init(struct device *dev) 1482bdcd8170SKalle Valo { 1483bdcd8170SKalle Valo int ret = 0; 1484bdcd8170SKalle Valo struct wireless_dev *wdev; 1485bdcd8170SKalle Valo 1486bdcd8170SKalle Valo wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL); 1487bdcd8170SKalle Valo if (!wdev) { 1488bdcd8170SKalle Valo ath6kl_err("couldn't allocate wireless device\n"); 1489bdcd8170SKalle Valo return NULL; 1490bdcd8170SKalle Valo } 1491bdcd8170SKalle Valo 1492bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1493bdcd8170SKalle Valo wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 1494bdcd8170SKalle Valo if (!wdev->wiphy) { 1495bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1496bdcd8170SKalle Valo kfree(wdev); 1497bdcd8170SKalle Valo return NULL; 1498bdcd8170SKalle Valo } 1499bdcd8170SKalle Valo 1500bdcd8170SKalle Valo /* set device pointer for wiphy */ 1501bdcd8170SKalle Valo set_wiphy_dev(wdev->wiphy, dev); 1502bdcd8170SKalle Valo 1503bdcd8170SKalle Valo wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 1504bdcd8170SKalle Valo BIT(NL80211_IFTYPE_ADHOC); 1505bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 1506bdcd8170SKalle Valo wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 1507bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 1508bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 1509bdcd8170SKalle Valo wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 1510bdcd8170SKalle Valo 1511bdcd8170SKalle Valo wdev->wiphy->cipher_suites = cipher_suites; 1512bdcd8170SKalle Valo wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 1513bdcd8170SKalle Valo 1514bdcd8170SKalle Valo ret = wiphy_register(wdev->wiphy); 1515bdcd8170SKalle Valo if (ret < 0) { 1516bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 1517bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1518bdcd8170SKalle Valo kfree(wdev); 1519bdcd8170SKalle Valo return NULL; 1520bdcd8170SKalle Valo } 1521bdcd8170SKalle Valo 1522bdcd8170SKalle Valo return wdev; 1523bdcd8170SKalle Valo } 1524bdcd8170SKalle Valo 1525bdcd8170SKalle Valo void ath6kl_cfg80211_deinit(struct ath6kl *ar) 1526bdcd8170SKalle Valo { 1527bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1528bdcd8170SKalle Valo 1529bdcd8170SKalle Valo if (ar->scan_req) { 1530bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 1531bdcd8170SKalle Valo ar->scan_req = NULL; 1532bdcd8170SKalle Valo } 1533bdcd8170SKalle Valo 1534bdcd8170SKalle Valo if (!wdev) 1535bdcd8170SKalle Valo return; 1536bdcd8170SKalle Valo 1537bdcd8170SKalle Valo wiphy_unregister(wdev->wiphy); 1538bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1539bdcd8170SKalle Valo kfree(wdev); 1540bdcd8170SKalle Valo } 1541