1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 3bdcd8170SKalle Valo * 4bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 5bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 6bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 7bdcd8170SKalle Valo * 8bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15bdcd8170SKalle Valo */ 16bdcd8170SKalle Valo 17bdcd8170SKalle Valo #include "core.h" 18bdcd8170SKalle Valo #include "cfg80211.h" 19bdcd8170SKalle Valo #include "debug.h" 20abcb344bSKalle Valo #include "hif-ops.h" 21bdcd8170SKalle Valo 22bdcd8170SKalle Valo #define RATETAB_ENT(_rate, _rateid, _flags) { \ 23bdcd8170SKalle Valo .bitrate = (_rate), \ 24bdcd8170SKalle Valo .flags = (_flags), \ 25bdcd8170SKalle Valo .hw_value = (_rateid), \ 26bdcd8170SKalle Valo } 27bdcd8170SKalle Valo 28bdcd8170SKalle Valo #define CHAN2G(_channel, _freq, _flags) { \ 29bdcd8170SKalle Valo .band = IEEE80211_BAND_2GHZ, \ 30bdcd8170SKalle Valo .hw_value = (_channel), \ 31bdcd8170SKalle Valo .center_freq = (_freq), \ 32bdcd8170SKalle Valo .flags = (_flags), \ 33bdcd8170SKalle Valo .max_antenna_gain = 0, \ 34bdcd8170SKalle Valo .max_power = 30, \ 35bdcd8170SKalle Valo } 36bdcd8170SKalle Valo 37bdcd8170SKalle Valo #define CHAN5G(_channel, _flags) { \ 38bdcd8170SKalle Valo .band = IEEE80211_BAND_5GHZ, \ 39bdcd8170SKalle Valo .hw_value = (_channel), \ 40bdcd8170SKalle Valo .center_freq = 5000 + (5 * (_channel)), \ 41bdcd8170SKalle Valo .flags = (_flags), \ 42bdcd8170SKalle Valo .max_antenna_gain = 0, \ 43bdcd8170SKalle Valo .max_power = 30, \ 44bdcd8170SKalle Valo } 45bdcd8170SKalle Valo 46bdcd8170SKalle Valo static struct ieee80211_rate ath6kl_rates[] = { 47bdcd8170SKalle Valo RATETAB_ENT(10, 0x1, 0), 48bdcd8170SKalle Valo RATETAB_ENT(20, 0x2, 0), 49bdcd8170SKalle Valo RATETAB_ENT(55, 0x4, 0), 50bdcd8170SKalle Valo RATETAB_ENT(110, 0x8, 0), 51bdcd8170SKalle Valo RATETAB_ENT(60, 0x10, 0), 52bdcd8170SKalle Valo RATETAB_ENT(90, 0x20, 0), 53bdcd8170SKalle Valo RATETAB_ENT(120, 0x40, 0), 54bdcd8170SKalle Valo RATETAB_ENT(180, 0x80, 0), 55bdcd8170SKalle Valo RATETAB_ENT(240, 0x100, 0), 56bdcd8170SKalle Valo RATETAB_ENT(360, 0x200, 0), 57bdcd8170SKalle Valo RATETAB_ENT(480, 0x400, 0), 58bdcd8170SKalle Valo RATETAB_ENT(540, 0x800, 0), 59bdcd8170SKalle Valo }; 60bdcd8170SKalle Valo 61bdcd8170SKalle Valo #define ath6kl_a_rates (ath6kl_rates + 4) 62bdcd8170SKalle Valo #define ath6kl_a_rates_size 8 63bdcd8170SKalle Valo #define ath6kl_g_rates (ath6kl_rates + 0) 64bdcd8170SKalle Valo #define ath6kl_g_rates_size 12 65bdcd8170SKalle Valo 66bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_2ghz_channels[] = { 67bdcd8170SKalle Valo CHAN2G(1, 2412, 0), 68bdcd8170SKalle Valo CHAN2G(2, 2417, 0), 69bdcd8170SKalle Valo CHAN2G(3, 2422, 0), 70bdcd8170SKalle Valo CHAN2G(4, 2427, 0), 71bdcd8170SKalle Valo CHAN2G(5, 2432, 0), 72bdcd8170SKalle Valo CHAN2G(6, 2437, 0), 73bdcd8170SKalle Valo CHAN2G(7, 2442, 0), 74bdcd8170SKalle Valo CHAN2G(8, 2447, 0), 75bdcd8170SKalle Valo CHAN2G(9, 2452, 0), 76bdcd8170SKalle Valo CHAN2G(10, 2457, 0), 77bdcd8170SKalle Valo CHAN2G(11, 2462, 0), 78bdcd8170SKalle Valo CHAN2G(12, 2467, 0), 79bdcd8170SKalle Valo CHAN2G(13, 2472, 0), 80bdcd8170SKalle Valo CHAN2G(14, 2484, 0), 81bdcd8170SKalle Valo }; 82bdcd8170SKalle Valo 83bdcd8170SKalle Valo static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 84bdcd8170SKalle Valo CHAN5G(34, 0), CHAN5G(36, 0), 85bdcd8170SKalle Valo CHAN5G(38, 0), CHAN5G(40, 0), 86bdcd8170SKalle Valo CHAN5G(42, 0), CHAN5G(44, 0), 87bdcd8170SKalle Valo CHAN5G(46, 0), CHAN5G(48, 0), 88bdcd8170SKalle Valo CHAN5G(52, 0), CHAN5G(56, 0), 89bdcd8170SKalle Valo CHAN5G(60, 0), CHAN5G(64, 0), 90bdcd8170SKalle Valo CHAN5G(100, 0), CHAN5G(104, 0), 91bdcd8170SKalle Valo CHAN5G(108, 0), CHAN5G(112, 0), 92bdcd8170SKalle Valo CHAN5G(116, 0), CHAN5G(120, 0), 93bdcd8170SKalle Valo CHAN5G(124, 0), CHAN5G(128, 0), 94bdcd8170SKalle Valo CHAN5G(132, 0), CHAN5G(136, 0), 95bdcd8170SKalle Valo CHAN5G(140, 0), CHAN5G(149, 0), 96bdcd8170SKalle Valo CHAN5G(153, 0), CHAN5G(157, 0), 97bdcd8170SKalle Valo CHAN5G(161, 0), CHAN5G(165, 0), 98bdcd8170SKalle Valo CHAN5G(184, 0), CHAN5G(188, 0), 99bdcd8170SKalle Valo CHAN5G(192, 0), CHAN5G(196, 0), 100bdcd8170SKalle Valo CHAN5G(200, 0), CHAN5G(204, 0), 101bdcd8170SKalle Valo CHAN5G(208, 0), CHAN5G(212, 0), 102bdcd8170SKalle Valo CHAN5G(216, 0), 103bdcd8170SKalle Valo }; 104bdcd8170SKalle Valo 105bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_2ghz = { 106bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 107bdcd8170SKalle Valo .channels = ath6kl_2ghz_channels, 108bdcd8170SKalle Valo .n_bitrates = ath6kl_g_rates_size, 109bdcd8170SKalle Valo .bitrates = ath6kl_g_rates, 110bdcd8170SKalle Valo }; 111bdcd8170SKalle Valo 112bdcd8170SKalle Valo static struct ieee80211_supported_band ath6kl_band_5ghz = { 113bdcd8170SKalle Valo .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 114bdcd8170SKalle Valo .channels = ath6kl_5ghz_a_channels, 115bdcd8170SKalle Valo .n_bitrates = ath6kl_a_rates_size, 116bdcd8170SKalle Valo .bitrates = ath6kl_a_rates, 117bdcd8170SKalle Valo }; 118bdcd8170SKalle Valo 119bdcd8170SKalle Valo static int ath6kl_set_wpa_version(struct ath6kl *ar, 120bdcd8170SKalle Valo enum nl80211_wpa_versions wpa_version) 121bdcd8170SKalle Valo { 122bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 123bdcd8170SKalle Valo 124bdcd8170SKalle Valo if (!wpa_version) { 125bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 126bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_2) { 127bdcd8170SKalle Valo ar->auth_mode = WPA2_AUTH; 128bdcd8170SKalle Valo } else if (wpa_version & NL80211_WPA_VERSION_1) { 129bdcd8170SKalle Valo ar->auth_mode = WPA_AUTH; 130bdcd8170SKalle Valo } else { 131bdcd8170SKalle Valo ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 132bdcd8170SKalle Valo return -ENOTSUPP; 133bdcd8170SKalle Valo } 134bdcd8170SKalle Valo 135bdcd8170SKalle Valo return 0; 136bdcd8170SKalle Valo } 137bdcd8170SKalle Valo 138bdcd8170SKalle Valo static int ath6kl_set_auth_type(struct ath6kl *ar, 139bdcd8170SKalle Valo enum nl80211_auth_type auth_type) 140bdcd8170SKalle Valo { 141bdcd8170SKalle Valo 142bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 143bdcd8170SKalle Valo 144bdcd8170SKalle Valo switch (auth_type) { 145bdcd8170SKalle Valo case NL80211_AUTHTYPE_OPEN_SYSTEM: 146bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 147bdcd8170SKalle Valo break; 148bdcd8170SKalle Valo case NL80211_AUTHTYPE_SHARED_KEY: 149bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 150bdcd8170SKalle Valo break; 151bdcd8170SKalle Valo case NL80211_AUTHTYPE_NETWORK_EAP: 152bdcd8170SKalle Valo ar->dot11_auth_mode = LEAP_AUTH; 153bdcd8170SKalle Valo break; 154bdcd8170SKalle Valo 155bdcd8170SKalle Valo case NL80211_AUTHTYPE_AUTOMATIC: 156bdcd8170SKalle Valo ar->dot11_auth_mode = OPEN_AUTH; 157bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_OPEN_IN_PROGRESS; 158bdcd8170SKalle Valo break; 159bdcd8170SKalle Valo 160bdcd8170SKalle Valo default: 161bdcd8170SKalle Valo ath6kl_err("%s: 0x%x not spported\n", __func__, auth_type); 162bdcd8170SKalle Valo return -ENOTSUPP; 163bdcd8170SKalle Valo } 164bdcd8170SKalle Valo 165bdcd8170SKalle Valo return 0; 166bdcd8170SKalle Valo } 167bdcd8170SKalle Valo 168bdcd8170SKalle Valo static int ath6kl_set_cipher(struct ath6kl *ar, u32 cipher, bool ucast) 169bdcd8170SKalle Valo { 170bdcd8170SKalle Valo u8 *ar_cipher = ucast ? &ar->prwise_crypto : &ar->grp_crypto; 171bdcd8170SKalle Valo u8 *ar_cipher_len = ucast ? &ar->prwise_crypto_len : &ar->grp_crpto_len; 172bdcd8170SKalle Valo 173bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 174bdcd8170SKalle Valo __func__, cipher, ucast); 175bdcd8170SKalle Valo 176bdcd8170SKalle Valo switch (cipher) { 177bdcd8170SKalle Valo case 0: 178bdcd8170SKalle Valo /* our own hack to use value 0 as no crypto used */ 179bdcd8170SKalle Valo *ar_cipher = NONE_CRYPT; 180bdcd8170SKalle Valo *ar_cipher_len = 0; 181bdcd8170SKalle Valo break; 182bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 183bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 184bdcd8170SKalle Valo *ar_cipher_len = 5; 185bdcd8170SKalle Valo break; 186bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 187bdcd8170SKalle Valo *ar_cipher = WEP_CRYPT; 188bdcd8170SKalle Valo *ar_cipher_len = 13; 189bdcd8170SKalle Valo break; 190bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 191bdcd8170SKalle Valo *ar_cipher = TKIP_CRYPT; 192bdcd8170SKalle Valo *ar_cipher_len = 0; 193bdcd8170SKalle Valo break; 194bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 195bdcd8170SKalle Valo *ar_cipher = AES_CRYPT; 196bdcd8170SKalle Valo *ar_cipher_len = 0; 197bdcd8170SKalle Valo break; 198bdcd8170SKalle Valo default: 199bdcd8170SKalle Valo ath6kl_err("cipher 0x%x not supported\n", cipher); 200bdcd8170SKalle Valo return -ENOTSUPP; 201bdcd8170SKalle Valo } 202bdcd8170SKalle Valo 203bdcd8170SKalle Valo return 0; 204bdcd8170SKalle Valo } 205bdcd8170SKalle Valo 206bdcd8170SKalle Valo static void ath6kl_set_key_mgmt(struct ath6kl *ar, u32 key_mgmt) 207bdcd8170SKalle Valo { 208bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 209bdcd8170SKalle Valo 210bdcd8170SKalle Valo if (key_mgmt == WLAN_AKM_SUITE_PSK) { 211bdcd8170SKalle Valo if (ar->auth_mode == WPA_AUTH) 212bdcd8170SKalle Valo ar->auth_mode = WPA_PSK_AUTH; 213bdcd8170SKalle Valo else if (ar->auth_mode == WPA2_AUTH) 214bdcd8170SKalle Valo ar->auth_mode = WPA2_PSK_AUTH; 215bdcd8170SKalle Valo } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 216bdcd8170SKalle Valo ar->auth_mode = NONE_AUTH; 217bdcd8170SKalle Valo } 218bdcd8170SKalle Valo } 219bdcd8170SKalle Valo 220bdcd8170SKalle Valo static bool ath6kl_cfg80211_ready(struct ath6kl *ar) 221bdcd8170SKalle Valo { 222bdcd8170SKalle Valo if (!test_bit(WMI_READY, &ar->flag)) { 223bdcd8170SKalle Valo ath6kl_err("wmi is not ready\n"); 224bdcd8170SKalle Valo return false; 225bdcd8170SKalle Valo } 226bdcd8170SKalle Valo 227575b5f34SRaja Mani if (!test_bit(WLAN_ENABLED, &ar->flag)) { 228bdcd8170SKalle Valo ath6kl_err("wlan disabled\n"); 229bdcd8170SKalle Valo return false; 230bdcd8170SKalle Valo } 231bdcd8170SKalle Valo 232bdcd8170SKalle Valo return true; 233bdcd8170SKalle Valo } 234bdcd8170SKalle Valo 235bdcd8170SKalle Valo static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 236bdcd8170SKalle Valo struct cfg80211_connect_params *sme) 237bdcd8170SKalle Valo { 238bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 239bdcd8170SKalle Valo int status; 240bdcd8170SKalle Valo 241bdcd8170SKalle Valo ar->sme_state = SME_CONNECTING; 242bdcd8170SKalle Valo 243bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 244bdcd8170SKalle Valo return -EIO; 245bdcd8170SKalle Valo 246bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 247bdcd8170SKalle Valo ath6kl_err("destroy in progress\n"); 248bdcd8170SKalle Valo return -EBUSY; 249bdcd8170SKalle Valo } 250bdcd8170SKalle Valo 251bdcd8170SKalle Valo if (test_bit(SKIP_SCAN, &ar->flag) && 252bdcd8170SKalle Valo ((sme->channel && sme->channel->center_freq == 0) || 253bdcd8170SKalle Valo (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 254bdcd8170SKalle Valo ath6kl_err("SkipScan: channel or bssid invalid\n"); 255bdcd8170SKalle Valo return -EINVAL; 256bdcd8170SKalle Valo } 257bdcd8170SKalle Valo 258bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 259bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 260bdcd8170SKalle Valo return -ERESTARTSYS; 261bdcd8170SKalle Valo } 262bdcd8170SKalle Valo 263bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 264bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 265bdcd8170SKalle Valo up(&ar->sem); 266bdcd8170SKalle Valo return -EBUSY; 267bdcd8170SKalle Valo } 268bdcd8170SKalle Valo 269bdcd8170SKalle Valo if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 270bdcd8170SKalle Valo /* 271bdcd8170SKalle Valo * sleep until the command queue drains 272bdcd8170SKalle Valo */ 273bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, 274bdcd8170SKalle Valo ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0, 275bdcd8170SKalle Valo WMI_TIMEOUT); 276bdcd8170SKalle Valo if (signal_pending(current)) { 277bdcd8170SKalle Valo ath6kl_err("cmd queue drain timeout\n"); 278bdcd8170SKalle Valo up(&ar->sem); 279bdcd8170SKalle Valo return -EINTR; 280bdcd8170SKalle Valo } 281bdcd8170SKalle Valo } 282bdcd8170SKalle Valo 283bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag) && 284bdcd8170SKalle Valo ar->ssid_len == sme->ssid_len && 285bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 286bdcd8170SKalle Valo ar->reconnect_flag = true; 287bdcd8170SKalle Valo status = ath6kl_wmi_reconnect_cmd(ar->wmi, ar->req_bssid, 288bdcd8170SKalle Valo ar->ch_hint); 289bdcd8170SKalle Valo 290bdcd8170SKalle Valo up(&ar->sem); 291bdcd8170SKalle Valo if (status) { 292bdcd8170SKalle Valo ath6kl_err("wmi_reconnect_cmd failed\n"); 293bdcd8170SKalle Valo return -EIO; 294bdcd8170SKalle Valo } 295bdcd8170SKalle Valo return 0; 296bdcd8170SKalle Valo } else if (ar->ssid_len == sme->ssid_len && 297bdcd8170SKalle Valo !memcmp(ar->ssid, sme->ssid, ar->ssid_len)) { 298bdcd8170SKalle Valo ath6kl_disconnect(ar); 299bdcd8170SKalle Valo } 300bdcd8170SKalle Valo 301bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 302bdcd8170SKalle Valo ar->ssid_len = sme->ssid_len; 303bdcd8170SKalle Valo memcpy(ar->ssid, sme->ssid, sme->ssid_len); 304bdcd8170SKalle Valo 305bdcd8170SKalle Valo if (sme->channel) 306bdcd8170SKalle Valo ar->ch_hint = sme->channel->center_freq; 307bdcd8170SKalle Valo 308bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 309bdcd8170SKalle Valo if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 310bdcd8170SKalle Valo memcpy(ar->req_bssid, sme->bssid, sizeof(ar->req_bssid)); 311bdcd8170SKalle Valo 312bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, sme->crypto.wpa_versions); 313bdcd8170SKalle Valo 314bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, sme->auth_type); 315bdcd8170SKalle Valo if (status) { 316bdcd8170SKalle Valo up(&ar->sem); 317bdcd8170SKalle Valo return status; 318bdcd8170SKalle Valo } 319bdcd8170SKalle Valo 320bdcd8170SKalle Valo if (sme->crypto.n_ciphers_pairwise) 321bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.ciphers_pairwise[0], true); 322bdcd8170SKalle Valo else 323bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 324bdcd8170SKalle Valo 325bdcd8170SKalle Valo ath6kl_set_cipher(ar, sme->crypto.cipher_group, false); 326bdcd8170SKalle Valo 327bdcd8170SKalle Valo if (sme->crypto.n_akm_suites) 328bdcd8170SKalle Valo ath6kl_set_key_mgmt(ar, sme->crypto.akm_suites[0]); 329bdcd8170SKalle Valo 330bdcd8170SKalle Valo if ((sme->key_len) && 331bdcd8170SKalle Valo (ar->auth_mode == NONE_AUTH) && (ar->prwise_crypto == WEP_CRYPT)) { 332bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 333bdcd8170SKalle Valo 334bdcd8170SKalle Valo if (sme->key_idx < WMI_MIN_KEY_INDEX || 335bdcd8170SKalle Valo sme->key_idx > WMI_MAX_KEY_INDEX) { 336bdcd8170SKalle Valo ath6kl_err("key index %d out of bounds\n", 337bdcd8170SKalle Valo sme->key_idx); 338bdcd8170SKalle Valo up(&ar->sem); 339bdcd8170SKalle Valo return -ENOENT; 340bdcd8170SKalle Valo } 341bdcd8170SKalle Valo 342bdcd8170SKalle Valo key = &ar->keys[sme->key_idx]; 343bdcd8170SKalle Valo key->key_len = sme->key_len; 344bdcd8170SKalle Valo memcpy(key->key, sme->key, key->key_len); 345bdcd8170SKalle Valo key->cipher = ar->prwise_crypto; 346bdcd8170SKalle Valo ar->def_txkey_index = sme->key_idx; 347bdcd8170SKalle Valo 348bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, sme->key_idx, 349bdcd8170SKalle Valo ar->prwise_crypto, 350bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 351bdcd8170SKalle Valo key->key_len, 352bdcd8170SKalle Valo NULL, 353bdcd8170SKalle Valo key->key, KEY_OP_INIT_VAL, NULL, 354bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 355bdcd8170SKalle Valo } 356bdcd8170SKalle Valo 357bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 358bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, ALL_BSS_FILTER, 0) != 0) { 359bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 360bdcd8170SKalle Valo up(&ar->sem); 361bdcd8170SKalle Valo return -EIO; 362bdcd8170SKalle Valo } 363bdcd8170SKalle Valo } 364bdcd8170SKalle Valo 365bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 366bdcd8170SKalle Valo 367bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 368bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 369bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 370bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 371bdcd8170SKalle Valo __func__, 372bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 373bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 374bdcd8170SKalle Valo ar->grp_crpto_len, ar->ch_hint); 375bdcd8170SKalle Valo 376bdcd8170SKalle Valo ar->reconnect_flag = 0; 377bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 378bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 379bdcd8170SKalle Valo ar->prwise_crypto, 380bdcd8170SKalle Valo ar->prwise_crypto_len, 381bdcd8170SKalle Valo ar->grp_crypto, ar->grp_crpto_len, 382bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 383bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 384bdcd8170SKalle Valo ar->connect_ctrl_flags); 385bdcd8170SKalle Valo 386bdcd8170SKalle Valo up(&ar->sem); 387bdcd8170SKalle Valo 388bdcd8170SKalle Valo if (status == -EINVAL) { 389bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 390bdcd8170SKalle Valo ar->ssid_len = 0; 391bdcd8170SKalle Valo ath6kl_err("invalid request\n"); 392bdcd8170SKalle Valo return -ENOENT; 393bdcd8170SKalle Valo } else if (status) { 394bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 395bdcd8170SKalle Valo return -EIO; 396bdcd8170SKalle Valo } 397bdcd8170SKalle Valo 398bdcd8170SKalle Valo if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 399bdcd8170SKalle Valo ((ar->auth_mode == WPA_PSK_AUTH) 400bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH))) { 401bdcd8170SKalle Valo mod_timer(&ar->disconnect_timer, 402bdcd8170SKalle Valo jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 403bdcd8170SKalle Valo } 404bdcd8170SKalle Valo 405bdcd8170SKalle Valo ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 406bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 407bdcd8170SKalle Valo 408bdcd8170SKalle Valo return 0; 409bdcd8170SKalle Valo } 410bdcd8170SKalle Valo 411bdcd8170SKalle Valo void ath6kl_cfg80211_connect_event(struct ath6kl *ar, u16 channel, 412bdcd8170SKalle Valo u8 *bssid, u16 listen_intvl, 413bdcd8170SKalle Valo u16 beacon_intvl, 414bdcd8170SKalle Valo enum network_type nw_type, 415bdcd8170SKalle Valo u8 beacon_ie_len, u8 assoc_req_len, 416bdcd8170SKalle Valo u8 assoc_resp_len, u8 *assoc_info) 417bdcd8170SKalle Valo { 418bdcd8170SKalle Valo u16 size = 0; 419bdcd8170SKalle Valo u16 capability = 0; 420bdcd8170SKalle Valo struct cfg80211_bss *bss = NULL; 421bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt = NULL; 422bdcd8170SKalle Valo struct ieee80211_channel *ibss_ch = NULL; 423bdcd8170SKalle Valo s32 signal = 50 * 100; 424bdcd8170SKalle Valo u8 ie_buf_len = 0; 425bdcd8170SKalle Valo unsigned char ie_buf[256]; 426bdcd8170SKalle Valo unsigned char *ptr_ie_buf = ie_buf; 427bdcd8170SKalle Valo unsigned char *ieeemgmtbuf = NULL; 428bdcd8170SKalle Valo u8 source_mac[ETH_ALEN]; 429bdcd8170SKalle Valo 430bdcd8170SKalle Valo /* capinfo + listen interval */ 431bdcd8170SKalle Valo u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 432bdcd8170SKalle Valo 433bdcd8170SKalle Valo /* capinfo + status code + associd */ 434bdcd8170SKalle Valo u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 435bdcd8170SKalle Valo 436bdcd8170SKalle Valo u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 437bdcd8170SKalle Valo u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 438bdcd8170SKalle Valo assoc_resp_ie_offset; 439bdcd8170SKalle Valo 440bdcd8170SKalle Valo assoc_req_len -= assoc_req_ie_offset; 441bdcd8170SKalle Valo assoc_resp_len -= assoc_resp_ie_offset; 442bdcd8170SKalle Valo 443bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 444bdcd8170SKalle Valo 445bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 446bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 447bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 448bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 449bdcd8170SKalle Valo return; 450bdcd8170SKalle Valo } 451bdcd8170SKalle Valo } 452bdcd8170SKalle Valo 453bdcd8170SKalle Valo if (nw_type & INFRA_NETWORK) { 454bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_STATION) { 455bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 456bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 457bdcd8170SKalle Valo return; 458bdcd8170SKalle Valo } 459bdcd8170SKalle Valo } 460bdcd8170SKalle Valo 461bdcd8170SKalle Valo /* 462bdcd8170SKalle Valo * Earlier we were updating the cfg about bss by making a beacon frame 463bdcd8170SKalle Valo * only if the entry for bss is not there. This can have some issue if 464bdcd8170SKalle Valo * ROAM event is generated and a heavy traffic is ongoing. The ROAM 465bdcd8170SKalle Valo * event is handled through a work queue and by the time it really gets 466bdcd8170SKalle Valo * handled, BSS would have been aged out. So it is better to update the 467bdcd8170SKalle Valo * cfg about BSS irrespective of its entry being present right now or 468bdcd8170SKalle Valo * not. 469bdcd8170SKalle Valo */ 470bdcd8170SKalle Valo 471bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 472bdcd8170SKalle Valo /* construct 802.11 mgmt beacon */ 473bdcd8170SKalle Valo if (ptr_ie_buf) { 474bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_SSID; 475bdcd8170SKalle Valo *ptr_ie_buf++ = ar->ssid_len; 476bdcd8170SKalle Valo memcpy(ptr_ie_buf, ar->ssid, ar->ssid_len); 477bdcd8170SKalle Valo ptr_ie_buf += ar->ssid_len; 478bdcd8170SKalle Valo 479bdcd8170SKalle Valo *ptr_ie_buf++ = WLAN_EID_IBSS_PARAMS; 480bdcd8170SKalle Valo *ptr_ie_buf++ = 2; /* length */ 481bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 482bdcd8170SKalle Valo *ptr_ie_buf++ = 0; /* ATIM window */ 483bdcd8170SKalle Valo 484bdcd8170SKalle Valo /* TODO: update ibss params and include supported rates, 485bdcd8170SKalle Valo * DS param set, extened support rates, wmm. */ 486bdcd8170SKalle Valo 487bdcd8170SKalle Valo ie_buf_len = ptr_ie_buf - ie_buf; 488bdcd8170SKalle Valo } 489bdcd8170SKalle Valo 490bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_IBSS; 491bdcd8170SKalle Valo 492bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 493bdcd8170SKalle Valo capability |= WLAN_CAPABILITY_PRIVACY; 494bdcd8170SKalle Valo 495bdcd8170SKalle Valo memcpy(source_mac, ar->net_dev->dev_addr, ETH_ALEN); 496bdcd8170SKalle Valo ptr_ie_buf = ie_buf; 497bdcd8170SKalle Valo } else { 498bdcd8170SKalle Valo capability = *(u16 *) (&assoc_info[beacon_ie_len]); 499bdcd8170SKalle Valo memcpy(source_mac, bssid, ETH_ALEN); 500bdcd8170SKalle Valo ptr_ie_buf = assoc_req_ie; 501bdcd8170SKalle Valo ie_buf_len = assoc_req_len; 502bdcd8170SKalle Valo } 503bdcd8170SKalle Valo 504bdcd8170SKalle Valo size = offsetof(struct ieee80211_mgmt, u) 505bdcd8170SKalle Valo + sizeof(mgmt->u.beacon) 506bdcd8170SKalle Valo + ie_buf_len; 507bdcd8170SKalle Valo 508bdcd8170SKalle Valo ieeemgmtbuf = kzalloc(size, GFP_ATOMIC); 509bdcd8170SKalle Valo if (!ieeemgmtbuf) { 510bdcd8170SKalle Valo ath6kl_err("ieee mgmt buf alloc error\n"); 511bdcd8170SKalle Valo return; 512bdcd8170SKalle Valo } 513bdcd8170SKalle Valo 514bdcd8170SKalle Valo mgmt = (struct ieee80211_mgmt *)ieeemgmtbuf; 515bdcd8170SKalle Valo mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | 516bdcd8170SKalle Valo IEEE80211_STYPE_BEACON); 517bdcd8170SKalle Valo memset(mgmt->da, 0xff, ETH_ALEN); /* broadcast addr */ 518bdcd8170SKalle Valo memcpy(mgmt->sa, source_mac, ETH_ALEN); 519bdcd8170SKalle Valo memcpy(mgmt->bssid, bssid, ETH_ALEN); 520bdcd8170SKalle Valo mgmt->u.beacon.beacon_int = cpu_to_le16(beacon_intvl); 521bdcd8170SKalle Valo mgmt->u.beacon.capab_info = cpu_to_le16(capability); 522bdcd8170SKalle Valo memcpy(mgmt->u.beacon.variable, ptr_ie_buf, ie_buf_len); 523bdcd8170SKalle Valo 524bdcd8170SKalle Valo ibss_ch = ieee80211_get_channel(ar->wdev->wiphy, (int)channel); 525bdcd8170SKalle Valo 526bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 527bdcd8170SKalle Valo "%s: inform bss with bssid %pM channel %d beacon_intvl %d capability 0x%x\n", 528bdcd8170SKalle Valo __func__, mgmt->bssid, ibss_ch->hw_value, 529bdcd8170SKalle Valo beacon_intvl, capability); 530bdcd8170SKalle Valo 531bdcd8170SKalle Valo bss = cfg80211_inform_bss_frame(ar->wdev->wiphy, 532bdcd8170SKalle Valo ibss_ch, mgmt, 533bdcd8170SKalle Valo size, signal, GFP_KERNEL); 534bdcd8170SKalle Valo kfree(ieeemgmtbuf); 535bdcd8170SKalle Valo cfg80211_put_bss(bss); 536bdcd8170SKalle Valo 537bdcd8170SKalle Valo if (nw_type & ADHOC_NETWORK) { 538bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 539bdcd8170SKalle Valo return; 540bdcd8170SKalle Valo } 541bdcd8170SKalle Valo 5429aa60357SRaja Mani if (ar->sme_state == SME_CONNECTING) { 543bdcd8170SKalle Valo /* inform connect result to cfg80211 */ 5449aa60357SRaja Mani ar->sme_state = SME_CONNECTED; 545bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, bssid, 546bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 547bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, 548bdcd8170SKalle Valo WLAN_STATUS_SUCCESS, GFP_KERNEL); 5499aa60357SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 550bdcd8170SKalle Valo /* inform roam event to cfg80211 */ 551bdcd8170SKalle Valo cfg80211_roamed(ar->net_dev, ibss_ch, bssid, 552bdcd8170SKalle Valo assoc_req_ie, assoc_req_len, 553bdcd8170SKalle Valo assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 554bdcd8170SKalle Valo } 555bdcd8170SKalle Valo } 556bdcd8170SKalle Valo 557bdcd8170SKalle Valo static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 558bdcd8170SKalle Valo struct net_device *dev, u16 reason_code) 559bdcd8170SKalle Valo { 560bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 563bdcd8170SKalle Valo reason_code); 564bdcd8170SKalle Valo 565bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 566bdcd8170SKalle Valo return -EIO; 567bdcd8170SKalle Valo 568bdcd8170SKalle Valo if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 569bdcd8170SKalle Valo ath6kl_err("busy, destroy in progress\n"); 570bdcd8170SKalle Valo return -EBUSY; 571bdcd8170SKalle Valo } 572bdcd8170SKalle Valo 573bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 574bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 575bdcd8170SKalle Valo return -ERESTARTSYS; 576bdcd8170SKalle Valo } 577bdcd8170SKalle Valo 578bdcd8170SKalle Valo ar->reconnect_flag = 0; 579bdcd8170SKalle Valo ath6kl_disconnect(ar); 580bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 581bdcd8170SKalle Valo ar->ssid_len = 0; 582bdcd8170SKalle Valo 583bdcd8170SKalle Valo if (!test_bit(SKIP_SCAN, &ar->flag)) 584bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 585bdcd8170SKalle Valo 586bdcd8170SKalle Valo up(&ar->sem); 587bdcd8170SKalle Valo 588bdcd8170SKalle Valo return 0; 589bdcd8170SKalle Valo } 590bdcd8170SKalle Valo 591bdcd8170SKalle Valo void ath6kl_cfg80211_disconnect_event(struct ath6kl *ar, u8 reason, 592bdcd8170SKalle Valo u8 *bssid, u8 assoc_resp_len, 593bdcd8170SKalle Valo u8 *assoc_info, u16 proto_reason) 594bdcd8170SKalle Valo { 595bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 596bdcd8170SKalle Valo u16 status; 597bdcd8170SKalle Valo 598bdcd8170SKalle Valo if (ar->scan_req) { 599bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 600bdcd8170SKalle Valo ar->scan_req = NULL; 601bdcd8170SKalle Valo } 602bdcd8170SKalle Valo 603bdcd8170SKalle Valo if (ar->nw_type & ADHOC_NETWORK) { 604bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_ADHOC) { 605bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 606bdcd8170SKalle Valo "%s: ath6k not in ibss mode\n", __func__); 607bdcd8170SKalle Valo return; 608bdcd8170SKalle Valo } 609bdcd8170SKalle Valo memset(bssid, 0, ETH_ALEN); 610bdcd8170SKalle Valo cfg80211_ibss_joined(ar->net_dev, bssid, GFP_KERNEL); 611bdcd8170SKalle Valo return; 612bdcd8170SKalle Valo } 613bdcd8170SKalle Valo 614bdcd8170SKalle Valo if (ar->nw_type & INFRA_NETWORK) { 615bdcd8170SKalle Valo if (ar->wdev->iftype != NL80211_IFTYPE_STATION) { 616bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 617bdcd8170SKalle Valo "%s: ath6k not in station mode\n", __func__); 618bdcd8170SKalle Valo return; 619bdcd8170SKalle Valo } 620bdcd8170SKalle Valo } 621bdcd8170SKalle Valo 622bdcd8170SKalle Valo if (!test_bit(CONNECT_PEND, &ar->flag)) { 623bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 624bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 625bdcd8170SKalle Valo 626bdcd8170SKalle Valo return; 627bdcd8170SKalle Valo } 628bdcd8170SKalle Valo 629bdcd8170SKalle Valo if (reason == NO_NETWORK_AVAIL) { 630bdcd8170SKalle Valo /* connect cmd failed */ 631bdcd8170SKalle Valo ath6kl_wmi_disconnect_cmd(ar->wmi); 632bdcd8170SKalle Valo return; 633bdcd8170SKalle Valo } 634bdcd8170SKalle Valo 635bdcd8170SKalle Valo if (reason != DISCONNECT_CMD) 636bdcd8170SKalle Valo return; 637bdcd8170SKalle Valo 638bdcd8170SKalle Valo if (!ar->auto_auth_stage) { 639bdcd8170SKalle Valo clear_bit(CONNECT_PEND, &ar->flag); 640bdcd8170SKalle Valo 641bdcd8170SKalle Valo if (ar->sme_state == SME_CONNECTING) { 642bdcd8170SKalle Valo cfg80211_connect_result(ar->net_dev, 643bdcd8170SKalle Valo bssid, NULL, 0, 644bdcd8170SKalle Valo NULL, 0, 645bdcd8170SKalle Valo WLAN_STATUS_UNSPECIFIED_FAILURE, 646bdcd8170SKalle Valo GFP_KERNEL); 6470e5cc8e6SRaja Mani } else if (ar->sme_state == SME_CONNECTED) { 648bdcd8170SKalle Valo cfg80211_disconnected(ar->net_dev, reason, 649bdcd8170SKalle Valo NULL, 0, GFP_KERNEL); 650bdcd8170SKalle Valo } 651bdcd8170SKalle Valo 652bdcd8170SKalle Valo ar->sme_state = SME_DISCONNECTED; 653bdcd8170SKalle Valo return; 654bdcd8170SKalle Valo } 655bdcd8170SKalle Valo 656bdcd8170SKalle Valo if (ar->dot11_auth_mode != OPEN_AUTH) 657bdcd8170SKalle Valo return; 658bdcd8170SKalle Valo 659bdcd8170SKalle Valo /* 660bdcd8170SKalle Valo * If the current auth algorithm is open, try shared and 661bdcd8170SKalle Valo * make autoAuthStage idle. We do not make it leap for now 662bdcd8170SKalle Valo * being. 663bdcd8170SKalle Valo */ 664bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 665bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) { 666bdcd8170SKalle Valo ath6kl_err("busy, couldn't get access\n"); 667bdcd8170SKalle Valo return; 668bdcd8170SKalle Valo } 669bdcd8170SKalle Valo 670bdcd8170SKalle Valo ar->dot11_auth_mode = SHARED_AUTH; 671bdcd8170SKalle Valo ar->auto_auth_stage = AUTH_IDLE; 672bdcd8170SKalle Valo 673bdcd8170SKalle Valo ath6kl_wmi_addkey_cmd(ar->wmi, 674bdcd8170SKalle Valo ar->def_txkey_index, 675bdcd8170SKalle Valo ar->prwise_crypto, 676bdcd8170SKalle Valo GROUP_USAGE | TX_USAGE, 677bdcd8170SKalle Valo key->key_len, NULL, 678bdcd8170SKalle Valo key->key, 679bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 680bdcd8170SKalle Valo NO_SYNC_WMIFLAG); 681bdcd8170SKalle Valo 682bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, 683bdcd8170SKalle Valo ar->nw_type, 684bdcd8170SKalle Valo ar->dot11_auth_mode, 685bdcd8170SKalle Valo ar->auth_mode, 686bdcd8170SKalle Valo ar->prwise_crypto, 687bdcd8170SKalle Valo ar->prwise_crypto_len, 688bdcd8170SKalle Valo ar->grp_crypto, 689bdcd8170SKalle Valo ar->grp_crpto_len, 690bdcd8170SKalle Valo ar->ssid_len, 691bdcd8170SKalle Valo ar->ssid, 692bdcd8170SKalle Valo ar->req_bssid, 693bdcd8170SKalle Valo ar->ch_hint, 694bdcd8170SKalle Valo ar->connect_ctrl_flags); 695bdcd8170SKalle Valo up(&ar->sem); 696bdcd8170SKalle Valo } 697bdcd8170SKalle Valo 698bdcd8170SKalle Valo static inline bool is_ch_11a(u16 ch) 699bdcd8170SKalle Valo { 700bdcd8170SKalle Valo return (!((ch >= 2412) && (ch <= 2484))); 701bdcd8170SKalle Valo } 702bdcd8170SKalle Valo 703cf104c2aSKalle Valo /* struct ath6kl_node_table::nt_nodelock is locked when calling this */ 70491db35daSVasanthakumar Thiagarajan void ath6kl_cfg80211_scan_node(struct wiphy *wiphy, struct bss *ni) 705bdcd8170SKalle Valo { 706bdcd8170SKalle Valo struct ieee80211_mgmt *mgmt; 707bdcd8170SKalle Valo struct ieee80211_channel *channel; 708bdcd8170SKalle Valo struct ieee80211_supported_band *band; 709bdcd8170SKalle Valo struct ath6kl_common_ie *cie; 710bdcd8170SKalle Valo s32 signal; 711bdcd8170SKalle Valo int freq; 712bdcd8170SKalle Valo 713bdcd8170SKalle Valo cie = &ni->ni_cie; 714bdcd8170SKalle Valo 715bdcd8170SKalle Valo if (is_ch_11a(cie->ie_chan)) 716bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_5GHZ]; /* 11a */ 717bdcd8170SKalle Valo else if ((cie->ie_erp) || (cie->ie_xrates)) 718bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11g */ 719bdcd8170SKalle Valo else 720bdcd8170SKalle Valo band = wiphy->bands[IEEE80211_BAND_2GHZ]; /* 11b */ 721bdcd8170SKalle Valo 722bdcd8170SKalle Valo freq = cie->ie_chan; 723bdcd8170SKalle Valo channel = ieee80211_get_channel(wiphy, freq); 724bdcd8170SKalle Valo signal = ni->ni_snr * 100; 725bdcd8170SKalle Valo 726bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 727bdcd8170SKalle Valo "%s: bssid %pM ch %d freq %d size %d\n", __func__, 7280ce77920SJouni Malinen ni->ni_macaddr, channel->hw_value, freq, ni->ni_framelen); 7290ce77920SJouni Malinen /* 7300ce77920SJouni Malinen * Both Beacon and Probe Response frames have same payload structure, 7310ce77920SJouni Malinen * so it is fine to share the parser for both. 7320ce77920SJouni Malinen */ 7330ce77920SJouni Malinen if (ni->ni_framelen < 8 + 2 + 2) 7340ce77920SJouni Malinen return; 7350ce77920SJouni Malinen mgmt = (struct ieee80211_mgmt *) (ni->ni_buf - 7360ce77920SJouni Malinen offsetof(struct ieee80211_mgmt, u)); 7370ce77920SJouni Malinen cfg80211_inform_bss(wiphy, channel, ni->ni_macaddr, 7380ce77920SJouni Malinen le64_to_cpu(mgmt->u.beacon.timestamp), 7390ce77920SJouni Malinen le16_to_cpu(mgmt->u.beacon.capab_info), 7400ce77920SJouni Malinen le16_to_cpu(mgmt->u.beacon.beacon_int), 7410ce77920SJouni Malinen mgmt->u.beacon.variable, 7420ce77920SJouni Malinen ni->ni_buf + ni->ni_framelen - 7430ce77920SJouni Malinen mgmt->u.beacon.variable, 7440ce77920SJouni Malinen signal, GFP_ATOMIC); 745bdcd8170SKalle Valo } 746bdcd8170SKalle Valo 747bdcd8170SKalle Valo static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 748bdcd8170SKalle Valo struct cfg80211_scan_request *request) 749bdcd8170SKalle Valo { 750bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 751bdcd8170SKalle Valo int ret = 0; 752bdcd8170SKalle Valo 753bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 754bdcd8170SKalle Valo return -EIO; 755bdcd8170SKalle Valo 756bdcd8170SKalle Valo if (!ar->usr_bss_filter) { 757bdcd8170SKalle Valo if (ath6kl_wmi_bssfilter_cmd(ar->wmi, 758bdcd8170SKalle Valo (test_bit(CONNECTED, &ar->flag) ? 759bdcd8170SKalle Valo ALL_BUT_BSS_FILTER : 760bdcd8170SKalle Valo ALL_BSS_FILTER), 0) != 0) { 761bdcd8170SKalle Valo ath6kl_err("couldn't set bss filtering\n"); 762bdcd8170SKalle Valo return -EIO; 763bdcd8170SKalle Valo } 764bdcd8170SKalle Valo } 765bdcd8170SKalle Valo 766bdcd8170SKalle Valo if (request->n_ssids && request->ssids[0].ssid_len) { 767bdcd8170SKalle Valo u8 i; 768bdcd8170SKalle Valo 769bdcd8170SKalle Valo if (request->n_ssids > (MAX_PROBED_SSID_INDEX - 1)) 770bdcd8170SKalle Valo request->n_ssids = MAX_PROBED_SSID_INDEX - 1; 771bdcd8170SKalle Valo 772bdcd8170SKalle Valo for (i = 0; i < request->n_ssids; i++) 773bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 774bdcd8170SKalle Valo SPECIFIC_SSID_FLAG, 775bdcd8170SKalle Valo request->ssids[i].ssid_len, 776bdcd8170SKalle Valo request->ssids[i].ssid); 777bdcd8170SKalle Valo } 778bdcd8170SKalle Valo 779b2c76bbeSKalle Valo if (ath6kl_wmi_startscan_cmd(ar->wmi, WMI_LONG_SCAN, 0, 780bdcd8170SKalle Valo false, 0, 0, 0, NULL) != 0) { 781bdcd8170SKalle Valo ath6kl_err("wmi_startscan_cmd failed\n"); 782bdcd8170SKalle Valo ret = -EIO; 783bdcd8170SKalle Valo } 784bdcd8170SKalle Valo 785bdcd8170SKalle Valo ar->scan_req = request; 786bdcd8170SKalle Valo 787bdcd8170SKalle Valo return ret; 788bdcd8170SKalle Valo } 789bdcd8170SKalle Valo 790bdcd8170SKalle Valo void ath6kl_cfg80211_scan_complete_event(struct ath6kl *ar, int status) 791bdcd8170SKalle Valo { 7926fd1eaceSKalle Valo int i; 793bdcd8170SKalle Valo 794bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status %d\n", __func__, status); 795bdcd8170SKalle Valo 7966fd1eaceSKalle Valo if (!ar->scan_req) 7976fd1eaceSKalle Valo return; 7986fd1eaceSKalle Valo 7996fd1eaceSKalle Valo if ((status == -ECANCELED) || (status == -EBUSY)) { 8006fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, true); 8016fd1eaceSKalle Valo goto out; 8026fd1eaceSKalle Valo } 8036fd1eaceSKalle Valo 804bdcd8170SKalle Valo /* Translate data to cfg80211 mgmt format */ 8058a8bc5a4SVasanthakumar Thiagarajan wlan_iterate_nodes(&ar->scan_table, ar->wdev->wiphy); 806bdcd8170SKalle Valo 8076fd1eaceSKalle Valo cfg80211_scan_done(ar->scan_req, false); 808bdcd8170SKalle Valo 809bdcd8170SKalle Valo if (ar->scan_req->n_ssids && ar->scan_req->ssids[0].ssid_len) { 810bdcd8170SKalle Valo for (i = 0; i < ar->scan_req->n_ssids; i++) { 811bdcd8170SKalle Valo ath6kl_wmi_probedssid_cmd(ar->wmi, i + 1, 812bdcd8170SKalle Valo DISABLE_SSID_FLAG, 813bdcd8170SKalle Valo 0, NULL); 814bdcd8170SKalle Valo } 815bdcd8170SKalle Valo } 8166fd1eaceSKalle Valo 8176fd1eaceSKalle Valo out: 818bdcd8170SKalle Valo ar->scan_req = NULL; 819bdcd8170SKalle Valo } 820bdcd8170SKalle Valo 821bdcd8170SKalle Valo static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 822bdcd8170SKalle Valo u8 key_index, bool pairwise, 823bdcd8170SKalle Valo const u8 *mac_addr, 824bdcd8170SKalle Valo struct key_params *params) 825bdcd8170SKalle Valo { 826bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 827bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 828bdcd8170SKalle Valo u8 key_usage; 829bdcd8170SKalle Valo u8 key_type; 830bdcd8170SKalle Valo int status = 0; 831bdcd8170SKalle Valo 832bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 833bdcd8170SKalle Valo return -EIO; 834bdcd8170SKalle Valo 835bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 836bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 837bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 838bdcd8170SKalle Valo key_index); 839bdcd8170SKalle Valo return -ENOENT; 840bdcd8170SKalle Valo } 841bdcd8170SKalle Valo 842bdcd8170SKalle Valo key = &ar->keys[key_index]; 843bdcd8170SKalle Valo memset(key, 0, sizeof(struct ath6kl_key)); 844bdcd8170SKalle Valo 845bdcd8170SKalle Valo if (pairwise) 846bdcd8170SKalle Valo key_usage = PAIRWISE_USAGE; 847bdcd8170SKalle Valo else 848bdcd8170SKalle Valo key_usage = GROUP_USAGE; 849bdcd8170SKalle Valo 850bdcd8170SKalle Valo if (params) { 851bdcd8170SKalle Valo if (params->key_len > WLAN_MAX_KEY_LEN || 852bdcd8170SKalle Valo params->seq_len > sizeof(key->seq)) 853bdcd8170SKalle Valo return -EINVAL; 854bdcd8170SKalle Valo 855bdcd8170SKalle Valo key->key_len = params->key_len; 856bdcd8170SKalle Valo memcpy(key->key, params->key, key->key_len); 857bdcd8170SKalle Valo key->seq_len = params->seq_len; 858bdcd8170SKalle Valo memcpy(key->seq, params->seq, key->seq_len); 859bdcd8170SKalle Valo key->cipher = params->cipher; 860bdcd8170SKalle Valo } 861bdcd8170SKalle Valo 862bdcd8170SKalle Valo switch (key->cipher) { 863bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP40: 864bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_WEP104: 865bdcd8170SKalle Valo key_type = WEP_CRYPT; 866bdcd8170SKalle Valo break; 867bdcd8170SKalle Valo 868bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_TKIP: 869bdcd8170SKalle Valo key_type = TKIP_CRYPT; 870bdcd8170SKalle Valo break; 871bdcd8170SKalle Valo 872bdcd8170SKalle Valo case WLAN_CIPHER_SUITE_CCMP: 873bdcd8170SKalle Valo key_type = AES_CRYPT; 874bdcd8170SKalle Valo break; 875bdcd8170SKalle Valo 876bdcd8170SKalle Valo default: 877bdcd8170SKalle Valo return -ENOTSUPP; 878bdcd8170SKalle Valo } 879bdcd8170SKalle Valo 880bdcd8170SKalle Valo if (((ar->auth_mode == WPA_PSK_AUTH) 881bdcd8170SKalle Valo || (ar->auth_mode == WPA2_PSK_AUTH)) 882bdcd8170SKalle Valo && (key_usage & GROUP_USAGE)) 883bdcd8170SKalle Valo del_timer(&ar->disconnect_timer); 884bdcd8170SKalle Valo 885bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 886bdcd8170SKalle Valo "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 887bdcd8170SKalle Valo __func__, key_index, key->key_len, key_type, 888bdcd8170SKalle Valo key_usage, key->seq_len); 889bdcd8170SKalle Valo 890bdcd8170SKalle Valo ar->def_txkey_index = key_index; 8919a5b1318SJouni Malinen 8929a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !pairwise && 8939a5b1318SJouni Malinen (key_type == TKIP_CRYPT || key_type == AES_CRYPT) && params) { 8949a5b1318SJouni Malinen ar->ap_mode_bkey.valid = true; 8959a5b1318SJouni Malinen ar->ap_mode_bkey.key_index = key_index; 8969a5b1318SJouni Malinen ar->ap_mode_bkey.key_type = key_type; 8979a5b1318SJouni Malinen ar->ap_mode_bkey.key_len = key->key_len; 8989a5b1318SJouni Malinen memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 8999a5b1318SJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) { 9009a5b1318SJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "Delay initial group " 9019a5b1318SJouni Malinen "key configuration until AP mode has been " 9029a5b1318SJouni Malinen "started\n"); 9039a5b1318SJouni Malinen /* 9049a5b1318SJouni Malinen * The key will be set in ath6kl_connect_ap_mode() once 9059a5b1318SJouni Malinen * the connected event is received from the target. 9069a5b1318SJouni Malinen */ 9079a5b1318SJouni Malinen return 0; 9089a5b1318SJouni Malinen } 9099a5b1318SJouni Malinen } 9109a5b1318SJouni Malinen 911bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 912bdcd8170SKalle Valo key_type, key_usage, key->key_len, 913bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 914bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 915bdcd8170SKalle Valo 916bdcd8170SKalle Valo if (status) 917bdcd8170SKalle Valo return -EIO; 918bdcd8170SKalle Valo 919bdcd8170SKalle Valo return 0; 920bdcd8170SKalle Valo } 921bdcd8170SKalle Valo 922bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 923bdcd8170SKalle Valo u8 key_index, bool pairwise, 924bdcd8170SKalle Valo const u8 *mac_addr) 925bdcd8170SKalle Valo { 926bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 927bdcd8170SKalle Valo 928bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 929bdcd8170SKalle Valo 930bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 931bdcd8170SKalle Valo return -EIO; 932bdcd8170SKalle Valo 933bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 934bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 935bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 936bdcd8170SKalle Valo key_index); 937bdcd8170SKalle Valo return -ENOENT; 938bdcd8170SKalle Valo } 939bdcd8170SKalle Valo 940bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 941bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 942bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 943bdcd8170SKalle Valo return 0; 944bdcd8170SKalle Valo } 945bdcd8170SKalle Valo 946bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 947bdcd8170SKalle Valo 948bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 949bdcd8170SKalle Valo } 950bdcd8170SKalle Valo 951bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 952bdcd8170SKalle Valo u8 key_index, bool pairwise, 953bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 954bdcd8170SKalle Valo void (*callback) (void *cookie, 955bdcd8170SKalle Valo struct key_params *)) 956bdcd8170SKalle Valo { 957bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 958bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 959bdcd8170SKalle Valo struct key_params params; 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 962bdcd8170SKalle Valo 963bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 964bdcd8170SKalle Valo return -EIO; 965bdcd8170SKalle Valo 966bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 967bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 968bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 969bdcd8170SKalle Valo key_index); 970bdcd8170SKalle Valo return -ENOENT; 971bdcd8170SKalle Valo } 972bdcd8170SKalle Valo 973bdcd8170SKalle Valo key = &ar->keys[key_index]; 974bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 975bdcd8170SKalle Valo params.cipher = key->cipher; 976bdcd8170SKalle Valo params.key_len = key->key_len; 977bdcd8170SKalle Valo params.seq_len = key->seq_len; 978bdcd8170SKalle Valo params.seq = key->seq; 979bdcd8170SKalle Valo params.key = key->key; 980bdcd8170SKalle Valo 981bdcd8170SKalle Valo callback(cookie, ¶ms); 982bdcd8170SKalle Valo 983bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 984bdcd8170SKalle Valo } 985bdcd8170SKalle Valo 986bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 987bdcd8170SKalle Valo struct net_device *ndev, 988bdcd8170SKalle Valo u8 key_index, bool unicast, 989bdcd8170SKalle Valo bool multicast) 990bdcd8170SKalle Valo { 991bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 992bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 993bdcd8170SKalle Valo int status = 0; 994bdcd8170SKalle Valo u8 key_usage; 995bdcd8170SKalle Valo 996bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 997bdcd8170SKalle Valo 998bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 999bdcd8170SKalle Valo return -EIO; 1000bdcd8170SKalle Valo 1001bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 1002bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1003bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 1004bdcd8170SKalle Valo __func__, key_index); 1005bdcd8170SKalle Valo return -ENOENT; 1006bdcd8170SKalle Valo } 1007bdcd8170SKalle Valo 1008bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 1009bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1010bdcd8170SKalle Valo __func__, key_index); 1011bdcd8170SKalle Valo return -EINVAL; 1012bdcd8170SKalle Valo } 1013bdcd8170SKalle Valo 1014bdcd8170SKalle Valo ar->def_txkey_index = key_index; 1015bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 1016bdcd8170SKalle Valo key_usage = GROUP_USAGE; 1017bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 1018bdcd8170SKalle Valo key_usage |= TX_USAGE; 1019bdcd8170SKalle Valo 10209a5b1318SJouni Malinen if (ar->nw_type == AP_NETWORK && !test_bit(CONNECTED, &ar->flag)) 10219a5b1318SJouni Malinen return 0; /* Delay until AP mode has been started */ 10229a5b1318SJouni Malinen 1023bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1024bdcd8170SKalle Valo ar->prwise_crypto, key_usage, 1025bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1026bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1027bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1028bdcd8170SKalle Valo if (status) 1029bdcd8170SKalle Valo return -EIO; 1030bdcd8170SKalle Valo 1031bdcd8170SKalle Valo return 0; 1032bdcd8170SKalle Valo } 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1035bdcd8170SKalle Valo bool ismcast) 1036bdcd8170SKalle Valo { 1037bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1038bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1039bdcd8170SKalle Valo 1040bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1041bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1042bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1043bdcd8170SKalle Valo GFP_KERNEL); 1044bdcd8170SKalle Valo } 1045bdcd8170SKalle Valo 1046bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1047bdcd8170SKalle Valo { 1048bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1049bdcd8170SKalle Valo int ret; 1050bdcd8170SKalle Valo 1051bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1052bdcd8170SKalle Valo changed); 1053bdcd8170SKalle Valo 1054bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1055bdcd8170SKalle Valo return -EIO; 1056bdcd8170SKalle Valo 1057bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1058bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1059bdcd8170SKalle Valo if (ret != 0) { 1060bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1061bdcd8170SKalle Valo return -EIO; 1062bdcd8170SKalle Valo } 1063bdcd8170SKalle Valo } 1064bdcd8170SKalle Valo 1065bdcd8170SKalle Valo return 0; 1066bdcd8170SKalle Valo } 1067bdcd8170SKalle Valo 1068bdcd8170SKalle Valo /* 1069bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1070bdcd8170SKalle Valo * data type from 2.6.36 onwards 1071bdcd8170SKalle Valo */ 1072bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1073bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1074bdcd8170SKalle Valo int dbm) 1075bdcd8170SKalle Valo { 1076bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1077bdcd8170SKalle Valo u8 ath6kl_dbm; 1078bdcd8170SKalle Valo 1079bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1080bdcd8170SKalle Valo type, dbm); 1081bdcd8170SKalle Valo 1082bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1083bdcd8170SKalle Valo return -EIO; 1084bdcd8170SKalle Valo 1085bdcd8170SKalle Valo switch (type) { 1086bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1087bdcd8170SKalle Valo return 0; 1088bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1089bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1090bdcd8170SKalle Valo break; 1091bdcd8170SKalle Valo default: 1092bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1093bdcd8170SKalle Valo __func__, type); 1094bdcd8170SKalle Valo return -EOPNOTSUPP; 1095bdcd8170SKalle Valo } 1096bdcd8170SKalle Valo 1097bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1098bdcd8170SKalle Valo 1099bdcd8170SKalle Valo return 0; 1100bdcd8170SKalle Valo } 1101bdcd8170SKalle Valo 1102bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1103bdcd8170SKalle Valo { 1104bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1105bdcd8170SKalle Valo 1106bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1107bdcd8170SKalle Valo return -EIO; 1108bdcd8170SKalle Valo 1109bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) { 1110bdcd8170SKalle Valo ar->tx_pwr = 0; 1111bdcd8170SKalle Valo 1112bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1113bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1114bdcd8170SKalle Valo return -EIO; 1115bdcd8170SKalle Valo } 1116bdcd8170SKalle Valo 1117bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1118bdcd8170SKalle Valo 5 * HZ); 1119bdcd8170SKalle Valo 1120bdcd8170SKalle Valo if (signal_pending(current)) { 1121bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1122bdcd8170SKalle Valo return -EINTR; 1123bdcd8170SKalle Valo } 1124bdcd8170SKalle Valo } 1125bdcd8170SKalle Valo 1126bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1127bdcd8170SKalle Valo return 0; 1128bdcd8170SKalle Valo } 1129bdcd8170SKalle Valo 1130bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1131bdcd8170SKalle Valo struct net_device *dev, 1132bdcd8170SKalle Valo bool pmgmt, int timeout) 1133bdcd8170SKalle Valo { 1134bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1135bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1136bdcd8170SKalle Valo 1137bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1138bdcd8170SKalle Valo __func__, pmgmt, timeout); 1139bdcd8170SKalle Valo 1140bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1141bdcd8170SKalle Valo return -EIO; 1142bdcd8170SKalle Valo 1143bdcd8170SKalle Valo if (pmgmt) { 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1145bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1146bdcd8170SKalle Valo } else { 1147bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1148bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1149bdcd8170SKalle Valo } 1150bdcd8170SKalle Valo 1151bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1152bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1153bdcd8170SKalle Valo return -EIO; 1154bdcd8170SKalle Valo } 1155bdcd8170SKalle Valo 1156bdcd8170SKalle Valo return 0; 1157bdcd8170SKalle Valo } 1158bdcd8170SKalle Valo 1159bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1160bdcd8170SKalle Valo struct net_device *ndev, 1161bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1162bdcd8170SKalle Valo struct vif_params *params) 1163bdcd8170SKalle Valo { 1164bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1165bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1166bdcd8170SKalle Valo 1167bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1168bdcd8170SKalle Valo 1169bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1170bdcd8170SKalle Valo return -EIO; 1171bdcd8170SKalle Valo 1172bdcd8170SKalle Valo switch (type) { 1173bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1174bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1175bdcd8170SKalle Valo break; 1176bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1177bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1178bdcd8170SKalle Valo break; 1179bdcd8170SKalle Valo default: 1180bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1181bdcd8170SKalle Valo return -EOPNOTSUPP; 1182bdcd8170SKalle Valo } 1183bdcd8170SKalle Valo 1184bdcd8170SKalle Valo wdev->iftype = type; 1185bdcd8170SKalle Valo 1186bdcd8170SKalle Valo return 0; 1187bdcd8170SKalle Valo } 1188bdcd8170SKalle Valo 1189bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1190bdcd8170SKalle Valo struct net_device *dev, 1191bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1192bdcd8170SKalle Valo { 1193bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1194bdcd8170SKalle Valo int status; 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1197bdcd8170SKalle Valo return -EIO; 1198bdcd8170SKalle Valo 1199bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1200bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1201bdcd8170SKalle Valo 1202bdcd8170SKalle Valo if (ibss_param->channel) 1203bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1204bdcd8170SKalle Valo 1205bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1206bdcd8170SKalle Valo /* 1207bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1208bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1209bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1210bdcd8170SKalle Valo * updated. 1211bdcd8170SKalle Valo */ 1212bdcd8170SKalle Valo return -EOPNOTSUPP; 1213bdcd8170SKalle Valo } 1214bdcd8170SKalle Valo 1215bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1216bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1217bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1218bdcd8170SKalle Valo 1219bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1220bdcd8170SKalle Valo 1221bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1222bdcd8170SKalle Valo if (status) 1223bdcd8170SKalle Valo return status; 1224bdcd8170SKalle Valo 1225bdcd8170SKalle Valo if (ibss_param->privacy) { 1226bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1227bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1228bdcd8170SKalle Valo } else { 1229bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1230bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1231bdcd8170SKalle Valo } 1232bdcd8170SKalle Valo 1233bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1234bdcd8170SKalle Valo 1235bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1236bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1237bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1238bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1239bdcd8170SKalle Valo __func__, 1240bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1241bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 1242bdcd8170SKalle Valo ar->grp_crpto_len, ar->ch_hint); 1243bdcd8170SKalle Valo 1244bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1245bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1246bdcd8170SKalle Valo ar->prwise_crypto, 1247bdcd8170SKalle Valo ar->prwise_crypto_len, 1248bdcd8170SKalle Valo ar->grp_crypto, ar->grp_crpto_len, 1249bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1250bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1251bdcd8170SKalle Valo ar->connect_ctrl_flags); 1252bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 1253bdcd8170SKalle Valo 1254bdcd8170SKalle Valo return 0; 1255bdcd8170SKalle Valo } 1256bdcd8170SKalle Valo 1257bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1258bdcd8170SKalle Valo struct net_device *dev) 1259bdcd8170SKalle Valo { 1260bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1261bdcd8170SKalle Valo 1262bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1263bdcd8170SKalle Valo return -EIO; 1264bdcd8170SKalle Valo 1265bdcd8170SKalle Valo ath6kl_disconnect(ar); 1266bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1267bdcd8170SKalle Valo ar->ssid_len = 0; 1268bdcd8170SKalle Valo 1269bdcd8170SKalle Valo return 0; 1270bdcd8170SKalle Valo } 1271bdcd8170SKalle Valo 1272bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1273bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1274bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1275bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1276bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1277bdcd8170SKalle Valo }; 1278bdcd8170SKalle Valo 1279bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1280bdcd8170SKalle Valo { 1281bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1282bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1283bdcd8170SKalle Valo 36000, 48000, 54000 1284bdcd8170SKalle Valo }; 1285bdcd8170SKalle Valo u8 i; 1286bdcd8170SKalle Valo 1287bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1288bdcd8170SKalle Valo if (rate == legacy[i]) 1289bdcd8170SKalle Valo return true; 1290bdcd8170SKalle Valo 1291bdcd8170SKalle Valo return false; 1292bdcd8170SKalle Valo } 1293bdcd8170SKalle Valo 1294bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1295bdcd8170SKalle Valo { 1296bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1297bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1298bdcd8170SKalle Valo }; 1299bdcd8170SKalle Valo u8 i; 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1302bdcd8170SKalle Valo if (rate == ht20[i]) { 1303bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1304bdcd8170SKalle Valo /* last rate uses sgi */ 1305bdcd8170SKalle Valo *sgi = true; 1306bdcd8170SKalle Valo else 1307bdcd8170SKalle Valo *sgi = false; 1308bdcd8170SKalle Valo 1309bdcd8170SKalle Valo *mcs = i; 1310bdcd8170SKalle Valo return true; 1311bdcd8170SKalle Valo } 1312bdcd8170SKalle Valo } 1313bdcd8170SKalle Valo return false; 1314bdcd8170SKalle Valo } 1315bdcd8170SKalle Valo 1316bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1317bdcd8170SKalle Valo { 1318bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1319bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1320bdcd8170SKalle Valo 150000 1321bdcd8170SKalle Valo }; 1322bdcd8170SKalle Valo u8 i; 1323bdcd8170SKalle Valo 1324bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1325bdcd8170SKalle Valo if (rate == ht40[i]) { 1326bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 1) 1327bdcd8170SKalle Valo /* last rate uses sgi */ 1328bdcd8170SKalle Valo *sgi = true; 1329bdcd8170SKalle Valo else 1330bdcd8170SKalle Valo *sgi = false; 1331bdcd8170SKalle Valo 1332bdcd8170SKalle Valo *mcs = i; 1333bdcd8170SKalle Valo return true; 1334bdcd8170SKalle Valo } 1335bdcd8170SKalle Valo } 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo return false; 1338bdcd8170SKalle Valo } 1339bdcd8170SKalle Valo 1340bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1341bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1342bdcd8170SKalle Valo { 1343bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1344bdcd8170SKalle Valo long left; 1345bdcd8170SKalle Valo bool sgi; 1346bdcd8170SKalle Valo s32 rate; 1347bdcd8170SKalle Valo int ret; 1348bdcd8170SKalle Valo u8 mcs; 1349bdcd8170SKalle Valo 1350bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1351bdcd8170SKalle Valo return -ENOENT; 1352bdcd8170SKalle Valo 1353bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1354bdcd8170SKalle Valo return -EBUSY; 1355bdcd8170SKalle Valo 1356bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1357bdcd8170SKalle Valo 1358bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1359bdcd8170SKalle Valo 1360bdcd8170SKalle Valo if (ret != 0) { 1361bdcd8170SKalle Valo up(&ar->sem); 1362bdcd8170SKalle Valo return -EIO; 1363bdcd8170SKalle Valo } 1364bdcd8170SKalle Valo 1365bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1366bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1367bdcd8170SKalle Valo &ar->flag), 1368bdcd8170SKalle Valo WMI_TIMEOUT); 1369bdcd8170SKalle Valo 1370bdcd8170SKalle Valo up(&ar->sem); 1371bdcd8170SKalle Valo 1372bdcd8170SKalle Valo if (left == 0) 1373bdcd8170SKalle Valo return -ETIMEDOUT; 1374bdcd8170SKalle Valo else if (left < 0) 1375bdcd8170SKalle Valo return left; 1376bdcd8170SKalle Valo 1377bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1378bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1379bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1380bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1381bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1382bdcd8170SKalle Valo } 1383bdcd8170SKalle Valo 1384bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1385bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1386bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1387bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1388bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1389bdcd8170SKalle Valo } 1390bdcd8170SKalle Valo 1391bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1392bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1393bdcd8170SKalle Valo 1394bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1395bdcd8170SKalle Valo 1396bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1397bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1398bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1399bdcd8170SKalle Valo if (sgi) { 1400bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1401bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1402bdcd8170SKalle Valo } else { 1403bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1404bdcd8170SKalle Valo } 1405bdcd8170SKalle Valo 1406bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1407bdcd8170SKalle Valo } else if (is_rate_ht40(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_40_MHZ_WIDTH; 1416bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1417bdcd8170SKalle Valo } else { 1418bdcd8170SKalle Valo ath6kl_warn("invalid rate: %d\n", rate); 1419bdcd8170SKalle Valo return 0; 1420bdcd8170SKalle Valo } 1421bdcd8170SKalle Valo 1422bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1423bdcd8170SKalle Valo 1424bdcd8170SKalle Valo return 0; 1425bdcd8170SKalle Valo } 1426bdcd8170SKalle Valo 1427bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1428bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1429bdcd8170SKalle Valo { 1430bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1431bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1432bdcd8170SKalle Valo pmksa->pmkid, true); 1433bdcd8170SKalle Valo } 1434bdcd8170SKalle Valo 1435bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1436bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1437bdcd8170SKalle Valo { 1438bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1439bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1440bdcd8170SKalle Valo pmksa->pmkid, false); 1441bdcd8170SKalle Valo } 1442bdcd8170SKalle Valo 1443bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1444bdcd8170SKalle Valo { 1445bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1446bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) 1447bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1448bdcd8170SKalle Valo return 0; 1449bdcd8170SKalle Valo } 1450bdcd8170SKalle Valo 1451abcb344bSKalle Valo #ifdef CONFIG_PM 1452abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1453abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1454abcb344bSKalle Valo { 1455abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1456abcb344bSKalle Valo 1457abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1458abcb344bSKalle Valo } 1459abcb344bSKalle Valo #endif 1460abcb344bSKalle Valo 14616a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 14626a7c9badSJouni Malinen struct ieee80211_channel *chan, 14636a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 14646a7c9badSJouni Malinen { 14656a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 14666a7c9badSJouni Malinen 14676a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 14686a7c9badSJouni Malinen return -EIO; 14696a7c9badSJouni Malinen 14706a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 14716a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 14726a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 14736a7c9badSJouni Malinen 14746a7c9badSJouni Malinen return 0; 14756a7c9badSJouni Malinen } 14766a7c9badSJouni Malinen 14776a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 14786a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 14796a7c9badSJouni Malinen { 14806a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 14816a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 14826a7c9badSJouni Malinen u8 *ies; 14836a7c9badSJouni Malinen int ies_len; 14846a7c9badSJouni Malinen struct wmi_connect_cmd p; 14856a7c9badSJouni Malinen int res; 14866a7c9badSJouni Malinen int i; 14876a7c9badSJouni Malinen 14886a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 14896a7c9badSJouni Malinen 14906a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 14916a7c9badSJouni Malinen return -EIO; 14926a7c9badSJouni Malinen 14936a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 14946a7c9badSJouni Malinen return -EOPNOTSUPP; 14956a7c9badSJouni Malinen 14966a7c9badSJouni Malinen if (info->beacon_ies) { 14976a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 14986a7c9badSJouni Malinen info->beacon_ies, 14996a7c9badSJouni Malinen info->beacon_ies_len); 15006a7c9badSJouni Malinen if (res) 15016a7c9badSJouni Malinen return res; 15026a7c9badSJouni Malinen } 15036a7c9badSJouni Malinen if (info->proberesp_ies) { 15046a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 15056a7c9badSJouni Malinen info->proberesp_ies, 15066a7c9badSJouni Malinen info->proberesp_ies_len); 15076a7c9badSJouni Malinen if (res) 15086a7c9badSJouni Malinen return res; 15096a7c9badSJouni Malinen } 15106a7c9badSJouni Malinen if (info->assocresp_ies) { 15116a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 15126a7c9badSJouni Malinen info->assocresp_ies, 15136a7c9badSJouni Malinen info->assocresp_ies_len); 15146a7c9badSJouni Malinen if (res) 15156a7c9badSJouni Malinen return res; 15166a7c9badSJouni Malinen } 15176a7c9badSJouni Malinen 15186a7c9badSJouni Malinen if (!add) 15196a7c9badSJouni Malinen return 0; 15206a7c9badSJouni Malinen 15219a5b1318SJouni Malinen ar->ap_mode_bkey.valid = false; 15229a5b1318SJouni Malinen 15236a7c9badSJouni Malinen /* TODO: 15246a7c9badSJouni Malinen * info->interval 15256a7c9badSJouni Malinen * info->dtim_period 15266a7c9badSJouni Malinen */ 15276a7c9badSJouni Malinen 15286a7c9badSJouni Malinen if (info->head == NULL) 15296a7c9badSJouni Malinen return -EINVAL; 15306a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 15316a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 15326a7c9badSJouni Malinen if (ies > info->head + info->head_len) 15336a7c9badSJouni Malinen return -EINVAL; 15346a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 15356a7c9badSJouni Malinen 15366a7c9badSJouni Malinen if (info->ssid == NULL) 15376a7c9badSJouni Malinen return -EINVAL; 15386a7c9badSJouni Malinen memcpy(ar->ssid, info->ssid, info->ssid_len); 15396a7c9badSJouni Malinen ar->ssid_len = info->ssid_len; 15406a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 15416a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 15426a7c9badSJouni Malinen 15436a7c9badSJouni Malinen ar->dot11_auth_mode = OPEN_AUTH; 15446a7c9badSJouni Malinen 15456a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 15466a7c9badSJouni Malinen 15476a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 15486a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 15496a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 15506a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 15516a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 15526a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 15536a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 15546a7c9badSJouni Malinen break; 15556a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 15566a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 15576a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 15586a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 15596a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 15606a7c9badSJouni Malinen break; 15616a7c9badSJouni Malinen } 15626a7c9badSJouni Malinen } 15636a7c9badSJouni Malinen if (p.auth_mode == 0) 15646a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 15656a7c9badSJouni Malinen ar->auth_mode = p.auth_mode; 15666a7c9badSJouni Malinen 15676a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 15686a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 15696a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 15706a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 15716a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 15726a7c9badSJouni Malinen break; 15736a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 15746a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 15756a7c9badSJouni Malinen break; 15766a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 15776a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 15786a7c9badSJouni Malinen break; 15796a7c9badSJouni Malinen } 15806a7c9badSJouni Malinen } 15816a7c9badSJouni Malinen if (p.prwise_crypto_type == 0) 15826a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 15836a7c9badSJouni Malinen 15846a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 15856a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 15866a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 15876a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 15886a7c9badSJouni Malinen break; 15896a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 15906a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 15916a7c9badSJouni Malinen break; 15926a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 15936a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 15946a7c9badSJouni Malinen break; 15956a7c9badSJouni Malinen default: 15966a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 15976a7c9badSJouni Malinen break; 15986a7c9badSJouni Malinen } 15996a7c9badSJouni Malinen 16006a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 16016a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 16026a7c9badSJouni Malinen 16036a7c9badSJouni Malinen p.ssid_len = ar->ssid_len; 16046a7c9badSJouni Malinen memcpy(p.ssid, ar->ssid, ar->ssid_len); 16056a7c9badSJouni Malinen p.dot11_auth_mode = ar->dot11_auth_mode; 16066a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 16076a7c9badSJouni Malinen 16089a5b1318SJouni Malinen res = ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 16099a5b1318SJouni Malinen if (res < 0) 16109a5b1318SJouni Malinen return res; 16119a5b1318SJouni Malinen 16129a5b1318SJouni Malinen return 0; 16136a7c9badSJouni Malinen } 16146a7c9badSJouni Malinen 16156a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 16166a7c9badSJouni Malinen struct beacon_parameters *info) 16176a7c9badSJouni Malinen { 16186a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 16196a7c9badSJouni Malinen } 16206a7c9badSJouni Malinen 16216a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 16226a7c9badSJouni Malinen struct beacon_parameters *info) 16236a7c9badSJouni Malinen { 16246a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 16256a7c9badSJouni Malinen } 16266a7c9badSJouni Malinen 16276a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 16286a7c9badSJouni Malinen { 16296a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 16306a7c9badSJouni Malinen 16316a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 16326a7c9badSJouni Malinen return -EOPNOTSUPP; 16336a7c9badSJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) 16346a7c9badSJouni Malinen return -ENOTCONN; 16356a7c9badSJouni Malinen 16366a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 16376a7c9badSJouni Malinen clear_bit(CONNECTED, &ar->flag); 16386a7c9badSJouni Malinen 16396a7c9badSJouni Malinen return 0; 16406a7c9badSJouni Malinen } 16416a7c9badSJouni Malinen 1642bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1643bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1644bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1645bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1646bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1647bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1648bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1649bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1650bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1651bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1652bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1653bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1654bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1655bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1656bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1657bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1658bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1659bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1660bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1661abcb344bSKalle Valo #ifdef CONFIG_PM 1662abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1663abcb344bSKalle Valo #endif 16646a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 16656a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 16666a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 16676a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 1668bdcd8170SKalle Valo }; 1669bdcd8170SKalle Valo 1670bdcd8170SKalle Valo struct wireless_dev *ath6kl_cfg80211_init(struct device *dev) 1671bdcd8170SKalle Valo { 1672bdcd8170SKalle Valo int ret = 0; 1673bdcd8170SKalle Valo struct wireless_dev *wdev; 1674bdcd8170SKalle Valo 1675bdcd8170SKalle Valo wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL); 1676bdcd8170SKalle Valo if (!wdev) { 1677bdcd8170SKalle Valo ath6kl_err("couldn't allocate wireless device\n"); 1678bdcd8170SKalle Valo return NULL; 1679bdcd8170SKalle Valo } 1680bdcd8170SKalle Valo 1681bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1682bdcd8170SKalle Valo wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 1683bdcd8170SKalle Valo if (!wdev->wiphy) { 1684bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1685bdcd8170SKalle Valo kfree(wdev); 1686bdcd8170SKalle Valo return NULL; 1687bdcd8170SKalle Valo } 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo /* set device pointer for wiphy */ 1690bdcd8170SKalle Valo set_wiphy_dev(wdev->wiphy, dev); 1691bdcd8170SKalle Valo 1692bdcd8170SKalle Valo wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 1693bdcd8170SKalle Valo BIT(NL80211_IFTYPE_ADHOC); 1694bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 1695bdcd8170SKalle Valo wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 1696bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 1697bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 1698bdcd8170SKalle Valo wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 1699bdcd8170SKalle Valo 1700bdcd8170SKalle Valo wdev->wiphy->cipher_suites = cipher_suites; 1701bdcd8170SKalle Valo wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 1702bdcd8170SKalle Valo 1703bdcd8170SKalle Valo ret = wiphy_register(wdev->wiphy); 1704bdcd8170SKalle Valo if (ret < 0) { 1705bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 1706bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1707bdcd8170SKalle Valo kfree(wdev); 1708bdcd8170SKalle Valo return NULL; 1709bdcd8170SKalle Valo } 1710bdcd8170SKalle Valo 1711bdcd8170SKalle Valo return wdev; 1712bdcd8170SKalle Valo } 1713bdcd8170SKalle Valo 1714bdcd8170SKalle Valo void ath6kl_cfg80211_deinit(struct ath6kl *ar) 1715bdcd8170SKalle Valo { 1716bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1717bdcd8170SKalle Valo 1718bdcd8170SKalle Valo if (ar->scan_req) { 1719bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 1720bdcd8170SKalle Valo ar->scan_req = NULL; 1721bdcd8170SKalle Valo } 1722bdcd8170SKalle Valo 1723bdcd8170SKalle Valo if (!wdev) 1724bdcd8170SKalle Valo return; 1725bdcd8170SKalle Valo 1726bdcd8170SKalle Valo wiphy_unregister(wdev->wiphy); 1727bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1728bdcd8170SKalle Valo kfree(wdev); 1729bdcd8170SKalle Valo } 1730