1 /* 2 * Copyright (c) 2004-2011 Atheros Communications Inc. 3 * Copyright (c) 2011-2012 Qualcomm Atheros, Inc. 4 * 5 * Permission to use, copy, modify, and/or distribute this software for any 6 * purpose with or without fee is hereby granted, provided that the above 7 * copyright notice and this permission notice appear in all copies. 8 * 9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16 */ 17 18 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 19 20 #include <linux/moduleparam.h> 21 #include <linux/inetdevice.h> 22 #include <linux/export.h> 23 24 #include "core.h" 25 #include "cfg80211.h" 26 #include "debug.h" 27 #include "hif-ops.h" 28 #include "testmode.h" 29 30 #define RATETAB_ENT(_rate, _rateid, _flags) { \ 31 .bitrate = (_rate), \ 32 .flags = (_flags), \ 33 .hw_value = (_rateid), \ 34 } 35 36 #define CHAN2G(_channel, _freq, _flags) { \ 37 .band = IEEE80211_BAND_2GHZ, \ 38 .hw_value = (_channel), \ 39 .center_freq = (_freq), \ 40 .flags = (_flags), \ 41 .max_antenna_gain = 0, \ 42 .max_power = 30, \ 43 } 44 45 #define CHAN5G(_channel, _flags) { \ 46 .band = IEEE80211_BAND_5GHZ, \ 47 .hw_value = (_channel), \ 48 .center_freq = 5000 + (5 * (_channel)), \ 49 .flags = (_flags), \ 50 .max_antenna_gain = 0, \ 51 .max_power = 30, \ 52 } 53 54 #define DEFAULT_BG_SCAN_PERIOD 60 55 56 static struct ieee80211_rate ath6kl_rates[] = { 57 RATETAB_ENT(10, 0x1, 0), 58 RATETAB_ENT(20, 0x2, 0), 59 RATETAB_ENT(55, 0x4, 0), 60 RATETAB_ENT(110, 0x8, 0), 61 RATETAB_ENT(60, 0x10, 0), 62 RATETAB_ENT(90, 0x20, 0), 63 RATETAB_ENT(120, 0x40, 0), 64 RATETAB_ENT(180, 0x80, 0), 65 RATETAB_ENT(240, 0x100, 0), 66 RATETAB_ENT(360, 0x200, 0), 67 RATETAB_ENT(480, 0x400, 0), 68 RATETAB_ENT(540, 0x800, 0), 69 }; 70 71 #define ath6kl_a_rates (ath6kl_rates + 4) 72 #define ath6kl_a_rates_size 8 73 #define ath6kl_g_rates (ath6kl_rates + 0) 74 #define ath6kl_g_rates_size 12 75 76 #define ath6kl_g_htcap IEEE80211_HT_CAP_SGI_20 77 #define ath6kl_a_htcap (IEEE80211_HT_CAP_SUP_WIDTH_20_40 | \ 78 IEEE80211_HT_CAP_SGI_20 | \ 79 IEEE80211_HT_CAP_SGI_40) 80 81 static struct ieee80211_channel ath6kl_2ghz_channels[] = { 82 CHAN2G(1, 2412, 0), 83 CHAN2G(2, 2417, 0), 84 CHAN2G(3, 2422, 0), 85 CHAN2G(4, 2427, 0), 86 CHAN2G(5, 2432, 0), 87 CHAN2G(6, 2437, 0), 88 CHAN2G(7, 2442, 0), 89 CHAN2G(8, 2447, 0), 90 CHAN2G(9, 2452, 0), 91 CHAN2G(10, 2457, 0), 92 CHAN2G(11, 2462, 0), 93 CHAN2G(12, 2467, 0), 94 CHAN2G(13, 2472, 0), 95 CHAN2G(14, 2484, 0), 96 }; 97 98 static struct ieee80211_channel ath6kl_5ghz_a_channels[] = { 99 CHAN5G(34, 0), CHAN5G(36, 0), 100 CHAN5G(38, 0), CHAN5G(40, 0), 101 CHAN5G(42, 0), CHAN5G(44, 0), 102 CHAN5G(46, 0), CHAN5G(48, 0), 103 CHAN5G(52, 0), CHAN5G(56, 0), 104 CHAN5G(60, 0), CHAN5G(64, 0), 105 CHAN5G(100, 0), CHAN5G(104, 0), 106 CHAN5G(108, 0), CHAN5G(112, 0), 107 CHAN5G(116, 0), CHAN5G(120, 0), 108 CHAN5G(124, 0), CHAN5G(128, 0), 109 CHAN5G(132, 0), CHAN5G(136, 0), 110 CHAN5G(140, 0), CHAN5G(149, 0), 111 CHAN5G(153, 0), CHAN5G(157, 0), 112 CHAN5G(161, 0), CHAN5G(165, 0), 113 CHAN5G(184, 0), CHAN5G(188, 0), 114 CHAN5G(192, 0), CHAN5G(196, 0), 115 CHAN5G(200, 0), CHAN5G(204, 0), 116 CHAN5G(208, 0), CHAN5G(212, 0), 117 CHAN5G(216, 0), 118 }; 119 120 static struct ieee80211_supported_band ath6kl_band_2ghz = { 121 .n_channels = ARRAY_SIZE(ath6kl_2ghz_channels), 122 .channels = ath6kl_2ghz_channels, 123 .n_bitrates = ath6kl_g_rates_size, 124 .bitrates = ath6kl_g_rates, 125 .ht_cap.cap = ath6kl_g_htcap, 126 .ht_cap.ht_supported = true, 127 }; 128 129 static struct ieee80211_supported_band ath6kl_band_5ghz = { 130 .n_channels = ARRAY_SIZE(ath6kl_5ghz_a_channels), 131 .channels = ath6kl_5ghz_a_channels, 132 .n_bitrates = ath6kl_a_rates_size, 133 .bitrates = ath6kl_a_rates, 134 .ht_cap.cap = ath6kl_a_htcap, 135 .ht_cap.ht_supported = true, 136 }; 137 138 #define CCKM_KRK_CIPHER_SUITE 0x004096ff /* use for KRK */ 139 140 /* returns true if scheduled scan was stopped */ 141 static bool __ath6kl_cfg80211_sscan_stop(struct ath6kl_vif *vif) 142 { 143 struct ath6kl *ar = vif->ar; 144 145 if (ar->state != ATH6KL_STATE_SCHED_SCAN) 146 return false; 147 148 del_timer_sync(&vif->sched_scan_timer); 149 150 ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 151 ATH6KL_HOST_MODE_AWAKE); 152 153 ar->state = ATH6KL_STATE_ON; 154 155 return true; 156 } 157 158 static void ath6kl_cfg80211_sscan_disable(struct ath6kl_vif *vif) 159 { 160 struct ath6kl *ar = vif->ar; 161 bool stopped; 162 163 stopped = __ath6kl_cfg80211_sscan_stop(vif); 164 165 if (!stopped) 166 return; 167 168 cfg80211_sched_scan_stopped(ar->wiphy); 169 } 170 171 static int ath6kl_set_wpa_version(struct ath6kl_vif *vif, 172 enum nl80211_wpa_versions wpa_version) 173 { 174 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: %u\n", __func__, wpa_version); 175 176 if (!wpa_version) { 177 vif->auth_mode = NONE_AUTH; 178 } else if (wpa_version & NL80211_WPA_VERSION_2) { 179 vif->auth_mode = WPA2_AUTH; 180 } else if (wpa_version & NL80211_WPA_VERSION_1) { 181 vif->auth_mode = WPA_AUTH; 182 } else { 183 ath6kl_err("%s: %u not supported\n", __func__, wpa_version); 184 return -ENOTSUPP; 185 } 186 187 return 0; 188 } 189 190 static int ath6kl_set_auth_type(struct ath6kl_vif *vif, 191 enum nl80211_auth_type auth_type) 192 { 193 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, auth_type); 194 195 switch (auth_type) { 196 case NL80211_AUTHTYPE_OPEN_SYSTEM: 197 vif->dot11_auth_mode = OPEN_AUTH; 198 break; 199 case NL80211_AUTHTYPE_SHARED_KEY: 200 vif->dot11_auth_mode = SHARED_AUTH; 201 break; 202 case NL80211_AUTHTYPE_NETWORK_EAP: 203 vif->dot11_auth_mode = LEAP_AUTH; 204 break; 205 206 case NL80211_AUTHTYPE_AUTOMATIC: 207 vif->dot11_auth_mode = OPEN_AUTH | SHARED_AUTH; 208 break; 209 210 default: 211 ath6kl_err("%s: 0x%x not supported\n", __func__, auth_type); 212 return -ENOTSUPP; 213 } 214 215 return 0; 216 } 217 218 static int ath6kl_set_cipher(struct ath6kl_vif *vif, u32 cipher, bool ucast) 219 { 220 u8 *ar_cipher = ucast ? &vif->prwise_crypto : &vif->grp_crypto; 221 u8 *ar_cipher_len = ucast ? &vif->prwise_crypto_len : 222 &vif->grp_crypto_len; 223 224 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: cipher 0x%x, ucast %u\n", 225 __func__, cipher, ucast); 226 227 switch (cipher) { 228 case 0: 229 /* our own hack to use value 0 as no crypto used */ 230 *ar_cipher = NONE_CRYPT; 231 *ar_cipher_len = 0; 232 break; 233 case WLAN_CIPHER_SUITE_WEP40: 234 *ar_cipher = WEP_CRYPT; 235 *ar_cipher_len = 5; 236 break; 237 case WLAN_CIPHER_SUITE_WEP104: 238 *ar_cipher = WEP_CRYPT; 239 *ar_cipher_len = 13; 240 break; 241 case WLAN_CIPHER_SUITE_TKIP: 242 *ar_cipher = TKIP_CRYPT; 243 *ar_cipher_len = 0; 244 break; 245 case WLAN_CIPHER_SUITE_CCMP: 246 *ar_cipher = AES_CRYPT; 247 *ar_cipher_len = 0; 248 break; 249 case WLAN_CIPHER_SUITE_SMS4: 250 *ar_cipher = WAPI_CRYPT; 251 *ar_cipher_len = 0; 252 break; 253 default: 254 ath6kl_err("cipher 0x%x not supported\n", cipher); 255 return -ENOTSUPP; 256 } 257 258 return 0; 259 } 260 261 static void ath6kl_set_key_mgmt(struct ath6kl_vif *vif, u32 key_mgmt) 262 { 263 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: 0x%x\n", __func__, key_mgmt); 264 265 if (key_mgmt == WLAN_AKM_SUITE_PSK) { 266 if (vif->auth_mode == WPA_AUTH) 267 vif->auth_mode = WPA_PSK_AUTH; 268 else if (vif->auth_mode == WPA2_AUTH) 269 vif->auth_mode = WPA2_PSK_AUTH; 270 } else if (key_mgmt == 0x00409600) { 271 if (vif->auth_mode == WPA_AUTH) 272 vif->auth_mode = WPA_AUTH_CCKM; 273 else if (vif->auth_mode == WPA2_AUTH) 274 vif->auth_mode = WPA2_AUTH_CCKM; 275 } else if (key_mgmt != WLAN_AKM_SUITE_8021X) { 276 vif->auth_mode = NONE_AUTH; 277 } 278 } 279 280 static bool ath6kl_cfg80211_ready(struct ath6kl_vif *vif) 281 { 282 struct ath6kl *ar = vif->ar; 283 284 if (!test_bit(WMI_READY, &ar->flag)) { 285 ath6kl_err("wmi is not ready\n"); 286 return false; 287 } 288 289 if (!test_bit(WLAN_ENABLED, &vif->flags)) { 290 ath6kl_err("wlan disabled\n"); 291 return false; 292 } 293 294 return true; 295 } 296 297 static bool ath6kl_is_wpa_ie(const u8 *pos) 298 { 299 return pos[0] == WLAN_EID_WPA && pos[1] >= 4 && 300 pos[2] == 0x00 && pos[3] == 0x50 && 301 pos[4] == 0xf2 && pos[5] == 0x01; 302 } 303 304 static bool ath6kl_is_rsn_ie(const u8 *pos) 305 { 306 return pos[0] == WLAN_EID_RSN; 307 } 308 309 static bool ath6kl_is_wps_ie(const u8 *pos) 310 { 311 return (pos[0] == WLAN_EID_VENDOR_SPECIFIC && 312 pos[1] >= 4 && 313 pos[2] == 0x00 && pos[3] == 0x50 && pos[4] == 0xf2 && 314 pos[5] == 0x04); 315 } 316 317 static int ath6kl_set_assoc_req_ies(struct ath6kl_vif *vif, const u8 *ies, 318 size_t ies_len) 319 { 320 struct ath6kl *ar = vif->ar; 321 const u8 *pos; 322 u8 *buf = NULL; 323 size_t len = 0; 324 int ret; 325 326 /* 327 * Clear previously set flag 328 */ 329 330 ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 331 332 /* 333 * Filter out RSN/WPA IE(s) 334 */ 335 336 if (ies && ies_len) { 337 buf = kmalloc(ies_len, GFP_KERNEL); 338 if (buf == NULL) 339 return -ENOMEM; 340 pos = ies; 341 342 while (pos + 1 < ies + ies_len) { 343 if (pos + 2 + pos[1] > ies + ies_len) 344 break; 345 if (!(ath6kl_is_wpa_ie(pos) || ath6kl_is_rsn_ie(pos))) { 346 memcpy(buf + len, pos, 2 + pos[1]); 347 len += 2 + pos[1]; 348 } 349 350 if (ath6kl_is_wps_ie(pos)) 351 ar->connect_ctrl_flags |= CONNECT_WPS_FLAG; 352 353 pos += 2 + pos[1]; 354 } 355 } 356 357 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 358 WMI_FRAME_ASSOC_REQ, buf, len); 359 kfree(buf); 360 return ret; 361 } 362 363 static int ath6kl_nliftype_to_drv_iftype(enum nl80211_iftype type, u8 *nw_type) 364 { 365 switch (type) { 366 case NL80211_IFTYPE_STATION: 367 *nw_type = INFRA_NETWORK; 368 break; 369 case NL80211_IFTYPE_ADHOC: 370 *nw_type = ADHOC_NETWORK; 371 break; 372 case NL80211_IFTYPE_AP: 373 *nw_type = AP_NETWORK; 374 break; 375 case NL80211_IFTYPE_P2P_CLIENT: 376 *nw_type = INFRA_NETWORK; 377 break; 378 case NL80211_IFTYPE_P2P_GO: 379 *nw_type = AP_NETWORK; 380 break; 381 default: 382 ath6kl_err("invalid interface type %u\n", type); 383 return -ENOTSUPP; 384 } 385 386 return 0; 387 } 388 389 static bool ath6kl_is_valid_iftype(struct ath6kl *ar, enum nl80211_iftype type, 390 u8 *if_idx, u8 *nw_type) 391 { 392 int i; 393 394 if (ath6kl_nliftype_to_drv_iftype(type, nw_type)) 395 return false; 396 397 if (ar->ibss_if_active || ((type == NL80211_IFTYPE_ADHOC) && 398 ar->num_vif)) 399 return false; 400 401 if (type == NL80211_IFTYPE_STATION || 402 type == NL80211_IFTYPE_AP || type == NL80211_IFTYPE_ADHOC) { 403 for (i = 0; i < ar->vif_max; i++) { 404 if ((ar->avail_idx_map >> i) & BIT(0)) { 405 *if_idx = i; 406 return true; 407 } 408 } 409 } 410 411 if (type == NL80211_IFTYPE_P2P_CLIENT || 412 type == NL80211_IFTYPE_P2P_GO) { 413 for (i = ar->max_norm_iface; i < ar->vif_max; i++) { 414 if ((ar->avail_idx_map >> i) & BIT(0)) { 415 *if_idx = i; 416 return true; 417 } 418 } 419 } 420 421 return false; 422 } 423 424 static bool ath6kl_is_tx_pending(struct ath6kl *ar) 425 { 426 return ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)] == 0; 427 } 428 429 430 static int ath6kl_cfg80211_connect(struct wiphy *wiphy, struct net_device *dev, 431 struct cfg80211_connect_params *sme) 432 { 433 struct ath6kl *ar = ath6kl_priv(dev); 434 struct ath6kl_vif *vif = netdev_priv(dev); 435 int status; 436 u8 nw_subtype = (ar->p2p) ? SUBTYPE_P2PDEV : SUBTYPE_NONE; 437 u16 interval; 438 439 ath6kl_cfg80211_sscan_disable(vif); 440 441 vif->sme_state = SME_CONNECTING; 442 443 if (!ath6kl_cfg80211_ready(vif)) 444 return -EIO; 445 446 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 447 ath6kl_err("destroy in progress\n"); 448 return -EBUSY; 449 } 450 451 if (test_bit(SKIP_SCAN, &ar->flag) && 452 ((sme->channel && sme->channel->center_freq == 0) || 453 (sme->bssid && is_zero_ether_addr(sme->bssid)))) { 454 ath6kl_err("SkipScan: channel or bssid invalid\n"); 455 return -EINVAL; 456 } 457 458 if (down_interruptible(&ar->sem)) { 459 ath6kl_err("busy, couldn't get access\n"); 460 return -ERESTARTSYS; 461 } 462 463 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 464 ath6kl_err("busy, destroy in progress\n"); 465 up(&ar->sem); 466 return -EBUSY; 467 } 468 469 if (ar->tx_pending[ath6kl_wmi_get_control_ep(ar->wmi)]) { 470 /* 471 * sleep until the command queue drains 472 */ 473 wait_event_interruptible_timeout(ar->event_wq, 474 ath6kl_is_tx_pending(ar), 475 WMI_TIMEOUT); 476 if (signal_pending(current)) { 477 ath6kl_err("cmd queue drain timeout\n"); 478 up(&ar->sem); 479 return -EINTR; 480 } 481 } 482 483 status = ath6kl_set_assoc_req_ies(vif, sme->ie, sme->ie_len); 484 if (status) { 485 up(&ar->sem); 486 return status; 487 } 488 489 if (sme->ie == NULL || sme->ie_len == 0) 490 ar->connect_ctrl_flags &= ~CONNECT_WPS_FLAG; 491 492 if (test_bit(CONNECTED, &vif->flags) && 493 vif->ssid_len == sme->ssid_len && 494 !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 495 vif->reconnect_flag = true; 496 status = ath6kl_wmi_reconnect_cmd(ar->wmi, vif->fw_vif_idx, 497 vif->req_bssid, 498 vif->ch_hint); 499 500 up(&ar->sem); 501 if (status) { 502 ath6kl_err("wmi_reconnect_cmd failed\n"); 503 return -EIO; 504 } 505 return 0; 506 } else if (vif->ssid_len == sme->ssid_len && 507 !memcmp(vif->ssid, sme->ssid, vif->ssid_len)) { 508 ath6kl_disconnect(vif); 509 } 510 511 memset(vif->ssid, 0, sizeof(vif->ssid)); 512 vif->ssid_len = sme->ssid_len; 513 memcpy(vif->ssid, sme->ssid, sme->ssid_len); 514 515 if (sme->channel) 516 vif->ch_hint = sme->channel->center_freq; 517 518 memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 519 if (sme->bssid && !is_broadcast_ether_addr(sme->bssid)) 520 memcpy(vif->req_bssid, sme->bssid, sizeof(vif->req_bssid)); 521 522 ath6kl_set_wpa_version(vif, sme->crypto.wpa_versions); 523 524 status = ath6kl_set_auth_type(vif, sme->auth_type); 525 if (status) { 526 up(&ar->sem); 527 return status; 528 } 529 530 if (sme->crypto.n_ciphers_pairwise) 531 ath6kl_set_cipher(vif, sme->crypto.ciphers_pairwise[0], true); 532 else 533 ath6kl_set_cipher(vif, 0, true); 534 535 ath6kl_set_cipher(vif, sme->crypto.cipher_group, false); 536 537 if (sme->crypto.n_akm_suites) 538 ath6kl_set_key_mgmt(vif, sme->crypto.akm_suites[0]); 539 540 if ((sme->key_len) && 541 (vif->auth_mode == NONE_AUTH) && 542 (vif->prwise_crypto == WEP_CRYPT)) { 543 struct ath6kl_key *key = NULL; 544 545 if (sme->key_idx > WMI_MAX_KEY_INDEX) { 546 ath6kl_err("key index %d out of bounds\n", 547 sme->key_idx); 548 up(&ar->sem); 549 return -ENOENT; 550 } 551 552 key = &vif->keys[sme->key_idx]; 553 key->key_len = sme->key_len; 554 memcpy(key->key, sme->key, key->key_len); 555 key->cipher = vif->prwise_crypto; 556 vif->def_txkey_index = sme->key_idx; 557 558 ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, sme->key_idx, 559 vif->prwise_crypto, 560 GROUP_USAGE | TX_USAGE, 561 key->key_len, 562 NULL, 0, 563 key->key, KEY_OP_INIT_VAL, NULL, 564 NO_SYNC_WMIFLAG); 565 } 566 567 if (!ar->usr_bss_filter) { 568 clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 569 if (ath6kl_wmi_bssfilter_cmd(ar->wmi, vif->fw_vif_idx, 570 ALL_BSS_FILTER, 0) != 0) { 571 ath6kl_err("couldn't set bss filtering\n"); 572 up(&ar->sem); 573 return -EIO; 574 } 575 } 576 577 vif->nw_type = vif->next_mode; 578 579 if (vif->wdev.iftype == NL80211_IFTYPE_P2P_CLIENT) 580 nw_subtype = SUBTYPE_P2PCLIENT; 581 582 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 583 "%s: connect called with authmode %d dot11 auth %d" 584 " PW crypto %d PW crypto len %d GRP crypto %d" 585 " GRP crypto len %d channel hint %u\n", 586 __func__, 587 vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 588 vif->prwise_crypto_len, vif->grp_crypto, 589 vif->grp_crypto_len, vif->ch_hint); 590 591 vif->reconnect_flag = 0; 592 593 if (vif->nw_type == INFRA_NETWORK) { 594 interval = max_t(u16, vif->listen_intvl_t, 595 ATH6KL_MAX_WOW_LISTEN_INTL); 596 status = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 597 interval, 598 0); 599 if (status) { 600 ath6kl_err("couldn't set listen intervel\n"); 601 up(&ar->sem); 602 return status; 603 } 604 } 605 606 status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 607 vif->dot11_auth_mode, vif->auth_mode, 608 vif->prwise_crypto, 609 vif->prwise_crypto_len, 610 vif->grp_crypto, vif->grp_crypto_len, 611 vif->ssid_len, vif->ssid, 612 vif->req_bssid, vif->ch_hint, 613 ar->connect_ctrl_flags, nw_subtype); 614 615 /* disable background scan if period is 0 */ 616 if (sme->bg_scan_period == 0) 617 sme->bg_scan_period = 0xffff; 618 619 /* configure default value if not specified */ 620 if (sme->bg_scan_period == -1) 621 sme->bg_scan_period = DEFAULT_BG_SCAN_PERIOD; 622 623 ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 0, 0, 624 sme->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 625 626 up(&ar->sem); 627 628 if (status == -EINVAL) { 629 memset(vif->ssid, 0, sizeof(vif->ssid)); 630 vif->ssid_len = 0; 631 ath6kl_err("invalid request\n"); 632 return -ENOENT; 633 } else if (status) { 634 ath6kl_err("ath6kl_wmi_connect_cmd failed\n"); 635 return -EIO; 636 } 637 638 if ((!(ar->connect_ctrl_flags & CONNECT_DO_WPA_OFFLOAD)) && 639 ((vif->auth_mode == WPA_PSK_AUTH) || 640 (vif->auth_mode == WPA2_PSK_AUTH))) { 641 mod_timer(&vif->disconnect_timer, 642 jiffies + msecs_to_jiffies(DISCON_TIMER_INTVAL)); 643 } 644 645 ar->connect_ctrl_flags &= ~CONNECT_DO_WPA_OFFLOAD; 646 set_bit(CONNECT_PEND, &vif->flags); 647 648 return 0; 649 } 650 651 static struct cfg80211_bss * 652 ath6kl_add_bss_if_needed(struct ath6kl_vif *vif, 653 enum network_type nw_type, 654 const u8 *bssid, 655 struct ieee80211_channel *chan, 656 const u8 *beacon_ie, 657 size_t beacon_ie_len) 658 { 659 struct ath6kl *ar = vif->ar; 660 struct cfg80211_bss *bss; 661 u16 cap_mask, cap_val; 662 u8 *ie; 663 664 if (nw_type & ADHOC_NETWORK) { 665 cap_mask = WLAN_CAPABILITY_IBSS; 666 cap_val = WLAN_CAPABILITY_IBSS; 667 } else { 668 cap_mask = WLAN_CAPABILITY_ESS; 669 cap_val = WLAN_CAPABILITY_ESS; 670 } 671 672 bss = cfg80211_get_bss(ar->wiphy, chan, bssid, 673 vif->ssid, vif->ssid_len, 674 cap_mask, cap_val); 675 if (bss == NULL) { 676 /* 677 * Since cfg80211 may not yet know about the BSS, 678 * generate a partial entry until the first BSS info 679 * event becomes available. 680 * 681 * Prepend SSID element since it is not included in the Beacon 682 * IEs from the target. 683 */ 684 ie = kmalloc(2 + vif->ssid_len + beacon_ie_len, GFP_KERNEL); 685 if (ie == NULL) 686 return NULL; 687 ie[0] = WLAN_EID_SSID; 688 ie[1] = vif->ssid_len; 689 memcpy(ie + 2, vif->ssid, vif->ssid_len); 690 memcpy(ie + 2 + vif->ssid_len, beacon_ie, beacon_ie_len); 691 bss = cfg80211_inform_bss(ar->wiphy, chan, 692 bssid, 0, cap_val, 100, 693 ie, 2 + vif->ssid_len + beacon_ie_len, 694 0, GFP_KERNEL); 695 if (bss) 696 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 697 "added bss %pM to cfg80211\n", bssid); 698 kfree(ie); 699 } else 700 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "cfg80211 already has a bss\n"); 701 702 return bss; 703 } 704 705 void ath6kl_cfg80211_connect_event(struct ath6kl_vif *vif, u16 channel, 706 u8 *bssid, u16 listen_intvl, 707 u16 beacon_intvl, 708 enum network_type nw_type, 709 u8 beacon_ie_len, u8 assoc_req_len, 710 u8 assoc_resp_len, u8 *assoc_info) 711 { 712 struct ieee80211_channel *chan; 713 struct ath6kl *ar = vif->ar; 714 struct cfg80211_bss *bss; 715 716 /* capinfo + listen interval */ 717 u8 assoc_req_ie_offset = sizeof(u16) + sizeof(u16); 718 719 /* capinfo + status code + associd */ 720 u8 assoc_resp_ie_offset = sizeof(u16) + sizeof(u16) + sizeof(u16); 721 722 u8 *assoc_req_ie = assoc_info + beacon_ie_len + assoc_req_ie_offset; 723 u8 *assoc_resp_ie = assoc_info + beacon_ie_len + assoc_req_len + 724 assoc_resp_ie_offset; 725 726 assoc_req_len -= assoc_req_ie_offset; 727 assoc_resp_len -= assoc_resp_ie_offset; 728 729 /* 730 * Store Beacon interval here; DTIM period will be available only once 731 * a Beacon frame from the AP is seen. 732 */ 733 vif->assoc_bss_beacon_int = beacon_intvl; 734 clear_bit(DTIM_PERIOD_AVAIL, &vif->flags); 735 736 if (nw_type & ADHOC_NETWORK) { 737 if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 738 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 739 "%s: ath6k not in ibss mode\n", __func__); 740 return; 741 } 742 } 743 744 if (nw_type & INFRA_NETWORK) { 745 if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 746 vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 747 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 748 "%s: ath6k not in station mode\n", __func__); 749 return; 750 } 751 } 752 753 chan = ieee80211_get_channel(ar->wiphy, (int) channel); 754 755 bss = ath6kl_add_bss_if_needed(vif, nw_type, bssid, chan, 756 assoc_info, beacon_ie_len); 757 if (!bss) { 758 ath6kl_err("could not add cfg80211 bss entry\n"); 759 return; 760 } 761 762 if (nw_type & ADHOC_NETWORK) { 763 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "ad-hoc %s selected\n", 764 nw_type & ADHOC_CREATOR ? "creator" : "joiner"); 765 cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 766 cfg80211_put_bss(bss); 767 return; 768 } 769 770 if (vif->sme_state == SME_CONNECTING) { 771 /* inform connect result to cfg80211 */ 772 vif->sme_state = SME_CONNECTED; 773 cfg80211_connect_result(vif->ndev, bssid, 774 assoc_req_ie, assoc_req_len, 775 assoc_resp_ie, assoc_resp_len, 776 WLAN_STATUS_SUCCESS, GFP_KERNEL); 777 cfg80211_put_bss(bss); 778 } else if (vif->sme_state == SME_CONNECTED) { 779 /* inform roam event to cfg80211 */ 780 cfg80211_roamed_bss(vif->ndev, bss, assoc_req_ie, assoc_req_len, 781 assoc_resp_ie, assoc_resp_len, GFP_KERNEL); 782 } 783 } 784 785 static int ath6kl_cfg80211_disconnect(struct wiphy *wiphy, 786 struct net_device *dev, u16 reason_code) 787 { 788 struct ath6kl *ar = ath6kl_priv(dev); 789 struct ath6kl_vif *vif = netdev_priv(dev); 790 791 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: reason=%u\n", __func__, 792 reason_code); 793 794 ath6kl_cfg80211_sscan_disable(vif); 795 796 if (!ath6kl_cfg80211_ready(vif)) 797 return -EIO; 798 799 if (test_bit(DESTROY_IN_PROGRESS, &ar->flag)) { 800 ath6kl_err("busy, destroy in progress\n"); 801 return -EBUSY; 802 } 803 804 if (down_interruptible(&ar->sem)) { 805 ath6kl_err("busy, couldn't get access\n"); 806 return -ERESTARTSYS; 807 } 808 809 vif->reconnect_flag = 0; 810 ath6kl_disconnect(vif); 811 memset(vif->ssid, 0, sizeof(vif->ssid)); 812 vif->ssid_len = 0; 813 814 if (!test_bit(SKIP_SCAN, &ar->flag)) 815 memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 816 817 up(&ar->sem); 818 819 vif->sme_state = SME_DISCONNECTED; 820 821 return 0; 822 } 823 824 void ath6kl_cfg80211_disconnect_event(struct ath6kl_vif *vif, u8 reason, 825 u8 *bssid, u8 assoc_resp_len, 826 u8 *assoc_info, u16 proto_reason) 827 { 828 struct ath6kl *ar = vif->ar; 829 830 if (vif->scan_req) { 831 cfg80211_scan_done(vif->scan_req, true); 832 vif->scan_req = NULL; 833 } 834 835 if (vif->nw_type & ADHOC_NETWORK) { 836 if (vif->wdev.iftype != NL80211_IFTYPE_ADHOC) { 837 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 838 "%s: ath6k not in ibss mode\n", __func__); 839 return; 840 } 841 memset(bssid, 0, ETH_ALEN); 842 cfg80211_ibss_joined(vif->ndev, bssid, GFP_KERNEL); 843 return; 844 } 845 846 if (vif->nw_type & INFRA_NETWORK) { 847 if (vif->wdev.iftype != NL80211_IFTYPE_STATION && 848 vif->wdev.iftype != NL80211_IFTYPE_P2P_CLIENT) { 849 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 850 "%s: ath6k not in station mode\n", __func__); 851 return; 852 } 853 } 854 855 /* 856 * Send a disconnect command to target when a disconnect event is 857 * received with reason code other than 3 (DISCONNECT_CMD - disconnect 858 * request from host) to make the firmware stop trying to connect even 859 * after giving disconnect event. There will be one more disconnect 860 * event for this disconnect command with reason code DISCONNECT_CMD 861 * which will be notified to cfg80211. 862 */ 863 864 if (reason != DISCONNECT_CMD) { 865 ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 866 return; 867 } 868 869 clear_bit(CONNECT_PEND, &vif->flags); 870 871 if (vif->sme_state == SME_CONNECTING) { 872 cfg80211_connect_result(vif->ndev, 873 bssid, NULL, 0, 874 NULL, 0, 875 WLAN_STATUS_UNSPECIFIED_FAILURE, 876 GFP_KERNEL); 877 } else if (vif->sme_state == SME_CONNECTED) { 878 cfg80211_disconnected(vif->ndev, reason, 879 NULL, 0, GFP_KERNEL); 880 } 881 882 vif->sme_state = SME_DISCONNECTED; 883 } 884 885 static int ath6kl_set_probed_ssids(struct ath6kl *ar, 886 struct ath6kl_vif *vif, 887 struct cfg80211_ssid *ssids, int n_ssids) 888 { 889 u8 i; 890 891 if (n_ssids > MAX_PROBED_SSID_INDEX) 892 return -EINVAL; 893 894 for (i = 0; i < n_ssids; i++) { 895 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 896 ssids[i].ssid_len ? 897 SPECIFIC_SSID_FLAG : ANY_SSID_FLAG, 898 ssids[i].ssid_len, 899 ssids[i].ssid); 900 } 901 902 /* Make sure no old entries are left behind */ 903 for (i = n_ssids; i < MAX_PROBED_SSID_INDEX; i++) { 904 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, i, 905 DISABLE_SSID_FLAG, 0, NULL); 906 } 907 908 return 0; 909 } 910 911 static int ath6kl_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev, 912 struct cfg80211_scan_request *request) 913 { 914 struct ath6kl *ar = ath6kl_priv(ndev); 915 struct ath6kl_vif *vif = netdev_priv(ndev); 916 s8 n_channels = 0; 917 u16 *channels = NULL; 918 int ret = 0; 919 u32 force_fg_scan = 0; 920 921 if (!ath6kl_cfg80211_ready(vif)) 922 return -EIO; 923 924 ath6kl_cfg80211_sscan_disable(vif); 925 926 if (!ar->usr_bss_filter) { 927 clear_bit(CLEAR_BSSFILTER_ON_BEACON, &vif->flags); 928 ret = ath6kl_wmi_bssfilter_cmd( 929 ar->wmi, vif->fw_vif_idx, 930 (test_bit(CONNECTED, &vif->flags) ? 931 ALL_BUT_BSS_FILTER : ALL_BSS_FILTER), 0); 932 if (ret) { 933 ath6kl_err("couldn't set bss filtering\n"); 934 return ret; 935 } 936 } 937 938 ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 939 request->n_ssids); 940 if (ret < 0) 941 return ret; 942 943 /* this also clears IE in fw if it's not set */ 944 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 945 WMI_FRAME_PROBE_REQ, 946 request->ie, request->ie_len); 947 if (ret) { 948 ath6kl_err("failed to set Probe Request appie for scan"); 949 return ret; 950 } 951 952 /* 953 * Scan only the requested channels if the request specifies a set of 954 * channels. If the list is longer than the target supports, do not 955 * configure the list and instead, scan all available channels. 956 */ 957 if (request->n_channels > 0 && 958 request->n_channels <= WMI_MAX_CHANNELS) { 959 u8 i; 960 961 n_channels = request->n_channels; 962 963 channels = kzalloc(n_channels * sizeof(u16), GFP_KERNEL); 964 if (channels == NULL) { 965 ath6kl_warn("failed to set scan channels, scan all channels"); 966 n_channels = 0; 967 } 968 969 for (i = 0; i < n_channels; i++) 970 channels[i] = request->channels[i]->center_freq; 971 } 972 973 if (test_bit(CONNECTED, &vif->flags)) 974 force_fg_scan = 1; 975 976 vif->scan_req = request; 977 978 if (test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 979 ar->fw_capabilities)) { 980 /* 981 * If capable of doing P2P mgmt operations using 982 * station interface, send additional information like 983 * supported rates to advertise and xmit rates for 984 * probe requests 985 */ 986 ret = ath6kl_wmi_beginscan_cmd(ar->wmi, vif->fw_vif_idx, 987 WMI_LONG_SCAN, force_fg_scan, 988 false, 0, 989 ATH6KL_FG_SCAN_INTERVAL, 990 n_channels, channels, 991 request->no_cck, 992 request->rates); 993 } else { 994 ret = ath6kl_wmi_startscan_cmd(ar->wmi, vif->fw_vif_idx, 995 WMI_LONG_SCAN, force_fg_scan, 996 false, 0, 997 ATH6KL_FG_SCAN_INTERVAL, 998 n_channels, channels); 999 } 1000 if (ret) { 1001 ath6kl_err("wmi_startscan_cmd failed\n"); 1002 vif->scan_req = NULL; 1003 } 1004 1005 kfree(channels); 1006 1007 return ret; 1008 } 1009 1010 void ath6kl_cfg80211_scan_complete_event(struct ath6kl_vif *vif, bool aborted) 1011 { 1012 struct ath6kl *ar = vif->ar; 1013 int i; 1014 1015 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: status%s\n", __func__, 1016 aborted ? " aborted" : ""); 1017 1018 if (!vif->scan_req) 1019 return; 1020 1021 if (aborted) 1022 goto out; 1023 1024 if (vif->scan_req->n_ssids && vif->scan_req->ssids[0].ssid_len) { 1025 for (i = 0; i < vif->scan_req->n_ssids; i++) { 1026 ath6kl_wmi_probedssid_cmd(ar->wmi, vif->fw_vif_idx, 1027 i + 1, DISABLE_SSID_FLAG, 1028 0, NULL); 1029 } 1030 } 1031 1032 out: 1033 cfg80211_scan_done(vif->scan_req, aborted); 1034 vif->scan_req = NULL; 1035 } 1036 1037 void ath6kl_cfg80211_ch_switch_notify(struct ath6kl_vif *vif, int freq, 1038 enum wmi_phy_mode mode) 1039 { 1040 enum nl80211_channel_type type; 1041 1042 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1043 "channel switch notify nw_type %d freq %d mode %d\n", 1044 vif->nw_type, freq, mode); 1045 1046 type = (mode == WMI_11G_HT20) ? NL80211_CHAN_HT20 : NL80211_CHAN_NO_HT; 1047 1048 cfg80211_ch_switch_notify(vif->ndev, freq, type); 1049 } 1050 1051 static int ath6kl_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev, 1052 u8 key_index, bool pairwise, 1053 const u8 *mac_addr, 1054 struct key_params *params) 1055 { 1056 struct ath6kl *ar = ath6kl_priv(ndev); 1057 struct ath6kl_vif *vif = netdev_priv(ndev); 1058 struct ath6kl_key *key = NULL; 1059 int seq_len; 1060 u8 key_usage; 1061 u8 key_type; 1062 1063 if (!ath6kl_cfg80211_ready(vif)) 1064 return -EIO; 1065 1066 if (params->cipher == CCKM_KRK_CIPHER_SUITE) { 1067 if (params->key_len != WMI_KRK_LEN) 1068 return -EINVAL; 1069 return ath6kl_wmi_add_krk_cmd(ar->wmi, vif->fw_vif_idx, 1070 params->key); 1071 } 1072 1073 if (key_index > WMI_MAX_KEY_INDEX) { 1074 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1075 "%s: key index %d out of bounds\n", __func__, 1076 key_index); 1077 return -ENOENT; 1078 } 1079 1080 key = &vif->keys[key_index]; 1081 memset(key, 0, sizeof(struct ath6kl_key)); 1082 1083 if (pairwise) 1084 key_usage = PAIRWISE_USAGE; 1085 else 1086 key_usage = GROUP_USAGE; 1087 1088 seq_len = params->seq_len; 1089 if (params->cipher == WLAN_CIPHER_SUITE_SMS4 && 1090 seq_len > ATH6KL_KEY_SEQ_LEN) { 1091 /* Only first half of the WPI PN is configured */ 1092 seq_len = ATH6KL_KEY_SEQ_LEN; 1093 } 1094 if (params->key_len > WLAN_MAX_KEY_LEN || 1095 seq_len > sizeof(key->seq)) 1096 return -EINVAL; 1097 1098 key->key_len = params->key_len; 1099 memcpy(key->key, params->key, key->key_len); 1100 key->seq_len = seq_len; 1101 memcpy(key->seq, params->seq, key->seq_len); 1102 key->cipher = params->cipher; 1103 1104 switch (key->cipher) { 1105 case WLAN_CIPHER_SUITE_WEP40: 1106 case WLAN_CIPHER_SUITE_WEP104: 1107 key_type = WEP_CRYPT; 1108 break; 1109 1110 case WLAN_CIPHER_SUITE_TKIP: 1111 key_type = TKIP_CRYPT; 1112 break; 1113 1114 case WLAN_CIPHER_SUITE_CCMP: 1115 key_type = AES_CRYPT; 1116 break; 1117 case WLAN_CIPHER_SUITE_SMS4: 1118 key_type = WAPI_CRYPT; 1119 break; 1120 1121 default: 1122 return -ENOTSUPP; 1123 } 1124 1125 if (((vif->auth_mode == WPA_PSK_AUTH) || 1126 (vif->auth_mode == WPA2_PSK_AUTH)) && 1127 (key_usage & GROUP_USAGE)) 1128 del_timer(&vif->disconnect_timer); 1129 1130 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1131 "%s: index %d, key_len %d, key_type 0x%x, key_usage 0x%x, seq_len %d\n", 1132 __func__, key_index, key->key_len, key_type, 1133 key_usage, key->seq_len); 1134 1135 if (vif->nw_type == AP_NETWORK && !pairwise && 1136 (key_type == TKIP_CRYPT || key_type == AES_CRYPT || 1137 key_type == WAPI_CRYPT)) { 1138 ar->ap_mode_bkey.valid = true; 1139 ar->ap_mode_bkey.key_index = key_index; 1140 ar->ap_mode_bkey.key_type = key_type; 1141 ar->ap_mode_bkey.key_len = key->key_len; 1142 memcpy(ar->ap_mode_bkey.key, key->key, key->key_len); 1143 if (!test_bit(CONNECTED, &vif->flags)) { 1144 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1145 "Delay initial group key configuration until AP mode has been started\n"); 1146 /* 1147 * The key will be set in ath6kl_connect_ap_mode() once 1148 * the connected event is received from the target. 1149 */ 1150 return 0; 1151 } 1152 } 1153 1154 if (vif->next_mode == AP_NETWORK && key_type == WEP_CRYPT && 1155 !test_bit(CONNECTED, &vif->flags)) { 1156 /* 1157 * Store the key locally so that it can be re-configured after 1158 * the AP mode has properly started 1159 * (ath6kl_install_statioc_wep_keys). 1160 */ 1161 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1162 "Delay WEP key configuration until AP mode has been started\n"); 1163 vif->wep_key_list[key_index].key_len = key->key_len; 1164 memcpy(vif->wep_key_list[key_index].key, key->key, 1165 key->key_len); 1166 return 0; 1167 } 1168 1169 return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, key_index, 1170 key_type, key_usage, key->key_len, 1171 key->seq, key->seq_len, key->key, 1172 KEY_OP_INIT_VAL, 1173 (u8 *) mac_addr, SYNC_BOTH_WMIFLAG); 1174 } 1175 1176 static int ath6kl_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev, 1177 u8 key_index, bool pairwise, 1178 const u8 *mac_addr) 1179 { 1180 struct ath6kl *ar = ath6kl_priv(ndev); 1181 struct ath6kl_vif *vif = netdev_priv(ndev); 1182 1183 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1184 1185 if (!ath6kl_cfg80211_ready(vif)) 1186 return -EIO; 1187 1188 if (key_index > WMI_MAX_KEY_INDEX) { 1189 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1190 "%s: key index %d out of bounds\n", __func__, 1191 key_index); 1192 return -ENOENT; 1193 } 1194 1195 if (!vif->keys[key_index].key_len) { 1196 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1197 "%s: index %d is empty\n", __func__, key_index); 1198 return 0; 1199 } 1200 1201 vif->keys[key_index].key_len = 0; 1202 1203 return ath6kl_wmi_deletekey_cmd(ar->wmi, vif->fw_vif_idx, key_index); 1204 } 1205 1206 static int ath6kl_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev, 1207 u8 key_index, bool pairwise, 1208 const u8 *mac_addr, void *cookie, 1209 void (*callback) (void *cookie, 1210 struct key_params *)) 1211 { 1212 struct ath6kl_vif *vif = netdev_priv(ndev); 1213 struct ath6kl_key *key = NULL; 1214 struct key_params params; 1215 1216 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1217 1218 if (!ath6kl_cfg80211_ready(vif)) 1219 return -EIO; 1220 1221 if (key_index > WMI_MAX_KEY_INDEX) { 1222 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1223 "%s: key index %d out of bounds\n", __func__, 1224 key_index); 1225 return -ENOENT; 1226 } 1227 1228 key = &vif->keys[key_index]; 1229 memset(¶ms, 0, sizeof(params)); 1230 params.cipher = key->cipher; 1231 params.key_len = key->key_len; 1232 params.seq_len = key->seq_len; 1233 params.seq = key->seq; 1234 params.key = key->key; 1235 1236 callback(cookie, ¶ms); 1237 1238 return key->key_len ? 0 : -ENOENT; 1239 } 1240 1241 static int ath6kl_cfg80211_set_default_key(struct wiphy *wiphy, 1242 struct net_device *ndev, 1243 u8 key_index, bool unicast, 1244 bool multicast) 1245 { 1246 struct ath6kl *ar = ath6kl_priv(ndev); 1247 struct ath6kl_vif *vif = netdev_priv(ndev); 1248 struct ath6kl_key *key = NULL; 1249 u8 key_usage; 1250 enum crypto_type key_type = NONE_CRYPT; 1251 1252 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: index %d\n", __func__, key_index); 1253 1254 if (!ath6kl_cfg80211_ready(vif)) 1255 return -EIO; 1256 1257 if (key_index > WMI_MAX_KEY_INDEX) { 1258 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1259 "%s: key index %d out of bounds\n", 1260 __func__, key_index); 1261 return -ENOENT; 1262 } 1263 1264 if (!vif->keys[key_index].key_len) { 1265 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: invalid key index %d\n", 1266 __func__, key_index); 1267 return -EINVAL; 1268 } 1269 1270 vif->def_txkey_index = key_index; 1271 key = &vif->keys[vif->def_txkey_index]; 1272 key_usage = GROUP_USAGE; 1273 if (vif->prwise_crypto == WEP_CRYPT) 1274 key_usage |= TX_USAGE; 1275 if (unicast) 1276 key_type = vif->prwise_crypto; 1277 if (multicast) 1278 key_type = vif->grp_crypto; 1279 1280 if (vif->next_mode == AP_NETWORK && !test_bit(CONNECTED, &vif->flags)) 1281 return 0; /* Delay until AP mode has been started */ 1282 1283 return ath6kl_wmi_addkey_cmd(ar->wmi, vif->fw_vif_idx, 1284 vif->def_txkey_index, 1285 key_type, key_usage, 1286 key->key_len, key->seq, key->seq_len, 1287 key->key, 1288 KEY_OP_INIT_VAL, NULL, 1289 SYNC_BOTH_WMIFLAG); 1290 } 1291 1292 void ath6kl_cfg80211_tkip_micerr_event(struct ath6kl_vif *vif, u8 keyid, 1293 bool ismcast) 1294 { 1295 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1296 "%s: keyid %d, ismcast %d\n", __func__, keyid, ismcast); 1297 1298 cfg80211_michael_mic_failure(vif->ndev, vif->bssid, 1299 (ismcast ? NL80211_KEYTYPE_GROUP : 1300 NL80211_KEYTYPE_PAIRWISE), keyid, NULL, 1301 GFP_KERNEL); 1302 } 1303 1304 static int ath6kl_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) 1305 { 1306 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1307 struct ath6kl_vif *vif; 1308 int ret; 1309 1310 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: changed 0x%x\n", __func__, 1311 changed); 1312 1313 vif = ath6kl_vif_first(ar); 1314 if (!vif) 1315 return -EIO; 1316 1317 if (!ath6kl_cfg80211_ready(vif)) 1318 return -EIO; 1319 1320 if (changed & WIPHY_PARAM_RTS_THRESHOLD) { 1321 ret = ath6kl_wmi_set_rts_cmd(ar->wmi, wiphy->rts_threshold); 1322 if (ret != 0) { 1323 ath6kl_err("ath6kl_wmi_set_rts_cmd failed\n"); 1324 return -EIO; 1325 } 1326 } 1327 1328 return 0; 1329 } 1330 1331 /* 1332 * The type nl80211_tx_power_setting replaces the following 1333 * data type from 2.6.36 onwards 1334 */ 1335 static int ath6kl_cfg80211_set_txpower(struct wiphy *wiphy, 1336 enum nl80211_tx_power_setting type, 1337 int mbm) 1338 { 1339 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1340 struct ath6kl_vif *vif; 1341 int dbm = MBM_TO_DBM(mbm); 1342 1343 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x, dbm %d\n", __func__, 1344 type, dbm); 1345 1346 vif = ath6kl_vif_first(ar); 1347 if (!vif) 1348 return -EIO; 1349 1350 if (!ath6kl_cfg80211_ready(vif)) 1351 return -EIO; 1352 1353 switch (type) { 1354 case NL80211_TX_POWER_AUTOMATIC: 1355 return 0; 1356 case NL80211_TX_POWER_LIMITED: 1357 ar->tx_pwr = dbm; 1358 break; 1359 default: 1360 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type 0x%x not supported\n", 1361 __func__, type); 1362 return -EOPNOTSUPP; 1363 } 1364 1365 ath6kl_wmi_set_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx, dbm); 1366 1367 return 0; 1368 } 1369 1370 static int ath6kl_cfg80211_get_txpower(struct wiphy *wiphy, int *dbm) 1371 { 1372 struct ath6kl *ar = (struct ath6kl *)wiphy_priv(wiphy); 1373 struct ath6kl_vif *vif; 1374 1375 vif = ath6kl_vif_first(ar); 1376 if (!vif) 1377 return -EIO; 1378 1379 if (!ath6kl_cfg80211_ready(vif)) 1380 return -EIO; 1381 1382 if (test_bit(CONNECTED, &vif->flags)) { 1383 ar->tx_pwr = 0; 1384 1385 if (ath6kl_wmi_get_tx_pwr_cmd(ar->wmi, vif->fw_vif_idx) != 0) { 1386 ath6kl_err("ath6kl_wmi_get_tx_pwr_cmd failed\n"); 1387 return -EIO; 1388 } 1389 1390 wait_event_interruptible_timeout(ar->event_wq, ar->tx_pwr != 0, 1391 5 * HZ); 1392 1393 if (signal_pending(current)) { 1394 ath6kl_err("target did not respond\n"); 1395 return -EINTR; 1396 } 1397 } 1398 1399 *dbm = ar->tx_pwr; 1400 return 0; 1401 } 1402 1403 static int ath6kl_cfg80211_set_power_mgmt(struct wiphy *wiphy, 1404 struct net_device *dev, 1405 bool pmgmt, int timeout) 1406 { 1407 struct ath6kl *ar = ath6kl_priv(dev); 1408 struct wmi_power_mode_cmd mode; 1409 struct ath6kl_vif *vif = netdev_priv(dev); 1410 1411 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: pmgmt %d, timeout %d\n", 1412 __func__, pmgmt, timeout); 1413 1414 if (!ath6kl_cfg80211_ready(vif)) 1415 return -EIO; 1416 1417 if (pmgmt) { 1418 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: max perf\n", __func__); 1419 mode.pwr_mode = REC_POWER; 1420 } else { 1421 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: rec power\n", __func__); 1422 mode.pwr_mode = MAX_PERF_POWER; 1423 } 1424 1425 if (ath6kl_wmi_powermode_cmd(ar->wmi, vif->fw_vif_idx, 1426 mode.pwr_mode) != 0) { 1427 ath6kl_err("wmi_powermode_cmd failed\n"); 1428 return -EIO; 1429 } 1430 1431 return 0; 1432 } 1433 1434 static struct net_device *ath6kl_cfg80211_add_iface(struct wiphy *wiphy, 1435 char *name, 1436 enum nl80211_iftype type, 1437 u32 *flags, 1438 struct vif_params *params) 1439 { 1440 struct ath6kl *ar = wiphy_priv(wiphy); 1441 struct net_device *ndev; 1442 u8 if_idx, nw_type; 1443 1444 if (ar->num_vif == ar->vif_max) { 1445 ath6kl_err("Reached maximum number of supported vif\n"); 1446 return ERR_PTR(-EINVAL); 1447 } 1448 1449 if (!ath6kl_is_valid_iftype(ar, type, &if_idx, &nw_type)) { 1450 ath6kl_err("Not a supported interface type\n"); 1451 return ERR_PTR(-EINVAL); 1452 } 1453 1454 ndev = ath6kl_interface_add(ar, name, type, if_idx, nw_type); 1455 if (!ndev) 1456 return ERR_PTR(-ENOMEM); 1457 1458 ar->num_vif++; 1459 1460 return ndev; 1461 } 1462 1463 static int ath6kl_cfg80211_del_iface(struct wiphy *wiphy, 1464 struct net_device *ndev) 1465 { 1466 struct ath6kl *ar = wiphy_priv(wiphy); 1467 struct ath6kl_vif *vif = netdev_priv(ndev); 1468 1469 spin_lock_bh(&ar->list_lock); 1470 list_del(&vif->list); 1471 spin_unlock_bh(&ar->list_lock); 1472 1473 ath6kl_cleanup_vif(vif, test_bit(WMI_READY, &ar->flag)); 1474 1475 ath6kl_cfg80211_vif_cleanup(vif); 1476 1477 return 0; 1478 } 1479 1480 static int ath6kl_cfg80211_change_iface(struct wiphy *wiphy, 1481 struct net_device *ndev, 1482 enum nl80211_iftype type, u32 *flags, 1483 struct vif_params *params) 1484 { 1485 struct ath6kl_vif *vif = netdev_priv(ndev); 1486 int i; 1487 1488 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: type %u\n", __func__, type); 1489 1490 /* 1491 * Don't bring up p2p on an interface which is not initialized 1492 * for p2p operation where fw does not have capability to switch 1493 * dynamically between non-p2p and p2p type interface. 1494 */ 1495 if (!test_bit(ATH6KL_FW_CAPABILITY_STA_P2PDEV_DUPLEX, 1496 vif->ar->fw_capabilities) && 1497 (type == NL80211_IFTYPE_P2P_CLIENT || 1498 type == NL80211_IFTYPE_P2P_GO)) { 1499 if (vif->ar->vif_max == 1) { 1500 if (vif->fw_vif_idx != 0) 1501 return -EINVAL; 1502 else 1503 goto set_iface_type; 1504 } 1505 1506 for (i = vif->ar->max_norm_iface; i < vif->ar->vif_max; i++) { 1507 if (i == vif->fw_vif_idx) 1508 break; 1509 } 1510 1511 if (i == vif->ar->vif_max) { 1512 ath6kl_err("Invalid interface to bring up P2P\n"); 1513 return -EINVAL; 1514 } 1515 } 1516 1517 set_iface_type: 1518 switch (type) { 1519 case NL80211_IFTYPE_STATION: 1520 vif->next_mode = INFRA_NETWORK; 1521 break; 1522 case NL80211_IFTYPE_ADHOC: 1523 vif->next_mode = ADHOC_NETWORK; 1524 break; 1525 case NL80211_IFTYPE_AP: 1526 vif->next_mode = AP_NETWORK; 1527 break; 1528 case NL80211_IFTYPE_P2P_CLIENT: 1529 vif->next_mode = INFRA_NETWORK; 1530 break; 1531 case NL80211_IFTYPE_P2P_GO: 1532 vif->next_mode = AP_NETWORK; 1533 break; 1534 default: 1535 ath6kl_err("invalid interface type %u\n", type); 1536 return -EOPNOTSUPP; 1537 } 1538 1539 vif->wdev.iftype = type; 1540 1541 return 0; 1542 } 1543 1544 static int ath6kl_cfg80211_join_ibss(struct wiphy *wiphy, 1545 struct net_device *dev, 1546 struct cfg80211_ibss_params *ibss_param) 1547 { 1548 struct ath6kl *ar = ath6kl_priv(dev); 1549 struct ath6kl_vif *vif = netdev_priv(dev); 1550 int status; 1551 1552 if (!ath6kl_cfg80211_ready(vif)) 1553 return -EIO; 1554 1555 vif->ssid_len = ibss_param->ssid_len; 1556 memcpy(vif->ssid, ibss_param->ssid, vif->ssid_len); 1557 1558 if (ibss_param->channel) 1559 vif->ch_hint = ibss_param->channel->center_freq; 1560 1561 if (ibss_param->channel_fixed) { 1562 /* 1563 * TODO: channel_fixed: The channel should be fixed, do not 1564 * search for IBSSs to join on other channels. Target 1565 * firmware does not support this feature, needs to be 1566 * updated. 1567 */ 1568 return -EOPNOTSUPP; 1569 } 1570 1571 memset(vif->req_bssid, 0, sizeof(vif->req_bssid)); 1572 if (ibss_param->bssid && !is_broadcast_ether_addr(ibss_param->bssid)) 1573 memcpy(vif->req_bssid, ibss_param->bssid, 1574 sizeof(vif->req_bssid)); 1575 1576 ath6kl_set_wpa_version(vif, 0); 1577 1578 status = ath6kl_set_auth_type(vif, NL80211_AUTHTYPE_OPEN_SYSTEM); 1579 if (status) 1580 return status; 1581 1582 if (ibss_param->privacy) { 1583 ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, true); 1584 ath6kl_set_cipher(vif, WLAN_CIPHER_SUITE_WEP40, false); 1585 } else { 1586 ath6kl_set_cipher(vif, 0, true); 1587 ath6kl_set_cipher(vif, 0, false); 1588 } 1589 1590 vif->nw_type = vif->next_mode; 1591 1592 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1593 "%s: connect called with authmode %d dot11 auth %d" 1594 " PW crypto %d PW crypto len %d GRP crypto %d" 1595 " GRP crypto len %d channel hint %u\n", 1596 __func__, 1597 vif->auth_mode, vif->dot11_auth_mode, vif->prwise_crypto, 1598 vif->prwise_crypto_len, vif->grp_crypto, 1599 vif->grp_crypto_len, vif->ch_hint); 1600 1601 status = ath6kl_wmi_connect_cmd(ar->wmi, vif->fw_vif_idx, vif->nw_type, 1602 vif->dot11_auth_mode, vif->auth_mode, 1603 vif->prwise_crypto, 1604 vif->prwise_crypto_len, 1605 vif->grp_crypto, vif->grp_crypto_len, 1606 vif->ssid_len, vif->ssid, 1607 vif->req_bssid, vif->ch_hint, 1608 ar->connect_ctrl_flags, SUBTYPE_NONE); 1609 set_bit(CONNECT_PEND, &vif->flags); 1610 1611 return 0; 1612 } 1613 1614 static int ath6kl_cfg80211_leave_ibss(struct wiphy *wiphy, 1615 struct net_device *dev) 1616 { 1617 struct ath6kl_vif *vif = netdev_priv(dev); 1618 1619 if (!ath6kl_cfg80211_ready(vif)) 1620 return -EIO; 1621 1622 ath6kl_disconnect(vif); 1623 memset(vif->ssid, 0, sizeof(vif->ssid)); 1624 vif->ssid_len = 0; 1625 1626 return 0; 1627 } 1628 1629 static const u32 cipher_suites[] = { 1630 WLAN_CIPHER_SUITE_WEP40, 1631 WLAN_CIPHER_SUITE_WEP104, 1632 WLAN_CIPHER_SUITE_TKIP, 1633 WLAN_CIPHER_SUITE_CCMP, 1634 CCKM_KRK_CIPHER_SUITE, 1635 WLAN_CIPHER_SUITE_SMS4, 1636 }; 1637 1638 static bool is_rate_legacy(s32 rate) 1639 { 1640 static const s32 legacy[] = { 1000, 2000, 5500, 11000, 1641 6000, 9000, 12000, 18000, 24000, 1642 36000, 48000, 54000 1643 }; 1644 u8 i; 1645 1646 for (i = 0; i < ARRAY_SIZE(legacy); i++) 1647 if (rate == legacy[i]) 1648 return true; 1649 1650 return false; 1651 } 1652 1653 static bool is_rate_ht20(s32 rate, u8 *mcs, bool *sgi) 1654 { 1655 static const s32 ht20[] = { 6500, 13000, 19500, 26000, 39000, 1656 52000, 58500, 65000, 72200 1657 }; 1658 u8 i; 1659 1660 for (i = 0; i < ARRAY_SIZE(ht20); i++) { 1661 if (rate == ht20[i]) { 1662 if (i == ARRAY_SIZE(ht20) - 1) 1663 /* last rate uses sgi */ 1664 *sgi = true; 1665 else 1666 *sgi = false; 1667 1668 *mcs = i; 1669 return true; 1670 } 1671 } 1672 return false; 1673 } 1674 1675 static bool is_rate_ht40(s32 rate, u8 *mcs, bool *sgi) 1676 { 1677 static const s32 ht40[] = { 13500, 27000, 40500, 54000, 1678 81000, 108000, 121500, 135000, 1679 150000 1680 }; 1681 u8 i; 1682 1683 for (i = 0; i < ARRAY_SIZE(ht40); i++) { 1684 if (rate == ht40[i]) { 1685 if (i == ARRAY_SIZE(ht40) - 1) 1686 /* last rate uses sgi */ 1687 *sgi = true; 1688 else 1689 *sgi = false; 1690 1691 *mcs = i; 1692 return true; 1693 } 1694 } 1695 1696 return false; 1697 } 1698 1699 static int ath6kl_get_station(struct wiphy *wiphy, struct net_device *dev, 1700 u8 *mac, struct station_info *sinfo) 1701 { 1702 struct ath6kl *ar = ath6kl_priv(dev); 1703 struct ath6kl_vif *vif = netdev_priv(dev); 1704 long left; 1705 bool sgi; 1706 s32 rate; 1707 int ret; 1708 u8 mcs; 1709 1710 if (memcmp(mac, vif->bssid, ETH_ALEN) != 0) 1711 return -ENOENT; 1712 1713 if (down_interruptible(&ar->sem)) 1714 return -EBUSY; 1715 1716 set_bit(STATS_UPDATE_PEND, &vif->flags); 1717 1718 ret = ath6kl_wmi_get_stats_cmd(ar->wmi, vif->fw_vif_idx); 1719 1720 if (ret != 0) { 1721 up(&ar->sem); 1722 return -EIO; 1723 } 1724 1725 left = wait_event_interruptible_timeout(ar->event_wq, 1726 !test_bit(STATS_UPDATE_PEND, 1727 &vif->flags), 1728 WMI_TIMEOUT); 1729 1730 up(&ar->sem); 1731 1732 if (left == 0) 1733 return -ETIMEDOUT; 1734 else if (left < 0) 1735 return left; 1736 1737 if (vif->target_stats.rx_byte) { 1738 sinfo->rx_bytes = vif->target_stats.rx_byte; 1739 sinfo->filled |= STATION_INFO_RX_BYTES; 1740 sinfo->rx_packets = vif->target_stats.rx_pkt; 1741 sinfo->filled |= STATION_INFO_RX_PACKETS; 1742 } 1743 1744 if (vif->target_stats.tx_byte) { 1745 sinfo->tx_bytes = vif->target_stats.tx_byte; 1746 sinfo->filled |= STATION_INFO_TX_BYTES; 1747 sinfo->tx_packets = vif->target_stats.tx_pkt; 1748 sinfo->filled |= STATION_INFO_TX_PACKETS; 1749 } 1750 1751 sinfo->signal = vif->target_stats.cs_rssi; 1752 sinfo->filled |= STATION_INFO_SIGNAL; 1753 1754 rate = vif->target_stats.tx_ucast_rate; 1755 1756 if (is_rate_legacy(rate)) { 1757 sinfo->txrate.legacy = rate / 100; 1758 } else if (is_rate_ht20(rate, &mcs, &sgi)) { 1759 if (sgi) { 1760 sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1761 sinfo->txrate.mcs = mcs - 1; 1762 } else { 1763 sinfo->txrate.mcs = mcs; 1764 } 1765 1766 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1767 } else if (is_rate_ht40(rate, &mcs, &sgi)) { 1768 if (sgi) { 1769 sinfo->txrate.flags |= RATE_INFO_FLAGS_SHORT_GI; 1770 sinfo->txrate.mcs = mcs - 1; 1771 } else { 1772 sinfo->txrate.mcs = mcs; 1773 } 1774 1775 sinfo->txrate.flags |= RATE_INFO_FLAGS_40_MHZ_WIDTH; 1776 sinfo->txrate.flags |= RATE_INFO_FLAGS_MCS; 1777 } else { 1778 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, 1779 "invalid rate from stats: %d\n", rate); 1780 ath6kl_debug_war(ar, ATH6KL_WAR_INVALID_RATE); 1781 return 0; 1782 } 1783 1784 sinfo->filled |= STATION_INFO_TX_BITRATE; 1785 1786 if (test_bit(CONNECTED, &vif->flags) && 1787 test_bit(DTIM_PERIOD_AVAIL, &vif->flags) && 1788 vif->nw_type == INFRA_NETWORK) { 1789 sinfo->filled |= STATION_INFO_BSS_PARAM; 1790 sinfo->bss_param.flags = 0; 1791 sinfo->bss_param.dtim_period = vif->assoc_bss_dtim_period; 1792 sinfo->bss_param.beacon_interval = vif->assoc_bss_beacon_int; 1793 } 1794 1795 return 0; 1796 } 1797 1798 static int ath6kl_set_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1799 struct cfg80211_pmksa *pmksa) 1800 { 1801 struct ath6kl *ar = ath6kl_priv(netdev); 1802 struct ath6kl_vif *vif = netdev_priv(netdev); 1803 1804 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1805 pmksa->pmkid, true); 1806 } 1807 1808 static int ath6kl_del_pmksa(struct wiphy *wiphy, struct net_device *netdev, 1809 struct cfg80211_pmksa *pmksa) 1810 { 1811 struct ath6kl *ar = ath6kl_priv(netdev); 1812 struct ath6kl_vif *vif = netdev_priv(netdev); 1813 1814 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, pmksa->bssid, 1815 pmksa->pmkid, false); 1816 } 1817 1818 static int ath6kl_flush_pmksa(struct wiphy *wiphy, struct net_device *netdev) 1819 { 1820 struct ath6kl *ar = ath6kl_priv(netdev); 1821 struct ath6kl_vif *vif = netdev_priv(netdev); 1822 1823 if (test_bit(CONNECTED, &vif->flags)) 1824 return ath6kl_wmi_setpmkid_cmd(ar->wmi, vif->fw_vif_idx, 1825 vif->bssid, NULL, false); 1826 return 0; 1827 } 1828 1829 static int ath6kl_wow_usr(struct ath6kl *ar, struct ath6kl_vif *vif, 1830 struct cfg80211_wowlan *wow, u32 *filter) 1831 { 1832 int ret, pos; 1833 u8 mask[WOW_MASK_SIZE]; 1834 u16 i; 1835 1836 /* Configure the patterns that we received from the user. */ 1837 for (i = 0; i < wow->n_patterns; i++) { 1838 1839 /* 1840 * Convert given nl80211 specific mask value to equivalent 1841 * driver specific mask value and send it to the chip along 1842 * with patterns. For example, If the mask value defined in 1843 * struct cfg80211_wowlan is 0xA (equivalent binary is 1010), 1844 * then equivalent driver specific mask value is 1845 * "0xFF 0x00 0xFF 0x00". 1846 */ 1847 memset(&mask, 0, sizeof(mask)); 1848 for (pos = 0; pos < wow->patterns[i].pattern_len; pos++) { 1849 if (wow->patterns[i].mask[pos / 8] & (0x1 << (pos % 8))) 1850 mask[pos] = 0xFF; 1851 } 1852 /* 1853 * Note: Pattern's offset is not passed as part of wowlan 1854 * parameter from CFG layer. So it's always passed as ZERO 1855 * to the firmware. It means, given WOW patterns are always 1856 * matched from the first byte of received pkt in the firmware. 1857 */ 1858 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1859 vif->fw_vif_idx, WOW_LIST_ID, 1860 wow->patterns[i].pattern_len, 1861 0 /* pattern offset */, 1862 wow->patterns[i].pattern, mask); 1863 if (ret) 1864 return ret; 1865 } 1866 1867 if (wow->disconnect) 1868 *filter |= WOW_FILTER_OPTION_NWK_DISASSOC; 1869 1870 if (wow->magic_pkt) 1871 *filter |= WOW_FILTER_OPTION_MAGIC_PACKET; 1872 1873 if (wow->gtk_rekey_failure) 1874 *filter |= WOW_FILTER_OPTION_GTK_ERROR; 1875 1876 if (wow->eap_identity_req) 1877 *filter |= WOW_FILTER_OPTION_EAP_REQ; 1878 1879 if (wow->four_way_handshake) 1880 *filter |= WOW_FILTER_OPTION_8021X_4WAYHS; 1881 1882 return 0; 1883 } 1884 1885 static int ath6kl_wow_ap(struct ath6kl *ar, struct ath6kl_vif *vif) 1886 { 1887 static const u8 unicst_pattern[] = { 0x00, 0x00, 0x00, 1888 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1889 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1890 0x00, 0x08 }; 1891 static const u8 unicst_mask[] = { 0x01, 0x00, 0x00, 1892 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1893 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1894 0x00, 0x7f }; 1895 u8 unicst_offset = 0; 1896 static const u8 arp_pattern[] = { 0x08, 0x06 }; 1897 static const u8 arp_mask[] = { 0xff, 0xff }; 1898 u8 arp_offset = 20; 1899 static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1900 static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1901 u8 discvr_offset = 38; 1902 static const u8 dhcp_pattern[] = { 0xff, 0xff, 0xff, 0xff, 1903 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1904 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x08, 0x00, 1905 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1906 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1907 0x00, 0x00, 0x00, 0x00, 0x00, 0x43 /* port 67 */ }; 1908 static const u8 dhcp_mask[] = { 0xff, 0xff, 0xff, 0xff, 1909 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1910 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 1911 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1912 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 1913 0x00, 0x00, 0x00, 0x00, 0xff, 0xff /* port 67 */ }; 1914 u8 dhcp_offset = 0; 1915 int ret; 1916 1917 /* Setup unicast IP, EAPOL-like and ARP pkt pattern */ 1918 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1919 vif->fw_vif_idx, WOW_LIST_ID, 1920 sizeof(unicst_pattern), unicst_offset, 1921 unicst_pattern, unicst_mask); 1922 if (ret) { 1923 ath6kl_err("failed to add WOW unicast IP pattern\n"); 1924 return ret; 1925 } 1926 1927 /* Setup all ARP pkt pattern */ 1928 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1929 vif->fw_vif_idx, WOW_LIST_ID, 1930 sizeof(arp_pattern), arp_offset, 1931 arp_pattern, arp_mask); 1932 if (ret) { 1933 ath6kl_err("failed to add WOW ARP pattern\n"); 1934 return ret; 1935 } 1936 1937 /* 1938 * Setup multicast pattern for mDNS 224.0.0.251, 1939 * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1940 */ 1941 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1942 vif->fw_vif_idx, WOW_LIST_ID, 1943 sizeof(discvr_pattern), discvr_offset, 1944 discvr_pattern, discvr_mask); 1945 if (ret) { 1946 ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1947 return ret; 1948 } 1949 1950 /* Setup all DHCP broadcast pkt pattern */ 1951 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1952 vif->fw_vif_idx, WOW_LIST_ID, 1953 sizeof(dhcp_pattern), dhcp_offset, 1954 dhcp_pattern, dhcp_mask); 1955 if (ret) { 1956 ath6kl_err("failed to add WOW DHCP broadcast pattern\n"); 1957 return ret; 1958 } 1959 1960 return 0; 1961 } 1962 1963 static int ath6kl_wow_sta(struct ath6kl *ar, struct ath6kl_vif *vif) 1964 { 1965 struct net_device *ndev = vif->ndev; 1966 static const u8 discvr_pattern[] = { 0xe0, 0x00, 0x00, 0xf8 }; 1967 static const u8 discvr_mask[] = { 0xf0, 0x00, 0x00, 0xf8 }; 1968 u8 discvr_offset = 38; 1969 u8 mac_mask[ETH_ALEN]; 1970 int ret; 1971 1972 /* Setup unicast pkt pattern */ 1973 memset(mac_mask, 0xff, ETH_ALEN); 1974 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1975 vif->fw_vif_idx, WOW_LIST_ID, 1976 ETH_ALEN, 0, ndev->dev_addr, 1977 mac_mask); 1978 if (ret) { 1979 ath6kl_err("failed to add WOW unicast pattern\n"); 1980 return ret; 1981 } 1982 1983 /* 1984 * Setup multicast pattern for mDNS 224.0.0.251, 1985 * SSDP 239.255.255.250 and LLMNR 224.0.0.252 1986 */ 1987 if ((ndev->flags & IFF_ALLMULTI) || 1988 (ndev->flags & IFF_MULTICAST && netdev_mc_count(ndev) > 0)) { 1989 ret = ath6kl_wmi_add_wow_pattern_cmd(ar->wmi, 1990 vif->fw_vif_idx, WOW_LIST_ID, 1991 sizeof(discvr_pattern), discvr_offset, 1992 discvr_pattern, discvr_mask); 1993 if (ret) { 1994 ath6kl_err("failed to add WOW mDNS/SSDP/LLMNR pattern\n"); 1995 return ret; 1996 } 1997 } 1998 1999 return 0; 2000 } 2001 2002 static int is_hsleep_mode_procsed(struct ath6kl_vif *vif) 2003 { 2004 return test_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2005 } 2006 2007 static bool is_ctrl_ep_empty(struct ath6kl *ar) 2008 { 2009 return !ar->tx_pending[ar->ctrl_ep]; 2010 } 2011 2012 static int ath6kl_cfg80211_host_sleep(struct ath6kl *ar, struct ath6kl_vif *vif) 2013 { 2014 int ret, left; 2015 2016 clear_bit(HOST_SLEEP_MODE_CMD_PROCESSED, &vif->flags); 2017 2018 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2019 ATH6KL_HOST_MODE_ASLEEP); 2020 if (ret) 2021 return ret; 2022 2023 left = wait_event_interruptible_timeout(ar->event_wq, 2024 is_hsleep_mode_procsed(vif), 2025 WMI_TIMEOUT); 2026 if (left == 0) { 2027 ath6kl_warn("timeout, didn't get host sleep cmd processed event\n"); 2028 ret = -ETIMEDOUT; 2029 } else if (left < 0) { 2030 ath6kl_warn("error while waiting for host sleep cmd processed event %d\n", 2031 left); 2032 ret = left; 2033 } 2034 2035 if (ar->tx_pending[ar->ctrl_ep]) { 2036 left = wait_event_interruptible_timeout(ar->event_wq, 2037 is_ctrl_ep_empty(ar), 2038 WMI_TIMEOUT); 2039 if (left == 0) { 2040 ath6kl_warn("clear wmi ctrl data timeout\n"); 2041 ret = -ETIMEDOUT; 2042 } else if (left < 0) { 2043 ath6kl_warn("clear wmi ctrl data failed: %d\n", left); 2044 ret = left; 2045 } 2046 } 2047 2048 return ret; 2049 } 2050 2051 static int ath6kl_wow_suspend(struct ath6kl *ar, struct cfg80211_wowlan *wow) 2052 { 2053 struct in_device *in_dev; 2054 struct in_ifaddr *ifa; 2055 struct ath6kl_vif *vif; 2056 int ret; 2057 u32 filter = 0; 2058 u16 i, bmiss_time; 2059 u8 index = 0; 2060 __be32 ips[MAX_IP_ADDRS]; 2061 2062 vif = ath6kl_vif_first(ar); 2063 if (!vif) 2064 return -EIO; 2065 2066 if (!ath6kl_cfg80211_ready(vif)) 2067 return -EIO; 2068 2069 if (!test_bit(CONNECTED, &vif->flags)) 2070 return -ENOTCONN; 2071 2072 if (wow && (wow->n_patterns > WOW_MAX_FILTERS_PER_LIST)) 2073 return -EINVAL; 2074 2075 /* Clear existing WOW patterns */ 2076 for (i = 0; i < WOW_MAX_FILTERS_PER_LIST; i++) 2077 ath6kl_wmi_del_wow_pattern_cmd(ar->wmi, vif->fw_vif_idx, 2078 WOW_LIST_ID, i); 2079 2080 /* 2081 * Skip the default WOW pattern configuration 2082 * if the driver receives any WOW patterns from 2083 * the user. 2084 */ 2085 if (wow) 2086 ret = ath6kl_wow_usr(ar, vif, wow, &filter); 2087 else if (vif->nw_type == AP_NETWORK) 2088 ret = ath6kl_wow_ap(ar, vif); 2089 else 2090 ret = ath6kl_wow_sta(ar, vif); 2091 2092 if (ret) 2093 return ret; 2094 2095 netif_stop_queue(vif->ndev); 2096 2097 if (vif->nw_type != AP_NETWORK) { 2098 ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2099 ATH6KL_MAX_WOW_LISTEN_INTL, 2100 0); 2101 if (ret) 2102 return ret; 2103 2104 /* Set listen interval x 15 times as bmiss time */ 2105 bmiss_time = ATH6KL_MAX_WOW_LISTEN_INTL * 15; 2106 if (bmiss_time > ATH6KL_MAX_BMISS_TIME) 2107 bmiss_time = ATH6KL_MAX_BMISS_TIME; 2108 2109 ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2110 bmiss_time, 0); 2111 if (ret) 2112 return ret; 2113 2114 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2115 0xFFFF, 0, 0xFFFF, 0, 0, 0, 2116 0, 0, 0, 0); 2117 if (ret) 2118 return ret; 2119 } 2120 2121 ar->state = ATH6KL_STATE_SUSPENDING; 2122 2123 /* Setup own IP addr for ARP agent. */ 2124 in_dev = __in_dev_get_rtnl(vif->ndev); 2125 if (!in_dev) 2126 goto skip_arp; 2127 2128 ifa = in_dev->ifa_list; 2129 memset(&ips, 0, sizeof(ips)); 2130 2131 /* Configure IP addr only if IP address count < MAX_IP_ADDRS */ 2132 while (index < MAX_IP_ADDRS && ifa) { 2133 ips[index] = ifa->ifa_local; 2134 ifa = ifa->ifa_next; 2135 index++; 2136 } 2137 2138 if (ifa) { 2139 ath6kl_err("total IP addr count is exceeding fw limit\n"); 2140 return -EINVAL; 2141 } 2142 2143 ret = ath6kl_wmi_set_ip_cmd(ar->wmi, vif->fw_vif_idx, ips[0], ips[1]); 2144 if (ret) { 2145 ath6kl_err("fail to setup ip for arp agent\n"); 2146 return ret; 2147 } 2148 2149 skip_arp: 2150 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 2151 ATH6KL_WOW_MODE_ENABLE, 2152 filter, 2153 WOW_HOST_REQ_DELAY); 2154 if (ret) 2155 return ret; 2156 2157 ret = ath6kl_cfg80211_host_sleep(ar, vif); 2158 if (ret) 2159 return ret; 2160 2161 return 0; 2162 } 2163 2164 static int ath6kl_wow_resume(struct ath6kl *ar) 2165 { 2166 struct ath6kl_vif *vif; 2167 int ret; 2168 2169 vif = ath6kl_vif_first(ar); 2170 if (!vif) 2171 return -EIO; 2172 2173 ar->state = ATH6KL_STATE_RESUMING; 2174 2175 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2176 ATH6KL_HOST_MODE_AWAKE); 2177 if (ret) { 2178 ath6kl_warn("Failed to configure host sleep mode for wow resume: %d\n", 2179 ret); 2180 ar->state = ATH6KL_STATE_WOW; 2181 return ret; 2182 } 2183 2184 if (vif->nw_type != AP_NETWORK) { 2185 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2186 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2187 if (ret) 2188 return ret; 2189 2190 ret = ath6kl_wmi_listeninterval_cmd(ar->wmi, vif->fw_vif_idx, 2191 vif->listen_intvl_t, 0); 2192 if (ret) 2193 return ret; 2194 2195 ret = ath6kl_wmi_bmisstime_cmd(ar->wmi, vif->fw_vif_idx, 2196 vif->bmiss_time_t, 0); 2197 if (ret) 2198 return ret; 2199 } 2200 2201 ar->state = ATH6KL_STATE_ON; 2202 2203 netif_wake_queue(vif->ndev); 2204 2205 return 0; 2206 } 2207 2208 static int ath6kl_cfg80211_deepsleep_suspend(struct ath6kl *ar) 2209 { 2210 struct ath6kl_vif *vif; 2211 int ret; 2212 2213 vif = ath6kl_vif_first(ar); 2214 if (!vif) 2215 return -EIO; 2216 2217 if (!test_bit(WMI_READY, &ar->flag)) { 2218 ath6kl_err("deepsleep failed as wmi is not ready\n"); 2219 return -EIO; 2220 } 2221 2222 ath6kl_cfg80211_stop_all(ar); 2223 2224 /* Save the current power mode before enabling power save */ 2225 ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 2226 2227 ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER); 2228 if (ret) 2229 return ret; 2230 2231 /* Disable WOW mode */ 2232 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 2233 ATH6KL_WOW_MODE_DISABLE, 2234 0, 0); 2235 if (ret) 2236 return ret; 2237 2238 /* Flush all non control pkts in TX path */ 2239 ath6kl_tx_data_cleanup(ar); 2240 2241 ret = ath6kl_cfg80211_host_sleep(ar, vif); 2242 if (ret) 2243 return ret; 2244 2245 return 0; 2246 } 2247 2248 static int ath6kl_cfg80211_deepsleep_resume(struct ath6kl *ar) 2249 { 2250 struct ath6kl_vif *vif; 2251 int ret; 2252 2253 vif = ath6kl_vif_first(ar); 2254 2255 if (!vif) 2256 return -EIO; 2257 2258 if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 2259 ret = ath6kl_wmi_powermode_cmd(ar->wmi, 0, 2260 ar->wmi->saved_pwr_mode); 2261 if (ret) 2262 return ret; 2263 } 2264 2265 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 2266 ATH6KL_HOST_MODE_AWAKE); 2267 if (ret) 2268 return ret; 2269 2270 ar->state = ATH6KL_STATE_ON; 2271 2272 /* Reset scan parameter to default values */ 2273 ret = ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 2274 0, 0, 0, 0, 0, 0, 3, 0, 0, 0); 2275 if (ret) 2276 return ret; 2277 2278 return 0; 2279 } 2280 2281 int ath6kl_cfg80211_suspend(struct ath6kl *ar, 2282 enum ath6kl_cfg_suspend_mode mode, 2283 struct cfg80211_wowlan *wow) 2284 { 2285 struct ath6kl_vif *vif; 2286 enum ath6kl_state prev_state; 2287 int ret; 2288 2289 switch (mode) { 2290 case ATH6KL_CFG_SUSPEND_WOW: 2291 2292 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode suspend\n"); 2293 2294 /* Flush all non control pkts in TX path */ 2295 ath6kl_tx_data_cleanup(ar); 2296 2297 prev_state = ar->state; 2298 2299 ret = ath6kl_wow_suspend(ar, wow); 2300 if (ret) { 2301 ar->state = prev_state; 2302 return ret; 2303 } 2304 2305 ar->state = ATH6KL_STATE_WOW; 2306 break; 2307 2308 case ATH6KL_CFG_SUSPEND_DEEPSLEEP: 2309 2310 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep suspend\n"); 2311 2312 ret = ath6kl_cfg80211_deepsleep_suspend(ar); 2313 if (ret) { 2314 ath6kl_err("deepsleep suspend failed: %d\n", ret); 2315 return ret; 2316 } 2317 2318 ar->state = ATH6KL_STATE_DEEPSLEEP; 2319 2320 break; 2321 2322 case ATH6KL_CFG_SUSPEND_CUTPOWER: 2323 2324 ath6kl_cfg80211_stop_all(ar); 2325 2326 if (ar->state == ATH6KL_STATE_OFF) { 2327 ath6kl_dbg(ATH6KL_DBG_SUSPEND, 2328 "suspend hw off, no action for cutpower\n"); 2329 break; 2330 } 2331 2332 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "suspend cutting power\n"); 2333 2334 ret = ath6kl_init_hw_stop(ar); 2335 if (ret) { 2336 ath6kl_warn("failed to stop hw during suspend: %d\n", 2337 ret); 2338 } 2339 2340 ar->state = ATH6KL_STATE_CUTPOWER; 2341 2342 break; 2343 2344 case ATH6KL_CFG_SUSPEND_SCHED_SCAN: 2345 /* 2346 * Nothing needed for schedule scan, firmware is already in 2347 * wow mode and sleeping most of the time. 2348 */ 2349 break; 2350 2351 default: 2352 break; 2353 } 2354 2355 list_for_each_entry(vif, &ar->vif_list, list) 2356 ath6kl_cfg80211_scan_complete_event(vif, true); 2357 2358 return 0; 2359 } 2360 EXPORT_SYMBOL(ath6kl_cfg80211_suspend); 2361 2362 int ath6kl_cfg80211_resume(struct ath6kl *ar) 2363 { 2364 int ret; 2365 2366 switch (ar->state) { 2367 case ATH6KL_STATE_WOW: 2368 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "wow mode resume\n"); 2369 2370 ret = ath6kl_wow_resume(ar); 2371 if (ret) { 2372 ath6kl_warn("wow mode resume failed: %d\n", ret); 2373 return ret; 2374 } 2375 2376 break; 2377 2378 case ATH6KL_STATE_DEEPSLEEP: 2379 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "deep sleep resume\n"); 2380 2381 ret = ath6kl_cfg80211_deepsleep_resume(ar); 2382 if (ret) { 2383 ath6kl_warn("deep sleep resume failed: %d\n", ret); 2384 return ret; 2385 } 2386 break; 2387 2388 case ATH6KL_STATE_CUTPOWER: 2389 ath6kl_dbg(ATH6KL_DBG_SUSPEND, "resume restoring power\n"); 2390 2391 ret = ath6kl_init_hw_start(ar); 2392 if (ret) { 2393 ath6kl_warn("Failed to boot hw in resume: %d\n", ret); 2394 return ret; 2395 } 2396 break; 2397 2398 case ATH6KL_STATE_SCHED_SCAN: 2399 break; 2400 2401 default: 2402 break; 2403 } 2404 2405 return 0; 2406 } 2407 EXPORT_SYMBOL(ath6kl_cfg80211_resume); 2408 2409 #ifdef CONFIG_PM 2410 2411 /* hif layer decides what suspend mode to use */ 2412 static int __ath6kl_cfg80211_suspend(struct wiphy *wiphy, 2413 struct cfg80211_wowlan *wow) 2414 { 2415 struct ath6kl *ar = wiphy_priv(wiphy); 2416 2417 return ath6kl_hif_suspend(ar, wow); 2418 } 2419 2420 static int __ath6kl_cfg80211_resume(struct wiphy *wiphy) 2421 { 2422 struct ath6kl *ar = wiphy_priv(wiphy); 2423 2424 return ath6kl_hif_resume(ar); 2425 } 2426 2427 /* 2428 * FIXME: WOW suspend mode is selected if the host sdio controller supports 2429 * both sdio irq wake up and keep power. The target pulls sdio data line to 2430 * wake up the host when WOW pattern matches. This causes sdio irq handler 2431 * is being called in the host side which internally hits ath6kl's RX path. 2432 * 2433 * Since sdio interrupt is not disabled, RX path executes even before 2434 * the host executes the actual resume operation from PM module. 2435 * 2436 * In the current scenario, WOW resume should happen before start processing 2437 * any data from the target. So It's required to perform WOW resume in RX path. 2438 * Ideally we should perform WOW resume only in the actual platform 2439 * resume path. This area needs bit rework to avoid WOW resume in RX path. 2440 * 2441 * ath6kl_check_wow_status() is called from ath6kl_rx(). 2442 */ 2443 void ath6kl_check_wow_status(struct ath6kl *ar) 2444 { 2445 if (ar->state == ATH6KL_STATE_SUSPENDING) 2446 return; 2447 2448 if (ar->state == ATH6KL_STATE_WOW) 2449 ath6kl_cfg80211_resume(ar); 2450 } 2451 2452 #else 2453 2454 void ath6kl_check_wow_status(struct ath6kl *ar) 2455 { 2456 } 2457 #endif 2458 2459 static int ath6kl_set_htcap(struct ath6kl_vif *vif, enum ieee80211_band band, 2460 bool ht_enable) 2461 { 2462 struct ath6kl_htcap *htcap = &vif->htcap; 2463 2464 if (htcap->ht_enable == ht_enable) 2465 return 0; 2466 2467 if (ht_enable) { 2468 /* Set default ht capabilities */ 2469 htcap->ht_enable = true; 2470 htcap->cap_info = (band == IEEE80211_BAND_2GHZ) ? 2471 ath6kl_g_htcap : ath6kl_a_htcap; 2472 htcap->ampdu_factor = IEEE80211_HT_MAX_AMPDU_16K; 2473 } else /* Disable ht */ 2474 memset(htcap, 0, sizeof(*htcap)); 2475 2476 return ath6kl_wmi_set_htcap_cmd(vif->ar->wmi, vif->fw_vif_idx, 2477 band, htcap); 2478 } 2479 2480 static bool ath6kl_is_p2p_ie(const u8 *pos) 2481 { 2482 return pos[0] == WLAN_EID_VENDOR_SPECIFIC && pos[1] >= 4 && 2483 pos[2] == 0x50 && pos[3] == 0x6f && 2484 pos[4] == 0x9a && pos[5] == 0x09; 2485 } 2486 2487 static int ath6kl_set_ap_probe_resp_ies(struct ath6kl_vif *vif, 2488 const u8 *ies, size_t ies_len) 2489 { 2490 struct ath6kl *ar = vif->ar; 2491 const u8 *pos; 2492 u8 *buf = NULL; 2493 size_t len = 0; 2494 int ret; 2495 2496 /* 2497 * Filter out P2P IE(s) since they will be included depending on 2498 * the Probe Request frame in ath6kl_send_go_probe_resp(). 2499 */ 2500 2501 if (ies && ies_len) { 2502 buf = kmalloc(ies_len, GFP_KERNEL); 2503 if (buf == NULL) 2504 return -ENOMEM; 2505 pos = ies; 2506 while (pos + 1 < ies + ies_len) { 2507 if (pos + 2 + pos[1] > ies + ies_len) 2508 break; 2509 if (!ath6kl_is_p2p_ie(pos)) { 2510 memcpy(buf + len, pos, 2 + pos[1]); 2511 len += 2 + pos[1]; 2512 } 2513 pos += 2 + pos[1]; 2514 } 2515 } 2516 2517 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2518 WMI_FRAME_PROBE_RESP, buf, len); 2519 kfree(buf); 2520 return ret; 2521 } 2522 2523 static int ath6kl_set_ies(struct ath6kl_vif *vif, 2524 struct cfg80211_beacon_data *info) 2525 { 2526 struct ath6kl *ar = vif->ar; 2527 int res; 2528 2529 /* this also clears IE in fw if it's not set */ 2530 res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2531 WMI_FRAME_BEACON, 2532 info->beacon_ies, 2533 info->beacon_ies_len); 2534 if (res) 2535 return res; 2536 2537 /* this also clears IE in fw if it's not set */ 2538 res = ath6kl_set_ap_probe_resp_ies(vif, info->proberesp_ies, 2539 info->proberesp_ies_len); 2540 if (res) 2541 return res; 2542 2543 /* this also clears IE in fw if it's not set */ 2544 res = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 2545 WMI_FRAME_ASSOC_RESP, 2546 info->assocresp_ies, 2547 info->assocresp_ies_len); 2548 if (res) 2549 return res; 2550 2551 return 0; 2552 } 2553 2554 static int ath6kl_set_channel(struct wiphy *wiphy, struct net_device *dev, 2555 struct ieee80211_channel *chan, 2556 enum nl80211_channel_type channel_type) 2557 { 2558 struct ath6kl_vif *vif; 2559 2560 /* 2561 * 'dev' could be NULL if a channel change is required for the hardware 2562 * device itself, instead of a particular VIF. 2563 * 2564 * FIXME: To be handled properly when monitor mode is supported. 2565 */ 2566 if (!dev) 2567 return -EBUSY; 2568 2569 vif = netdev_priv(dev); 2570 2571 if (!ath6kl_cfg80211_ready(vif)) 2572 return -EIO; 2573 2574 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: center_freq=%u hw_value=%u\n", 2575 __func__, chan->center_freq, chan->hw_value); 2576 vif->next_chan = chan->center_freq; 2577 vif->next_ch_type = channel_type; 2578 vif->next_ch_band = chan->band; 2579 2580 return 0; 2581 } 2582 2583 static int ath6kl_get_rsn_capab(struct cfg80211_beacon_data *beacon, 2584 u8 *rsn_capab) 2585 { 2586 const u8 *rsn_ie; 2587 size_t rsn_ie_len; 2588 u16 cnt; 2589 2590 if (!beacon->tail) 2591 return -EINVAL; 2592 2593 rsn_ie = cfg80211_find_ie(WLAN_EID_RSN, beacon->tail, beacon->tail_len); 2594 if (!rsn_ie) 2595 return -EINVAL; 2596 2597 rsn_ie_len = *(rsn_ie + 1); 2598 /* skip element id and length */ 2599 rsn_ie += 2; 2600 2601 /* skip version */ 2602 if (rsn_ie_len < 2) 2603 return -EINVAL; 2604 rsn_ie += 2; 2605 rsn_ie_len -= 2; 2606 2607 /* skip group cipher suite */ 2608 if (rsn_ie_len < 4) 2609 return 0; 2610 rsn_ie += 4; 2611 rsn_ie_len -= 4; 2612 2613 /* skip pairwise cipher suite */ 2614 if (rsn_ie_len < 2) 2615 return 0; 2616 cnt = get_unaligned_le16(rsn_ie); 2617 rsn_ie += (2 + cnt * 4); 2618 rsn_ie_len -= (2 + cnt * 4); 2619 2620 /* skip akm suite */ 2621 if (rsn_ie_len < 2) 2622 return 0; 2623 cnt = get_unaligned_le16(rsn_ie); 2624 rsn_ie += (2 + cnt * 4); 2625 rsn_ie_len -= (2 + cnt * 4); 2626 2627 if (rsn_ie_len < 2) 2628 return 0; 2629 2630 memcpy(rsn_capab, rsn_ie, 2); 2631 2632 return 0; 2633 } 2634 2635 static int ath6kl_start_ap(struct wiphy *wiphy, struct net_device *dev, 2636 struct cfg80211_ap_settings *info) 2637 { 2638 struct ath6kl *ar = ath6kl_priv(dev); 2639 struct ath6kl_vif *vif = netdev_priv(dev); 2640 struct ieee80211_mgmt *mgmt; 2641 bool hidden = false; 2642 u8 *ies; 2643 int ies_len; 2644 struct wmi_connect_cmd p; 2645 int res; 2646 int i, ret; 2647 u16 rsn_capab = 0; 2648 2649 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s:\n", __func__); 2650 2651 if (!ath6kl_cfg80211_ready(vif)) 2652 return -EIO; 2653 2654 if (vif->next_mode != AP_NETWORK) 2655 return -EOPNOTSUPP; 2656 2657 res = ath6kl_set_ies(vif, &info->beacon); 2658 2659 ar->ap_mode_bkey.valid = false; 2660 2661 /* TODO: 2662 * info->interval 2663 * info->dtim_period 2664 */ 2665 2666 if (info->beacon.head == NULL) 2667 return -EINVAL; 2668 mgmt = (struct ieee80211_mgmt *) info->beacon.head; 2669 ies = mgmt->u.beacon.variable; 2670 if (ies > info->beacon.head + info->beacon.head_len) 2671 return -EINVAL; 2672 ies_len = info->beacon.head + info->beacon.head_len - ies; 2673 2674 if (info->ssid == NULL) 2675 return -EINVAL; 2676 memcpy(vif->ssid, info->ssid, info->ssid_len); 2677 vif->ssid_len = info->ssid_len; 2678 if (info->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE) 2679 hidden = true; 2680 2681 res = ath6kl_wmi_ap_hidden_ssid(ar->wmi, vif->fw_vif_idx, hidden); 2682 if (res) 2683 return res; 2684 2685 ret = ath6kl_set_auth_type(vif, info->auth_type); 2686 if (ret) 2687 return ret; 2688 2689 memset(&p, 0, sizeof(p)); 2690 2691 for (i = 0; i < info->crypto.n_akm_suites; i++) { 2692 switch (info->crypto.akm_suites[i]) { 2693 case WLAN_AKM_SUITE_8021X: 2694 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 2695 p.auth_mode |= WPA_AUTH; 2696 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 2697 p.auth_mode |= WPA2_AUTH; 2698 break; 2699 case WLAN_AKM_SUITE_PSK: 2700 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_1) 2701 p.auth_mode |= WPA_PSK_AUTH; 2702 if (info->crypto.wpa_versions & NL80211_WPA_VERSION_2) 2703 p.auth_mode |= WPA2_PSK_AUTH; 2704 break; 2705 } 2706 } 2707 if (p.auth_mode == 0) 2708 p.auth_mode = NONE_AUTH; 2709 vif->auth_mode = p.auth_mode; 2710 2711 for (i = 0; i < info->crypto.n_ciphers_pairwise; i++) { 2712 switch (info->crypto.ciphers_pairwise[i]) { 2713 case WLAN_CIPHER_SUITE_WEP40: 2714 case WLAN_CIPHER_SUITE_WEP104: 2715 p.prwise_crypto_type |= WEP_CRYPT; 2716 break; 2717 case WLAN_CIPHER_SUITE_TKIP: 2718 p.prwise_crypto_type |= TKIP_CRYPT; 2719 break; 2720 case WLAN_CIPHER_SUITE_CCMP: 2721 p.prwise_crypto_type |= AES_CRYPT; 2722 break; 2723 case WLAN_CIPHER_SUITE_SMS4: 2724 p.prwise_crypto_type |= WAPI_CRYPT; 2725 break; 2726 } 2727 } 2728 if (p.prwise_crypto_type == 0) { 2729 p.prwise_crypto_type = NONE_CRYPT; 2730 ath6kl_set_cipher(vif, 0, true); 2731 } else if (info->crypto.n_ciphers_pairwise == 1) 2732 ath6kl_set_cipher(vif, info->crypto.ciphers_pairwise[0], true); 2733 2734 switch (info->crypto.cipher_group) { 2735 case WLAN_CIPHER_SUITE_WEP40: 2736 case WLAN_CIPHER_SUITE_WEP104: 2737 p.grp_crypto_type = WEP_CRYPT; 2738 break; 2739 case WLAN_CIPHER_SUITE_TKIP: 2740 p.grp_crypto_type = TKIP_CRYPT; 2741 break; 2742 case WLAN_CIPHER_SUITE_CCMP: 2743 p.grp_crypto_type = AES_CRYPT; 2744 break; 2745 case WLAN_CIPHER_SUITE_SMS4: 2746 p.grp_crypto_type = WAPI_CRYPT; 2747 break; 2748 default: 2749 p.grp_crypto_type = NONE_CRYPT; 2750 break; 2751 } 2752 ath6kl_set_cipher(vif, info->crypto.cipher_group, false); 2753 2754 p.nw_type = AP_NETWORK; 2755 vif->nw_type = vif->next_mode; 2756 2757 p.ssid_len = vif->ssid_len; 2758 memcpy(p.ssid, vif->ssid, vif->ssid_len); 2759 p.dot11_auth_mode = vif->dot11_auth_mode; 2760 p.ch = cpu_to_le16(vif->next_chan); 2761 2762 /* Enable uAPSD support by default */ 2763 res = ath6kl_wmi_ap_set_apsd(ar->wmi, vif->fw_vif_idx, true); 2764 if (res < 0) 2765 return res; 2766 2767 if (vif->wdev.iftype == NL80211_IFTYPE_P2P_GO) { 2768 p.nw_subtype = SUBTYPE_P2PGO; 2769 } else { 2770 /* 2771 * Due to firmware limitation, it is not possible to 2772 * do P2P mgmt operations in AP mode 2773 */ 2774 p.nw_subtype = SUBTYPE_NONE; 2775 } 2776 2777 if (info->inactivity_timeout) { 2778 res = ath6kl_wmi_set_inact_period(ar->wmi, vif->fw_vif_idx, 2779 info->inactivity_timeout); 2780 if (res < 0) 2781 return res; 2782 } 2783 2784 if (ath6kl_set_htcap(vif, vif->next_ch_band, 2785 vif->next_ch_type != NL80211_CHAN_NO_HT)) 2786 return -EIO; 2787 2788 /* 2789 * Get the PTKSA replay counter in the RSN IE. Supplicant 2790 * will use the RSN IE in M3 message and firmware has to 2791 * advertise the same in beacon/probe response. Send 2792 * the complete RSN IE capability field to firmware 2793 */ 2794 if (!ath6kl_get_rsn_capab(&info->beacon, (u8 *) &rsn_capab) && 2795 test_bit(ATH6KL_FW_CAPABILITY_RSN_CAP_OVERRIDE, 2796 ar->fw_capabilities)) { 2797 res = ath6kl_wmi_set_ie_cmd(ar->wmi, vif->fw_vif_idx, 2798 WLAN_EID_RSN, WMI_RSN_IE_CAPB, 2799 (const u8 *) &rsn_capab, 2800 sizeof(rsn_capab)); 2801 if (res < 0) 2802 return res; 2803 } 2804 2805 memcpy(&vif->profile, &p, sizeof(p)); 2806 res = ath6kl_wmi_ap_profile_commit(ar->wmi, vif->fw_vif_idx, &p); 2807 if (res < 0) 2808 return res; 2809 2810 return 0; 2811 } 2812 2813 static int ath6kl_change_beacon(struct wiphy *wiphy, struct net_device *dev, 2814 struct cfg80211_beacon_data *beacon) 2815 { 2816 struct ath6kl_vif *vif = netdev_priv(dev); 2817 2818 if (!ath6kl_cfg80211_ready(vif)) 2819 return -EIO; 2820 2821 if (vif->next_mode != AP_NETWORK) 2822 return -EOPNOTSUPP; 2823 2824 return ath6kl_set_ies(vif, beacon); 2825 } 2826 2827 static int ath6kl_stop_ap(struct wiphy *wiphy, struct net_device *dev) 2828 { 2829 struct ath6kl *ar = ath6kl_priv(dev); 2830 struct ath6kl_vif *vif = netdev_priv(dev); 2831 2832 if (vif->nw_type != AP_NETWORK) 2833 return -EOPNOTSUPP; 2834 if (!test_bit(CONNECTED, &vif->flags)) 2835 return -ENOTCONN; 2836 2837 ath6kl_wmi_disconnect_cmd(ar->wmi, vif->fw_vif_idx); 2838 clear_bit(CONNECTED, &vif->flags); 2839 2840 /* Restore ht setting in firmware */ 2841 if (ath6kl_set_htcap(vif, IEEE80211_BAND_2GHZ, true)) 2842 return -EIO; 2843 2844 if (ath6kl_set_htcap(vif, IEEE80211_BAND_5GHZ, true)) 2845 return -EIO; 2846 2847 return 0; 2848 } 2849 2850 static const u8 bcast_addr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; 2851 2852 static int ath6kl_del_station(struct wiphy *wiphy, struct net_device *dev, 2853 u8 *mac) 2854 { 2855 struct ath6kl *ar = ath6kl_priv(dev); 2856 struct ath6kl_vif *vif = netdev_priv(dev); 2857 const u8 *addr = mac ? mac : bcast_addr; 2858 2859 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, WMI_AP_DEAUTH, 2860 addr, WLAN_REASON_PREV_AUTH_NOT_VALID); 2861 } 2862 2863 static int ath6kl_change_station(struct wiphy *wiphy, struct net_device *dev, 2864 u8 *mac, struct station_parameters *params) 2865 { 2866 struct ath6kl *ar = ath6kl_priv(dev); 2867 struct ath6kl_vif *vif = netdev_priv(dev); 2868 2869 if (vif->nw_type != AP_NETWORK) 2870 return -EOPNOTSUPP; 2871 2872 /* Use this only for authorizing/unauthorizing a station */ 2873 if (!(params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED))) 2874 return -EOPNOTSUPP; 2875 2876 if (params->sta_flags_set & BIT(NL80211_STA_FLAG_AUTHORIZED)) 2877 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2878 WMI_AP_MLME_AUTHORIZE, mac, 0); 2879 return ath6kl_wmi_ap_set_mlme(ar->wmi, vif->fw_vif_idx, 2880 WMI_AP_MLME_UNAUTHORIZE, mac, 0); 2881 } 2882 2883 static int ath6kl_remain_on_channel(struct wiphy *wiphy, 2884 struct net_device *dev, 2885 struct ieee80211_channel *chan, 2886 enum nl80211_channel_type channel_type, 2887 unsigned int duration, 2888 u64 *cookie) 2889 { 2890 struct ath6kl *ar = ath6kl_priv(dev); 2891 struct ath6kl_vif *vif = netdev_priv(dev); 2892 u32 id; 2893 2894 /* TODO: if already pending or ongoing remain-on-channel, 2895 * return -EBUSY */ 2896 id = ++vif->last_roc_id; 2897 if (id == 0) { 2898 /* Do not use 0 as the cookie value */ 2899 id = ++vif->last_roc_id; 2900 } 2901 *cookie = id; 2902 2903 return ath6kl_wmi_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx, 2904 chan->center_freq, duration); 2905 } 2906 2907 static int ath6kl_cancel_remain_on_channel(struct wiphy *wiphy, 2908 struct net_device *dev, 2909 u64 cookie) 2910 { 2911 struct ath6kl *ar = ath6kl_priv(dev); 2912 struct ath6kl_vif *vif = netdev_priv(dev); 2913 2914 if (cookie != vif->last_roc_id) 2915 return -ENOENT; 2916 vif->last_cancel_roc_id = cookie; 2917 2918 return ath6kl_wmi_cancel_remain_on_chnl_cmd(ar->wmi, vif->fw_vif_idx); 2919 } 2920 2921 static int ath6kl_send_go_probe_resp(struct ath6kl_vif *vif, 2922 const u8 *buf, size_t len, 2923 unsigned int freq) 2924 { 2925 struct ath6kl *ar = vif->ar; 2926 const u8 *pos; 2927 u8 *p2p; 2928 int p2p_len; 2929 int ret; 2930 const struct ieee80211_mgmt *mgmt; 2931 2932 mgmt = (const struct ieee80211_mgmt *) buf; 2933 2934 /* Include P2P IE(s) from the frame generated in user space. */ 2935 2936 p2p = kmalloc(len, GFP_KERNEL); 2937 if (p2p == NULL) 2938 return -ENOMEM; 2939 p2p_len = 0; 2940 2941 pos = mgmt->u.probe_resp.variable; 2942 while (pos + 1 < buf + len) { 2943 if (pos + 2 + pos[1] > buf + len) 2944 break; 2945 if (ath6kl_is_p2p_ie(pos)) { 2946 memcpy(p2p + p2p_len, pos, 2 + pos[1]); 2947 p2p_len += 2 + pos[1]; 2948 } 2949 pos += 2 + pos[1]; 2950 } 2951 2952 ret = ath6kl_wmi_send_probe_response_cmd(ar->wmi, vif->fw_vif_idx, freq, 2953 mgmt->da, p2p, p2p_len); 2954 kfree(p2p); 2955 return ret; 2956 } 2957 2958 static bool ath6kl_mgmt_powersave_ap(struct ath6kl_vif *vif, 2959 u32 id, 2960 u32 freq, 2961 u32 wait, 2962 const u8 *buf, 2963 size_t len, 2964 bool *more_data, 2965 bool no_cck) 2966 { 2967 struct ieee80211_mgmt *mgmt; 2968 struct ath6kl_sta *conn; 2969 bool is_psq_empty = false; 2970 struct ath6kl_mgmt_buff *mgmt_buf; 2971 size_t mgmt_buf_size; 2972 struct ath6kl *ar = vif->ar; 2973 2974 mgmt = (struct ieee80211_mgmt *) buf; 2975 if (is_multicast_ether_addr(mgmt->da)) 2976 return false; 2977 2978 conn = ath6kl_find_sta(vif, mgmt->da); 2979 if (!conn) 2980 return false; 2981 2982 if (conn->sta_flags & STA_PS_SLEEP) { 2983 if (!(conn->sta_flags & STA_PS_POLLED)) { 2984 /* Queue the frames if the STA is sleeping */ 2985 mgmt_buf_size = len + sizeof(struct ath6kl_mgmt_buff); 2986 mgmt_buf = kmalloc(mgmt_buf_size, GFP_KERNEL); 2987 if (!mgmt_buf) 2988 return false; 2989 2990 INIT_LIST_HEAD(&mgmt_buf->list); 2991 mgmt_buf->id = id; 2992 mgmt_buf->freq = freq; 2993 mgmt_buf->wait = wait; 2994 mgmt_buf->len = len; 2995 mgmt_buf->no_cck = no_cck; 2996 memcpy(mgmt_buf->buf, buf, len); 2997 spin_lock_bh(&conn->psq_lock); 2998 is_psq_empty = skb_queue_empty(&conn->psq) && 2999 (conn->mgmt_psq_len == 0); 3000 list_add_tail(&mgmt_buf->list, &conn->mgmt_psq); 3001 conn->mgmt_psq_len++; 3002 spin_unlock_bh(&conn->psq_lock); 3003 3004 /* 3005 * If this is the first pkt getting queued 3006 * for this STA, update the PVB for this 3007 * STA. 3008 */ 3009 if (is_psq_empty) 3010 ath6kl_wmi_set_pvb_cmd(ar->wmi, vif->fw_vif_idx, 3011 conn->aid, 1); 3012 return true; 3013 } 3014 3015 /* 3016 * This tx is because of a PsPoll. 3017 * Determine if MoreData bit has to be set. 3018 */ 3019 spin_lock_bh(&conn->psq_lock); 3020 if (!skb_queue_empty(&conn->psq) || (conn->mgmt_psq_len != 0)) 3021 *more_data = true; 3022 spin_unlock_bh(&conn->psq_lock); 3023 } 3024 3025 return false; 3026 } 3027 3028 /* Check if SSID length is greater than DIRECT- */ 3029 static bool ath6kl_is_p2p_go_ssid(const u8 *buf, size_t len) 3030 { 3031 const struct ieee80211_mgmt *mgmt; 3032 mgmt = (const struct ieee80211_mgmt *) buf; 3033 3034 /* variable[1] contains the SSID tag length */ 3035 if (buf + len >= &mgmt->u.probe_resp.variable[1] && 3036 (mgmt->u.probe_resp.variable[1] > P2P_WILDCARD_SSID_LEN)) { 3037 return true; 3038 } 3039 3040 return false; 3041 } 3042 3043 static int ath6kl_mgmt_tx(struct wiphy *wiphy, struct net_device *dev, 3044 struct ieee80211_channel *chan, bool offchan, 3045 enum nl80211_channel_type channel_type, 3046 bool channel_type_valid, unsigned int wait, 3047 const u8 *buf, size_t len, bool no_cck, 3048 bool dont_wait_for_ack, u64 *cookie) 3049 { 3050 struct ath6kl *ar = ath6kl_priv(dev); 3051 struct ath6kl_vif *vif = netdev_priv(dev); 3052 u32 id; 3053 const struct ieee80211_mgmt *mgmt; 3054 bool more_data, queued; 3055 3056 mgmt = (const struct ieee80211_mgmt *) buf; 3057 if (vif->nw_type == AP_NETWORK && test_bit(CONNECTED, &vif->flags) && 3058 ieee80211_is_probe_resp(mgmt->frame_control) && 3059 ath6kl_is_p2p_go_ssid(buf, len)) { 3060 /* 3061 * Send Probe Response frame in GO mode using a separate WMI 3062 * command to allow the target to fill in the generic IEs. 3063 */ 3064 *cookie = 0; /* TX status not supported */ 3065 return ath6kl_send_go_probe_resp(vif, buf, len, 3066 chan->center_freq); 3067 } 3068 3069 id = vif->send_action_id++; 3070 if (id == 0) { 3071 /* 3072 * 0 is a reserved value in the WMI command and shall not be 3073 * used for the command. 3074 */ 3075 id = vif->send_action_id++; 3076 } 3077 3078 *cookie = id; 3079 3080 /* AP mode Power saving processing */ 3081 if (vif->nw_type == AP_NETWORK) { 3082 queued = ath6kl_mgmt_powersave_ap(vif, 3083 id, chan->center_freq, 3084 wait, buf, 3085 len, &more_data, no_cck); 3086 if (queued) 3087 return 0; 3088 } 3089 3090 return ath6kl_wmi_send_mgmt_cmd(ar->wmi, vif->fw_vif_idx, id, 3091 chan->center_freq, wait, 3092 buf, len, no_cck); 3093 } 3094 3095 static void ath6kl_mgmt_frame_register(struct wiphy *wiphy, 3096 struct net_device *dev, 3097 u16 frame_type, bool reg) 3098 { 3099 struct ath6kl_vif *vif = netdev_priv(dev); 3100 3101 ath6kl_dbg(ATH6KL_DBG_WLAN_CFG, "%s: frame_type=0x%x reg=%d\n", 3102 __func__, frame_type, reg); 3103 if (frame_type == IEEE80211_STYPE_PROBE_REQ) { 3104 /* 3105 * Note: This notification callback is not allowed to sleep, so 3106 * we cannot send WMI_PROBE_REQ_REPORT_CMD here. Instead, we 3107 * hardcode target to report Probe Request frames all the time. 3108 */ 3109 vif->probe_req_report = reg; 3110 } 3111 } 3112 3113 static int ath6kl_cfg80211_sscan_start(struct wiphy *wiphy, 3114 struct net_device *dev, 3115 struct cfg80211_sched_scan_request *request) 3116 { 3117 struct ath6kl *ar = ath6kl_priv(dev); 3118 struct ath6kl_vif *vif = netdev_priv(dev); 3119 u16 interval; 3120 int ret; 3121 3122 if (ar->state != ATH6KL_STATE_ON) 3123 return -EIO; 3124 3125 if (vif->sme_state != SME_DISCONNECTED) 3126 return -EBUSY; 3127 3128 ath6kl_cfg80211_scan_complete_event(vif, true); 3129 3130 ret = ath6kl_set_probed_ssids(ar, vif, request->ssids, 3131 request->n_ssids); 3132 if (ret < 0) 3133 return ret; 3134 3135 /* fw uses seconds, also make sure that it's >0 */ 3136 interval = max_t(u16, 1, request->interval / 1000); 3137 3138 ath6kl_wmi_scanparams_cmd(ar->wmi, vif->fw_vif_idx, 3139 interval, interval, 3140 vif->bg_scan_period, 0, 0, 0, 3, 0, 0, 0); 3141 3142 ret = ath6kl_wmi_set_wow_mode_cmd(ar->wmi, vif->fw_vif_idx, 3143 ATH6KL_WOW_MODE_ENABLE, 3144 WOW_FILTER_SSID, 3145 WOW_HOST_REQ_DELAY); 3146 if (ret) { 3147 ath6kl_warn("Failed to enable wow with ssid filter: %d\n", ret); 3148 return ret; 3149 } 3150 3151 /* this also clears IE in fw if it's not set */ 3152 ret = ath6kl_wmi_set_appie_cmd(ar->wmi, vif->fw_vif_idx, 3153 WMI_FRAME_PROBE_REQ, 3154 request->ie, request->ie_len); 3155 if (ret) { 3156 ath6kl_warn("Failed to set probe request IE for scheduled scan: %d", 3157 ret); 3158 return ret; 3159 } 3160 3161 ret = ath6kl_wmi_set_host_sleep_mode_cmd(ar->wmi, vif->fw_vif_idx, 3162 ATH6KL_HOST_MODE_ASLEEP); 3163 if (ret) { 3164 ath6kl_warn("Failed to enable host sleep mode for sched scan: %d\n", 3165 ret); 3166 return ret; 3167 } 3168 3169 ar->state = ATH6KL_STATE_SCHED_SCAN; 3170 3171 return ret; 3172 } 3173 3174 static int ath6kl_cfg80211_sscan_stop(struct wiphy *wiphy, 3175 struct net_device *dev) 3176 { 3177 struct ath6kl_vif *vif = netdev_priv(dev); 3178 bool stopped; 3179 3180 stopped = __ath6kl_cfg80211_sscan_stop(vif); 3181 3182 if (!stopped) 3183 return -EIO; 3184 3185 return 0; 3186 } 3187 3188 static const struct ieee80211_txrx_stypes 3189 ath6kl_mgmt_stypes[NUM_NL80211_IFTYPES] = { 3190 [NL80211_IFTYPE_STATION] = { 3191 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3192 BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3193 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3194 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3195 }, 3196 [NL80211_IFTYPE_AP] = { 3197 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3198 BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3199 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3200 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3201 }, 3202 [NL80211_IFTYPE_P2P_CLIENT] = { 3203 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3204 BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3205 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3206 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3207 }, 3208 [NL80211_IFTYPE_P2P_GO] = { 3209 .tx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3210 BIT(IEEE80211_STYPE_PROBE_RESP >> 4), 3211 .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | 3212 BIT(IEEE80211_STYPE_PROBE_REQ >> 4) 3213 }, 3214 }; 3215 3216 static struct cfg80211_ops ath6kl_cfg80211_ops = { 3217 .add_virtual_intf = ath6kl_cfg80211_add_iface, 3218 .del_virtual_intf = ath6kl_cfg80211_del_iface, 3219 .change_virtual_intf = ath6kl_cfg80211_change_iface, 3220 .scan = ath6kl_cfg80211_scan, 3221 .connect = ath6kl_cfg80211_connect, 3222 .disconnect = ath6kl_cfg80211_disconnect, 3223 .add_key = ath6kl_cfg80211_add_key, 3224 .get_key = ath6kl_cfg80211_get_key, 3225 .del_key = ath6kl_cfg80211_del_key, 3226 .set_default_key = ath6kl_cfg80211_set_default_key, 3227 .set_wiphy_params = ath6kl_cfg80211_set_wiphy_params, 3228 .set_tx_power = ath6kl_cfg80211_set_txpower, 3229 .get_tx_power = ath6kl_cfg80211_get_txpower, 3230 .set_power_mgmt = ath6kl_cfg80211_set_power_mgmt, 3231 .join_ibss = ath6kl_cfg80211_join_ibss, 3232 .leave_ibss = ath6kl_cfg80211_leave_ibss, 3233 .get_station = ath6kl_get_station, 3234 .set_pmksa = ath6kl_set_pmksa, 3235 .del_pmksa = ath6kl_del_pmksa, 3236 .flush_pmksa = ath6kl_flush_pmksa, 3237 CFG80211_TESTMODE_CMD(ath6kl_tm_cmd) 3238 #ifdef CONFIG_PM 3239 .suspend = __ath6kl_cfg80211_suspend, 3240 .resume = __ath6kl_cfg80211_resume, 3241 #endif 3242 .set_channel = ath6kl_set_channel, 3243 .start_ap = ath6kl_start_ap, 3244 .change_beacon = ath6kl_change_beacon, 3245 .stop_ap = ath6kl_stop_ap, 3246 .del_station = ath6kl_del_station, 3247 .change_station = ath6kl_change_station, 3248 .remain_on_channel = ath6kl_remain_on_channel, 3249 .cancel_remain_on_channel = ath6kl_cancel_remain_on_channel, 3250 .mgmt_tx = ath6kl_mgmt_tx, 3251 .mgmt_frame_register = ath6kl_mgmt_frame_register, 3252 .sched_scan_start = ath6kl_cfg80211_sscan_start, 3253 .sched_scan_stop = ath6kl_cfg80211_sscan_stop, 3254 }; 3255 3256 void ath6kl_cfg80211_stop(struct ath6kl_vif *vif) 3257 { 3258 ath6kl_cfg80211_sscan_disable(vif); 3259 3260 switch (vif->sme_state) { 3261 case SME_DISCONNECTED: 3262 break; 3263 case SME_CONNECTING: 3264 cfg80211_connect_result(vif->ndev, vif->bssid, NULL, 0, 3265 NULL, 0, 3266 WLAN_STATUS_UNSPECIFIED_FAILURE, 3267 GFP_KERNEL); 3268 break; 3269 case SME_CONNECTED: 3270 cfg80211_disconnected(vif->ndev, 0, NULL, 0, GFP_KERNEL); 3271 break; 3272 } 3273 3274 if (test_bit(CONNECTED, &vif->flags) || 3275 test_bit(CONNECT_PEND, &vif->flags)) 3276 ath6kl_wmi_disconnect_cmd(vif->ar->wmi, vif->fw_vif_idx); 3277 3278 vif->sme_state = SME_DISCONNECTED; 3279 clear_bit(CONNECTED, &vif->flags); 3280 clear_bit(CONNECT_PEND, &vif->flags); 3281 3282 /* disable scanning */ 3283 if (ath6kl_wmi_scanparams_cmd(vif->ar->wmi, vif->fw_vif_idx, 0xFFFF, 3284 0, 0, 0, 0, 0, 0, 0, 0, 0) != 0) 3285 ath6kl_warn("failed to disable scan during stop\n"); 3286 3287 ath6kl_cfg80211_scan_complete_event(vif, true); 3288 } 3289 3290 void ath6kl_cfg80211_stop_all(struct ath6kl *ar) 3291 { 3292 struct ath6kl_vif *vif; 3293 3294 vif = ath6kl_vif_first(ar); 3295 if (!vif) { 3296 /* save the current power mode before enabling power save */ 3297 ar->wmi->saved_pwr_mode = ar->wmi->pwr_mode; 3298 3299 if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, REC_POWER) != 0) 3300 ath6kl_warn("ath6kl_deep_sleep_enable: wmi_powermode_cmd failed\n"); 3301 return; 3302 } 3303 3304 /* 3305 * FIXME: we should take ar->list_lock to protect changes in the 3306 * vif_list, but that's not trivial to do as ath6kl_cfg80211_stop() 3307 * sleeps. 3308 */ 3309 list_for_each_entry(vif, &ar->vif_list, list) 3310 ath6kl_cfg80211_stop(vif); 3311 } 3312 3313 static int ath6kl_cfg80211_vif_init(struct ath6kl_vif *vif) 3314 { 3315 vif->aggr_cntxt = aggr_init(vif); 3316 if (!vif->aggr_cntxt) { 3317 ath6kl_err("failed to initialize aggr\n"); 3318 return -ENOMEM; 3319 } 3320 3321 setup_timer(&vif->disconnect_timer, disconnect_timer_handler, 3322 (unsigned long) vif->ndev); 3323 setup_timer(&vif->sched_scan_timer, ath6kl_wmi_sscan_timer, 3324 (unsigned long) vif); 3325 3326 set_bit(WMM_ENABLED, &vif->flags); 3327 spin_lock_init(&vif->if_lock); 3328 3329 INIT_LIST_HEAD(&vif->mc_filter); 3330 3331 return 0; 3332 } 3333 3334 void ath6kl_cfg80211_vif_cleanup(struct ath6kl_vif *vif) 3335 { 3336 struct ath6kl *ar = vif->ar; 3337 struct ath6kl_mc_filter *mc_filter, *tmp; 3338 3339 aggr_module_destroy(vif->aggr_cntxt); 3340 3341 ar->avail_idx_map |= BIT(vif->fw_vif_idx); 3342 3343 if (vif->nw_type == ADHOC_NETWORK) 3344 ar->ibss_if_active = false; 3345 3346 list_for_each_entry_safe(mc_filter, tmp, &vif->mc_filter, list) { 3347 list_del(&mc_filter->list); 3348 kfree(mc_filter); 3349 } 3350 3351 unregister_netdevice(vif->ndev); 3352 3353 ar->num_vif--; 3354 } 3355 3356 struct net_device *ath6kl_interface_add(struct ath6kl *ar, char *name, 3357 enum nl80211_iftype type, u8 fw_vif_idx, 3358 u8 nw_type) 3359 { 3360 struct net_device *ndev; 3361 struct ath6kl_vif *vif; 3362 3363 ndev = alloc_netdev(sizeof(*vif), name, ether_setup); 3364 if (!ndev) 3365 return NULL; 3366 3367 vif = netdev_priv(ndev); 3368 ndev->ieee80211_ptr = &vif->wdev; 3369 vif->wdev.wiphy = ar->wiphy; 3370 vif->ar = ar; 3371 vif->ndev = ndev; 3372 SET_NETDEV_DEV(ndev, wiphy_dev(vif->wdev.wiphy)); 3373 vif->wdev.netdev = ndev; 3374 vif->wdev.iftype = type; 3375 vif->fw_vif_idx = fw_vif_idx; 3376 vif->nw_type = nw_type; 3377 vif->next_mode = nw_type; 3378 vif->listen_intvl_t = ATH6KL_DEFAULT_LISTEN_INTVAL; 3379 vif->bmiss_time_t = ATH6KL_DEFAULT_BMISS_TIME; 3380 vif->bg_scan_period = 0; 3381 vif->htcap.ht_enable = true; 3382 3383 memcpy(ndev->dev_addr, ar->mac_addr, ETH_ALEN); 3384 if (fw_vif_idx != 0) 3385 ndev->dev_addr[0] = (ndev->dev_addr[0] ^ (1 << fw_vif_idx)) | 3386 0x2; 3387 3388 init_netdev(ndev); 3389 3390 ath6kl_init_control_info(vif); 3391 3392 if (ath6kl_cfg80211_vif_init(vif)) 3393 goto err; 3394 3395 if (register_netdevice(ndev)) 3396 goto err; 3397 3398 ar->avail_idx_map &= ~BIT(fw_vif_idx); 3399 vif->sme_state = SME_DISCONNECTED; 3400 set_bit(WLAN_ENABLED, &vif->flags); 3401 ar->wlan_pwr_state = WLAN_POWER_STATE_ON; 3402 set_bit(NETDEV_REGISTERED, &vif->flags); 3403 3404 if (type == NL80211_IFTYPE_ADHOC) 3405 ar->ibss_if_active = true; 3406 3407 spin_lock_bh(&ar->list_lock); 3408 list_add_tail(&vif->list, &ar->vif_list); 3409 spin_unlock_bh(&ar->list_lock); 3410 3411 return ndev; 3412 3413 err: 3414 aggr_module_destroy(vif->aggr_cntxt); 3415 free_netdev(ndev); 3416 return NULL; 3417 } 3418 3419 int ath6kl_cfg80211_init(struct ath6kl *ar) 3420 { 3421 struct wiphy *wiphy = ar->wiphy; 3422 bool band_2gig = false, band_5gig = false, ht = false; 3423 int ret; 3424 3425 wiphy->mgmt_stypes = ath6kl_mgmt_stypes; 3426 3427 wiphy->max_remain_on_channel_duration = 5000; 3428 3429 /* set device pointer for wiphy */ 3430 set_wiphy_dev(wiphy, ar->dev); 3431 3432 wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) | 3433 BIT(NL80211_IFTYPE_ADHOC) | 3434 BIT(NL80211_IFTYPE_AP); 3435 if (ar->p2p) { 3436 wiphy->interface_modes |= BIT(NL80211_IFTYPE_P2P_GO) | 3437 BIT(NL80211_IFTYPE_P2P_CLIENT); 3438 } 3439 3440 /* max num of ssids that can be probed during scanning */ 3441 wiphy->max_scan_ssids = MAX_PROBED_SSID_INDEX; 3442 wiphy->max_scan_ie_len = 1000; /* FIX: what is correct limit? */ 3443 switch (ar->hw.cap) { 3444 case WMI_11AN_CAP: 3445 ht = true; 3446 case WMI_11A_CAP: 3447 band_5gig = true; 3448 break; 3449 case WMI_11GN_CAP: 3450 ht = true; 3451 case WMI_11G_CAP: 3452 band_2gig = true; 3453 break; 3454 case WMI_11AGN_CAP: 3455 ht = true; 3456 case WMI_11AG_CAP: 3457 band_2gig = true; 3458 band_5gig = true; 3459 break; 3460 default: 3461 ath6kl_err("invalid phy capability!\n"); 3462 return -EINVAL; 3463 } 3464 3465 if (!ht) { 3466 ath6kl_band_2ghz.ht_cap.cap = 0; 3467 ath6kl_band_2ghz.ht_cap.ht_supported = false; 3468 ath6kl_band_5ghz.ht_cap.cap = 0; 3469 ath6kl_band_5ghz.ht_cap.ht_supported = false; 3470 } 3471 if (band_2gig) 3472 wiphy->bands[IEEE80211_BAND_2GHZ] = &ath6kl_band_2ghz; 3473 if (band_5gig) 3474 wiphy->bands[IEEE80211_BAND_5GHZ] = &ath6kl_band_5ghz; 3475 3476 wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM; 3477 3478 wiphy->cipher_suites = cipher_suites; 3479 wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites); 3480 3481 wiphy->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT | 3482 WIPHY_WOWLAN_DISCONNECT | 3483 WIPHY_WOWLAN_GTK_REKEY_FAILURE | 3484 WIPHY_WOWLAN_SUPPORTS_GTK_REKEY | 3485 WIPHY_WOWLAN_EAP_IDENTITY_REQ | 3486 WIPHY_WOWLAN_4WAY_HANDSHAKE; 3487 wiphy->wowlan.n_patterns = WOW_MAX_FILTERS_PER_LIST; 3488 wiphy->wowlan.pattern_min_len = 1; 3489 wiphy->wowlan.pattern_max_len = WOW_PATTERN_SIZE; 3490 3491 wiphy->max_sched_scan_ssids = MAX_PROBED_SSID_INDEX; 3492 3493 ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM | 3494 WIPHY_FLAG_HAVE_AP_SME | 3495 WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL | 3496 WIPHY_FLAG_AP_PROBE_RESP_OFFLOAD; 3497 3498 if (test_bit(ATH6KL_FW_CAPABILITY_SCHED_SCAN, ar->fw_capabilities)) 3499 ar->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; 3500 3501 if (test_bit(ATH6KL_FW_CAPABILITY_INACTIVITY_TIMEOUT, 3502 ar->fw_capabilities)) 3503 ar->wiphy->features = NL80211_FEATURE_INACTIVITY_TIMER; 3504 3505 ar->wiphy->probe_resp_offload = 3506 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS | 3507 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_WPS2 | 3508 NL80211_PROBE_RESP_OFFLOAD_SUPPORT_P2P; 3509 3510 ret = wiphy_register(wiphy); 3511 if (ret < 0) { 3512 ath6kl_err("couldn't register wiphy device\n"); 3513 return ret; 3514 } 3515 3516 ar->wiphy_registered = true; 3517 3518 return 0; 3519 } 3520 3521 void ath6kl_cfg80211_cleanup(struct ath6kl *ar) 3522 { 3523 wiphy_unregister(ar->wiphy); 3524 3525 ar->wiphy_registered = false; 3526 } 3527 3528 struct ath6kl *ath6kl_cfg80211_create(void) 3529 { 3530 struct ath6kl *ar; 3531 struct wiphy *wiphy; 3532 3533 /* create a new wiphy for use with cfg80211 */ 3534 wiphy = wiphy_new(&ath6kl_cfg80211_ops, sizeof(struct ath6kl)); 3535 3536 if (!wiphy) { 3537 ath6kl_err("couldn't allocate wiphy device\n"); 3538 return NULL; 3539 } 3540 3541 ar = wiphy_priv(wiphy); 3542 ar->wiphy = wiphy; 3543 3544 return ar; 3545 } 3546 3547 /* Note: ar variable must not be accessed after calling this! */ 3548 void ath6kl_cfg80211_destroy(struct ath6kl *ar) 3549 { 3550 int i; 3551 3552 for (i = 0; i < AP_MAX_NUM_STA; i++) 3553 kfree(ar->sta_list[i].aggr_conn); 3554 3555 wiphy_free(ar->wiphy); 3556 } 3557 3558