1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * NXP Wireless LAN device driver: scan ioctl and command handling 4 * 5 * Copyright 2011-2020 NXP 6 */ 7 8 #include "decl.h" 9 #include "ioctl.h" 10 #include "util.h" 11 #include "fw.h" 12 #include "main.h" 13 #include "11n.h" 14 #include "cfg80211.h" 15 16 /* The maximum number of channels the firmware can scan per command */ 17 #define MWIFIEX_MAX_CHANNELS_PER_SPECIFIC_SCAN 14 18 19 #define MWIFIEX_DEF_CHANNELS_PER_SCAN_CMD 4 20 21 /* Memory needed to store a max sized Channel List TLV for a firmware scan */ 22 #define CHAN_TLV_MAX_SIZE (sizeof(struct mwifiex_ie_types_header) \ 23 + (MWIFIEX_MAX_CHANNELS_PER_SPECIFIC_SCAN \ 24 *sizeof(struct mwifiex_chan_scan_param_set))) 25 26 /* Memory needed to store supported rate */ 27 #define RATE_TLV_MAX_SIZE (sizeof(struct mwifiex_ie_types_rates_param_set) \ 28 + HOSTCMD_SUPPORTED_RATES) 29 30 /* Memory needed to store a max number/size WildCard SSID TLV for a firmware 31 scan */ 32 #define WILDCARD_SSID_TLV_MAX_SIZE \ 33 (MWIFIEX_MAX_SSID_LIST_LENGTH * \ 34 (sizeof(struct mwifiex_ie_types_wildcard_ssid_params) \ 35 + IEEE80211_MAX_SSID_LEN)) 36 37 /* Maximum memory needed for a mwifiex_scan_cmd_config with all TLVs at max */ 38 #define MAX_SCAN_CFG_ALLOC (sizeof(struct mwifiex_scan_cmd_config) \ 39 + sizeof(struct mwifiex_ie_types_num_probes) \ 40 + sizeof(struct mwifiex_ie_types_htcap) \ 41 + CHAN_TLV_MAX_SIZE \ 42 + RATE_TLV_MAX_SIZE \ 43 + WILDCARD_SSID_TLV_MAX_SIZE) 44 45 46 union mwifiex_scan_cmd_config_tlv { 47 /* Scan configuration (variable length) */ 48 struct mwifiex_scan_cmd_config config; 49 /* Max allocated block */ 50 u8 config_alloc_buf[MAX_SCAN_CFG_ALLOC]; 51 }; 52 53 enum cipher_suite { 54 CIPHER_SUITE_TKIP, 55 CIPHER_SUITE_CCMP, 56 CIPHER_SUITE_MAX 57 }; 58 static u8 mwifiex_wpa_oui[CIPHER_SUITE_MAX][4] = { 59 { 0x00, 0x50, 0xf2, 0x02 }, /* TKIP */ 60 { 0x00, 0x50, 0xf2, 0x04 }, /* AES */ 61 }; 62 static u8 mwifiex_rsn_oui[CIPHER_SUITE_MAX][4] = { 63 { 0x00, 0x0f, 0xac, 0x02 }, /* TKIP */ 64 { 0x00, 0x0f, 0xac, 0x04 }, /* AES */ 65 }; 66 67 static void 68 _dbg_security_flags(int log_level, const char *func, const char *desc, 69 struct mwifiex_private *priv, 70 struct mwifiex_bssdescriptor *bss_desc) 71 { 72 _mwifiex_dbg(priv->adapter, log_level, 73 "info: %s: %s:\twpa_ie=%#x wpa2_ie=%#x WEP=%s WPA=%s WPA2=%s\tEncMode=%#x privacy=%#x\n", 74 func, desc, 75 bss_desc->bcn_wpa_ie ? 76 bss_desc->bcn_wpa_ie->vend_hdr.element_id : 0, 77 bss_desc->bcn_rsn_ie ? 78 bss_desc->bcn_rsn_ie->ieee_hdr.element_id : 0, 79 priv->sec_info.wep_enabled ? "e" : "d", 80 priv->sec_info.wpa_enabled ? "e" : "d", 81 priv->sec_info.wpa2_enabled ? "e" : "d", 82 priv->sec_info.encryption_mode, 83 bss_desc->privacy); 84 } 85 #define dbg_security_flags(mask, desc, priv, bss_desc) \ 86 _dbg_security_flags(MWIFIEX_DBG_##mask, desc, __func__, priv, bss_desc) 87 88 static bool 89 has_ieee_hdr(struct ieee_types_generic *ie, u8 key) 90 { 91 return (ie && ie->ieee_hdr.element_id == key); 92 } 93 94 static bool 95 has_vendor_hdr(struct ieee_types_vendor_specific *ie, u8 key) 96 { 97 return (ie && ie->vend_hdr.element_id == key); 98 } 99 100 /* 101 * This function parses a given IE for a given OUI. 102 * 103 * This is used to parse a WPA/RSN IE to find if it has 104 * a given oui in PTK. 105 */ 106 static u8 107 mwifiex_search_oui_in_ie(struct ie_body *iebody, u8 *oui) 108 { 109 u8 count; 110 111 count = iebody->ptk_cnt[0]; 112 113 /* There could be multiple OUIs for PTK hence 114 1) Take the length. 115 2) Check all the OUIs for AES. 116 3) If one of them is AES then pass success. */ 117 while (count) { 118 if (!memcmp(iebody->ptk_body, oui, sizeof(iebody->ptk_body))) 119 return MWIFIEX_OUI_PRESENT; 120 121 --count; 122 if (count) 123 iebody = (struct ie_body *) ((u8 *) iebody + 124 sizeof(iebody->ptk_body)); 125 } 126 127 pr_debug("info: %s: OUI is not found in PTK\n", __func__); 128 return MWIFIEX_OUI_NOT_PRESENT; 129 } 130 131 /* 132 * This function checks if a given OUI is present in a RSN IE. 133 * 134 * The function first checks if a RSN IE is present or not in the 135 * BSS descriptor. It tries to locate the OUI only if such an IE is 136 * present. 137 */ 138 static u8 139 mwifiex_is_rsn_oui_present(struct mwifiex_bssdescriptor *bss_desc, u32 cipher) 140 { 141 u8 *oui; 142 struct ie_body *iebody; 143 u8 ret = MWIFIEX_OUI_NOT_PRESENT; 144 145 if (has_ieee_hdr(bss_desc->bcn_rsn_ie, WLAN_EID_RSN)) { 146 iebody = (struct ie_body *) 147 (((u8 *) bss_desc->bcn_rsn_ie->data) + 148 RSN_GTK_OUI_OFFSET); 149 oui = &mwifiex_rsn_oui[cipher][0]; 150 ret = mwifiex_search_oui_in_ie(iebody, oui); 151 if (ret) 152 return ret; 153 } 154 return ret; 155 } 156 157 /* 158 * This function checks if a given OUI is present in a WPA IE. 159 * 160 * The function first checks if a WPA IE is present or not in the 161 * BSS descriptor. It tries to locate the OUI only if such an IE is 162 * present. 163 */ 164 static u8 165 mwifiex_is_wpa_oui_present(struct mwifiex_bssdescriptor *bss_desc, u32 cipher) 166 { 167 u8 *oui; 168 struct ie_body *iebody; 169 u8 ret = MWIFIEX_OUI_NOT_PRESENT; 170 171 if (has_vendor_hdr(bss_desc->bcn_wpa_ie, WLAN_EID_VENDOR_SPECIFIC)) { 172 iebody = (struct ie_body *)((u8 *)bss_desc->bcn_wpa_ie->data + 173 WPA_GTK_OUI_OFFSET); 174 oui = &mwifiex_wpa_oui[cipher][0]; 175 ret = mwifiex_search_oui_in_ie(iebody, oui); 176 if (ret) 177 return ret; 178 } 179 return ret; 180 } 181 182 /* 183 * This function checks if wapi is enabled in driver and scanned network is 184 * compatible with it. 185 */ 186 static bool 187 mwifiex_is_bss_wapi(struct mwifiex_private *priv, 188 struct mwifiex_bssdescriptor *bss_desc) 189 { 190 if (priv->sec_info.wapi_enabled && 191 has_ieee_hdr(bss_desc->bcn_wapi_ie, WLAN_EID_BSS_AC_ACCESS_DELAY)) 192 return true; 193 return false; 194 } 195 196 /* 197 * This function checks if driver is configured with no security mode and 198 * scanned network is compatible with it. 199 */ 200 static bool 201 mwifiex_is_bss_no_sec(struct mwifiex_private *priv, 202 struct mwifiex_bssdescriptor *bss_desc) 203 { 204 if (!priv->sec_info.wep_enabled && !priv->sec_info.wpa_enabled && 205 !priv->sec_info.wpa2_enabled && 206 !has_vendor_hdr(bss_desc->bcn_wpa_ie, WLAN_EID_VENDOR_SPECIFIC) && 207 !has_ieee_hdr(bss_desc->bcn_rsn_ie, WLAN_EID_RSN) && 208 !priv->sec_info.encryption_mode && !bss_desc->privacy) { 209 return true; 210 } 211 return false; 212 } 213 214 /* 215 * This function checks if static WEP is enabled in driver and scanned network 216 * is compatible with it. 217 */ 218 static bool 219 mwifiex_is_bss_static_wep(struct mwifiex_private *priv, 220 struct mwifiex_bssdescriptor *bss_desc) 221 { 222 if (priv->sec_info.wep_enabled && !priv->sec_info.wpa_enabled && 223 !priv->sec_info.wpa2_enabled && bss_desc->privacy) { 224 return true; 225 } 226 return false; 227 } 228 229 /* 230 * This function checks if wpa is enabled in driver and scanned network is 231 * compatible with it. 232 */ 233 static bool 234 mwifiex_is_bss_wpa(struct mwifiex_private *priv, 235 struct mwifiex_bssdescriptor *bss_desc) 236 { 237 if (!priv->sec_info.wep_enabled && priv->sec_info.wpa_enabled && 238 !priv->sec_info.wpa2_enabled && 239 has_vendor_hdr(bss_desc->bcn_wpa_ie, WLAN_EID_VENDOR_SPECIFIC) 240 /* 241 * Privacy bit may NOT be set in some APs like 242 * LinkSys WRT54G && bss_desc->privacy 243 */ 244 ) { 245 dbg_security_flags(INFO, "WPA", priv, bss_desc); 246 return true; 247 } 248 return false; 249 } 250 251 /* 252 * This function checks if wpa2 is enabled in driver and scanned network is 253 * compatible with it. 254 */ 255 static bool 256 mwifiex_is_bss_wpa2(struct mwifiex_private *priv, 257 struct mwifiex_bssdescriptor *bss_desc) 258 { 259 if (!priv->sec_info.wep_enabled && !priv->sec_info.wpa_enabled && 260 priv->sec_info.wpa2_enabled && 261 has_ieee_hdr(bss_desc->bcn_rsn_ie, WLAN_EID_RSN)) { 262 /* 263 * Privacy bit may NOT be set in some APs like 264 * LinkSys WRT54G && bss_desc->privacy 265 */ 266 dbg_security_flags(INFO, "WAP2", priv, bss_desc); 267 return true; 268 } 269 return false; 270 } 271 272 /* 273 * This function checks if adhoc AES is enabled in driver and scanned network is 274 * compatible with it. 275 */ 276 static bool 277 mwifiex_is_bss_adhoc_aes(struct mwifiex_private *priv, 278 struct mwifiex_bssdescriptor *bss_desc) 279 { 280 if (!priv->sec_info.wep_enabled && !priv->sec_info.wpa_enabled && 281 !priv->sec_info.wpa2_enabled && 282 !has_vendor_hdr(bss_desc->bcn_wpa_ie, WLAN_EID_VENDOR_SPECIFIC) && 283 !has_ieee_hdr(bss_desc->bcn_rsn_ie, WLAN_EID_RSN) && 284 !priv->sec_info.encryption_mode && bss_desc->privacy) { 285 return true; 286 } 287 return false; 288 } 289 290 /* 291 * This function checks if dynamic WEP is enabled in driver and scanned network 292 * is compatible with it. 293 */ 294 static bool 295 mwifiex_is_bss_dynamic_wep(struct mwifiex_private *priv, 296 struct mwifiex_bssdescriptor *bss_desc) 297 { 298 if (!priv->sec_info.wep_enabled && !priv->sec_info.wpa_enabled && 299 !priv->sec_info.wpa2_enabled && 300 !has_vendor_hdr(bss_desc->bcn_wpa_ie, WLAN_EID_VENDOR_SPECIFIC) && 301 !has_ieee_hdr(bss_desc->bcn_rsn_ie, WLAN_EID_RSN) && 302 priv->sec_info.encryption_mode && bss_desc->privacy) { 303 dbg_security_flags(INFO, "dynamic", priv, bss_desc); 304 return true; 305 } 306 return false; 307 } 308 309 /* 310 * This function checks if a scanned network is compatible with the driver 311 * settings. 312 * 313 * WEP WPA WPA2 ad-hoc encrypt Network 314 * enabled enabled enabled AES mode Privacy WPA WPA2 Compatible 315 * 0 0 0 0 NONE 0 0 0 yes No security 316 * 0 1 0 0 x 1x 1 x yes WPA (disable 317 * HT if no AES) 318 * 0 0 1 0 x 1x x 1 yes WPA2 (disable 319 * HT if no AES) 320 * 0 0 0 1 NONE 1 0 0 yes Ad-hoc AES 321 * 1 0 0 0 NONE 1 0 0 yes Static WEP 322 * (disable HT) 323 * 0 0 0 0 !=NONE 1 0 0 yes Dynamic WEP 324 * 325 * Compatibility is not matched while roaming, except for mode. 326 */ 327 static s32 328 mwifiex_is_network_compatible(struct mwifiex_private *priv, 329 struct mwifiex_bssdescriptor *bss_desc, u32 mode) 330 { 331 struct mwifiex_adapter *adapter = priv->adapter; 332 333 bss_desc->disable_11n = false; 334 335 /* Don't check for compatibility if roaming */ 336 if (priv->media_connected && 337 (priv->bss_mode == NL80211_IFTYPE_STATION) && 338 (bss_desc->bss_mode == NL80211_IFTYPE_STATION)) 339 return 0; 340 341 if (priv->wps.session_enable) { 342 mwifiex_dbg(adapter, IOCTL, 343 "info: return success directly in WPS period\n"); 344 return 0; 345 } 346 347 if (bss_desc->chan_sw_ie_present) { 348 mwifiex_dbg(adapter, INFO, 349 "Don't connect to AP with WLAN_EID_CHANNEL_SWITCH\n"); 350 return -1; 351 } 352 353 if (mwifiex_is_bss_wapi(priv, bss_desc)) { 354 mwifiex_dbg(adapter, INFO, 355 "info: return success for WAPI AP\n"); 356 return 0; 357 } 358 359 if (bss_desc->bss_mode == mode) { 360 if (mwifiex_is_bss_no_sec(priv, bss_desc)) { 361 /* No security */ 362 return 0; 363 } else if (mwifiex_is_bss_static_wep(priv, bss_desc)) { 364 /* Static WEP enabled */ 365 mwifiex_dbg(adapter, INFO, 366 "info: Disable 11n in WEP mode.\n"); 367 bss_desc->disable_11n = true; 368 return 0; 369 } else if (mwifiex_is_bss_wpa(priv, bss_desc)) { 370 /* WPA enabled */ 371 if (((priv->adapter->config_bands & BAND_GN || 372 priv->adapter->config_bands & BAND_AN) && 373 bss_desc->bcn_ht_cap) && 374 !mwifiex_is_wpa_oui_present(bss_desc, 375 CIPHER_SUITE_CCMP)) { 376 377 if (mwifiex_is_wpa_oui_present 378 (bss_desc, CIPHER_SUITE_TKIP)) { 379 mwifiex_dbg(adapter, INFO, 380 "info: Disable 11n if AES\t" 381 "is not supported by AP\n"); 382 bss_desc->disable_11n = true; 383 } else { 384 return -1; 385 } 386 } 387 return 0; 388 } else if (mwifiex_is_bss_wpa2(priv, bss_desc)) { 389 /* WPA2 enabled */ 390 if (((priv->adapter->config_bands & BAND_GN || 391 priv->adapter->config_bands & BAND_AN) && 392 bss_desc->bcn_ht_cap) && 393 !mwifiex_is_rsn_oui_present(bss_desc, 394 CIPHER_SUITE_CCMP)) { 395 396 if (mwifiex_is_rsn_oui_present 397 (bss_desc, CIPHER_SUITE_TKIP)) { 398 mwifiex_dbg(adapter, INFO, 399 "info: Disable 11n if AES\t" 400 "is not supported by AP\n"); 401 bss_desc->disable_11n = true; 402 } else { 403 return -1; 404 } 405 } 406 return 0; 407 } else if (mwifiex_is_bss_adhoc_aes(priv, bss_desc)) { 408 /* Ad-hoc AES enabled */ 409 return 0; 410 } else if (mwifiex_is_bss_dynamic_wep(priv, bss_desc)) { 411 /* Dynamic WEP enabled */ 412 return 0; 413 } 414 415 /* Security doesn't match */ 416 dbg_security_flags(ERROR, "failed", priv, bss_desc); 417 return -1; 418 } 419 420 /* Mode doesn't match */ 421 return -1; 422 } 423 424 /* 425 * This function creates a channel list for the driver to scan, based 426 * on region/band information. 427 * 428 * This routine is used for any scan that is not provided with a 429 * specific channel list to scan. 430 */ 431 static int 432 mwifiex_scan_create_channel_list(struct mwifiex_private *priv, 433 const struct mwifiex_user_scan_cfg 434 *user_scan_in, 435 struct mwifiex_chan_scan_param_set 436 *scan_chan_list, 437 u8 filtered_scan) 438 { 439 enum nl80211_band band; 440 struct ieee80211_supported_band *sband; 441 struct ieee80211_channel *ch; 442 struct mwifiex_adapter *adapter = priv->adapter; 443 int chan_idx = 0, i; 444 445 for (band = 0; (band < NUM_NL80211_BANDS) ; band++) { 446 447 if (!priv->wdev.wiphy->bands[band]) 448 continue; 449 450 sband = priv->wdev.wiphy->bands[band]; 451 452 for (i = 0; (i < sband->n_channels) ; i++) { 453 ch = &sband->channels[i]; 454 if (ch->flags & IEEE80211_CHAN_DISABLED) 455 continue; 456 scan_chan_list[chan_idx].radio_type = band; 457 458 if (user_scan_in && 459 user_scan_in->chan_list[0].scan_time) 460 scan_chan_list[chan_idx].max_scan_time = 461 cpu_to_le16((u16) user_scan_in-> 462 chan_list[0].scan_time); 463 else if ((ch->flags & IEEE80211_CHAN_NO_IR) || 464 (ch->flags & IEEE80211_CHAN_RADAR)) 465 scan_chan_list[chan_idx].max_scan_time = 466 cpu_to_le16(adapter->passive_scan_time); 467 else 468 scan_chan_list[chan_idx].max_scan_time = 469 cpu_to_le16(adapter->active_scan_time); 470 471 if (ch->flags & IEEE80211_CHAN_NO_IR) 472 scan_chan_list[chan_idx].chan_scan_mode_bitmap 473 |= (MWIFIEX_PASSIVE_SCAN | 474 MWIFIEX_HIDDEN_SSID_REPORT); 475 else 476 scan_chan_list[chan_idx].chan_scan_mode_bitmap 477 &= ~MWIFIEX_PASSIVE_SCAN; 478 scan_chan_list[chan_idx].chan_number = 479 (u32) ch->hw_value; 480 481 scan_chan_list[chan_idx].chan_scan_mode_bitmap 482 |= MWIFIEX_DISABLE_CHAN_FILT; 483 484 if (filtered_scan && 485 !((ch->flags & IEEE80211_CHAN_NO_IR) || 486 (ch->flags & IEEE80211_CHAN_RADAR))) 487 scan_chan_list[chan_idx].max_scan_time = 488 cpu_to_le16(adapter->specific_scan_time); 489 490 chan_idx++; 491 } 492 493 } 494 return chan_idx; 495 } 496 497 /* This function creates a channel list tlv for bgscan config, based 498 * on region/band information. 499 */ 500 static int 501 mwifiex_bgscan_create_channel_list(struct mwifiex_private *priv, 502 const struct mwifiex_bg_scan_cfg 503 *bgscan_cfg_in, 504 struct mwifiex_chan_scan_param_set 505 *scan_chan_list) 506 { 507 enum nl80211_band band; 508 struct ieee80211_supported_band *sband; 509 struct ieee80211_channel *ch; 510 struct mwifiex_adapter *adapter = priv->adapter; 511 int chan_idx = 0, i; 512 513 for (band = 0; (band < NUM_NL80211_BANDS); band++) { 514 if (!priv->wdev.wiphy->bands[band]) 515 continue; 516 517 sband = priv->wdev.wiphy->bands[band]; 518 519 for (i = 0; (i < sband->n_channels) ; i++) { 520 ch = &sband->channels[i]; 521 if (ch->flags & IEEE80211_CHAN_DISABLED) 522 continue; 523 scan_chan_list[chan_idx].radio_type = band; 524 525 if (bgscan_cfg_in->chan_list[0].scan_time) 526 scan_chan_list[chan_idx].max_scan_time = 527 cpu_to_le16((u16)bgscan_cfg_in-> 528 chan_list[0].scan_time); 529 else if (ch->flags & IEEE80211_CHAN_NO_IR) 530 scan_chan_list[chan_idx].max_scan_time = 531 cpu_to_le16(adapter->passive_scan_time); 532 else 533 scan_chan_list[chan_idx].max_scan_time = 534 cpu_to_le16(adapter-> 535 specific_scan_time); 536 537 if (ch->flags & IEEE80211_CHAN_NO_IR) 538 scan_chan_list[chan_idx].chan_scan_mode_bitmap 539 |= MWIFIEX_PASSIVE_SCAN; 540 else 541 scan_chan_list[chan_idx].chan_scan_mode_bitmap 542 &= ~MWIFIEX_PASSIVE_SCAN; 543 544 scan_chan_list[chan_idx].chan_number = 545 (u32)ch->hw_value; 546 chan_idx++; 547 } 548 } 549 return chan_idx; 550 } 551 552 /* This function appends rate TLV to scan config command. */ 553 static int 554 mwifiex_append_rate_tlv(struct mwifiex_private *priv, 555 struct mwifiex_scan_cmd_config *scan_cfg_out, 556 u8 radio) 557 { 558 struct mwifiex_ie_types_rates_param_set *rates_tlv; 559 u8 rates[MWIFIEX_SUPPORTED_RATES], *tlv_pos; 560 u32 rates_size; 561 562 memset(rates, 0, sizeof(rates)); 563 564 tlv_pos = (u8 *)scan_cfg_out->tlv_buf + scan_cfg_out->tlv_buf_len; 565 566 if (priv->scan_request) 567 rates_size = mwifiex_get_rates_from_cfg80211(priv, rates, 568 radio); 569 else 570 rates_size = mwifiex_get_supported_rates(priv, rates); 571 572 mwifiex_dbg(priv->adapter, CMD, 573 "info: SCAN_CMD: Rates size = %d\n", 574 rates_size); 575 rates_tlv = (struct mwifiex_ie_types_rates_param_set *)tlv_pos; 576 rates_tlv->header.type = cpu_to_le16(WLAN_EID_SUPP_RATES); 577 rates_tlv->header.len = cpu_to_le16((u16) rates_size); 578 memcpy(rates_tlv->rates, rates, rates_size); 579 scan_cfg_out->tlv_buf_len += sizeof(rates_tlv->header) + rates_size; 580 581 return rates_size; 582 } 583 584 /* 585 * This function constructs and sends multiple scan config commands to 586 * the firmware. 587 * 588 * Previous routines in the code flow have created a scan command configuration 589 * with any requested TLVs. This function splits the channel TLV into maximum 590 * channels supported per scan lists and sends the portion of the channel TLV, 591 * along with the other TLVs, to the firmware. 592 */ 593 static int 594 mwifiex_scan_channel_list(struct mwifiex_private *priv, 595 u32 max_chan_per_scan, u8 filtered_scan, 596 struct mwifiex_scan_cmd_config *scan_cfg_out, 597 struct mwifiex_ie_types_chan_list_param_set 598 *chan_tlv_out, 599 struct mwifiex_chan_scan_param_set *scan_chan_list) 600 { 601 struct mwifiex_adapter *adapter = priv->adapter; 602 int ret = 0; 603 struct mwifiex_chan_scan_param_set *tmp_chan_list; 604 u32 tlv_idx, rates_size, cmd_no; 605 u32 total_scan_time; 606 u32 done_early; 607 u8 radio_type; 608 609 if (!scan_cfg_out || !chan_tlv_out || !scan_chan_list) { 610 mwifiex_dbg(priv->adapter, ERROR, 611 "info: Scan: Null detect: %p, %p, %p\n", 612 scan_cfg_out, chan_tlv_out, scan_chan_list); 613 return -1; 614 } 615 616 /* Check csa channel expiry before preparing scan list */ 617 mwifiex_11h_get_csa_closed_channel(priv); 618 619 chan_tlv_out->header.type = cpu_to_le16(TLV_TYPE_CHANLIST); 620 621 /* Set the temp channel struct pointer to the start of the desired 622 list */ 623 tmp_chan_list = scan_chan_list; 624 625 /* Loop through the desired channel list, sending a new firmware scan 626 commands for each max_chan_per_scan channels (or for 1,6,11 627 individually if configured accordingly) */ 628 while (tmp_chan_list->chan_number) { 629 630 tlv_idx = 0; 631 total_scan_time = 0; 632 radio_type = 0; 633 chan_tlv_out->header.len = 0; 634 done_early = false; 635 636 /* 637 * Construct the Channel TLV for the scan command. Continue to 638 * insert channel TLVs until: 639 * - the tlv_idx hits the maximum configured per scan command 640 * - the next channel to insert is 0 (end of desired channel 641 * list) 642 * - done_early is set (controlling individual scanning of 643 * 1,6,11) 644 */ 645 while (tlv_idx < max_chan_per_scan && 646 tmp_chan_list->chan_number && !done_early) { 647 648 if (tmp_chan_list->chan_number == priv->csa_chan) { 649 tmp_chan_list++; 650 continue; 651 } 652 653 radio_type = tmp_chan_list->radio_type; 654 mwifiex_dbg(priv->adapter, INFO, 655 "info: Scan: Chan(%3d), Radio(%d),\t" 656 "Mode(%d, %d), Dur(%d)\n", 657 tmp_chan_list->chan_number, 658 tmp_chan_list->radio_type, 659 tmp_chan_list->chan_scan_mode_bitmap 660 & MWIFIEX_PASSIVE_SCAN, 661 (tmp_chan_list->chan_scan_mode_bitmap 662 & MWIFIEX_DISABLE_CHAN_FILT) >> 1, 663 le16_to_cpu(tmp_chan_list->max_scan_time)); 664 665 /* Copy the current channel TLV to the command being 666 prepared */ 667 memcpy(&chan_tlv_out->chan_scan_param[tlv_idx], 668 tmp_chan_list, 669 sizeof(*chan_tlv_out->chan_scan_param)); 670 671 /* Increment the TLV header length by the size 672 appended */ 673 le16_unaligned_add_cpu(&chan_tlv_out->header.len, 674 sizeof(*chan_tlv_out->chan_scan_param)); 675 676 /* 677 * The tlv buffer length is set to the number of bytes 678 * of the between the channel tlv pointer and the start 679 * of the tlv buffer. This compensates for any TLVs 680 * that were appended before the channel list. 681 */ 682 scan_cfg_out->tlv_buf_len = (u32) ((u8 *) chan_tlv_out - 683 scan_cfg_out->tlv_buf); 684 685 /* Add the size of the channel tlv header and the data 686 length */ 687 scan_cfg_out->tlv_buf_len += 688 (sizeof(chan_tlv_out->header) 689 + le16_to_cpu(chan_tlv_out->header.len)); 690 691 /* Increment the index to the channel tlv we are 692 constructing */ 693 tlv_idx++; 694 695 /* Count the total scan time per command */ 696 total_scan_time += 697 le16_to_cpu(tmp_chan_list->max_scan_time); 698 699 done_early = false; 700 701 /* Stop the loop if the *current* channel is in the 702 1,6,11 set and we are not filtering on a BSSID 703 or SSID. */ 704 if (!filtered_scan && 705 (tmp_chan_list->chan_number == 1 || 706 tmp_chan_list->chan_number == 6 || 707 tmp_chan_list->chan_number == 11)) 708 done_early = true; 709 710 /* Increment the tmp pointer to the next channel to 711 be scanned */ 712 tmp_chan_list++; 713 714 /* Stop the loop if the *next* channel is in the 1,6,11 715 set. This will cause it to be the only channel 716 scanned on the next interation */ 717 if (!filtered_scan && 718 (tmp_chan_list->chan_number == 1 || 719 tmp_chan_list->chan_number == 6 || 720 tmp_chan_list->chan_number == 11)) 721 done_early = true; 722 } 723 724 /* The total scan time should be less than scan command timeout 725 value */ 726 if (total_scan_time > MWIFIEX_MAX_TOTAL_SCAN_TIME) { 727 mwifiex_dbg(priv->adapter, ERROR, 728 "total scan time %dms\t" 729 "is over limit (%dms), scan skipped\n", 730 total_scan_time, 731 MWIFIEX_MAX_TOTAL_SCAN_TIME); 732 ret = -1; 733 break; 734 } 735 736 rates_size = mwifiex_append_rate_tlv(priv, scan_cfg_out, 737 radio_type); 738 739 /* Send the scan command to the firmware with the specified 740 cfg */ 741 if (priv->adapter->ext_scan) 742 cmd_no = HostCmd_CMD_802_11_SCAN_EXT; 743 else 744 cmd_no = HostCmd_CMD_802_11_SCAN; 745 746 ret = mwifiex_send_cmd(priv, cmd_no, HostCmd_ACT_GEN_SET, 747 0, scan_cfg_out, false); 748 749 /* rate IE is updated per scan command but same starting 750 * pointer is used each time so that rate IE from earlier 751 * scan_cfg_out->buf is overwritten with new one. 752 */ 753 scan_cfg_out->tlv_buf_len -= 754 sizeof(struct mwifiex_ie_types_header) + rates_size; 755 756 if (ret) { 757 mwifiex_cancel_pending_scan_cmd(adapter); 758 break; 759 } 760 } 761 762 if (ret) 763 return -1; 764 765 return 0; 766 } 767 768 /* 769 * This function constructs a scan command configuration structure to use 770 * in scan commands. 771 * 772 * Application layer or other functions can invoke network scanning 773 * with a scan configuration supplied in a user scan configuration structure. 774 * This structure is used as the basis of one or many scan command configuration 775 * commands that are sent to the command processing module and eventually to the 776 * firmware. 777 * 778 * This function creates a scan command configuration structure based on the 779 * following user supplied parameters (if present): 780 * - SSID filter 781 * - BSSID filter 782 * - Number of Probes to be sent 783 * - Channel list 784 * 785 * If the SSID or BSSID filter is not present, the filter is disabled/cleared. 786 * If the number of probes is not set, adapter default setting is used. 787 */ 788 static void 789 mwifiex_config_scan(struct mwifiex_private *priv, 790 const struct mwifiex_user_scan_cfg *user_scan_in, 791 struct mwifiex_scan_cmd_config *scan_cfg_out, 792 struct mwifiex_ie_types_chan_list_param_set **chan_list_out, 793 struct mwifiex_chan_scan_param_set *scan_chan_list, 794 u8 *max_chan_per_scan, u8 *filtered_scan, 795 u8 *scan_current_only) 796 { 797 struct mwifiex_adapter *adapter = priv->adapter; 798 struct mwifiex_ie_types_num_probes *num_probes_tlv; 799 struct mwifiex_ie_types_scan_chan_gap *chan_gap_tlv; 800 struct mwifiex_ie_types_random_mac *random_mac_tlv; 801 struct mwifiex_ie_types_wildcard_ssid_params *wildcard_ssid_tlv; 802 struct mwifiex_ie_types_bssid_list *bssid_tlv; 803 u8 *tlv_pos; 804 u32 num_probes; 805 u32 ssid_len; 806 u32 chan_idx; 807 u32 scan_type; 808 u16 scan_dur; 809 u8 channel; 810 u8 radio_type; 811 int i; 812 u8 ssid_filter; 813 struct mwifiex_ie_types_htcap *ht_cap; 814 struct mwifiex_ie_types_bss_mode *bss_mode; 815 816 /* The tlv_buf_len is calculated for each scan command. The TLVs added 817 in this routine will be preserved since the routine that sends the 818 command will append channelTLVs at *chan_list_out. The difference 819 between the *chan_list_out and the tlv_buf start will be used to 820 calculate the size of anything we add in this routine. */ 821 scan_cfg_out->tlv_buf_len = 0; 822 823 /* Running tlv pointer. Assigned to chan_list_out at end of function 824 so later routines know where channels can be added to the command 825 buf */ 826 tlv_pos = scan_cfg_out->tlv_buf; 827 828 /* Initialize the scan as un-filtered; the flag is later set to TRUE 829 below if a SSID or BSSID filter is sent in the command */ 830 *filtered_scan = false; 831 832 /* Initialize the scan as not being only on the current channel. If 833 the channel list is customized, only contains one channel, and is 834 the active channel, this is set true and data flow is not halted. */ 835 *scan_current_only = false; 836 837 if (user_scan_in) { 838 u8 tmpaddr[ETH_ALEN]; 839 840 /* Default the ssid_filter flag to TRUE, set false under 841 certain wildcard conditions and qualified by the existence 842 of an SSID list before marking the scan as filtered */ 843 ssid_filter = true; 844 845 /* Set the BSS type scan filter, use Adapter setting if 846 unset */ 847 scan_cfg_out->bss_mode = 848 (u8)(user_scan_in->bss_mode ?: adapter->scan_mode); 849 850 /* Set the number of probes to send, use Adapter setting 851 if unset */ 852 num_probes = user_scan_in->num_probes ?: adapter->scan_probes; 853 854 /* 855 * Set the BSSID filter to the incoming configuration, 856 * if non-zero. If not set, it will remain disabled 857 * (all zeros). 858 */ 859 memcpy(scan_cfg_out->specific_bssid, 860 user_scan_in->specific_bssid, 861 sizeof(scan_cfg_out->specific_bssid)); 862 863 memcpy(tmpaddr, scan_cfg_out->specific_bssid, ETH_ALEN); 864 865 if (adapter->ext_scan && 866 !is_zero_ether_addr(tmpaddr)) { 867 bssid_tlv = 868 (struct mwifiex_ie_types_bssid_list *)tlv_pos; 869 bssid_tlv->header.type = cpu_to_le16(TLV_TYPE_BSSID); 870 bssid_tlv->header.len = cpu_to_le16(ETH_ALEN); 871 memcpy(bssid_tlv->bssid, user_scan_in->specific_bssid, 872 ETH_ALEN); 873 tlv_pos += sizeof(struct mwifiex_ie_types_bssid_list); 874 } 875 876 for (i = 0; i < user_scan_in->num_ssids; i++) { 877 ssid_len = user_scan_in->ssid_list[i].ssid_len; 878 879 wildcard_ssid_tlv = 880 (struct mwifiex_ie_types_wildcard_ssid_params *) 881 tlv_pos; 882 wildcard_ssid_tlv->header.type = 883 cpu_to_le16(TLV_TYPE_WILDCARDSSID); 884 wildcard_ssid_tlv->header.len = cpu_to_le16( 885 (u16) (ssid_len + sizeof(wildcard_ssid_tlv-> 886 max_ssid_length))); 887 888 /* 889 * max_ssid_length = 0 tells firmware to perform 890 * specific scan for the SSID filled, whereas 891 * max_ssid_length = IEEE80211_MAX_SSID_LEN is for 892 * wildcard scan. 893 */ 894 if (ssid_len) 895 wildcard_ssid_tlv->max_ssid_length = 0; 896 else 897 wildcard_ssid_tlv->max_ssid_length = 898 IEEE80211_MAX_SSID_LEN; 899 900 if (!memcmp(user_scan_in->ssid_list[i].ssid, 901 "DIRECT-", 7)) 902 wildcard_ssid_tlv->max_ssid_length = 0xfe; 903 904 memcpy(wildcard_ssid_tlv->ssid, 905 user_scan_in->ssid_list[i].ssid, ssid_len); 906 907 tlv_pos += (sizeof(wildcard_ssid_tlv->header) 908 + le16_to_cpu(wildcard_ssid_tlv->header.len)); 909 910 mwifiex_dbg(adapter, INFO, 911 "info: scan: ssid[%d]: %s, %d\n", 912 i, wildcard_ssid_tlv->ssid, 913 wildcard_ssid_tlv->max_ssid_length); 914 915 /* Empty wildcard ssid with a maxlen will match many or 916 potentially all SSIDs (maxlen == 32), therefore do 917 not treat the scan as 918 filtered. */ 919 if (!ssid_len && wildcard_ssid_tlv->max_ssid_length) 920 ssid_filter = false; 921 } 922 923 /* 924 * The default number of channels sent in the command is low to 925 * ensure the response buffer from the firmware does not 926 * truncate scan results. That is not an issue with an SSID 927 * or BSSID filter applied to the scan results in the firmware. 928 */ 929 memcpy(tmpaddr, scan_cfg_out->specific_bssid, ETH_ALEN); 930 if ((i && ssid_filter) || 931 !is_zero_ether_addr(tmpaddr)) 932 *filtered_scan = true; 933 934 if (user_scan_in->scan_chan_gap) { 935 mwifiex_dbg(adapter, INFO, 936 "info: scan: channel gap = %d\n", 937 user_scan_in->scan_chan_gap); 938 *max_chan_per_scan = 939 MWIFIEX_MAX_CHANNELS_PER_SPECIFIC_SCAN; 940 941 chan_gap_tlv = (void *)tlv_pos; 942 chan_gap_tlv->header.type = 943 cpu_to_le16(TLV_TYPE_SCAN_CHANNEL_GAP); 944 chan_gap_tlv->header.len = 945 cpu_to_le16(sizeof(chan_gap_tlv->chan_gap)); 946 chan_gap_tlv->chan_gap = 947 cpu_to_le16((user_scan_in->scan_chan_gap)); 948 tlv_pos += 949 sizeof(struct mwifiex_ie_types_scan_chan_gap); 950 } 951 952 if (!is_zero_ether_addr(user_scan_in->random_mac)) { 953 random_mac_tlv = (void *)tlv_pos; 954 random_mac_tlv->header.type = 955 cpu_to_le16(TLV_TYPE_RANDOM_MAC); 956 random_mac_tlv->header.len = 957 cpu_to_le16(sizeof(random_mac_tlv->mac)); 958 ether_addr_copy(random_mac_tlv->mac, 959 user_scan_in->random_mac); 960 tlv_pos += 961 sizeof(struct mwifiex_ie_types_random_mac); 962 } 963 } else { 964 scan_cfg_out->bss_mode = (u8) adapter->scan_mode; 965 num_probes = adapter->scan_probes; 966 } 967 968 /* 969 * If a specific BSSID or SSID is used, the number of channels in the 970 * scan command will be increased to the absolute maximum. 971 */ 972 if (*filtered_scan) { 973 *max_chan_per_scan = MWIFIEX_MAX_CHANNELS_PER_SPECIFIC_SCAN; 974 } else { 975 if (!priv->media_connected) 976 *max_chan_per_scan = MWIFIEX_DEF_CHANNELS_PER_SCAN_CMD; 977 else 978 *max_chan_per_scan = 979 MWIFIEX_DEF_CHANNELS_PER_SCAN_CMD / 2; 980 } 981 982 if (adapter->ext_scan) { 983 bss_mode = (struct mwifiex_ie_types_bss_mode *)tlv_pos; 984 bss_mode->header.type = cpu_to_le16(TLV_TYPE_BSS_MODE); 985 bss_mode->header.len = cpu_to_le16(sizeof(bss_mode->bss_mode)); 986 bss_mode->bss_mode = scan_cfg_out->bss_mode; 987 tlv_pos += sizeof(bss_mode->header) + 988 le16_to_cpu(bss_mode->header.len); 989 } 990 991 /* If the input config or adapter has the number of Probes set, 992 add tlv */ 993 if (num_probes) { 994 995 mwifiex_dbg(adapter, INFO, 996 "info: scan: num_probes = %d\n", 997 num_probes); 998 999 num_probes_tlv = (struct mwifiex_ie_types_num_probes *) tlv_pos; 1000 num_probes_tlv->header.type = cpu_to_le16(TLV_TYPE_NUMPROBES); 1001 num_probes_tlv->header.len = 1002 cpu_to_le16(sizeof(num_probes_tlv->num_probes)); 1003 num_probes_tlv->num_probes = cpu_to_le16((u16) num_probes); 1004 1005 tlv_pos += sizeof(num_probes_tlv->header) + 1006 le16_to_cpu(num_probes_tlv->header.len); 1007 1008 } 1009 1010 if (ISSUPP_11NENABLED(priv->adapter->fw_cap_info) && 1011 (priv->adapter->config_bands & BAND_GN || 1012 priv->adapter->config_bands & BAND_AN)) { 1013 ht_cap = (struct mwifiex_ie_types_htcap *) tlv_pos; 1014 memset(ht_cap, 0, sizeof(struct mwifiex_ie_types_htcap)); 1015 ht_cap->header.type = cpu_to_le16(WLAN_EID_HT_CAPABILITY); 1016 ht_cap->header.len = 1017 cpu_to_le16(sizeof(struct ieee80211_ht_cap)); 1018 radio_type = 1019 mwifiex_band_to_radio_type(priv->adapter->config_bands); 1020 mwifiex_fill_cap_info(priv, radio_type, &ht_cap->ht_cap); 1021 tlv_pos += sizeof(struct mwifiex_ie_types_htcap); 1022 } 1023 1024 /* Append vendor specific IE TLV */ 1025 mwifiex_cmd_append_vsie_tlv(priv, MWIFIEX_VSIE_MASK_SCAN, &tlv_pos); 1026 1027 /* 1028 * Set the output for the channel TLV to the address in the tlv buffer 1029 * past any TLVs that were added in this function (SSID, num_probes). 1030 * Channel TLVs will be added past this for each scan command, 1031 * preserving the TLVs that were previously added. 1032 */ 1033 *chan_list_out = 1034 (struct mwifiex_ie_types_chan_list_param_set *) tlv_pos; 1035 1036 if (user_scan_in && user_scan_in->chan_list[0].chan_number) { 1037 1038 mwifiex_dbg(adapter, INFO, 1039 "info: Scan: Using supplied channel list\n"); 1040 1041 for (chan_idx = 0; 1042 chan_idx < MWIFIEX_USER_SCAN_CHAN_MAX && 1043 user_scan_in->chan_list[chan_idx].chan_number; 1044 chan_idx++) { 1045 1046 channel = user_scan_in->chan_list[chan_idx].chan_number; 1047 scan_chan_list[chan_idx].chan_number = channel; 1048 1049 radio_type = 1050 user_scan_in->chan_list[chan_idx].radio_type; 1051 scan_chan_list[chan_idx].radio_type = radio_type; 1052 1053 scan_type = user_scan_in->chan_list[chan_idx].scan_type; 1054 1055 if (scan_type == MWIFIEX_SCAN_TYPE_PASSIVE) 1056 scan_chan_list[chan_idx].chan_scan_mode_bitmap 1057 |= (MWIFIEX_PASSIVE_SCAN | 1058 MWIFIEX_HIDDEN_SSID_REPORT); 1059 else 1060 scan_chan_list[chan_idx].chan_scan_mode_bitmap 1061 &= ~MWIFIEX_PASSIVE_SCAN; 1062 1063 scan_chan_list[chan_idx].chan_scan_mode_bitmap 1064 |= MWIFIEX_DISABLE_CHAN_FILT; 1065 1066 if (user_scan_in->chan_list[chan_idx].scan_time) { 1067 scan_dur = (u16) user_scan_in-> 1068 chan_list[chan_idx].scan_time; 1069 } else { 1070 if (scan_type == MWIFIEX_SCAN_TYPE_PASSIVE) 1071 scan_dur = adapter->passive_scan_time; 1072 else if (*filtered_scan) 1073 scan_dur = adapter->specific_scan_time; 1074 else 1075 scan_dur = adapter->active_scan_time; 1076 } 1077 1078 scan_chan_list[chan_idx].min_scan_time = 1079 cpu_to_le16(scan_dur); 1080 scan_chan_list[chan_idx].max_scan_time = 1081 cpu_to_le16(scan_dur); 1082 } 1083 1084 /* Check if we are only scanning the current channel */ 1085 if ((chan_idx == 1) && 1086 (user_scan_in->chan_list[0].chan_number == 1087 priv->curr_bss_params.bss_descriptor.channel)) { 1088 *scan_current_only = true; 1089 mwifiex_dbg(adapter, INFO, 1090 "info: Scan: Scanning current channel only\n"); 1091 } 1092 } else { 1093 mwifiex_dbg(adapter, INFO, 1094 "info: Scan: Creating full region channel list\n"); 1095 mwifiex_scan_create_channel_list(priv, user_scan_in, 1096 scan_chan_list, 1097 *filtered_scan); 1098 } 1099 1100 } 1101 1102 /* 1103 * This function inspects the scan response buffer for pointers to 1104 * expected TLVs. 1105 * 1106 * TLVs can be included at the end of the scan response BSS information. 1107 * 1108 * Data in the buffer is parsed pointers to TLVs that can potentially 1109 * be passed back in the response. 1110 */ 1111 static void 1112 mwifiex_ret_802_11_scan_get_tlv_ptrs(struct mwifiex_adapter *adapter, 1113 struct mwifiex_ie_types_data *tlv, 1114 u32 tlv_buf_size, u32 req_tlv_type, 1115 struct mwifiex_ie_types_data **tlv_data) 1116 { 1117 struct mwifiex_ie_types_data *current_tlv; 1118 u32 tlv_buf_left; 1119 u32 tlv_type; 1120 u32 tlv_len; 1121 1122 current_tlv = tlv; 1123 tlv_buf_left = tlv_buf_size; 1124 *tlv_data = NULL; 1125 1126 mwifiex_dbg(adapter, INFO, 1127 "info: SCAN_RESP: tlv_buf_size = %d\n", 1128 tlv_buf_size); 1129 1130 while (tlv_buf_left >= sizeof(struct mwifiex_ie_types_header)) { 1131 1132 tlv_type = le16_to_cpu(current_tlv->header.type); 1133 tlv_len = le16_to_cpu(current_tlv->header.len); 1134 1135 if (sizeof(tlv->header) + tlv_len > tlv_buf_left) { 1136 mwifiex_dbg(adapter, ERROR, 1137 "SCAN_RESP: TLV buffer corrupt\n"); 1138 break; 1139 } 1140 1141 if (req_tlv_type == tlv_type) { 1142 switch (tlv_type) { 1143 case TLV_TYPE_TSFTIMESTAMP: 1144 mwifiex_dbg(adapter, INFO, 1145 "info: SCAN_RESP: TSF\t" 1146 "timestamp TLV, len = %d\n", 1147 tlv_len); 1148 *tlv_data = current_tlv; 1149 break; 1150 case TLV_TYPE_CHANNELBANDLIST: 1151 mwifiex_dbg(adapter, INFO, 1152 "info: SCAN_RESP: channel\t" 1153 "band list TLV, len = %d\n", 1154 tlv_len); 1155 *tlv_data = current_tlv; 1156 break; 1157 default: 1158 mwifiex_dbg(adapter, ERROR, 1159 "SCAN_RESP: unhandled TLV = %d\n", 1160 tlv_type); 1161 /* Give up, this seems corrupted */ 1162 return; 1163 } 1164 } 1165 1166 if (*tlv_data) 1167 break; 1168 1169 1170 tlv_buf_left -= (sizeof(tlv->header) + tlv_len); 1171 current_tlv = 1172 (struct mwifiex_ie_types_data *) (current_tlv->data + 1173 tlv_len); 1174 1175 } /* while */ 1176 } 1177 1178 /* 1179 * This function parses provided beacon buffer and updates 1180 * respective fields in bss descriptor structure. 1181 */ 1182 int mwifiex_update_bss_desc_with_ie(struct mwifiex_adapter *adapter, 1183 struct mwifiex_bssdescriptor *bss_entry) 1184 { 1185 u8 element_id; 1186 struct ieee_types_fh_param_set *fh_param_set; 1187 struct ieee_types_ds_param_set *ds_param_set; 1188 struct ieee_types_cf_param_set *cf_param_set; 1189 struct ieee_types_ibss_param_set *ibss_param_set; 1190 u8 *current_ptr; 1191 u8 *rate; 1192 u8 element_len; 1193 u16 total_ie_len; 1194 u8 bytes_to_copy; 1195 u8 rate_size; 1196 u8 found_data_rate_ie; 1197 u32 bytes_left; 1198 struct ieee_types_vendor_specific *vendor_ie; 1199 const u8 wpa_oui[4] = { 0x00, 0x50, 0xf2, 0x01 }; 1200 const u8 wmm_oui[4] = { 0x00, 0x50, 0xf2, 0x02 }; 1201 1202 found_data_rate_ie = false; 1203 rate_size = 0; 1204 current_ptr = bss_entry->beacon_buf; 1205 bytes_left = bss_entry->beacon_buf_size; 1206 1207 /* Process variable IE */ 1208 while (bytes_left >= 2) { 1209 element_id = *current_ptr; 1210 element_len = *(current_ptr + 1); 1211 total_ie_len = element_len + sizeof(struct ieee_types_header); 1212 1213 if (bytes_left < total_ie_len) { 1214 mwifiex_dbg(adapter, ERROR, 1215 "err: InterpretIE: in processing\t" 1216 "IE, bytes left < IE length\n"); 1217 return -EINVAL; 1218 } 1219 switch (element_id) { 1220 case WLAN_EID_SSID: 1221 if (element_len > IEEE80211_MAX_SSID_LEN) 1222 return -EINVAL; 1223 bss_entry->ssid.ssid_len = element_len; 1224 memcpy(bss_entry->ssid.ssid, (current_ptr + 2), 1225 element_len); 1226 mwifiex_dbg(adapter, INFO, 1227 "info: InterpretIE: ssid: %-32s\n", 1228 bss_entry->ssid.ssid); 1229 break; 1230 1231 case WLAN_EID_SUPP_RATES: 1232 if (element_len > MWIFIEX_SUPPORTED_RATES) 1233 return -EINVAL; 1234 memcpy(bss_entry->data_rates, current_ptr + 2, 1235 element_len); 1236 memcpy(bss_entry->supported_rates, current_ptr + 2, 1237 element_len); 1238 rate_size = element_len; 1239 found_data_rate_ie = true; 1240 break; 1241 1242 case WLAN_EID_FH_PARAMS: 1243 if (total_ie_len < sizeof(*fh_param_set)) 1244 return -EINVAL; 1245 fh_param_set = 1246 (struct ieee_types_fh_param_set *) current_ptr; 1247 memcpy(&bss_entry->phy_param_set.fh_param_set, 1248 fh_param_set, 1249 sizeof(struct ieee_types_fh_param_set)); 1250 break; 1251 1252 case WLAN_EID_DS_PARAMS: 1253 if (total_ie_len < sizeof(*ds_param_set)) 1254 return -EINVAL; 1255 ds_param_set = 1256 (struct ieee_types_ds_param_set *) current_ptr; 1257 1258 bss_entry->channel = ds_param_set->current_chan; 1259 1260 memcpy(&bss_entry->phy_param_set.ds_param_set, 1261 ds_param_set, 1262 sizeof(struct ieee_types_ds_param_set)); 1263 break; 1264 1265 case WLAN_EID_CF_PARAMS: 1266 if (total_ie_len < sizeof(*cf_param_set)) 1267 return -EINVAL; 1268 cf_param_set = 1269 (struct ieee_types_cf_param_set *) current_ptr; 1270 memcpy(&bss_entry->ss_param_set.cf_param_set, 1271 cf_param_set, 1272 sizeof(struct ieee_types_cf_param_set)); 1273 break; 1274 1275 case WLAN_EID_IBSS_PARAMS: 1276 if (total_ie_len < sizeof(*ibss_param_set)) 1277 return -EINVAL; 1278 ibss_param_set = 1279 (struct ieee_types_ibss_param_set *) 1280 current_ptr; 1281 memcpy(&bss_entry->ss_param_set.ibss_param_set, 1282 ibss_param_set, 1283 sizeof(struct ieee_types_ibss_param_set)); 1284 break; 1285 1286 case WLAN_EID_ERP_INFO: 1287 if (!element_len) 1288 return -EINVAL; 1289 bss_entry->erp_flags = *(current_ptr + 2); 1290 break; 1291 1292 case WLAN_EID_PWR_CONSTRAINT: 1293 if (!element_len) 1294 return -EINVAL; 1295 bss_entry->local_constraint = *(current_ptr + 2); 1296 bss_entry->sensed_11h = true; 1297 break; 1298 1299 case WLAN_EID_CHANNEL_SWITCH: 1300 bss_entry->chan_sw_ie_present = true; 1301 fallthrough; 1302 case WLAN_EID_PWR_CAPABILITY: 1303 case WLAN_EID_TPC_REPORT: 1304 case WLAN_EID_QUIET: 1305 bss_entry->sensed_11h = true; 1306 break; 1307 1308 case WLAN_EID_EXT_SUPP_RATES: 1309 /* 1310 * Only process extended supported rate 1311 * if data rate is already found. 1312 * Data rate IE should come before 1313 * extended supported rate IE 1314 */ 1315 if (found_data_rate_ie) { 1316 if ((element_len + rate_size) > 1317 MWIFIEX_SUPPORTED_RATES) 1318 bytes_to_copy = 1319 (MWIFIEX_SUPPORTED_RATES - 1320 rate_size); 1321 else 1322 bytes_to_copy = element_len; 1323 1324 rate = (u8 *) bss_entry->data_rates; 1325 rate += rate_size; 1326 memcpy(rate, current_ptr + 2, bytes_to_copy); 1327 1328 rate = (u8 *) bss_entry->supported_rates; 1329 rate += rate_size; 1330 memcpy(rate, current_ptr + 2, bytes_to_copy); 1331 } 1332 break; 1333 1334 case WLAN_EID_VENDOR_SPECIFIC: 1335 vendor_ie = (struct ieee_types_vendor_specific *) 1336 current_ptr; 1337 1338 /* 802.11 requires at least 3-byte OUI. */ 1339 if (element_len < sizeof(vendor_ie->vend_hdr.oui.oui)) 1340 return -EINVAL; 1341 1342 /* Not long enough for a match? Skip it. */ 1343 if (element_len < sizeof(wpa_oui)) 1344 break; 1345 1346 if (!memcmp(&vendor_ie->vend_hdr.oui, wpa_oui, 1347 sizeof(wpa_oui))) { 1348 bss_entry->bcn_wpa_ie = 1349 (struct ieee_types_vendor_specific *) 1350 current_ptr; 1351 bss_entry->wpa_offset = (u16) 1352 (current_ptr - bss_entry->beacon_buf); 1353 } else if (!memcmp(&vendor_ie->vend_hdr.oui, wmm_oui, 1354 sizeof(wmm_oui))) { 1355 if (total_ie_len == 1356 sizeof(struct ieee_types_wmm_parameter) || 1357 total_ie_len == 1358 sizeof(struct ieee_types_wmm_info)) 1359 /* 1360 * Only accept and copy the WMM IE if 1361 * it matches the size expected for the 1362 * WMM Info IE or the WMM Parameter IE. 1363 */ 1364 memcpy((u8 *) &bss_entry->wmm_ie, 1365 current_ptr, total_ie_len); 1366 } 1367 break; 1368 case WLAN_EID_RSN: 1369 bss_entry->bcn_rsn_ie = 1370 (struct ieee_types_generic *) current_ptr; 1371 bss_entry->rsn_offset = (u16) (current_ptr - 1372 bss_entry->beacon_buf); 1373 break; 1374 case WLAN_EID_RSNX: 1375 bss_entry->bcn_rsnx_ie = 1376 (struct ieee_types_generic *)current_ptr; 1377 bss_entry->rsnx_offset = 1378 (u16)(current_ptr - bss_entry->beacon_buf); 1379 break; 1380 case WLAN_EID_BSS_AC_ACCESS_DELAY: 1381 bss_entry->bcn_wapi_ie = 1382 (struct ieee_types_generic *) current_ptr; 1383 bss_entry->wapi_offset = (u16) (current_ptr - 1384 bss_entry->beacon_buf); 1385 break; 1386 case WLAN_EID_HT_CAPABILITY: 1387 bss_entry->bcn_ht_cap = (struct ieee80211_ht_cap *) 1388 (current_ptr + 1389 sizeof(struct ieee_types_header)); 1390 bss_entry->ht_cap_offset = (u16) (current_ptr + 1391 sizeof(struct ieee_types_header) - 1392 bss_entry->beacon_buf); 1393 break; 1394 case WLAN_EID_HT_OPERATION: 1395 bss_entry->bcn_ht_oper = 1396 (struct ieee80211_ht_operation *)(current_ptr + 1397 sizeof(struct ieee_types_header)); 1398 bss_entry->ht_info_offset = (u16) (current_ptr + 1399 sizeof(struct ieee_types_header) - 1400 bss_entry->beacon_buf); 1401 break; 1402 case WLAN_EID_VHT_CAPABILITY: 1403 bss_entry->disable_11ac = false; 1404 bss_entry->bcn_vht_cap = 1405 (void *)(current_ptr + 1406 sizeof(struct ieee_types_header)); 1407 bss_entry->vht_cap_offset = 1408 (u16)((u8 *)bss_entry->bcn_vht_cap - 1409 bss_entry->beacon_buf); 1410 break; 1411 case WLAN_EID_VHT_OPERATION: 1412 bss_entry->bcn_vht_oper = 1413 (void *)(current_ptr + 1414 sizeof(struct ieee_types_header)); 1415 bss_entry->vht_info_offset = 1416 (u16)((u8 *)bss_entry->bcn_vht_oper - 1417 bss_entry->beacon_buf); 1418 break; 1419 case WLAN_EID_BSS_COEX_2040: 1420 bss_entry->bcn_bss_co_2040 = current_ptr; 1421 bss_entry->bss_co_2040_offset = 1422 (u16) (current_ptr - bss_entry->beacon_buf); 1423 break; 1424 case WLAN_EID_EXT_CAPABILITY: 1425 bss_entry->bcn_ext_cap = current_ptr; 1426 bss_entry->ext_cap_offset = 1427 (u16) (current_ptr - bss_entry->beacon_buf); 1428 break; 1429 case WLAN_EID_OPMODE_NOTIF: 1430 bss_entry->oper_mode = (void *)current_ptr; 1431 bss_entry->oper_mode_offset = 1432 (u16)((u8 *)bss_entry->oper_mode - 1433 bss_entry->beacon_buf); 1434 break; 1435 default: 1436 break; 1437 } 1438 1439 current_ptr += total_ie_len; 1440 bytes_left -= total_ie_len; 1441 1442 } /* while (bytes_left > 2) */ 1443 return 0; 1444 } 1445 1446 /* 1447 * This function converts radio type scan parameter to a band configuration 1448 * to be used in join command. 1449 */ 1450 static u8 1451 mwifiex_radio_type_to_band(u8 radio_type) 1452 { 1453 switch (radio_type) { 1454 case HostCmd_SCAN_RADIO_TYPE_A: 1455 return BAND_A; 1456 case HostCmd_SCAN_RADIO_TYPE_BG: 1457 default: 1458 return BAND_G; 1459 } 1460 } 1461 1462 /* 1463 * This is an internal function used to start a scan based on an input 1464 * configuration. 1465 * 1466 * This uses the input user scan configuration information when provided in 1467 * order to send the appropriate scan commands to firmware to populate or 1468 * update the internal driver scan table. 1469 */ 1470 int mwifiex_scan_networks(struct mwifiex_private *priv, 1471 const struct mwifiex_user_scan_cfg *user_scan_in) 1472 { 1473 int ret; 1474 struct mwifiex_adapter *adapter = priv->adapter; 1475 struct cmd_ctrl_node *cmd_node; 1476 union mwifiex_scan_cmd_config_tlv *scan_cfg_out; 1477 struct mwifiex_ie_types_chan_list_param_set *chan_list_out; 1478 struct mwifiex_chan_scan_param_set *scan_chan_list; 1479 u8 filtered_scan; 1480 u8 scan_current_chan_only; 1481 u8 max_chan_per_scan; 1482 1483 if (adapter->scan_processing) { 1484 mwifiex_dbg(adapter, WARN, 1485 "cmd: Scan already in process...\n"); 1486 return -EBUSY; 1487 } 1488 1489 if (priv->scan_block) { 1490 mwifiex_dbg(adapter, WARN, 1491 "cmd: Scan is blocked during association...\n"); 1492 return -EBUSY; 1493 } 1494 1495 if (test_bit(MWIFIEX_SURPRISE_REMOVED, &adapter->work_flags) || 1496 test_bit(MWIFIEX_IS_CMD_TIMEDOUT, &adapter->work_flags)) { 1497 mwifiex_dbg(adapter, ERROR, 1498 "Ignore scan. Card removed or firmware in bad state\n"); 1499 return -EFAULT; 1500 } 1501 1502 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1503 adapter->scan_processing = true; 1504 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1505 1506 scan_cfg_out = kzalloc(sizeof(union mwifiex_scan_cmd_config_tlv), 1507 GFP_KERNEL); 1508 if (!scan_cfg_out) { 1509 ret = -ENOMEM; 1510 goto done; 1511 } 1512 1513 scan_chan_list = kcalloc(MWIFIEX_USER_SCAN_CHAN_MAX, 1514 sizeof(struct mwifiex_chan_scan_param_set), 1515 GFP_KERNEL); 1516 if (!scan_chan_list) { 1517 kfree(scan_cfg_out); 1518 ret = -ENOMEM; 1519 goto done; 1520 } 1521 1522 mwifiex_config_scan(priv, user_scan_in, &scan_cfg_out->config, 1523 &chan_list_out, scan_chan_list, &max_chan_per_scan, 1524 &filtered_scan, &scan_current_chan_only); 1525 1526 ret = mwifiex_scan_channel_list(priv, max_chan_per_scan, filtered_scan, 1527 &scan_cfg_out->config, chan_list_out, 1528 scan_chan_list); 1529 1530 /* Get scan command from scan_pending_q and put to cmd_pending_q */ 1531 if (!ret) { 1532 spin_lock_bh(&adapter->scan_pending_q_lock); 1533 if (!list_empty(&adapter->scan_pending_q)) { 1534 cmd_node = list_first_entry(&adapter->scan_pending_q, 1535 struct cmd_ctrl_node, list); 1536 list_del(&cmd_node->list); 1537 spin_unlock_bh(&adapter->scan_pending_q_lock); 1538 mwifiex_insert_cmd_to_pending_q(adapter, cmd_node); 1539 queue_work(adapter->workqueue, &adapter->main_work); 1540 1541 /* Perform internal scan synchronously */ 1542 if (!priv->scan_request) { 1543 mwifiex_dbg(adapter, INFO, 1544 "wait internal scan\n"); 1545 mwifiex_wait_queue_complete(adapter, cmd_node); 1546 } 1547 } else { 1548 spin_unlock_bh(&adapter->scan_pending_q_lock); 1549 } 1550 } 1551 1552 kfree(scan_cfg_out); 1553 kfree(scan_chan_list); 1554 done: 1555 if (ret) { 1556 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1557 adapter->scan_processing = false; 1558 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1559 } 1560 return ret; 1561 } 1562 1563 /* 1564 * This function prepares a scan command to be sent to the firmware. 1565 * 1566 * This uses the scan command configuration sent to the command processing 1567 * module in command preparation stage to configure a scan command structure 1568 * to send to firmware. 1569 * 1570 * The fixed fields specifying the BSS type and BSSID filters as well as a 1571 * variable number/length of TLVs are sent in the command to firmware. 1572 * 1573 * Preparation also includes - 1574 * - Setting command ID, and proper size 1575 * - Ensuring correct endian-ness 1576 */ 1577 int mwifiex_cmd_802_11_scan(struct host_cmd_ds_command *cmd, 1578 struct mwifiex_scan_cmd_config *scan_cfg) 1579 { 1580 struct host_cmd_ds_802_11_scan *scan_cmd = &cmd->params.scan; 1581 1582 /* Set fixed field variables in scan command */ 1583 scan_cmd->bss_mode = scan_cfg->bss_mode; 1584 memcpy(scan_cmd->bssid, scan_cfg->specific_bssid, 1585 sizeof(scan_cmd->bssid)); 1586 memcpy(scan_cmd->tlv_buffer, scan_cfg->tlv_buf, scan_cfg->tlv_buf_len); 1587 1588 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_SCAN); 1589 1590 /* Size is equal to the sizeof(fixed portions) + the TLV len + header */ 1591 cmd->size = cpu_to_le16((u16) (sizeof(scan_cmd->bss_mode) 1592 + sizeof(scan_cmd->bssid) 1593 + scan_cfg->tlv_buf_len + S_DS_GEN)); 1594 1595 return 0; 1596 } 1597 1598 /* 1599 * This function checks compatibility of requested network with current 1600 * driver settings. 1601 */ 1602 int mwifiex_check_network_compatibility(struct mwifiex_private *priv, 1603 struct mwifiex_bssdescriptor *bss_desc) 1604 { 1605 int ret = -1; 1606 1607 if (!bss_desc) 1608 return -1; 1609 1610 if ((mwifiex_get_cfp(priv, (u8) bss_desc->bss_band, 1611 (u16) bss_desc->channel, 0))) { 1612 switch (priv->bss_mode) { 1613 case NL80211_IFTYPE_STATION: 1614 case NL80211_IFTYPE_ADHOC: 1615 ret = mwifiex_is_network_compatible(priv, bss_desc, 1616 priv->bss_mode); 1617 if (ret) 1618 mwifiex_dbg(priv->adapter, ERROR, 1619 "Incompatible network settings\n"); 1620 break; 1621 default: 1622 ret = 0; 1623 } 1624 } 1625 1626 return ret; 1627 } 1628 1629 /* This function checks if SSID string contains all zeroes or length is zero */ 1630 static bool mwifiex_is_hidden_ssid(struct cfg80211_ssid *ssid) 1631 { 1632 int idx; 1633 1634 for (idx = 0; idx < ssid->ssid_len; idx++) { 1635 if (ssid->ssid[idx]) 1636 return false; 1637 } 1638 1639 return true; 1640 } 1641 1642 /* This function checks if any hidden SSID found in passive scan channels 1643 * and save those channels for specific SSID active scan 1644 */ 1645 static int mwifiex_save_hidden_ssid_channels(struct mwifiex_private *priv, 1646 struct cfg80211_bss *bss) 1647 { 1648 struct mwifiex_bssdescriptor *bss_desc; 1649 int ret; 1650 int chid; 1651 1652 /* Allocate and fill new bss descriptor */ 1653 bss_desc = kzalloc(sizeof(*bss_desc), GFP_KERNEL); 1654 if (!bss_desc) 1655 return -ENOMEM; 1656 1657 ret = mwifiex_fill_new_bss_desc(priv, bss, bss_desc); 1658 if (ret) 1659 goto done; 1660 1661 if (mwifiex_is_hidden_ssid(&bss_desc->ssid)) { 1662 mwifiex_dbg(priv->adapter, INFO, "found hidden SSID\n"); 1663 for (chid = 0 ; chid < MWIFIEX_USER_SCAN_CHAN_MAX; chid++) { 1664 if (priv->hidden_chan[chid].chan_number == 1665 bss->channel->hw_value) 1666 break; 1667 1668 if (!priv->hidden_chan[chid].chan_number) { 1669 priv->hidden_chan[chid].chan_number = 1670 bss->channel->hw_value; 1671 priv->hidden_chan[chid].radio_type = 1672 bss->channel->band; 1673 priv->hidden_chan[chid].scan_type = 1674 MWIFIEX_SCAN_TYPE_ACTIVE; 1675 break; 1676 } 1677 } 1678 } 1679 1680 done: 1681 /* beacon_ie buffer was allocated in function 1682 * mwifiex_fill_new_bss_desc(). Free it now. 1683 */ 1684 kfree(bss_desc->beacon_buf); 1685 kfree(bss_desc); 1686 return 0; 1687 } 1688 1689 static int mwifiex_update_curr_bss_params(struct mwifiex_private *priv, 1690 struct cfg80211_bss *bss) 1691 { 1692 struct mwifiex_bssdescriptor *bss_desc; 1693 int ret; 1694 1695 /* Allocate and fill new bss descriptor */ 1696 bss_desc = kzalloc(sizeof(struct mwifiex_bssdescriptor), GFP_KERNEL); 1697 if (!bss_desc) 1698 return -ENOMEM; 1699 1700 ret = mwifiex_fill_new_bss_desc(priv, bss, bss_desc); 1701 if (ret) 1702 goto done; 1703 1704 ret = mwifiex_check_network_compatibility(priv, bss_desc); 1705 if (ret) 1706 goto done; 1707 1708 spin_lock_bh(&priv->curr_bcn_buf_lock); 1709 /* Make a copy of current BSSID descriptor */ 1710 memcpy(&priv->curr_bss_params.bss_descriptor, bss_desc, 1711 sizeof(priv->curr_bss_params.bss_descriptor)); 1712 1713 /* The contents of beacon_ie will be copied to its own buffer 1714 * in mwifiex_save_curr_bcn() 1715 */ 1716 mwifiex_save_curr_bcn(priv); 1717 spin_unlock_bh(&priv->curr_bcn_buf_lock); 1718 1719 done: 1720 /* beacon_ie buffer was allocated in function 1721 * mwifiex_fill_new_bss_desc(). Free it now. 1722 */ 1723 kfree(bss_desc->beacon_buf); 1724 kfree(bss_desc); 1725 return 0; 1726 } 1727 1728 static int 1729 mwifiex_parse_single_response_buf(struct mwifiex_private *priv, u8 **bss_info, 1730 u32 *bytes_left, u64 fw_tsf, u8 *radio_type, 1731 bool ext_scan, s32 rssi_val) 1732 { 1733 struct mwifiex_adapter *adapter = priv->adapter; 1734 struct mwifiex_chan_freq_power *cfp; 1735 struct cfg80211_bss *bss; 1736 u8 bssid[ETH_ALEN]; 1737 s32 rssi; 1738 const u8 *ie_buf; 1739 size_t ie_len; 1740 u16 channel = 0; 1741 u16 beacon_size = 0; 1742 u32 curr_bcn_bytes; 1743 u32 freq; 1744 u16 beacon_period; 1745 u16 cap_info_bitmap; 1746 u8 *current_ptr; 1747 u64 timestamp; 1748 struct mwifiex_fixed_bcn_param *bcn_param; 1749 struct mwifiex_bss_priv *bss_priv; 1750 1751 if (*bytes_left >= sizeof(beacon_size)) { 1752 /* Extract & convert beacon size from command buffer */ 1753 beacon_size = get_unaligned_le16((*bss_info)); 1754 *bytes_left -= sizeof(beacon_size); 1755 *bss_info += sizeof(beacon_size); 1756 } 1757 1758 if (!beacon_size || beacon_size > *bytes_left) { 1759 *bss_info += *bytes_left; 1760 *bytes_left = 0; 1761 return -EFAULT; 1762 } 1763 1764 /* Initialize the current working beacon pointer for this BSS 1765 * iteration 1766 */ 1767 current_ptr = *bss_info; 1768 1769 /* Advance the return beacon pointer past the current beacon */ 1770 *bss_info += beacon_size; 1771 *bytes_left -= beacon_size; 1772 1773 curr_bcn_bytes = beacon_size; 1774 1775 /* First 5 fields are bssid, RSSI(for legacy scan only), 1776 * time stamp, beacon interval, and capability information 1777 */ 1778 if (curr_bcn_bytes < ETH_ALEN + sizeof(u8) + 1779 sizeof(struct mwifiex_fixed_bcn_param)) { 1780 mwifiex_dbg(adapter, ERROR, 1781 "InterpretIE: not enough bytes left\n"); 1782 return -EFAULT; 1783 } 1784 1785 memcpy(bssid, current_ptr, ETH_ALEN); 1786 current_ptr += ETH_ALEN; 1787 curr_bcn_bytes -= ETH_ALEN; 1788 1789 if (!ext_scan) { 1790 rssi = (s32) *current_ptr; 1791 rssi = (-rssi) * 100; /* Convert dBm to mBm */ 1792 current_ptr += sizeof(u8); 1793 curr_bcn_bytes -= sizeof(u8); 1794 mwifiex_dbg(adapter, INFO, 1795 "info: InterpretIE: RSSI=%d\n", rssi); 1796 } else { 1797 rssi = rssi_val; 1798 } 1799 1800 bcn_param = (struct mwifiex_fixed_bcn_param *)current_ptr; 1801 current_ptr += sizeof(*bcn_param); 1802 curr_bcn_bytes -= sizeof(*bcn_param); 1803 1804 timestamp = le64_to_cpu(bcn_param->timestamp); 1805 beacon_period = le16_to_cpu(bcn_param->beacon_period); 1806 1807 cap_info_bitmap = le16_to_cpu(bcn_param->cap_info_bitmap); 1808 mwifiex_dbg(adapter, INFO, 1809 "info: InterpretIE: capabilities=0x%X\n", 1810 cap_info_bitmap); 1811 1812 /* Rest of the current buffer are IE's */ 1813 ie_buf = current_ptr; 1814 ie_len = curr_bcn_bytes; 1815 mwifiex_dbg(adapter, INFO, 1816 "info: InterpretIE: IELength for this AP = %d\n", 1817 curr_bcn_bytes); 1818 1819 while (curr_bcn_bytes >= sizeof(struct ieee_types_header)) { 1820 u8 element_id, element_len; 1821 1822 element_id = *current_ptr; 1823 element_len = *(current_ptr + 1); 1824 if (curr_bcn_bytes < element_len + 1825 sizeof(struct ieee_types_header)) { 1826 mwifiex_dbg(adapter, ERROR, 1827 "%s: bytes left < IE length\n", __func__); 1828 return -EFAULT; 1829 } 1830 if (element_id == WLAN_EID_DS_PARAMS) { 1831 channel = *(current_ptr + 1832 sizeof(struct ieee_types_header)); 1833 break; 1834 } 1835 1836 current_ptr += element_len + sizeof(struct ieee_types_header); 1837 curr_bcn_bytes -= element_len + 1838 sizeof(struct ieee_types_header); 1839 } 1840 1841 if (channel) { 1842 struct ieee80211_channel *chan; 1843 u8 band; 1844 1845 /* Skip entry if on csa closed channel */ 1846 if (channel == priv->csa_chan) { 1847 mwifiex_dbg(adapter, WARN, 1848 "Dropping entry on csa closed channel\n"); 1849 return 0; 1850 } 1851 1852 band = BAND_G; 1853 if (radio_type) 1854 band = mwifiex_radio_type_to_band(*radio_type & 1855 (BIT(0) | BIT(1))); 1856 1857 cfp = mwifiex_get_cfp(priv, band, channel, 0); 1858 1859 freq = cfp ? cfp->freq : 0; 1860 1861 chan = ieee80211_get_channel(priv->wdev.wiphy, freq); 1862 1863 if (chan && !(chan->flags & IEEE80211_CHAN_DISABLED)) { 1864 bss = cfg80211_inform_bss(priv->wdev.wiphy, 1865 chan, CFG80211_BSS_FTYPE_UNKNOWN, 1866 bssid, timestamp, 1867 cap_info_bitmap, beacon_period, 1868 ie_buf, ie_len, rssi, GFP_ATOMIC); 1869 if (bss) { 1870 bss_priv = (struct mwifiex_bss_priv *)bss->priv; 1871 bss_priv->band = band; 1872 bss_priv->fw_tsf = fw_tsf; 1873 if (priv->media_connected && 1874 !memcmp(bssid, priv->curr_bss_params. 1875 bss_descriptor.mac_address, 1876 ETH_ALEN)) 1877 mwifiex_update_curr_bss_params(priv, 1878 bss); 1879 1880 if ((chan->flags & IEEE80211_CHAN_RADAR) || 1881 (chan->flags & IEEE80211_CHAN_NO_IR)) { 1882 mwifiex_dbg(adapter, INFO, 1883 "radar or passive channel %d\n", 1884 channel); 1885 mwifiex_save_hidden_ssid_channels(priv, 1886 bss); 1887 } 1888 1889 cfg80211_put_bss(priv->wdev.wiphy, bss); 1890 } 1891 } 1892 } else { 1893 mwifiex_dbg(adapter, WARN, "missing BSS channel IE\n"); 1894 } 1895 1896 return 0; 1897 } 1898 1899 static void mwifiex_complete_scan(struct mwifiex_private *priv) 1900 { 1901 struct mwifiex_adapter *adapter = priv->adapter; 1902 1903 adapter->survey_idx = 0; 1904 if (adapter->curr_cmd->wait_q_enabled) { 1905 adapter->cmd_wait_q.status = 0; 1906 if (!priv->scan_request) { 1907 mwifiex_dbg(adapter, INFO, 1908 "complete internal scan\n"); 1909 mwifiex_complete_cmd(adapter, adapter->curr_cmd); 1910 } 1911 } 1912 } 1913 1914 /* This function checks if any hidden SSID found in passive scan channels 1915 * and do specific SSID active scan for those channels 1916 */ 1917 static int 1918 mwifiex_active_scan_req_for_passive_chan(struct mwifiex_private *priv) 1919 { 1920 int ret; 1921 struct mwifiex_adapter *adapter = priv->adapter; 1922 u8 id = 0; 1923 struct mwifiex_user_scan_cfg *user_scan_cfg; 1924 1925 if (adapter->active_scan_triggered || !priv->scan_request || 1926 priv->scan_aborting) { 1927 adapter->active_scan_triggered = false; 1928 return 0; 1929 } 1930 1931 if (!priv->hidden_chan[0].chan_number) { 1932 mwifiex_dbg(adapter, INFO, "No BSS with hidden SSID found on DFS channels\n"); 1933 return 0; 1934 } 1935 user_scan_cfg = kzalloc(sizeof(*user_scan_cfg), GFP_KERNEL); 1936 1937 if (!user_scan_cfg) 1938 return -ENOMEM; 1939 1940 for (id = 0; id < MWIFIEX_USER_SCAN_CHAN_MAX; id++) { 1941 if (!priv->hidden_chan[id].chan_number) 1942 break; 1943 memcpy(&user_scan_cfg->chan_list[id], 1944 &priv->hidden_chan[id], 1945 sizeof(struct mwifiex_user_scan_chan)); 1946 } 1947 1948 adapter->active_scan_triggered = true; 1949 if (priv->scan_request->flags & NL80211_SCAN_FLAG_RANDOM_ADDR) 1950 ether_addr_copy(user_scan_cfg->random_mac, 1951 priv->scan_request->mac_addr); 1952 user_scan_cfg->num_ssids = priv->scan_request->n_ssids; 1953 user_scan_cfg->ssid_list = priv->scan_request->ssids; 1954 1955 ret = mwifiex_scan_networks(priv, user_scan_cfg); 1956 kfree(user_scan_cfg); 1957 1958 memset(&priv->hidden_chan, 0, sizeof(priv->hidden_chan)); 1959 1960 if (ret) { 1961 dev_err(priv->adapter->dev, "scan failed: %d\n", ret); 1962 return ret; 1963 } 1964 1965 return 0; 1966 } 1967 static void mwifiex_check_next_scan_command(struct mwifiex_private *priv) 1968 { 1969 struct mwifiex_adapter *adapter = priv->adapter; 1970 struct cmd_ctrl_node *cmd_node; 1971 1972 spin_lock_bh(&adapter->scan_pending_q_lock); 1973 if (list_empty(&adapter->scan_pending_q)) { 1974 spin_unlock_bh(&adapter->scan_pending_q_lock); 1975 1976 spin_lock_bh(&adapter->mwifiex_cmd_lock); 1977 adapter->scan_processing = false; 1978 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 1979 1980 mwifiex_active_scan_req_for_passive_chan(priv); 1981 1982 if (!adapter->ext_scan) 1983 mwifiex_complete_scan(priv); 1984 1985 if (priv->scan_request) { 1986 struct cfg80211_scan_info info = { 1987 .aborted = false, 1988 }; 1989 1990 mwifiex_dbg(adapter, INFO, 1991 "info: notifying scan done\n"); 1992 cfg80211_scan_done(priv->scan_request, &info); 1993 priv->scan_request = NULL; 1994 priv->scan_aborting = false; 1995 } else { 1996 priv->scan_aborting = false; 1997 mwifiex_dbg(adapter, INFO, 1998 "info: scan already aborted\n"); 1999 } 2000 } else if ((priv->scan_aborting && !priv->scan_request) || 2001 priv->scan_block) { 2002 spin_unlock_bh(&adapter->scan_pending_q_lock); 2003 2004 mwifiex_cancel_pending_scan_cmd(adapter); 2005 2006 spin_lock_bh(&adapter->mwifiex_cmd_lock); 2007 adapter->scan_processing = false; 2008 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 2009 2010 if (!adapter->active_scan_triggered) { 2011 if (priv->scan_request) { 2012 struct cfg80211_scan_info info = { 2013 .aborted = true, 2014 }; 2015 2016 mwifiex_dbg(adapter, INFO, 2017 "info: aborting scan\n"); 2018 cfg80211_scan_done(priv->scan_request, &info); 2019 priv->scan_request = NULL; 2020 priv->scan_aborting = false; 2021 } else { 2022 priv->scan_aborting = false; 2023 mwifiex_dbg(adapter, INFO, 2024 "info: scan already aborted\n"); 2025 } 2026 } 2027 } else { 2028 /* Get scan command from scan_pending_q and put to 2029 * cmd_pending_q 2030 */ 2031 cmd_node = list_first_entry(&adapter->scan_pending_q, 2032 struct cmd_ctrl_node, list); 2033 list_del(&cmd_node->list); 2034 spin_unlock_bh(&adapter->scan_pending_q_lock); 2035 mwifiex_insert_cmd_to_pending_q(adapter, cmd_node); 2036 } 2037 2038 return; 2039 } 2040 2041 void mwifiex_cancel_scan(struct mwifiex_adapter *adapter) 2042 { 2043 struct mwifiex_private *priv; 2044 int i; 2045 2046 mwifiex_cancel_pending_scan_cmd(adapter); 2047 2048 if (adapter->scan_processing) { 2049 spin_lock_bh(&adapter->mwifiex_cmd_lock); 2050 adapter->scan_processing = false; 2051 spin_unlock_bh(&adapter->mwifiex_cmd_lock); 2052 for (i = 0; i < adapter->priv_num; i++) { 2053 priv = adapter->priv[i]; 2054 if (priv->scan_request) { 2055 struct cfg80211_scan_info info = { 2056 .aborted = true, 2057 }; 2058 2059 mwifiex_dbg(adapter, INFO, 2060 "info: aborting scan\n"); 2061 cfg80211_scan_done(priv->scan_request, &info); 2062 priv->scan_request = NULL; 2063 priv->scan_aborting = false; 2064 } 2065 } 2066 } 2067 } 2068 2069 /* 2070 * This function handles the command response of scan. 2071 * 2072 * The response buffer for the scan command has the following 2073 * memory layout: 2074 * 2075 * .-------------------------------------------------------------. 2076 * | Header (4 * sizeof(t_u16)): Standard command response hdr | 2077 * .-------------------------------------------------------------. 2078 * | BufSize (t_u16) : sizeof the BSS Description data | 2079 * .-------------------------------------------------------------. 2080 * | NumOfSet (t_u8) : Number of BSS Descs returned | 2081 * .-------------------------------------------------------------. 2082 * | BSSDescription data (variable, size given in BufSize) | 2083 * .-------------------------------------------------------------. 2084 * | TLV data (variable, size calculated using Header->Size, | 2085 * | BufSize and sizeof the fixed fields above) | 2086 * .-------------------------------------------------------------. 2087 */ 2088 int mwifiex_ret_802_11_scan(struct mwifiex_private *priv, 2089 struct host_cmd_ds_command *resp) 2090 { 2091 int ret = 0; 2092 struct mwifiex_adapter *adapter = priv->adapter; 2093 struct host_cmd_ds_802_11_scan_rsp *scan_rsp; 2094 struct mwifiex_ie_types_data *tlv_data; 2095 struct mwifiex_ie_types_tsf_timestamp *tsf_tlv; 2096 u8 *bss_info; 2097 u32 scan_resp_size; 2098 u32 bytes_left; 2099 u32 idx; 2100 u32 tlv_buf_size; 2101 struct mwifiex_ie_types_chan_band_list_param_set *chan_band_tlv; 2102 struct chan_band_param_set *chan_band; 2103 u8 is_bgscan_resp; 2104 __le64 fw_tsf = 0; 2105 u8 *radio_type; 2106 struct cfg80211_wowlan_nd_match *pmatch; 2107 struct cfg80211_sched_scan_request *nd_config = NULL; 2108 2109 is_bgscan_resp = (le16_to_cpu(resp->command) 2110 == HostCmd_CMD_802_11_BG_SCAN_QUERY); 2111 if (is_bgscan_resp) 2112 scan_rsp = &resp->params.bg_scan_query_resp.scan_resp; 2113 else 2114 scan_rsp = &resp->params.scan_resp; 2115 2116 2117 if (scan_rsp->number_of_sets > MWIFIEX_MAX_AP) { 2118 mwifiex_dbg(adapter, ERROR, 2119 "SCAN_RESP: too many AP returned (%d)\n", 2120 scan_rsp->number_of_sets); 2121 ret = -1; 2122 goto check_next_scan; 2123 } 2124 2125 /* Check csa channel expiry before parsing scan response */ 2126 mwifiex_11h_get_csa_closed_channel(priv); 2127 2128 bytes_left = le16_to_cpu(scan_rsp->bss_descript_size); 2129 mwifiex_dbg(adapter, INFO, 2130 "info: SCAN_RESP: bss_descript_size %d\n", 2131 bytes_left); 2132 2133 scan_resp_size = le16_to_cpu(resp->size); 2134 2135 mwifiex_dbg(adapter, INFO, 2136 "info: SCAN_RESP: returned %d APs before parsing\n", 2137 scan_rsp->number_of_sets); 2138 2139 bss_info = scan_rsp->bss_desc_and_tlv_buffer; 2140 2141 /* 2142 * The size of the TLV buffer is equal to the entire command response 2143 * size (scan_resp_size) minus the fixed fields (sizeof()'s), the 2144 * BSS Descriptions (bss_descript_size as bytesLef) and the command 2145 * response header (S_DS_GEN) 2146 */ 2147 tlv_buf_size = scan_resp_size - (bytes_left 2148 + sizeof(scan_rsp->bss_descript_size) 2149 + sizeof(scan_rsp->number_of_sets) 2150 + S_DS_GEN); 2151 2152 tlv_data = (struct mwifiex_ie_types_data *) (scan_rsp-> 2153 bss_desc_and_tlv_buffer + 2154 bytes_left); 2155 2156 /* Search the TLV buffer space in the scan response for any valid 2157 TLVs */ 2158 mwifiex_ret_802_11_scan_get_tlv_ptrs(adapter, tlv_data, tlv_buf_size, 2159 TLV_TYPE_TSFTIMESTAMP, 2160 (struct mwifiex_ie_types_data **) 2161 &tsf_tlv); 2162 2163 /* Search the TLV buffer space in the scan response for any valid 2164 TLVs */ 2165 mwifiex_ret_802_11_scan_get_tlv_ptrs(adapter, tlv_data, tlv_buf_size, 2166 TLV_TYPE_CHANNELBANDLIST, 2167 (struct mwifiex_ie_types_data **) 2168 &chan_band_tlv); 2169 2170 #ifdef CONFIG_PM 2171 if (priv->wdev.wiphy->wowlan_config) 2172 nd_config = priv->wdev.wiphy->wowlan_config->nd_config; 2173 #endif 2174 2175 if (nd_config) { 2176 adapter->nd_info = 2177 kzalloc(struct_size(adapter->nd_info, matches, 2178 scan_rsp->number_of_sets), 2179 GFP_ATOMIC); 2180 2181 if (adapter->nd_info) 2182 adapter->nd_info->n_matches = scan_rsp->number_of_sets; 2183 } 2184 2185 for (idx = 0; idx < scan_rsp->number_of_sets && bytes_left; idx++) { 2186 /* 2187 * If the TSF TLV was appended to the scan results, save this 2188 * entry's TSF value in the fw_tsf field. It is the firmware's 2189 * TSF value at the time the beacon or probe response was 2190 * received. 2191 */ 2192 if (tsf_tlv) 2193 memcpy(&fw_tsf, &tsf_tlv->tsf_data[idx * TSF_DATA_SIZE], 2194 sizeof(fw_tsf)); 2195 2196 if (chan_band_tlv) { 2197 chan_band = &chan_band_tlv->chan_band_param[idx]; 2198 radio_type = &chan_band->radio_type; 2199 } else { 2200 radio_type = NULL; 2201 } 2202 2203 if (chan_band_tlv && adapter->nd_info) { 2204 adapter->nd_info->matches[idx] = 2205 kzalloc(sizeof(*pmatch) + sizeof(u32), 2206 GFP_ATOMIC); 2207 2208 pmatch = adapter->nd_info->matches[idx]; 2209 2210 if (pmatch) { 2211 pmatch->n_channels = 1; 2212 pmatch->channels[0] = chan_band->chan_number; 2213 } 2214 } 2215 2216 ret = mwifiex_parse_single_response_buf(priv, &bss_info, 2217 &bytes_left, 2218 le64_to_cpu(fw_tsf), 2219 radio_type, false, 0); 2220 if (ret) 2221 goto check_next_scan; 2222 } 2223 2224 check_next_scan: 2225 mwifiex_check_next_scan_command(priv); 2226 return ret; 2227 } 2228 2229 /* 2230 * This function prepares an extended scan command to be sent to the firmware 2231 * 2232 * This uses the scan command configuration sent to the command processing 2233 * module in command preparation stage to configure a extended scan command 2234 * structure to send to firmware. 2235 */ 2236 int mwifiex_cmd_802_11_scan_ext(struct mwifiex_private *priv, 2237 struct host_cmd_ds_command *cmd, 2238 void *data_buf) 2239 { 2240 struct host_cmd_ds_802_11_scan_ext *ext_scan = &cmd->params.ext_scan; 2241 struct mwifiex_scan_cmd_config *scan_cfg = data_buf; 2242 2243 memcpy(ext_scan->tlv_buffer, scan_cfg->tlv_buf, scan_cfg->tlv_buf_len); 2244 2245 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_SCAN_EXT); 2246 2247 /* Size is equal to the sizeof(fixed portions) + the TLV len + header */ 2248 cmd->size = cpu_to_le16((u16)(sizeof(ext_scan->reserved) 2249 + scan_cfg->tlv_buf_len + S_DS_GEN)); 2250 2251 return 0; 2252 } 2253 2254 /* This function prepares an background scan config command to be sent 2255 * to the firmware 2256 */ 2257 int mwifiex_cmd_802_11_bg_scan_config(struct mwifiex_private *priv, 2258 struct host_cmd_ds_command *cmd, 2259 void *data_buf) 2260 { 2261 struct host_cmd_ds_802_11_bg_scan_config *bgscan_config = 2262 &cmd->params.bg_scan_config; 2263 struct mwifiex_bg_scan_cfg *bgscan_cfg_in = data_buf; 2264 u8 *tlv_pos = bgscan_config->tlv; 2265 u8 num_probes; 2266 u32 ssid_len, chan_idx, scan_type, scan_dur, chan_num; 2267 int i; 2268 struct mwifiex_ie_types_num_probes *num_probes_tlv; 2269 struct mwifiex_ie_types_repeat_count *repeat_count_tlv; 2270 struct mwifiex_ie_types_min_rssi_threshold *rssi_threshold_tlv; 2271 struct mwifiex_ie_types_bgscan_start_later *start_later_tlv; 2272 struct mwifiex_ie_types_wildcard_ssid_params *wildcard_ssid_tlv; 2273 struct mwifiex_ie_types_chan_list_param_set *chan_list_tlv; 2274 struct mwifiex_chan_scan_param_set *temp_chan; 2275 2276 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_BG_SCAN_CONFIG); 2277 cmd->size = cpu_to_le16(sizeof(*bgscan_config) + S_DS_GEN); 2278 2279 bgscan_config->action = cpu_to_le16(bgscan_cfg_in->action); 2280 bgscan_config->enable = bgscan_cfg_in->enable; 2281 bgscan_config->bss_type = bgscan_cfg_in->bss_type; 2282 bgscan_config->scan_interval = 2283 cpu_to_le32(bgscan_cfg_in->scan_interval); 2284 bgscan_config->report_condition = 2285 cpu_to_le32(bgscan_cfg_in->report_condition); 2286 2287 /* stop sched scan */ 2288 if (!bgscan_config->enable) 2289 return 0; 2290 2291 bgscan_config->chan_per_scan = bgscan_cfg_in->chan_per_scan; 2292 2293 num_probes = (bgscan_cfg_in->num_probes ? bgscan_cfg_in-> 2294 num_probes : priv->adapter->scan_probes); 2295 2296 if (num_probes) { 2297 num_probes_tlv = (struct mwifiex_ie_types_num_probes *)tlv_pos; 2298 num_probes_tlv->header.type = cpu_to_le16(TLV_TYPE_NUMPROBES); 2299 num_probes_tlv->header.len = 2300 cpu_to_le16(sizeof(num_probes_tlv->num_probes)); 2301 num_probes_tlv->num_probes = cpu_to_le16((u16)num_probes); 2302 2303 tlv_pos += sizeof(num_probes_tlv->header) + 2304 le16_to_cpu(num_probes_tlv->header.len); 2305 } 2306 2307 if (bgscan_cfg_in->repeat_count) { 2308 repeat_count_tlv = 2309 (struct mwifiex_ie_types_repeat_count *)tlv_pos; 2310 repeat_count_tlv->header.type = 2311 cpu_to_le16(TLV_TYPE_REPEAT_COUNT); 2312 repeat_count_tlv->header.len = 2313 cpu_to_le16(sizeof(repeat_count_tlv->repeat_count)); 2314 repeat_count_tlv->repeat_count = 2315 cpu_to_le16(bgscan_cfg_in->repeat_count); 2316 2317 tlv_pos += sizeof(repeat_count_tlv->header) + 2318 le16_to_cpu(repeat_count_tlv->header.len); 2319 } 2320 2321 if (bgscan_cfg_in->rssi_threshold) { 2322 rssi_threshold_tlv = 2323 (struct mwifiex_ie_types_min_rssi_threshold *)tlv_pos; 2324 rssi_threshold_tlv->header.type = 2325 cpu_to_le16(TLV_TYPE_RSSI_LOW); 2326 rssi_threshold_tlv->header.len = 2327 cpu_to_le16(sizeof(rssi_threshold_tlv->rssi_threshold)); 2328 rssi_threshold_tlv->rssi_threshold = 2329 cpu_to_le16(bgscan_cfg_in->rssi_threshold); 2330 2331 tlv_pos += sizeof(rssi_threshold_tlv->header) + 2332 le16_to_cpu(rssi_threshold_tlv->header.len); 2333 } 2334 2335 for (i = 0; i < bgscan_cfg_in->num_ssids; i++) { 2336 ssid_len = bgscan_cfg_in->ssid_list[i].ssid.ssid_len; 2337 2338 wildcard_ssid_tlv = 2339 (struct mwifiex_ie_types_wildcard_ssid_params *)tlv_pos; 2340 wildcard_ssid_tlv->header.type = 2341 cpu_to_le16(TLV_TYPE_WILDCARDSSID); 2342 wildcard_ssid_tlv->header.len = cpu_to_le16( 2343 (u16)(ssid_len + sizeof(wildcard_ssid_tlv-> 2344 max_ssid_length))); 2345 2346 /* max_ssid_length = 0 tells firmware to perform 2347 * specific scan for the SSID filled, whereas 2348 * max_ssid_length = IEEE80211_MAX_SSID_LEN is for 2349 * wildcard scan. 2350 */ 2351 if (ssid_len) 2352 wildcard_ssid_tlv->max_ssid_length = 0; 2353 else 2354 wildcard_ssid_tlv->max_ssid_length = 2355 IEEE80211_MAX_SSID_LEN; 2356 2357 memcpy(wildcard_ssid_tlv->ssid, 2358 bgscan_cfg_in->ssid_list[i].ssid.ssid, ssid_len); 2359 2360 tlv_pos += (sizeof(wildcard_ssid_tlv->header) 2361 + le16_to_cpu(wildcard_ssid_tlv->header.len)); 2362 } 2363 2364 chan_list_tlv = (struct mwifiex_ie_types_chan_list_param_set *)tlv_pos; 2365 2366 if (bgscan_cfg_in->chan_list[0].chan_number) { 2367 dev_dbg(priv->adapter->dev, "info: bgscan: Using supplied channel list\n"); 2368 2369 chan_list_tlv->header.type = cpu_to_le16(TLV_TYPE_CHANLIST); 2370 2371 for (chan_idx = 0; 2372 chan_idx < MWIFIEX_BG_SCAN_CHAN_MAX && 2373 bgscan_cfg_in->chan_list[chan_idx].chan_number; 2374 chan_idx++) { 2375 temp_chan = &chan_list_tlv->chan_scan_param[chan_idx]; 2376 2377 /* Increment the TLV header length by size appended */ 2378 le16_unaligned_add_cpu(&chan_list_tlv->header.len, 2379 sizeof(*chan_list_tlv->chan_scan_param)); 2380 2381 temp_chan->chan_number = 2382 bgscan_cfg_in->chan_list[chan_idx].chan_number; 2383 temp_chan->radio_type = 2384 bgscan_cfg_in->chan_list[chan_idx].radio_type; 2385 2386 scan_type = 2387 bgscan_cfg_in->chan_list[chan_idx].scan_type; 2388 2389 if (scan_type == MWIFIEX_SCAN_TYPE_PASSIVE) 2390 temp_chan->chan_scan_mode_bitmap 2391 |= MWIFIEX_PASSIVE_SCAN; 2392 else 2393 temp_chan->chan_scan_mode_bitmap 2394 &= ~MWIFIEX_PASSIVE_SCAN; 2395 2396 if (bgscan_cfg_in->chan_list[chan_idx].scan_time) { 2397 scan_dur = (u16)bgscan_cfg_in-> 2398 chan_list[chan_idx].scan_time; 2399 } else { 2400 scan_dur = (scan_type == 2401 MWIFIEX_SCAN_TYPE_PASSIVE) ? 2402 priv->adapter->passive_scan_time : 2403 priv->adapter->specific_scan_time; 2404 } 2405 2406 temp_chan->min_scan_time = cpu_to_le16(scan_dur); 2407 temp_chan->max_scan_time = cpu_to_le16(scan_dur); 2408 } 2409 } else { 2410 dev_dbg(priv->adapter->dev, 2411 "info: bgscan: Creating full region channel list\n"); 2412 chan_num = 2413 mwifiex_bgscan_create_channel_list(priv, bgscan_cfg_in, 2414 chan_list_tlv-> 2415 chan_scan_param); 2416 le16_unaligned_add_cpu(&chan_list_tlv->header.len, 2417 chan_num * 2418 sizeof(*chan_list_tlv->chan_scan_param)); 2419 } 2420 2421 tlv_pos += (sizeof(chan_list_tlv->header) 2422 + le16_to_cpu(chan_list_tlv->header.len)); 2423 2424 if (bgscan_cfg_in->start_later) { 2425 start_later_tlv = 2426 (struct mwifiex_ie_types_bgscan_start_later *)tlv_pos; 2427 start_later_tlv->header.type = 2428 cpu_to_le16(TLV_TYPE_BGSCAN_START_LATER); 2429 start_later_tlv->header.len = 2430 cpu_to_le16(sizeof(start_later_tlv->start_later)); 2431 start_later_tlv->start_later = 2432 cpu_to_le16(bgscan_cfg_in->start_later); 2433 2434 tlv_pos += sizeof(start_later_tlv->header) + 2435 le16_to_cpu(start_later_tlv->header.len); 2436 } 2437 2438 /* Append vendor specific IE TLV */ 2439 mwifiex_cmd_append_vsie_tlv(priv, MWIFIEX_VSIE_MASK_BGSCAN, &tlv_pos); 2440 2441 le16_unaligned_add_cpu(&cmd->size, tlv_pos - bgscan_config->tlv); 2442 2443 return 0; 2444 } 2445 2446 int mwifiex_stop_bg_scan(struct mwifiex_private *priv) 2447 { 2448 struct mwifiex_bg_scan_cfg *bgscan_cfg; 2449 2450 if (!priv->sched_scanning) { 2451 dev_dbg(priv->adapter->dev, "bgscan already stopped!\n"); 2452 return 0; 2453 } 2454 2455 bgscan_cfg = kzalloc(sizeof(*bgscan_cfg), GFP_KERNEL); 2456 if (!bgscan_cfg) 2457 return -ENOMEM; 2458 2459 bgscan_cfg->bss_type = MWIFIEX_BSS_MODE_INFRA; 2460 bgscan_cfg->action = MWIFIEX_BGSCAN_ACT_SET; 2461 bgscan_cfg->enable = false; 2462 2463 if (mwifiex_send_cmd(priv, HostCmd_CMD_802_11_BG_SCAN_CONFIG, 2464 HostCmd_ACT_GEN_SET, 0, bgscan_cfg, true)) { 2465 kfree(bgscan_cfg); 2466 return -EFAULT; 2467 } 2468 2469 kfree(bgscan_cfg); 2470 priv->sched_scanning = false; 2471 2472 return 0; 2473 } 2474 2475 static void 2476 mwifiex_update_chan_statistics(struct mwifiex_private *priv, 2477 struct mwifiex_ietypes_chanstats *tlv_stat) 2478 { 2479 struct mwifiex_adapter *adapter = priv->adapter; 2480 u8 i, num_chan; 2481 struct mwifiex_fw_chan_stats *fw_chan_stats; 2482 struct mwifiex_chan_stats chan_stats; 2483 2484 fw_chan_stats = (void *)((u8 *)tlv_stat + 2485 sizeof(struct mwifiex_ie_types_header)); 2486 num_chan = le16_to_cpu(tlv_stat->header.len) / 2487 sizeof(struct mwifiex_chan_stats); 2488 2489 for (i = 0 ; i < num_chan; i++) { 2490 if (adapter->survey_idx >= adapter->num_in_chan_stats) { 2491 mwifiex_dbg(adapter, WARN, 2492 "FW reported too many channel results (max %d)\n", 2493 adapter->num_in_chan_stats); 2494 return; 2495 } 2496 chan_stats.chan_num = fw_chan_stats->chan_num; 2497 chan_stats.bandcfg = fw_chan_stats->bandcfg; 2498 chan_stats.flags = fw_chan_stats->flags; 2499 chan_stats.noise = fw_chan_stats->noise; 2500 chan_stats.total_bss = le16_to_cpu(fw_chan_stats->total_bss); 2501 chan_stats.cca_scan_dur = 2502 le16_to_cpu(fw_chan_stats->cca_scan_dur); 2503 chan_stats.cca_busy_dur = 2504 le16_to_cpu(fw_chan_stats->cca_busy_dur); 2505 mwifiex_dbg(adapter, INFO, 2506 "chan=%d, noise=%d, total_network=%d scan_duration=%d, busy_duration=%d\n", 2507 chan_stats.chan_num, 2508 chan_stats.noise, 2509 chan_stats.total_bss, 2510 chan_stats.cca_scan_dur, 2511 chan_stats.cca_busy_dur); 2512 memcpy(&adapter->chan_stats[adapter->survey_idx++], &chan_stats, 2513 sizeof(struct mwifiex_chan_stats)); 2514 fw_chan_stats++; 2515 } 2516 } 2517 2518 /* This function handles the command response of extended scan */ 2519 int mwifiex_ret_802_11_scan_ext(struct mwifiex_private *priv, 2520 struct host_cmd_ds_command *resp) 2521 { 2522 struct mwifiex_adapter *adapter = priv->adapter; 2523 struct host_cmd_ds_802_11_scan_ext *ext_scan_resp; 2524 struct mwifiex_ie_types_header *tlv; 2525 struct mwifiex_ietypes_chanstats *tlv_stat; 2526 u16 buf_left, type, len; 2527 2528 struct host_cmd_ds_command *cmd_ptr; 2529 struct cmd_ctrl_node *cmd_node; 2530 bool complete_scan = false; 2531 2532 mwifiex_dbg(adapter, INFO, "info: EXT scan returns successfully\n"); 2533 2534 ext_scan_resp = &resp->params.ext_scan; 2535 2536 tlv = (void *)ext_scan_resp->tlv_buffer; 2537 buf_left = le16_to_cpu(resp->size) - (sizeof(*ext_scan_resp) + S_DS_GEN); 2538 2539 while (buf_left >= sizeof(struct mwifiex_ie_types_header)) { 2540 type = le16_to_cpu(tlv->type); 2541 len = le16_to_cpu(tlv->len); 2542 2543 if (buf_left < (sizeof(struct mwifiex_ie_types_header) + len)) { 2544 mwifiex_dbg(adapter, ERROR, 2545 "error processing scan response TLVs"); 2546 break; 2547 } 2548 2549 switch (type) { 2550 case TLV_TYPE_CHANNEL_STATS: 2551 tlv_stat = (void *)tlv; 2552 mwifiex_update_chan_statistics(priv, tlv_stat); 2553 break; 2554 default: 2555 break; 2556 } 2557 2558 buf_left -= len + sizeof(struct mwifiex_ie_types_header); 2559 tlv = (void *)((u8 *)tlv + len + 2560 sizeof(struct mwifiex_ie_types_header)); 2561 } 2562 2563 spin_lock_bh(&adapter->cmd_pending_q_lock); 2564 spin_lock_bh(&adapter->scan_pending_q_lock); 2565 if (list_empty(&adapter->scan_pending_q)) { 2566 complete_scan = true; 2567 list_for_each_entry(cmd_node, &adapter->cmd_pending_q, list) { 2568 cmd_ptr = (void *)cmd_node->cmd_skb->data; 2569 if (le16_to_cpu(cmd_ptr->command) == 2570 HostCmd_CMD_802_11_SCAN_EXT) { 2571 mwifiex_dbg(adapter, INFO, 2572 "Scan pending in command pending list"); 2573 complete_scan = false; 2574 break; 2575 } 2576 } 2577 } 2578 spin_unlock_bh(&adapter->scan_pending_q_lock); 2579 spin_unlock_bh(&adapter->cmd_pending_q_lock); 2580 2581 if (complete_scan) 2582 mwifiex_complete_scan(priv); 2583 2584 return 0; 2585 } 2586 2587 /* This function This function handles the event extended scan report. It 2588 * parses extended scan results and informs to cfg80211 stack. 2589 */ 2590 int mwifiex_handle_event_ext_scan_report(struct mwifiex_private *priv, 2591 void *buf) 2592 { 2593 int ret = 0; 2594 struct mwifiex_adapter *adapter = priv->adapter; 2595 u8 *bss_info; 2596 u32 bytes_left, bytes_left_for_tlv, idx; 2597 u16 type, len; 2598 struct mwifiex_ie_types_data *tlv; 2599 struct mwifiex_ie_types_bss_scan_rsp *scan_rsp_tlv; 2600 struct mwifiex_ie_types_bss_scan_info *scan_info_tlv; 2601 u8 *radio_type; 2602 u64 fw_tsf = 0; 2603 s32 rssi = 0; 2604 struct mwifiex_event_scan_result *event_scan = buf; 2605 u8 num_of_set = event_scan->num_of_set; 2606 u8 *scan_resp = buf + sizeof(struct mwifiex_event_scan_result); 2607 u16 scan_resp_size = le16_to_cpu(event_scan->buf_size); 2608 2609 if (num_of_set > MWIFIEX_MAX_AP) { 2610 mwifiex_dbg(adapter, ERROR, 2611 "EXT_SCAN: Invalid number of AP returned (%d)!!\n", 2612 num_of_set); 2613 ret = -1; 2614 goto check_next_scan; 2615 } 2616 2617 bytes_left = scan_resp_size; 2618 mwifiex_dbg(adapter, INFO, 2619 "EXT_SCAN: size %d, returned %d APs...", 2620 scan_resp_size, num_of_set); 2621 mwifiex_dbg_dump(adapter, CMD_D, "EXT_SCAN buffer:", buf, 2622 scan_resp_size + 2623 sizeof(struct mwifiex_event_scan_result)); 2624 2625 tlv = (struct mwifiex_ie_types_data *)scan_resp; 2626 2627 for (idx = 0; idx < num_of_set && bytes_left; idx++) { 2628 type = le16_to_cpu(tlv->header.type); 2629 len = le16_to_cpu(tlv->header.len); 2630 if (bytes_left < sizeof(struct mwifiex_ie_types_header) + len) { 2631 mwifiex_dbg(adapter, ERROR, 2632 "EXT_SCAN: Error bytes left < TLV length\n"); 2633 break; 2634 } 2635 scan_rsp_tlv = NULL; 2636 scan_info_tlv = NULL; 2637 bytes_left_for_tlv = bytes_left; 2638 2639 /* BSS response TLV with beacon or probe response buffer 2640 * at the initial position of each descriptor 2641 */ 2642 if (type != TLV_TYPE_BSS_SCAN_RSP) 2643 break; 2644 2645 bss_info = (u8 *)tlv; 2646 scan_rsp_tlv = (struct mwifiex_ie_types_bss_scan_rsp *)tlv; 2647 tlv = (struct mwifiex_ie_types_data *)(tlv->data + len); 2648 bytes_left_for_tlv -= 2649 (len + sizeof(struct mwifiex_ie_types_header)); 2650 2651 while (bytes_left_for_tlv >= 2652 sizeof(struct mwifiex_ie_types_header) && 2653 le16_to_cpu(tlv->header.type) != TLV_TYPE_BSS_SCAN_RSP) { 2654 type = le16_to_cpu(tlv->header.type); 2655 len = le16_to_cpu(tlv->header.len); 2656 if (bytes_left_for_tlv < 2657 sizeof(struct mwifiex_ie_types_header) + len) { 2658 mwifiex_dbg(adapter, ERROR, 2659 "EXT_SCAN: Error in processing TLV,\t" 2660 "bytes left < TLV length\n"); 2661 scan_rsp_tlv = NULL; 2662 bytes_left_for_tlv = 0; 2663 continue; 2664 } 2665 switch (type) { 2666 case TLV_TYPE_BSS_SCAN_INFO: 2667 scan_info_tlv = 2668 (struct mwifiex_ie_types_bss_scan_info *)tlv; 2669 if (len != 2670 sizeof(struct mwifiex_ie_types_bss_scan_info) - 2671 sizeof(struct mwifiex_ie_types_header)) { 2672 bytes_left_for_tlv = 0; 2673 continue; 2674 } 2675 break; 2676 default: 2677 break; 2678 } 2679 tlv = (struct mwifiex_ie_types_data *)(tlv->data + len); 2680 bytes_left -= 2681 (len + sizeof(struct mwifiex_ie_types_header)); 2682 bytes_left_for_tlv -= 2683 (len + sizeof(struct mwifiex_ie_types_header)); 2684 } 2685 2686 if (!scan_rsp_tlv) 2687 break; 2688 2689 /* Advance pointer to the beacon buffer length and 2690 * update the bytes count so that the function 2691 * wlan_interpret_bss_desc_with_ie() can handle the 2692 * scan buffer withut any change 2693 */ 2694 bss_info += sizeof(u16); 2695 bytes_left -= sizeof(u16); 2696 2697 if (scan_info_tlv) { 2698 rssi = (s32)(s16)(le16_to_cpu(scan_info_tlv->rssi)); 2699 rssi *= 100; /* Convert dBm to mBm */ 2700 mwifiex_dbg(adapter, INFO, 2701 "info: InterpretIE: RSSI=%d\n", rssi); 2702 fw_tsf = le64_to_cpu(scan_info_tlv->tsf); 2703 radio_type = &scan_info_tlv->radio_type; 2704 } else { 2705 radio_type = NULL; 2706 } 2707 ret = mwifiex_parse_single_response_buf(priv, &bss_info, 2708 &bytes_left, fw_tsf, 2709 radio_type, true, rssi); 2710 if (ret) 2711 goto check_next_scan; 2712 } 2713 2714 check_next_scan: 2715 if (!event_scan->more_event) 2716 mwifiex_check_next_scan_command(priv); 2717 2718 return ret; 2719 } 2720 2721 /* 2722 * This function prepares command for background scan query. 2723 * 2724 * Preparation includes - 2725 * - Setting command ID and proper size 2726 * - Setting background scan flush parameter 2727 * - Ensuring correct endian-ness 2728 */ 2729 int mwifiex_cmd_802_11_bg_scan_query(struct host_cmd_ds_command *cmd) 2730 { 2731 struct host_cmd_ds_802_11_bg_scan_query *bg_query = 2732 &cmd->params.bg_scan_query; 2733 2734 cmd->command = cpu_to_le16(HostCmd_CMD_802_11_BG_SCAN_QUERY); 2735 cmd->size = cpu_to_le16(sizeof(struct host_cmd_ds_802_11_bg_scan_query) 2736 + S_DS_GEN); 2737 2738 bg_query->flush = 1; 2739 2740 return 0; 2741 } 2742 2743 /* 2744 * This function inserts scan command node to the scan pending queue. 2745 */ 2746 void 2747 mwifiex_queue_scan_cmd(struct mwifiex_private *priv, 2748 struct cmd_ctrl_node *cmd_node) 2749 { 2750 struct mwifiex_adapter *adapter = priv->adapter; 2751 2752 cmd_node->wait_q_enabled = true; 2753 cmd_node->condition = &adapter->scan_wait_q_woken; 2754 spin_lock_bh(&adapter->scan_pending_q_lock); 2755 list_add_tail(&cmd_node->list, &adapter->scan_pending_q); 2756 spin_unlock_bh(&adapter->scan_pending_q_lock); 2757 } 2758 2759 /* 2760 * This function sends a scan command for all available channels to the 2761 * firmware, filtered on a specific SSID. 2762 */ 2763 static int mwifiex_scan_specific_ssid(struct mwifiex_private *priv, 2764 struct cfg80211_ssid *req_ssid) 2765 { 2766 struct mwifiex_adapter *adapter = priv->adapter; 2767 int ret; 2768 struct mwifiex_user_scan_cfg *scan_cfg; 2769 2770 if (adapter->scan_processing) { 2771 mwifiex_dbg(adapter, WARN, 2772 "cmd: Scan already in process...\n"); 2773 return -EBUSY; 2774 } 2775 2776 if (priv->scan_block) { 2777 mwifiex_dbg(adapter, WARN, 2778 "cmd: Scan is blocked during association...\n"); 2779 return -EBUSY; 2780 } 2781 2782 scan_cfg = kzalloc(sizeof(struct mwifiex_user_scan_cfg), GFP_KERNEL); 2783 if (!scan_cfg) 2784 return -ENOMEM; 2785 2786 scan_cfg->ssid_list = req_ssid; 2787 scan_cfg->num_ssids = 1; 2788 2789 ret = mwifiex_scan_networks(priv, scan_cfg); 2790 2791 kfree(scan_cfg); 2792 return ret; 2793 } 2794 2795 /* 2796 * Sends IOCTL request to start a scan. 2797 * 2798 * This function allocates the IOCTL request buffer, fills it 2799 * with requisite parameters and calls the IOCTL handler. 2800 * 2801 * Scan command can be issued for both normal scan and specific SSID 2802 * scan, depending upon whether an SSID is provided or not. 2803 */ 2804 int mwifiex_request_scan(struct mwifiex_private *priv, 2805 struct cfg80211_ssid *req_ssid) 2806 { 2807 int ret; 2808 2809 if (mutex_lock_interruptible(&priv->async_mutex)) { 2810 mwifiex_dbg(priv->adapter, ERROR, 2811 "%s: acquire semaphore fail\n", 2812 __func__); 2813 return -1; 2814 } 2815 2816 priv->adapter->scan_wait_q_woken = false; 2817 2818 if (req_ssid && req_ssid->ssid_len != 0) 2819 /* Specific SSID scan */ 2820 ret = mwifiex_scan_specific_ssid(priv, req_ssid); 2821 else 2822 /* Normal scan */ 2823 ret = mwifiex_scan_networks(priv, NULL); 2824 2825 mutex_unlock(&priv->async_mutex); 2826 2827 return ret; 2828 } 2829 2830 /* 2831 * This function appends the vendor specific IE TLV to a buffer. 2832 */ 2833 int 2834 mwifiex_cmd_append_vsie_tlv(struct mwifiex_private *priv, 2835 u16 vsie_mask, u8 **buffer) 2836 { 2837 int id, ret_len = 0; 2838 struct mwifiex_ie_types_vendor_param_set *vs_param_set; 2839 2840 if (!buffer) 2841 return 0; 2842 if (!(*buffer)) 2843 return 0; 2844 2845 /* 2846 * Traverse through the saved vendor specific IE array and append 2847 * the selected(scan/assoc/adhoc) IE as TLV to the command 2848 */ 2849 for (id = 0; id < MWIFIEX_MAX_VSIE_NUM; id++) { 2850 if (priv->vs_ie[id].mask & vsie_mask) { 2851 vs_param_set = 2852 (struct mwifiex_ie_types_vendor_param_set *) 2853 *buffer; 2854 vs_param_set->header.type = 2855 cpu_to_le16(TLV_TYPE_PASSTHROUGH); 2856 vs_param_set->header.len = 2857 cpu_to_le16((((u16) priv->vs_ie[id].ie[1]) 2858 & 0x00FF) + 2); 2859 if (le16_to_cpu(vs_param_set->header.len) > 2860 MWIFIEX_MAX_VSIE_LEN) { 2861 mwifiex_dbg(priv->adapter, ERROR, 2862 "Invalid param length!\n"); 2863 break; 2864 } 2865 2866 memcpy(vs_param_set->ie, priv->vs_ie[id].ie, 2867 le16_to_cpu(vs_param_set->header.len)); 2868 *buffer += le16_to_cpu(vs_param_set->header.len) + 2869 sizeof(struct mwifiex_ie_types_header); 2870 ret_len += le16_to_cpu(vs_param_set->header.len) + 2871 sizeof(struct mwifiex_ie_types_header); 2872 } 2873 } 2874 return ret_len; 2875 } 2876 2877 /* 2878 * This function saves a beacon buffer of the current BSS descriptor. 2879 * 2880 * The current beacon buffer is saved so that it can be restored in the 2881 * following cases that makes the beacon buffer not to contain the current 2882 * ssid's beacon buffer. 2883 * - The current ssid was not found somehow in the last scan. 2884 * - The current ssid was the last entry of the scan table and overloaded. 2885 */ 2886 void 2887 mwifiex_save_curr_bcn(struct mwifiex_private *priv) 2888 { 2889 struct mwifiex_bssdescriptor *curr_bss = 2890 &priv->curr_bss_params.bss_descriptor; 2891 2892 if (!curr_bss->beacon_buf_size) 2893 return; 2894 2895 /* allocate beacon buffer at 1st time; or if it's size has changed */ 2896 if (!priv->curr_bcn_buf || 2897 priv->curr_bcn_size != curr_bss->beacon_buf_size) { 2898 priv->curr_bcn_size = curr_bss->beacon_buf_size; 2899 2900 kfree(priv->curr_bcn_buf); 2901 priv->curr_bcn_buf = kmalloc(curr_bss->beacon_buf_size, 2902 GFP_ATOMIC); 2903 if (!priv->curr_bcn_buf) 2904 return; 2905 } 2906 2907 memcpy(priv->curr_bcn_buf, curr_bss->beacon_buf, 2908 curr_bss->beacon_buf_size); 2909 mwifiex_dbg(priv->adapter, INFO, 2910 "info: current beacon saved %d\n", 2911 priv->curr_bcn_size); 2912 2913 curr_bss->beacon_buf = priv->curr_bcn_buf; 2914 2915 /* adjust the pointers in the current BSS descriptor */ 2916 if (curr_bss->bcn_wpa_ie) 2917 curr_bss->bcn_wpa_ie = 2918 (struct ieee_types_vendor_specific *) 2919 (curr_bss->beacon_buf + 2920 curr_bss->wpa_offset); 2921 2922 if (curr_bss->bcn_rsn_ie) 2923 curr_bss->bcn_rsn_ie = (struct ieee_types_generic *) 2924 (curr_bss->beacon_buf + 2925 curr_bss->rsn_offset); 2926 2927 if (curr_bss->bcn_ht_cap) 2928 curr_bss->bcn_ht_cap = (struct ieee80211_ht_cap *) 2929 (curr_bss->beacon_buf + 2930 curr_bss->ht_cap_offset); 2931 2932 if (curr_bss->bcn_ht_oper) 2933 curr_bss->bcn_ht_oper = (struct ieee80211_ht_operation *) 2934 (curr_bss->beacon_buf + 2935 curr_bss->ht_info_offset); 2936 2937 if (curr_bss->bcn_vht_cap) 2938 curr_bss->bcn_vht_cap = (void *)(curr_bss->beacon_buf + 2939 curr_bss->vht_cap_offset); 2940 2941 if (curr_bss->bcn_vht_oper) 2942 curr_bss->bcn_vht_oper = (void *)(curr_bss->beacon_buf + 2943 curr_bss->vht_info_offset); 2944 2945 if (curr_bss->bcn_bss_co_2040) 2946 curr_bss->bcn_bss_co_2040 = 2947 (curr_bss->beacon_buf + curr_bss->bss_co_2040_offset); 2948 2949 if (curr_bss->bcn_ext_cap) 2950 curr_bss->bcn_ext_cap = curr_bss->beacon_buf + 2951 curr_bss->ext_cap_offset; 2952 2953 if (curr_bss->oper_mode) 2954 curr_bss->oper_mode = (void *)(curr_bss->beacon_buf + 2955 curr_bss->oper_mode_offset); 2956 } 2957 2958 /* 2959 * This function frees the current BSS descriptor beacon buffer. 2960 */ 2961 void 2962 mwifiex_free_curr_bcn(struct mwifiex_private *priv) 2963 { 2964 kfree(priv->curr_bcn_buf); 2965 priv->curr_bcn_buf = NULL; 2966 } 2967