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; 891bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 892bdcd8170SKalle Valo key_type, key_usage, key->key_len, 893bdcd8170SKalle Valo key->seq, key->key, KEY_OP_INIT_VAL, 894bdcd8170SKalle Valo (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 895bdcd8170SKalle Valo 896bdcd8170SKalle Valo if (status) 897bdcd8170SKalle Valo return -EIO; 898bdcd8170SKalle Valo 899bdcd8170SKalle Valo return 0; 900bdcd8170SKalle Valo } 901bdcd8170SKalle Valo 902bdcd8170SKalle Valo static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 903bdcd8170SKalle Valo u8 key_index, bool pairwise, 904bdcd8170SKalle Valo const u8 *mac_addr) 905bdcd8170SKalle Valo { 906bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 907bdcd8170SKalle Valo 908bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 909bdcd8170SKalle Valo 910bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 911bdcd8170SKalle Valo return -EIO; 912bdcd8170SKalle Valo 913bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 914bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 915bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 916bdcd8170SKalle Valo key_index); 917bdcd8170SKalle Valo return -ENOENT; 918bdcd8170SKalle Valo } 919bdcd8170SKalle Valo 920bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 921bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 922bdcd8170SKalle Valo "%s: index %d is empty\n", __func__, key_index); 923bdcd8170SKalle Valo return 0; 924bdcd8170SKalle Valo } 925bdcd8170SKalle Valo 926bdcd8170SKalle Valo ar->keys[key_index].key_len = 0; 927bdcd8170SKalle Valo 928bdcd8170SKalle Valo return ath6kl_wmi_deletekey_cmd(ar->wmi, key_index); 929bdcd8170SKalle Valo } 930bdcd8170SKalle Valo 931bdcd8170SKalle Valo static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 932bdcd8170SKalle Valo u8 key_index, bool pairwise, 933bdcd8170SKalle Valo const u8 *mac_addr, void *cookie, 934bdcd8170SKalle Valo void (*callback) (void *cookie, 935bdcd8170SKalle Valo struct key_params *)) 936bdcd8170SKalle Valo { 937bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 938bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 939bdcd8170SKalle Valo struct key_params params; 940bdcd8170SKalle Valo 941bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 942bdcd8170SKalle Valo 943bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 944bdcd8170SKalle Valo return -EIO; 945bdcd8170SKalle Valo 946bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 947bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 948bdcd8170SKalle Valo "%s: key index %d out of bounds\n", __func__, 949bdcd8170SKalle Valo key_index); 950bdcd8170SKalle Valo return -ENOENT; 951bdcd8170SKalle Valo } 952bdcd8170SKalle Valo 953bdcd8170SKalle Valo key = &ar->keys[key_index]; 954bdcd8170SKalle Valo memset(¶ms, 0, sizeof(params)); 955bdcd8170SKalle Valo params.cipher = key->cipher; 956bdcd8170SKalle Valo params.key_len = key->key_len; 957bdcd8170SKalle Valo params.seq_len = key->seq_len; 958bdcd8170SKalle Valo params.seq = key->seq; 959bdcd8170SKalle Valo params.key = key->key; 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo callback(cookie, ¶ms); 962bdcd8170SKalle Valo 963bdcd8170SKalle Valo return key->key_len ? 0 : -ENOENT; 964bdcd8170SKalle Valo } 965bdcd8170SKalle Valo 966bdcd8170SKalle Valo static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 967bdcd8170SKalle Valo struct net_device *ndev, 968bdcd8170SKalle Valo u8 key_index, bool unicast, 969bdcd8170SKalle Valo bool multicast) 970bdcd8170SKalle Valo { 971bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(ndev); 972bdcd8170SKalle Valo struct ath6kl_key *key = NULL; 973bdcd8170SKalle Valo int status = 0; 974bdcd8170SKalle Valo u8 key_usage; 975bdcd8170SKalle Valo 976bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 977bdcd8170SKalle Valo 978bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 979bdcd8170SKalle Valo return -EIO; 980bdcd8170SKalle Valo 981bdcd8170SKalle Valo if (key_index < WMI_MIN_KEY_INDEX || key_index > WMI_MAX_KEY_INDEX) { 982bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 983bdcd8170SKalle Valo "%s: key index %d out of bounds\n", 984bdcd8170SKalle Valo __func__, key_index); 985bdcd8170SKalle Valo return -ENOENT; 986bdcd8170SKalle Valo } 987bdcd8170SKalle Valo 988bdcd8170SKalle Valo if (!ar->keys[key_index].key_len) { 989bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 990bdcd8170SKalle Valo __func__, key_index); 991bdcd8170SKalle Valo return -EINVAL; 992bdcd8170SKalle Valo } 993bdcd8170SKalle Valo 994bdcd8170SKalle Valo ar->def_txkey_index = key_index; 995bdcd8170SKalle Valo key = &ar->keys[ar->def_txkey_index]; 996bdcd8170SKalle Valo key_usage = GROUP_USAGE; 997bdcd8170SKalle Valo if (ar->prwise_crypto == WEP_CRYPT) 998bdcd8170SKalle Valo key_usage |= TX_USAGE; 999bdcd8170SKalle Valo 1000bdcd8170SKalle Valo status = ath6kl_wmi_addkey_cmd(ar->wmi, ar->def_txkey_index, 1001bdcd8170SKalle Valo ar->prwise_crypto, key_usage, 1002bdcd8170SKalle Valo key->key_len, key->seq, key->key, 1003bdcd8170SKalle Valo KEY_OP_INIT_VAL, NULL, 1004bdcd8170SKalle Valo SYNC_BOTH_WMIFLAG); 1005bdcd8170SKalle Valo if (status) 1006bdcd8170SKalle Valo return -EIO; 1007bdcd8170SKalle Valo 1008bdcd8170SKalle Valo return 0; 1009bdcd8170SKalle Valo } 1010bdcd8170SKalle Valo 1011bdcd8170SKalle Valo void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl *ar, u8 keyid, 1012bdcd8170SKalle Valo bool ismcast) 1013bdcd8170SKalle Valo { 1014bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1015bdcd8170SKalle Valo "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1016bdcd8170SKalle Valo 1017bdcd8170SKalle Valo cfg80211_michael_mic_failure(ar->net_dev, ar->bssid, 1018bdcd8170SKalle Valo (ismcast ? NL80211_KEYTYPE_GROUP : 1019bdcd8170SKalle Valo NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1020bdcd8170SKalle Valo GFP_KERNEL); 1021bdcd8170SKalle Valo } 1022bdcd8170SKalle Valo 1023bdcd8170SKalle Valo static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1024bdcd8170SKalle Valo { 1025bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1026bdcd8170SKalle Valo int ret; 1027bdcd8170SKalle Valo 1028bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1029bdcd8170SKalle Valo changed); 1030bdcd8170SKalle Valo 1031bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1032bdcd8170SKalle Valo return -EIO; 1033bdcd8170SKalle Valo 1034bdcd8170SKalle Valo if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1035bdcd8170SKalle Valo ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1036bdcd8170SKalle Valo if (ret != 0) { 1037bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1038bdcd8170SKalle Valo return -EIO; 1039bdcd8170SKalle Valo } 1040bdcd8170SKalle Valo } 1041bdcd8170SKalle Valo 1042bdcd8170SKalle Valo return 0; 1043bdcd8170SKalle Valo } 1044bdcd8170SKalle Valo 1045bdcd8170SKalle Valo /* 1046bdcd8170SKalle Valo * The type nl80211_tx_power_setting replaces the following 1047bdcd8170SKalle Valo * data type from 2.6.36 onwards 1048bdcd8170SKalle Valo */ 1049bdcd8170SKalle Valo static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1050bdcd8170SKalle Valo enum nl80211_tx_power_setting type, 1051bdcd8170SKalle Valo int dbm) 1052bdcd8170SKalle Valo { 1053bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1054bdcd8170SKalle Valo u8 ath6kl_dbm; 1055bdcd8170SKalle Valo 1056bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1057bdcd8170SKalle Valo type, dbm); 1058bdcd8170SKalle Valo 1059bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1060bdcd8170SKalle Valo return -EIO; 1061bdcd8170SKalle Valo 1062bdcd8170SKalle Valo switch (type) { 1063bdcd8170SKalle Valo case NL80211_TX_POWER_AUTOMATIC: 1064bdcd8170SKalle Valo return 0; 1065bdcd8170SKalle Valo case NL80211_TX_POWER_LIMITED: 1066bdcd8170SKalle Valo ar->tx_pwr = ath6kl_dbm = dbm; 1067bdcd8170SKalle Valo break; 1068bdcd8170SKalle Valo default: 1069bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1070bdcd8170SKalle Valo __func__, type); 1071bdcd8170SKalle Valo return -EOPNOTSUPP; 1072bdcd8170SKalle Valo } 1073bdcd8170SKalle Valo 1074bdcd8170SKalle Valo ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, ath6kl_dbm); 1075bdcd8170SKalle Valo 1076bdcd8170SKalle Valo return 0; 1077bdcd8170SKalle Valo } 1078bdcd8170SKalle Valo 1079bdcd8170SKalle Valo static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1080bdcd8170SKalle Valo { 1081bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1082bdcd8170SKalle Valo 1083bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1084bdcd8170SKalle Valo return -EIO; 1085bdcd8170SKalle Valo 1086bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) { 1087bdcd8170SKalle Valo ar->tx_pwr = 0; 1088bdcd8170SKalle Valo 1089bdcd8170SKalle Valo if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi) != 0) { 1090bdcd8170SKalle Valo ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1091bdcd8170SKalle Valo return -EIO; 1092bdcd8170SKalle Valo } 1093bdcd8170SKalle Valo 1094bdcd8170SKalle Valo wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1095bdcd8170SKalle Valo 5 * HZ); 1096bdcd8170SKalle Valo 1097bdcd8170SKalle Valo if (signal_pending(current)) { 1098bdcd8170SKalle Valo ath6kl_err("target did not respond\n"); 1099bdcd8170SKalle Valo return -EINTR; 1100bdcd8170SKalle Valo } 1101bdcd8170SKalle Valo } 1102bdcd8170SKalle Valo 1103bdcd8170SKalle Valo *dbm = ar->tx_pwr; 1104bdcd8170SKalle Valo return 0; 1105bdcd8170SKalle Valo } 1106bdcd8170SKalle Valo 1107bdcd8170SKalle Valo static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1108bdcd8170SKalle Valo struct net_device *dev, 1109bdcd8170SKalle Valo bool pmgmt, int timeout) 1110bdcd8170SKalle Valo { 1111bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1112bdcd8170SKalle Valo struct wmi_power_mode_cmd mode; 1113bdcd8170SKalle Valo 1114bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1115bdcd8170SKalle Valo __func__, pmgmt, timeout); 1116bdcd8170SKalle Valo 1117bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1118bdcd8170SKalle Valo return -EIO; 1119bdcd8170SKalle Valo 1120bdcd8170SKalle Valo if (pmgmt) { 1121bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1122bdcd8170SKalle Valo mode.pwr_mode = REC_POWER; 1123bdcd8170SKalle Valo } else { 1124bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1125bdcd8170SKalle Valo mode.pwr_mode = MAX_PERF_POWER; 1126bdcd8170SKalle Valo } 1127bdcd8170SKalle Valo 1128bdcd8170SKalle Valo if (ath6kl_wmi_powermode_cmd(ar->wmi, mode.pwr_mode) != 0) { 1129bdcd8170SKalle Valo ath6kl_err("wmi_powermode_cmd failed\n"); 1130bdcd8170SKalle Valo return -EIO; 1131bdcd8170SKalle Valo } 1132bdcd8170SKalle Valo 1133bdcd8170SKalle Valo return 0; 1134bdcd8170SKalle Valo } 1135bdcd8170SKalle Valo 1136bdcd8170SKalle Valo static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1137bdcd8170SKalle Valo struct net_device *ndev, 1138bdcd8170SKalle Valo enum nl80211_iftype type, u32 *flags, 1139bdcd8170SKalle Valo struct vif_params *params) 1140bdcd8170SKalle Valo { 1141bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(ndev); 1142bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1143bdcd8170SKalle Valo 1144bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1145bdcd8170SKalle Valo 1146bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1147bdcd8170SKalle Valo return -EIO; 1148bdcd8170SKalle Valo 1149bdcd8170SKalle Valo switch (type) { 1150bdcd8170SKalle Valo case NL80211_IFTYPE_STATION: 1151bdcd8170SKalle Valo ar->next_mode = INFRA_NETWORK; 1152bdcd8170SKalle Valo break; 1153bdcd8170SKalle Valo case NL80211_IFTYPE_ADHOC: 1154bdcd8170SKalle Valo ar->next_mode = ADHOC_NETWORK; 1155bdcd8170SKalle Valo break; 1156bdcd8170SKalle Valo default: 1157bdcd8170SKalle Valo ath6kl_err("invalid interface type %u\n", type); 1158bdcd8170SKalle Valo return -EOPNOTSUPP; 1159bdcd8170SKalle Valo } 1160bdcd8170SKalle Valo 1161bdcd8170SKalle Valo wdev->iftype = type; 1162bdcd8170SKalle Valo 1163bdcd8170SKalle Valo return 0; 1164bdcd8170SKalle Valo } 1165bdcd8170SKalle Valo 1166bdcd8170SKalle Valo static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1167bdcd8170SKalle Valo struct net_device *dev, 1168bdcd8170SKalle Valo struct cfg80211_ibss_params *ibss_param) 1169bdcd8170SKalle Valo { 1170bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1171bdcd8170SKalle Valo int status; 1172bdcd8170SKalle Valo 1173bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1174bdcd8170SKalle Valo return -EIO; 1175bdcd8170SKalle Valo 1176bdcd8170SKalle Valo ar->ssid_len = ibss_param->ssid_len; 1177bdcd8170SKalle Valo memcpy(ar->ssid, ibss_param->ssid, ar->ssid_len); 1178bdcd8170SKalle Valo 1179bdcd8170SKalle Valo if (ibss_param->channel) 1180bdcd8170SKalle Valo ar->ch_hint = ibss_param->channel->center_freq; 1181bdcd8170SKalle Valo 1182bdcd8170SKalle Valo if (ibss_param->channel_fixed) { 1183bdcd8170SKalle Valo /* 1184bdcd8170SKalle Valo * TODO: channel_fixed: The channel should be fixed, do not 1185bdcd8170SKalle Valo * search for IBSSs to join on other channels. Target 1186bdcd8170SKalle Valo * firmware does not support this feature, needs to be 1187bdcd8170SKalle Valo * updated. 1188bdcd8170SKalle Valo */ 1189bdcd8170SKalle Valo return -EOPNOTSUPP; 1190bdcd8170SKalle Valo } 1191bdcd8170SKalle Valo 1192bdcd8170SKalle Valo memset(ar->req_bssid, 0, sizeof(ar->req_bssid)); 1193bdcd8170SKalle Valo if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1194bdcd8170SKalle Valo memcpy(ar->req_bssid, ibss_param->bssid, sizeof(ar->req_bssid)); 1195bdcd8170SKalle Valo 1196bdcd8170SKalle Valo ath6kl_set_wpa_version(ar, 0); 1197bdcd8170SKalle Valo 1198bdcd8170SKalle Valo status = ath6kl_set_auth_type(ar, NL80211_AUTHTYPE_OPEN_SYSTEM); 1199bdcd8170SKalle Valo if (status) 1200bdcd8170SKalle Valo return status; 1201bdcd8170SKalle Valo 1202bdcd8170SKalle Valo if (ibss_param->privacy) { 1203bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, true); 1204bdcd8170SKalle Valo ath6kl_set_cipher(ar, WLAN_CIPHER_SUITE_WEP40, false); 1205bdcd8170SKalle Valo } else { 1206bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, true); 1207bdcd8170SKalle Valo ath6kl_set_cipher(ar, 0, false); 1208bdcd8170SKalle Valo } 1209bdcd8170SKalle Valo 1210bdcd8170SKalle Valo ar->nw_type = ar->next_mode; 1211bdcd8170SKalle Valo 1212bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1213bdcd8170SKalle Valo "%s: connect called with authmode %d dot11 auth %d" 1214bdcd8170SKalle Valo " PW crypto %d PW crypto len %d GRP crypto %d" 1215bdcd8170SKalle Valo " GRP crypto len %d channel hint %u\n", 1216bdcd8170SKalle Valo __func__, 1217bdcd8170SKalle Valo ar->auth_mode, ar->dot11_auth_mode, ar->prwise_crypto, 1218bdcd8170SKalle Valo ar->prwise_crypto_len, ar->grp_crypto, 1219bdcd8170SKalle Valo ar->grp_crpto_len, ar->ch_hint); 1220bdcd8170SKalle Valo 1221bdcd8170SKalle Valo status = ath6kl_wmi_connect_cmd(ar->wmi, ar->nw_type, 1222bdcd8170SKalle Valo ar->dot11_auth_mode, ar->auth_mode, 1223bdcd8170SKalle Valo ar->prwise_crypto, 1224bdcd8170SKalle Valo ar->prwise_crypto_len, 1225bdcd8170SKalle Valo ar->grp_crypto, ar->grp_crpto_len, 1226bdcd8170SKalle Valo ar->ssid_len, ar->ssid, 1227bdcd8170SKalle Valo ar->req_bssid, ar->ch_hint, 1228bdcd8170SKalle Valo ar->connect_ctrl_flags); 1229bdcd8170SKalle Valo set_bit(CONNECT_PEND, &ar->flag); 1230bdcd8170SKalle Valo 1231bdcd8170SKalle Valo return 0; 1232bdcd8170SKalle Valo } 1233bdcd8170SKalle Valo 1234bdcd8170SKalle Valo static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1235bdcd8170SKalle Valo struct net_device *dev) 1236bdcd8170SKalle Valo { 1237bdcd8170SKalle Valo struct ath6kl *ar = (struct ath6kl *)ath6kl_priv(dev); 1238bdcd8170SKalle Valo 1239bdcd8170SKalle Valo if (!ath6kl_cfg80211_ready(ar)) 1240bdcd8170SKalle Valo return -EIO; 1241bdcd8170SKalle Valo 1242bdcd8170SKalle Valo ath6kl_disconnect(ar); 1243bdcd8170SKalle Valo memset(ar->ssid, 0, sizeof(ar->ssid)); 1244bdcd8170SKalle Valo ar->ssid_len = 0; 1245bdcd8170SKalle Valo 1246bdcd8170SKalle Valo return 0; 1247bdcd8170SKalle Valo } 1248bdcd8170SKalle Valo 1249bdcd8170SKalle Valo static const u32 cipher_suites[] = { 1250bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP40, 1251bdcd8170SKalle Valo WLAN_CIPHER_SUITE_WEP104, 1252bdcd8170SKalle Valo WLAN_CIPHER_SUITE_TKIP, 1253bdcd8170SKalle Valo WLAN_CIPHER_SUITE_CCMP, 1254bdcd8170SKalle Valo }; 1255bdcd8170SKalle Valo 1256bdcd8170SKalle Valo static bool is_rate_legacy(s32 rate) 1257bdcd8170SKalle Valo { 1258bdcd8170SKalle Valo static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1259bdcd8170SKalle Valo 6000, 9000, 12000, 18000, 24000, 1260bdcd8170SKalle Valo 36000, 48000, 54000 1261bdcd8170SKalle Valo }; 1262bdcd8170SKalle Valo u8 i; 1263bdcd8170SKalle Valo 1264bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(legacy); i++) 1265bdcd8170SKalle Valo if (rate == legacy[i]) 1266bdcd8170SKalle Valo return true; 1267bdcd8170SKalle Valo 1268bdcd8170SKalle Valo return false; 1269bdcd8170SKalle Valo } 1270bdcd8170SKalle Valo 1271bdcd8170SKalle Valo static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1272bdcd8170SKalle Valo { 1273bdcd8170SKalle Valo static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1274bdcd8170SKalle Valo 52000, 58500, 65000, 72200 1275bdcd8170SKalle Valo }; 1276bdcd8170SKalle Valo u8 i; 1277bdcd8170SKalle Valo 1278bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1279bdcd8170SKalle Valo if (rate == ht20[i]) { 1280bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht20) - 1) 1281bdcd8170SKalle Valo /* last rate uses sgi */ 1282bdcd8170SKalle Valo *sgi = true; 1283bdcd8170SKalle Valo else 1284bdcd8170SKalle Valo *sgi = false; 1285bdcd8170SKalle Valo 1286bdcd8170SKalle Valo *mcs = i; 1287bdcd8170SKalle Valo return true; 1288bdcd8170SKalle Valo } 1289bdcd8170SKalle Valo } 1290bdcd8170SKalle Valo return false; 1291bdcd8170SKalle Valo } 1292bdcd8170SKalle Valo 1293bdcd8170SKalle Valo static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1294bdcd8170SKalle Valo { 1295bdcd8170SKalle Valo static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1296bdcd8170SKalle Valo 81000, 108000, 121500, 135000, 1297bdcd8170SKalle Valo 150000 1298bdcd8170SKalle Valo }; 1299bdcd8170SKalle Valo u8 i; 1300bdcd8170SKalle Valo 1301bdcd8170SKalle Valo for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1302bdcd8170SKalle Valo if (rate == ht40[i]) { 1303bdcd8170SKalle Valo if (i == ARRAY_SIZE(ht40) - 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 1314bdcd8170SKalle Valo return false; 1315bdcd8170SKalle Valo } 1316bdcd8170SKalle Valo 1317bdcd8170SKalle Valo static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1318bdcd8170SKalle Valo u8 *mac, struct station_info *sinfo) 1319bdcd8170SKalle Valo { 1320bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(dev); 1321bdcd8170SKalle Valo long left; 1322bdcd8170SKalle Valo bool sgi; 1323bdcd8170SKalle Valo s32 rate; 1324bdcd8170SKalle Valo int ret; 1325bdcd8170SKalle Valo u8 mcs; 1326bdcd8170SKalle Valo 1327bdcd8170SKalle Valo if (memcmp(mac, ar->bssid, ETH_ALEN) != 0) 1328bdcd8170SKalle Valo return -ENOENT; 1329bdcd8170SKalle Valo 1330bdcd8170SKalle Valo if (down_interruptible(&ar->sem)) 1331bdcd8170SKalle Valo return -EBUSY; 1332bdcd8170SKalle Valo 1333bdcd8170SKalle Valo set_bit(STATS_UPDATE_PEND, &ar->flag); 1334bdcd8170SKalle Valo 1335bdcd8170SKalle Valo ret = ath6kl_wmi_get_stats_cmd(ar->wmi); 1336bdcd8170SKalle Valo 1337bdcd8170SKalle Valo if (ret != 0) { 1338bdcd8170SKalle Valo up(&ar->sem); 1339bdcd8170SKalle Valo return -EIO; 1340bdcd8170SKalle Valo } 1341bdcd8170SKalle Valo 1342bdcd8170SKalle Valo left = wait_event_interruptible_timeout(ar->event_wq, 1343bdcd8170SKalle Valo !test_bit(STATS_UPDATE_PEND, 1344bdcd8170SKalle Valo &ar->flag), 1345bdcd8170SKalle Valo WMI_TIMEOUT); 1346bdcd8170SKalle Valo 1347bdcd8170SKalle Valo up(&ar->sem); 1348bdcd8170SKalle Valo 1349bdcd8170SKalle Valo if (left == 0) 1350bdcd8170SKalle Valo return -ETIMEDOUT; 1351bdcd8170SKalle Valo else if (left < 0) 1352bdcd8170SKalle Valo return left; 1353bdcd8170SKalle Valo 1354bdcd8170SKalle Valo if (ar->target_stats.rx_byte) { 1355bdcd8170SKalle Valo sinfo->rx_bytes = ar->target_stats.rx_byte; 1356bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_BYTES; 1357bdcd8170SKalle Valo sinfo->rx_packets = ar->target_stats.rx_pkt; 1358bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_RX_PACKETS; 1359bdcd8170SKalle Valo } 1360bdcd8170SKalle Valo 1361bdcd8170SKalle Valo if (ar->target_stats.tx_byte) { 1362bdcd8170SKalle Valo sinfo->tx_bytes = ar->target_stats.tx_byte; 1363bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BYTES; 1364bdcd8170SKalle Valo sinfo->tx_packets = ar->target_stats.tx_pkt; 1365bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_PACKETS; 1366bdcd8170SKalle Valo } 1367bdcd8170SKalle Valo 1368bdcd8170SKalle Valo sinfo->signal = ar->target_stats.cs_rssi; 1369bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_SIGNAL; 1370bdcd8170SKalle Valo 1371bdcd8170SKalle Valo rate = ar->target_stats.tx_ucast_rate; 1372bdcd8170SKalle Valo 1373bdcd8170SKalle Valo if (is_rate_legacy(rate)) { 1374bdcd8170SKalle Valo sinfo->txrate.legacy = rate / 100; 1375bdcd8170SKalle Valo } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1376bdcd8170SKalle Valo if (sgi) { 1377bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1378bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1379bdcd8170SKalle Valo } else { 1380bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1381bdcd8170SKalle Valo } 1382bdcd8170SKalle Valo 1383bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1384bdcd8170SKalle Valo } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1385bdcd8170SKalle Valo if (sgi) { 1386bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1387bdcd8170SKalle Valo sinfo->txrate.mcs = mcs - 1; 1388bdcd8170SKalle Valo } else { 1389bdcd8170SKalle Valo sinfo->txrate.mcs = mcs; 1390bdcd8170SKalle Valo } 1391bdcd8170SKalle Valo 1392bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1393bdcd8170SKalle Valo sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1394bdcd8170SKalle Valo } else { 1395bdcd8170SKalle Valo ath6kl_warn("invalid rate: %d\n", rate); 1396bdcd8170SKalle Valo return 0; 1397bdcd8170SKalle Valo } 1398bdcd8170SKalle Valo 1399bdcd8170SKalle Valo sinfo->filled |= STATION_INFO_TX_BITRATE; 1400bdcd8170SKalle Valo 1401bdcd8170SKalle Valo return 0; 1402bdcd8170SKalle Valo } 1403bdcd8170SKalle Valo 1404bdcd8170SKalle Valo static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1405bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1406bdcd8170SKalle Valo { 1407bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1408bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1409bdcd8170SKalle Valo pmksa->pmkid, true); 1410bdcd8170SKalle Valo } 1411bdcd8170SKalle Valo 1412bdcd8170SKalle Valo static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1413bdcd8170SKalle Valo struct cfg80211_pmksa *pmksa) 1414bdcd8170SKalle Valo { 1415bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1416bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, pmksa->bssid, 1417bdcd8170SKalle Valo pmksa->pmkid, false); 1418bdcd8170SKalle Valo } 1419bdcd8170SKalle Valo 1420bdcd8170SKalle Valo static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1421bdcd8170SKalle Valo { 1422bdcd8170SKalle Valo struct ath6kl *ar = ath6kl_priv(netdev); 1423bdcd8170SKalle Valo if (test_bit(CONNECTED, &ar->flag)) 1424bdcd8170SKalle Valo return ath6kl_wmi_setpmkid_cmd(ar->wmi, ar->bssid, NULL, false); 1425bdcd8170SKalle Valo return 0; 1426bdcd8170SKalle Valo } 1427bdcd8170SKalle Valo 1428abcb344bSKalle Valo #ifdef CONFIG_PM 1429abcb344bSKalle Valo static int ar6k_cfg80211_suspend(struct wiphy *wiphy, 1430abcb344bSKalle Valo struct cfg80211_wowlan *wow) 1431abcb344bSKalle Valo { 1432abcb344bSKalle Valo struct ath6kl *ar = wiphy_priv(wiphy); 1433abcb344bSKalle Valo 1434abcb344bSKalle Valo return ath6kl_hif_suspend(ar); 1435abcb344bSKalle Valo } 1436abcb344bSKalle Valo #endif 1437abcb344bSKalle Valo 14386a7c9badSJouni Malinen static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 14396a7c9badSJouni Malinen struct ieee80211_channel *chan, 14406a7c9badSJouni Malinen enum nl80211_channel_type channel_type) 14416a7c9badSJouni Malinen { 14426a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 14436a7c9badSJouni Malinen 14446a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 14456a7c9badSJouni Malinen return -EIO; 14466a7c9badSJouni Malinen 14476a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 14486a7c9badSJouni Malinen __func__, chan->center_freq, chan->hw_value); 14496a7c9badSJouni Malinen ar->next_chan = chan->center_freq; 14506a7c9badSJouni Malinen 14516a7c9badSJouni Malinen return 0; 14526a7c9badSJouni Malinen } 14536a7c9badSJouni Malinen 14546a7c9badSJouni Malinen static int ath6kl_ap_beacon(struct wiphy *wiphy, struct net_device *dev, 14556a7c9badSJouni Malinen struct beacon_parameters *info, bool add) 14566a7c9badSJouni Malinen { 14576a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 14586a7c9badSJouni Malinen struct ieee80211_mgmt *mgmt; 14596a7c9badSJouni Malinen u8 *ies; 14606a7c9badSJouni Malinen int ies_len; 14616a7c9badSJouni Malinen struct wmi_connect_cmd p; 14626a7c9badSJouni Malinen int res; 14636a7c9badSJouni Malinen int i; 14646a7c9badSJouni Malinen 14656a7c9badSJouni Malinen ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: add=%d\n", __func__, add); 14666a7c9badSJouni Malinen 14676a7c9badSJouni Malinen if (!ath6kl_cfg80211_ready(ar)) 14686a7c9badSJouni Malinen return -EIO; 14696a7c9badSJouni Malinen 14706a7c9badSJouni Malinen if (ar->next_mode != AP_NETWORK) 14716a7c9badSJouni Malinen return -EOPNOTSUPP; 14726a7c9badSJouni Malinen 14736a7c9badSJouni Malinen if (info->beacon_ies) { 14746a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_BEACON, 14756a7c9badSJouni Malinen info->beacon_ies, 14766a7c9badSJouni Malinen info->beacon_ies_len); 14776a7c9badSJouni Malinen if (res) 14786a7c9badSJouni Malinen return res; 14796a7c9badSJouni Malinen } 14806a7c9badSJouni Malinen if (info->proberesp_ies) { 14816a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_PROBE_RESP, 14826a7c9badSJouni Malinen info->proberesp_ies, 14836a7c9badSJouni Malinen info->proberesp_ies_len); 14846a7c9badSJouni Malinen if (res) 14856a7c9badSJouni Malinen return res; 14866a7c9badSJouni Malinen } 14876a7c9badSJouni Malinen if (info->assocresp_ies) { 14886a7c9badSJouni Malinen res = ath6kl_wmi_set_appie_cmd(ar->wmi, WMI_FRAME_ASSOC_RESP, 14896a7c9badSJouni Malinen info->assocresp_ies, 14906a7c9badSJouni Malinen info->assocresp_ies_len); 14916a7c9badSJouni Malinen if (res) 14926a7c9badSJouni Malinen return res; 14936a7c9badSJouni Malinen } 14946a7c9badSJouni Malinen 14956a7c9badSJouni Malinen if (!add) 14966a7c9badSJouni Malinen return 0; 14976a7c9badSJouni Malinen 14986a7c9badSJouni Malinen /* TODO: 14996a7c9badSJouni Malinen * info->interval 15006a7c9badSJouni Malinen * info->dtim_period 15016a7c9badSJouni Malinen */ 15026a7c9badSJouni Malinen 15036a7c9badSJouni Malinen if (info->head == NULL) 15046a7c9badSJouni Malinen return -EINVAL; 15056a7c9badSJouni Malinen mgmt = (struct ieee80211_mgmt *) info->head; 15066a7c9badSJouni Malinen ies = mgmt->u.beacon.variable; 15076a7c9badSJouni Malinen if (ies > info->head + info->head_len) 15086a7c9badSJouni Malinen return -EINVAL; 15096a7c9badSJouni Malinen ies_len = info->head + info->head_len - ies; 15106a7c9badSJouni Malinen 15116a7c9badSJouni Malinen if (info->ssid == NULL) 15126a7c9badSJouni Malinen return -EINVAL; 15136a7c9badSJouni Malinen memcpy(ar->ssid, info->ssid, info->ssid_len); 15146a7c9badSJouni Malinen ar->ssid_len = info->ssid_len; 15156a7c9badSJouni Malinen if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 15166a7c9badSJouni Malinen return -EOPNOTSUPP; /* TODO */ 15176a7c9badSJouni Malinen 15186a7c9badSJouni Malinen ar->dot11_auth_mode = OPEN_AUTH; 15196a7c9badSJouni Malinen 15206a7c9badSJouni Malinen memset(&p, 0, sizeof(p)); 15216a7c9badSJouni Malinen 15226a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_akm_suites; i++) { 15236a7c9badSJouni Malinen switch (info->crypto.akm_suites[i]) { 15246a7c9badSJouni Malinen case WLAN_AKM_SUITE_8021X: 15256a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 15266a7c9badSJouni Malinen p.auth_mode |= WPA_AUTH; 15276a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 15286a7c9badSJouni Malinen p.auth_mode |= WPA2_AUTH; 15296a7c9badSJouni Malinen break; 15306a7c9badSJouni Malinen case WLAN_AKM_SUITE_PSK: 15316a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 15326a7c9badSJouni Malinen p.auth_mode |= WPA_PSK_AUTH; 15336a7c9badSJouni Malinen if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 15346a7c9badSJouni Malinen p.auth_mode |= WPA2_PSK_AUTH; 15356a7c9badSJouni Malinen break; 15366a7c9badSJouni Malinen } 15376a7c9badSJouni Malinen } 15386a7c9badSJouni Malinen if (p.auth_mode == 0) 15396a7c9badSJouni Malinen p.auth_mode = NONE_AUTH; 15406a7c9badSJouni Malinen ar->auth_mode = p.auth_mode; 15416a7c9badSJouni Malinen 15426a7c9badSJouni Malinen for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 15436a7c9badSJouni Malinen switch (info->crypto.ciphers_pairwise[i]) { 15446a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 15456a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 15466a7c9badSJouni Malinen p.prwise_crypto_type |= WEP_CRYPT; 15476a7c9badSJouni Malinen break; 15486a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 15496a7c9badSJouni Malinen p.prwise_crypto_type |= TKIP_CRYPT; 15506a7c9badSJouni Malinen break; 15516a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 15526a7c9badSJouni Malinen p.prwise_crypto_type |= AES_CRYPT; 15536a7c9badSJouni Malinen break; 15546a7c9badSJouni Malinen } 15556a7c9badSJouni Malinen } 15566a7c9badSJouni Malinen if (p.prwise_crypto_type == 0) 15576a7c9badSJouni Malinen p.prwise_crypto_type = NONE_CRYPT; 15586a7c9badSJouni Malinen 15596a7c9badSJouni Malinen switch (info->crypto.cipher_group) { 15606a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP40: 15616a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_WEP104: 15626a7c9badSJouni Malinen p.grp_crypto_type = WEP_CRYPT; 15636a7c9badSJouni Malinen break; 15646a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_TKIP: 15656a7c9badSJouni Malinen p.grp_crypto_type = TKIP_CRYPT; 15666a7c9badSJouni Malinen break; 15676a7c9badSJouni Malinen case WLAN_CIPHER_SUITE_CCMP: 15686a7c9badSJouni Malinen p.grp_crypto_type = AES_CRYPT; 15696a7c9badSJouni Malinen break; 15706a7c9badSJouni Malinen default: 15716a7c9badSJouni Malinen p.grp_crypto_type = NONE_CRYPT; 15726a7c9badSJouni Malinen break; 15736a7c9badSJouni Malinen } 15746a7c9badSJouni Malinen 15756a7c9badSJouni Malinen p.nw_type = AP_NETWORK; 15766a7c9badSJouni Malinen ar->nw_type = ar->next_mode; 15776a7c9badSJouni Malinen 15786a7c9badSJouni Malinen p.ssid_len = ar->ssid_len; 15796a7c9badSJouni Malinen memcpy(p.ssid, ar->ssid, ar->ssid_len); 15806a7c9badSJouni Malinen p.dot11_auth_mode = ar->dot11_auth_mode; 15816a7c9badSJouni Malinen p.ch = cpu_to_le16(ar->next_chan); 15826a7c9badSJouni Malinen 15836a7c9badSJouni Malinen return ath6kl_wmi_ap_profile_commit(ar->wmi, &p); 15846a7c9badSJouni Malinen } 15856a7c9badSJouni Malinen 15866a7c9badSJouni Malinen static int ath6kl_add_beacon(struct wiphy *wiphy, struct net_device *dev, 15876a7c9badSJouni Malinen struct beacon_parameters *info) 15886a7c9badSJouni Malinen { 15896a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, true); 15906a7c9badSJouni Malinen } 15916a7c9badSJouni Malinen 15926a7c9badSJouni Malinen static int ath6kl_set_beacon(struct wiphy *wiphy, struct net_device *dev, 15936a7c9badSJouni Malinen struct beacon_parameters *info) 15946a7c9badSJouni Malinen { 15956a7c9badSJouni Malinen return ath6kl_ap_beacon(wiphy, dev, info, false); 15966a7c9badSJouni Malinen } 15976a7c9badSJouni Malinen 15986a7c9badSJouni Malinen static int ath6kl_del_beacon(struct wiphy *wiphy, struct net_device *dev) 15996a7c9badSJouni Malinen { 16006a7c9badSJouni Malinen struct ath6kl *ar = ath6kl_priv(dev); 16016a7c9badSJouni Malinen 16026a7c9badSJouni Malinen if (ar->nw_type != AP_NETWORK) 16036a7c9badSJouni Malinen return -EOPNOTSUPP; 16046a7c9badSJouni Malinen if (!test_bit(CONNECTED, &ar->flag)) 16056a7c9badSJouni Malinen return -ENOTCONN; 16066a7c9badSJouni Malinen 16076a7c9badSJouni Malinen ath6kl_wmi_disconnect_cmd(ar->wmi); 16086a7c9badSJouni Malinen clear_bit(CONNECTED, &ar->flag); 16096a7c9badSJouni Malinen 16106a7c9badSJouni Malinen return 0; 16116a7c9badSJouni Malinen } 16126a7c9badSJouni Malinen 1613bdcd8170SKalle Valo static struct cfg80211_ops ath6kl_cfg80211_ops = { 1614bdcd8170SKalle Valo .change_virtual_intf = ath6kl_cfg80211_change_iface, 1615bdcd8170SKalle Valo .scan = ath6kl_cfg80211_scan, 1616bdcd8170SKalle Valo .connect = ath6kl_cfg80211_connect, 1617bdcd8170SKalle Valo .disconnect = ath6kl_cfg80211_disconnect, 1618bdcd8170SKalle Valo .add_key = ath6kl_cfg80211_add_key, 1619bdcd8170SKalle Valo .get_key = ath6kl_cfg80211_get_key, 1620bdcd8170SKalle Valo .del_key = ath6kl_cfg80211_del_key, 1621bdcd8170SKalle Valo .set_default_key = ath6kl_cfg80211_set_default_key, 1622bdcd8170SKalle Valo .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 1623bdcd8170SKalle Valo .set_tx_power = ath6kl_cfg80211_set_txpower, 1624bdcd8170SKalle Valo .get_tx_power = ath6kl_cfg80211_get_txpower, 1625bdcd8170SKalle Valo .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 1626bdcd8170SKalle Valo .join_ibss = ath6kl_cfg80211_join_ibss, 1627bdcd8170SKalle Valo .leave_ibss = ath6kl_cfg80211_leave_ibss, 1628bdcd8170SKalle Valo .get_station = ath6kl_get_station, 1629bdcd8170SKalle Valo .set_pmksa = ath6kl_set_pmksa, 1630bdcd8170SKalle Valo .del_pmksa = ath6kl_del_pmksa, 1631bdcd8170SKalle Valo .flush_pmksa = ath6kl_flush_pmksa, 1632abcb344bSKalle Valo #ifdef CONFIG_PM 1633abcb344bSKalle Valo .suspend = ar6k_cfg80211_suspend, 1634abcb344bSKalle Valo #endif 16356a7c9badSJouni Malinen .set_channel = ath6kl_set_channel, 16366a7c9badSJouni Malinen .add_beacon = ath6kl_add_beacon, 16376a7c9badSJouni Malinen .set_beacon = ath6kl_set_beacon, 16386a7c9badSJouni Malinen .del_beacon = ath6kl_del_beacon, 1639bdcd8170SKalle Valo }; 1640bdcd8170SKalle Valo 1641bdcd8170SKalle Valo struct wireless_dev *ath6kl_cfg80211_init(struct device *dev) 1642bdcd8170SKalle Valo { 1643bdcd8170SKalle Valo int ret = 0; 1644bdcd8170SKalle Valo struct wireless_dev *wdev; 1645bdcd8170SKalle Valo 1646bdcd8170SKalle Valo wdev = kzalloc(sizeof(struct wireless_dev), GFP_KERNEL); 1647bdcd8170SKalle Valo if (!wdev) { 1648bdcd8170SKalle Valo ath6kl_err("couldn't allocate wireless device\n"); 1649bdcd8170SKalle Valo return NULL; 1650bdcd8170SKalle Valo } 1651bdcd8170SKalle Valo 1652bdcd8170SKalle Valo /* create a new wiphy for use with cfg80211 */ 1653bdcd8170SKalle Valo wdev->wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 1654bdcd8170SKalle Valo if (!wdev->wiphy) { 1655bdcd8170SKalle Valo ath6kl_err("couldn't allocate wiphy device\n"); 1656bdcd8170SKalle Valo kfree(wdev); 1657bdcd8170SKalle Valo return NULL; 1658bdcd8170SKalle Valo } 1659bdcd8170SKalle Valo 1660bdcd8170SKalle Valo /* set device pointer for wiphy */ 1661bdcd8170SKalle Valo set_wiphy_dev(wdev->wiphy, dev); 1662bdcd8170SKalle Valo 1663bdcd8170SKalle Valo wdev->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 1664bdcd8170SKalle Valo BIT(NL80211_IFTYPE_ADHOC); 1665bdcd8170SKalle Valo /* max num of ssids that can be probed during scanning */ 1666bdcd8170SKalle Valo wdev->wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 1667bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 1668bdcd8170SKalle Valo wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 1669bdcd8170SKalle Valo wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 1670bdcd8170SKalle Valo 1671bdcd8170SKalle Valo wdev->wiphy->cipher_suites = cipher_suites; 1672bdcd8170SKalle Valo wdev->wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 1673bdcd8170SKalle Valo 1674bdcd8170SKalle Valo ret = wiphy_register(wdev->wiphy); 1675bdcd8170SKalle Valo if (ret < 0) { 1676bdcd8170SKalle Valo ath6kl_err("couldn't register wiphy device\n"); 1677bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1678bdcd8170SKalle Valo kfree(wdev); 1679bdcd8170SKalle Valo return NULL; 1680bdcd8170SKalle Valo } 1681bdcd8170SKalle Valo 1682bdcd8170SKalle Valo return wdev; 1683bdcd8170SKalle Valo } 1684bdcd8170SKalle Valo 1685bdcd8170SKalle Valo void ath6kl_cfg80211_deinit(struct ath6kl *ar) 1686bdcd8170SKalle Valo { 1687bdcd8170SKalle Valo struct wireless_dev *wdev = ar->wdev; 1688bdcd8170SKalle Valo 1689bdcd8170SKalle Valo if (ar->scan_req) { 1690bdcd8170SKalle Valo cfg80211_scan_done(ar->scan_req, true); 1691bdcd8170SKalle Valo ar->scan_req = NULL; 1692bdcd8170SKalle Valo } 1693bdcd8170SKalle Valo 1694bdcd8170SKalle Valo if (!wdev) 1695bdcd8170SKalle Valo return; 1696bdcd8170SKalle Valo 1697bdcd8170SKalle Valo wiphy_unregister(wdev->wiphy); 1698bdcd8170SKalle Valo wiphy_free(wdev->wiphy); 1699bdcd8170SKalle Valo kfree(wdev); 1700bdcd8170SKalle Valo } 1701